plane: Allow current waypoint to be set correctly outside Auto mode.