mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-18 06:38:29 -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;
|
int8_t besti = -1;
|
||||||
float best_error = 0;
|
float best_error = 0;
|
||||||
for (uint8_t i=0; i<_ins.get_accel_count(); i++) {
|
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
|
// only use healthy sensors
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user