EKF: capture airspeed innovation test failures

This commit is contained in:
Paul Riseborough
2016-06-01 17:13:00 +10:00
parent e7690bd8f8
commit cf489f4248
+2
View File
@@ -139,10 +139,12 @@ void Ekf::fuseAirspeed()
// If the innovation consistency check fails then don't fuse the sample and indicate bad airspeed health
if (_tas_test_ratio > 1.0f) {
_airspeed_healthy = false;
_sensor_fault_status.flags.reject_airspeed = true;
return;
}
else {
_airspeed_healthy = true;
_sensor_fault_status.flags.reject_airspeed = false;
}
// Airspeed measurement sample has passed check so record it