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 e8ea88a23e..8cfaeafbff 100644 --- a/src/modules/mc_pos_control/mc_pos_control_main.cpp +++ b/src/modules/mc_pos_control/mc_pos_control_main.cpp @@ -1573,6 +1573,8 @@ MulticopterPositionControl::task_main() } /* limit max thrust */ + thrust_abs = thrust_sp.length(); /* recalculate because it might have changed */ + if (thrust_abs > thr_max) { if (thrust_sp(2) < 0.0f) { if (-thrust_sp(2) > thr_max) {