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
-2
View File
@@ -150,8 +150,6 @@ void Ekf::controlMagFusion()
_aid_src_mag_heading.time_last_fuse = _time_delayed_us;
_time_last_heading_fuse = _time_delayed_us;
_last_static_yaw = NAN;
}
}
}