ekf2: centralize mag covariance reset (#693)

* ekf2: centralize mag covariance reset. A complete and clean reset of the
mag states covariances is now performed through the "resetMagCov"
function only. This avoid having slight differences of implementations
across the code.

* Ekf: reset quat cov with initial uncertainty instead of zero
This commit is contained in:
Mathieu Bresciani
2020-03-17 20:07:20 +11:00
committed by GitHub
parent f1aa53db8a
commit f20fc08b7d
3 changed files with 39 additions and 51 deletions
+5 -1
View File
@@ -760,9 +760,13 @@ private:
// do not call before quaternion states are initialised
void initialiseQuatCovariances(Vector3f &rot_vec_var);
// perform a limited reset of the magnetic field state covariances
// perform a limited reset of the magnetic field related state covariances
void resetMagRelatedCovariances();
void resetQuatCov();
void zeroQuatCov();
void resetMagCov();
// perform a limited reset of the wind state covariances
void resetWindCovariance();