Update AStar.cpp

Vector iterator problem