diff --git a/libraries/AC_AttitudeControl/AC_AttitudeControl.cpp b/libraries/AC_AttitudeControl/AC_AttitudeControl.cpp index 1973ca60e3..06b6edd9ff 100644 --- a/libraries/AC_AttitudeControl/AC_AttitudeControl.cpp +++ b/libraries/AC_AttitudeControl/AC_AttitudeControl.cpp @@ -634,7 +634,7 @@ void AC_AttitudeControl::set_throttle_out_unstabilized(float throttle_in, bool r float AC_AttitudeControl::sqrt_controller(float error, float p, float second_ord_lim) { - if (is_zero(second_ord_lim) || is_zero(p)) { + if (second_ord_lim < 0.0f || is_zero(second_ord_lim) || is_zero(p)) { return error*p; }