Remove uninformative comments

This commit is contained in:
kamilritz
2020-06-26 08:26:26 +02:00
committed by Mathieu Bresciani
parent 4a69b41015
commit 48f0eb16da
7 changed files with 0 additions and 44 deletions
-5
View File
@@ -475,13 +475,10 @@ void Ekf::fuseOptFlow()
for (int i = 0; i < _k_num_states; i++) {
if (P(i,i) < KHP(i,i)) {
// zero rows and columns
P.uncorrelateCovarianceSetVariance<1>(i, 0.0f);
//flag as unhealthy
healthy = false;
// update individual measurement health status
if (obs_index == 0) {
_fault_status.flags.bad_optflow_X = true;
@@ -491,12 +488,10 @@ void Ekf::fuseOptFlow()
}
}
// only apply covariance and state corrections if healthy
if (healthy) {
// apply the covariance corrections
P -= KHP;
// correct the covariance matrix for gross errors
fixCovarianceErrors(true);
// apply the state corrections