Update AStarAlgorithm.java