EKF: Prevent unwanted declination fusion when re-starting 3-axis fusion

This commit is contained in:
Paul Riseborough 2019-01-22 10:29:42 +11:00 committed by Daniel Agar
parent bd1647a7fb
commit fe378fd761
2 changed files with 1 additions and 2 deletions

View File

@ -1608,7 +1608,7 @@ void Ekf::controlMagFusion()
_mag_decl_cov_reset = true;
fuseMag();
} else {
// The normal sequence is to fuse the magnetmer data first before fusing
// The normal sequence is to fuse the magnetometer data first before fusing
// declination angle at a higher uncertainty to allow some learning of
// declination angle over time.
fuseMag();

View File

@ -847,7 +847,6 @@ void Ekf::fixCovarianceErrors()
if (!_control_status.flags.mag_3D) {
zeroRows(P, 16, 21);
zeroCols(P, 16, 21);
_mag_decl_cov_reset = false;
} else {
// constrain variances