AStar optimize