setpoint 0 set leads to local_sp_change, waypoint reached and change to next still to verify