mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-16 23:13:33 +08:00
ekf2: revent yaw spikes on reset (#25972)
This commit is contained in:
@@ -748,7 +748,6 @@ void EKF2::Run()
|
||||
|
||||
// push imu data into estimator
|
||||
_ekf.setIMUData(imu_sample_new);
|
||||
PublishAttitude(now); // publish attitude immediately (uses quaternion from output predictor)
|
||||
|
||||
// integrate time to monitor time slippage
|
||||
if (_start_time_us > 0) {
|
||||
@@ -855,6 +854,9 @@ void EKF2::Run()
|
||||
#endif // CONFIG_EKF2_MAGNETOMETER
|
||||
}
|
||||
|
||||
PublishAttitude(now); // publish attitude immediately (uses quaternion from output predictor)
|
||||
|
||||
|
||||
// publish ekf2_timestamps
|
||||
_ekf2_timestamps_pub.publish(ekf2_timestamps);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user