ekf2: revent yaw spikes on reset (#25972)

This commit is contained in:
Nick
2025-12-18 09:08:44 -09:00
committed by GitHub
parent 339a0b40af
commit c51502781f
+3 -1
View File
@@ -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);
}