Update AStarPathFinding