diff --git a/libraries/AP_Airspeed/Airspeed_Calibration.cpp b/libraries/AP_Airspeed/Airspeed_Calibration.cpp index ee7e404d44..5fc8427490 100644 --- a/libraries/AP_Airspeed/Airspeed_Calibration.cpp +++ b/libraries/AP_Airspeed/Airspeed_Calibration.cpp @@ -102,6 +102,10 @@ float Airspeed_Calibration::update(float airspeed, const Vector3f &vg) P.b.y = max(P.b.y, 0.0f); P.c.z = max(P.c.z, 0.0f); + state.x = constrain_float(state.x, -aparm.airspeed_max, aparm.airspeed_max); + state.y = constrain_float(state.y, -aparm.airspeed_max, aparm.airspeed_max); + state.z = constrain_float(state.z, 0.5f, 1.0f); + return state.z; }