A* routing to pathfind