fixed AStar Planner in HW3