Astar works. Add set nav_goal