Added in the Astar search function