How to navigate to the next waypoint?