Update code/astar.cpp