diff --git a/libraries/AP_AHRS/AP_AHRS_DCM.cpp b/libraries/AP_AHRS/AP_AHRS_DCM.cpp index 10a5738cd7..2216af40ef 100644 --- a/libraries/AP_AHRS/AP_AHRS_DCM.cpp +++ b/libraries/AP_AHRS/AP_AHRS_DCM.cpp @@ -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; }