EKF: consolidate covariance corrections

Combines the forced symmetry, variance limiting and zeroing of covariances for unwanted states in the one function.
This ensures a consistent correction is applied after every covariance prediction or correction.
This commit is contained in:
Paul Riseborough
2016-05-07 20:29:50 +10:00
parent 0c6a367e1b
commit 7f5669fb2d
7 changed files with 62 additions and 59 deletions
+1 -2
View File
@@ -486,8 +486,7 @@ void Ekf::fuseOptFlow()
}
// correct the covariance marix for gross errors
makeSymmetrical();
limitCov();
fixCovarianceErrors();
// apply the state corrections
fuse(gain, _flow_innov[obs_index]);