Update time of last fusion event really only if fused

Except for the velpos fusion
This commit is contained in:
kamilritz
2020-07-16 18:25:06 +02:00
committed by Mathieu Bresciani
parent efd96db49d
commit 05855b7fc1
3 changed files with 4 additions and 7 deletions
+2 -3
View File
@@ -192,9 +192,6 @@ void Ekf::fuseSideslip()
_innov_check_fail_status.flags.reject_sideslip = false;
}
// synthetic sideslip measurement sample has passed check so record it
_time_last_beta_fuse = _time_last_imu;
// apply covariance correction via P_new = (I -K*H)*P
// first calculate expression for KHP
// then calculate P - KHP
@@ -249,6 +246,8 @@ void Ekf::fuseSideslip()
// apply the state corrections
fuse(Kfusion, _beta_innov);
_time_last_beta_fuse = _time_last_imu;
}
}
}