AStarSolver implementation