Astar search method