mc_pos_contol: add break when printing warning

8 years ago · 8c5b1d33da
1 changed files with 1 additions and 0 deletions
--- 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)
				@@ -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;
 		}
 	}