ekf2: create simple estimator aid source base class and extract zero velocity update

This commit is contained in:
Daniel Agar
2023-10-18 20:23:56 -04:00
parent 7ac50a20b0
commit e79737a38d
8 changed files with 165 additions and 26 deletions
+2 -1
View File
@@ -145,7 +145,8 @@ void Ekf::controlFusionModes(const imuSample &imu_delayed)
controlZeroInnovationHeadingUpdate();
controlZeroVelocityUpdate();
_zero_velocity_update.update(*this, imu_delayed);
controlZeroGyroUpdate(imu_delayed);
// Fake position measurement for constraining drift when no other velocity or position measurements