Update waypoint mode