Update AStarSearch.java