add astar shortest path search