Browse Source

AP_AHRS: fixed bug in blended EKF bias

The bug fix in #20431 was incomplete, and ended up with the wrong
blended accel bias. This fixes it
apm_2208
Andrew Tridgell 3 years ago
parent
commit
5a1a87cc60
  1. 2
      libraries/AP_AHRS/AP_AHRS.cpp

2
libraries/AP_AHRS/AP_AHRS.cpp

@ -613,7 +613,7 @@ void AP_AHRS::update_EKF3(void) @@ -613,7 +613,7 @@ void AP_AHRS::update_EKF3(void)
_accel_ef_ekf[i] = _dcm_matrix * accel;
}
}
_accel_ef_ekf_blended = _accel_ef_ekf[_ins.get_primary_accel()];
_accel_ef_ekf_blended = _accel_ef_ekf[primary_imu>=0?primary_imu:_ins.get_primary_accel()];
nav_filter_status filt_state;
EKF3.getFilterStatus(filt_state);
update_notify_from_filter_status(filt_state);

Loading…
Cancel
Save