EKF: Don't run unnecessary makeRowColSymmetric operation

This operation is expensive when done to the whole covariance matrix and unnecessary after covariance prediction because we calculate the upper diagonal and copy across so it is already symmetric.
This commit is contained in:
Paul Riseborough
2020-01-02 19:26:57 +11:00
committed by Paul Riseborough
parent 166d260058
commit 0d0f46ec1c
9 changed files with 24 additions and 17 deletions
+1 -1
View File
@@ -501,7 +501,7 @@ void Ekf::fuseOptFlow()
}
// correct the covariance matrix for gross errors
fixCovarianceErrors();
fixCovarianceErrors(true);
// apply the state corrections
fuse(gain, _flow_innov[obs_index]);