mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-13 21:03:33 +08:00
EKF: capture magnetometer innovation test failures
This commit is contained in:
@@ -183,6 +183,9 @@ void Ekf::fuseMag()
|
||||
|
||||
if (_mag_test_ratio[index] > 1.0f) {
|
||||
_mag_healthy = false;
|
||||
_sensor_fault_status.value |= (1 << (index + 3));
|
||||
} else {
|
||||
_sensor_fault_status.value &= !(1 << (index + 3));
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user