EKF2: Zero gyro update (#21691)

When at rest, directly fuse the gyro data as an observation of its bias.
This allows to strongly observe the gyro biases without having to fuse a
constant heading that makes the ekf too confident about its heading.
This commit is contained in:
Mathieu Bresciani
2023-06-09 21:13:18 -04:00
committed by GitHub
parent c95539e8ce
commit 24de623989
13 changed files with 974 additions and 790 deletions
+1
View File
@@ -139,6 +139,7 @@ void Ekf::controlFusionModes(const imuSample &imu_delayed)
controlZeroInnovationHeadingUpdate();
controlZeroVelocityUpdate();
controlZeroGyroUpdate(imu_delayed);
// Fake position measurement for constraining drift when no other velocity or position measurements
controlFakePosFusion();