mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-13 22:23:34 +08:00
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:
@@ -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]);
|
||||
|
||||
Reference in New Issue
Block a user