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 4fe46a5102..90c1aac3c5 100644 --- a/src/modules/mc_pos_control/mc_pos_control_main.cpp +++ b/src/modules/mc_pos_control/mc_pos_control_main.cpp @@ -2088,6 +2088,7 @@ MulticopterPositionControl::calculate_thrust_setpoint(float dt) for (int i = 0; i < 3; ++i) { if (!PX4_ISFINITE(thrust_sp(i))) { warn_rate_limited("Thrust setpoint not finite"); + break; } }