ekf2: predict covariance before predicting state (#20715)

* To predict the covariance, the jacobian from the previous to the current state is required.
This commit is contained in:
Mathieu Bresciani
2022-12-07 09:34:19 -05:00
committed by GitHub
parent c12d9124bd
commit a187bb3b80
3 changed files with 236 additions and 236 deletions
+1 -1
View File
@@ -103,8 +103,8 @@ bool Ekf::update()
// Only run the filter if IMU data in the buffer has been updated
if (_imu_updated) {
// perform state and covariance prediction for the main filter
predictState();
predictCovariance();
predictState();
// control fusion of observation data
controlFusionModes();