mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-13 22:33:33 +08:00
EKF: capture airspeed innovation test failures
This commit is contained in:
@@ -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
|
||||
|
||||
Reference in New Issue
Block a user