diff --git a/src/modules/mc_pos_control/mc_pos_control_main.cpp b/src/modules/mc_pos_control/mc_pos_control_main.cpp index adaf4a3fb6..299330eebf 100644 --- a/src/modules/mc_pos_control/mc_pos_control_main.cpp +++ b/src/modules/mc_pos_control/mc_pos_control_main.cpp @@ -770,6 +770,8 @@ MulticopterPositionControl::control_offboard(float dt) /* set position setpoint move rate */ _vel_sp(0) = _pos_sp_triplet.current.vx; _vel_sp(1) = _pos_sp_triplet.current.vy; + + _run_pos_control = false; /* request velocity setpoint to be used, instead of position setpoint */ } if (_pos_sp_triplet.current.yaw_valid) { @@ -787,6 +789,8 @@ MulticopterPositionControl::control_offboard(float dt) /* set altitude setpoint move rate */ _vel_sp(2) = _pos_sp_triplet.current.vz; + + _run_alt_control = false; /* request velocity setpoint to be used, instead of position setpoint */ } } else { reset_pos_sp();