Browse Source

EKF: Fix bug causing incorrect yaw variance value to be used

This bug causes the variance of the Z axis rotation vector uncertainty to not be reset to the correct value.
master
Paul Riseborough 6 years ago committed by Lorenz Meier
parent
commit
c032126745
  1. 2
      EKF/ekf_helper.cpp

2
EKF/ekf_helper.cpp

@ -729,7 +729,7 @@ bool Ekf::resetMagHeading(Vector3f &mag_init) @@ -729,7 +729,7 @@ bool Ekf::resetMagHeading(Vector3f &mag_init)
}
// update the yaw angle variance using the variance of the measurement
if (!_control_status.flags.ev_yaw) {
if (_control_status.flags.ev_yaw) {
// using error estimate from external vision data
angle_err_var_vec(2) = sq(fmaxf(_ev_sample_delayed.angErr, 1.0e-2f));

Loading…
Cancel
Save