diff --git a/libraries/AP_Math/AP_Math.cpp b/libraries/AP_Math/AP_Math.cpp index a352a4a92f..ccaee322ae 100644 --- a/libraries/AP_Math/AP_Math.cpp +++ b/libraries/AP_Math/AP_Math.cpp @@ -141,7 +141,16 @@ T constrain_value(const T amt, const T low, const T high) if (isnan(amt)) { return (low + high) * 0.5f; } - return amt < low ? low : (amt > high ? high : amt); + + if (amt < low) { + return low; + } + + if (amt > high) { + return high; + } + + return amt; } template int constrain_value(const int amt, const int low, const int high);