ekf2: move zero gyro update to aid source class

This commit is contained in:
Daniel Agar
2023-10-18 20:23:56 -04:00
parent e79737a38d
commit 27f9b1b65a
6 changed files with 127 additions and 68 deletions
+3 -1
View File
@@ -147,7 +147,9 @@ void Ekf::controlFusionModes(const imuSample &imu_delayed)
_zero_velocity_update.update(*this, imu_delayed);
controlZeroGyroUpdate(imu_delayed);
if (_params.imu_ctrl & static_cast<int32_t>(ImuCtrl::GyroBias)) {
_zero_gyro_update.update(*this, imu_delayed);
}
// Fake position measurement for constraining drift when no other velocity or position measurements
controlFakePosFusion();