mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-22 19:03:33 +08:00
ekf2: move zero gyro update to aid source class
This commit is contained in:
@@ -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();
|
||||
|
||||
Reference in New Issue
Block a user