ekf2: in bias estimator, use psd instead of var for prediction

PSD is independent from the sampling time while variance isn't
This commit is contained in:
bresch
2022-08-24 09:16:11 -04:00
committed by Daniel Agar
parent b04d61c411
commit 52f726c5b7
5 changed files with 20 additions and 20 deletions
+1 -1
View File
@@ -43,7 +43,7 @@ void BiasEstimator::predict(const float dt)
{
// State is constant
// Predict state covariance only
float delta_state_var = _process_var * dt * dt;
float delta_state_var = _process_psd * dt;
if (isOffsetDetected()) {
// A bias in the state has been detected by the innovation sequence check