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
+1 -3
View File
@@ -159,9 +159,6 @@ void Ekf::fuseAirspeed()
_innov_check_fail_status.flags.reject_airspeed = false;
}
// Airspeed measurement sample has passed check so record it
_time_last_arsp_fuse = _time_last_imu;
// apply covariance correction via P_new = (I -K*H)*P
// first calculate expression for KHP
// then calculate P - KHP
@@ -211,6 +208,7 @@ void Ekf::fuseAirspeed()
// apply the state corrections
fuse(Kfusion, _airspeed_innov);
_time_last_arsp_fuse = _time_last_imu;
}
}
}