mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-23 17:23:33 +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:
@@ -307,13 +307,11 @@ private:
|
||||
// reset height state of the ekf
|
||||
void resetHeight();
|
||||
|
||||
void makeCovSymetrical();
|
||||
|
||||
// limit the diagonal of the covariance matrix
|
||||
void limitCov();
|
||||
void fixCovarianceErrors();
|
||||
|
||||
// make ekf covariance matrix symmetric
|
||||
void makeSymmetrical();
|
||||
// make ekf covariance matrix symmetric between a nominated state indexe range
|
||||
void makeSymmetrical(float (&cov_mat)[_k_num_states][_k_num_states], uint8_t first, uint8_t last);
|
||||
|
||||
// constrain the ekf states
|
||||
void constrainStates();
|
||||
|
||||
Reference in New Issue
Block a user