Browse Source

AP_Airspeed: constrain internal state of calibration code

mission-4.1.18
Andrew Tridgell 12 years ago
parent
commit
0c06dff2db
  1. 4
      libraries/AP_Airspeed/Airspeed_Calibration.cpp

4
libraries/AP_Airspeed/Airspeed_Calibration.cpp

@ -102,6 +102,10 @@ float Airspeed_Calibration::update(float airspeed, const Vector3f &vg) @@ -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;
}

Loading…
Cancel
Save