AHRS_NavEKF: fix blended accel to use primary accel

This commit is contained in:
Randy Mackay 2015-08-01 17:19:26 +09:00
parent 5f00ea77e8
commit cdd64fc43d

View File

@ -138,7 +138,7 @@ void AP_AHRS_NavEKF::update(void)
EKF.getIMU1Weighting(IMU1_weighting);
_accel_ef_ekf_blended = _accel_ef_ekf[0] * IMU1_weighting + _accel_ef_ekf[1] * (1.0f-IMU1_weighting);
} else {
_accel_ef_ekf_blended = _accel_ef_ekf[0];
_accel_ef_ekf_blended = _accel_ef_ekf[_ins.get_primary_accel()];
}
}
}