mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-03 06:28:27 -04:00
AP_AHRS: fixed check of accel sensor health
we need to check health of each accelerometer separately
This commit is contained in:
parent
5edf4ba596
commit
315290029a
@ -619,7 +619,7 @@ AP_AHRS_DCM::drift_correction(float deltat)
|
||||
int8_t besti = -1;
|
||||
float best_error = 0;
|
||||
for (uint8_t i=0; i<_ins.get_accel_count(); i++) {
|
||||
if (!_ins.get_accel_health()) {
|
||||
if (!_ins.get_accel_health(i)) {
|
||||
// only use healthy sensors
|
||||
continue;
|
||||
}
|
||||
|
Loading…
Reference in New Issue
Block a user