EKF: capture magnetometer innovation test failures

This commit is contained in:
Paul Riseborough
2016-06-01 17:13:00 +10:00
parent 3fb449295e
commit e7690bd8f8
+3
View File
@@ -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));
}
}