mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-25 17:43:34 +08:00
ekf2: publish yaw estimator status last
This commit is contained in:
@@ -767,7 +767,6 @@ void EKF2::Run()
|
|||||||
PublishGlobalPosition(now);
|
PublishGlobalPosition(now);
|
||||||
PublishSensorBias(now);
|
PublishSensorBias(now);
|
||||||
PublishWindEstimate(now);
|
PublishWindEstimate(now);
|
||||||
PublishYawEstimatorStatus(now);
|
|
||||||
|
|
||||||
// publish status/logging messages
|
// publish status/logging messages
|
||||||
PublishEkfDriftMetrics(now);
|
PublishEkfDriftMetrics(now);
|
||||||
@@ -776,6 +775,7 @@ void EKF2::Run()
|
|||||||
PublishInnovations(now, imu_sample_new);
|
PublishInnovations(now, imu_sample_new);
|
||||||
PublishInnovationTestRatios(now);
|
PublishInnovationTestRatios(now);
|
||||||
PublishInnovationVariances(now);
|
PublishInnovationVariances(now);
|
||||||
|
PublishYawEstimatorStatus(now);
|
||||||
|
|
||||||
if (!_mag_decl_saved && _standby) {
|
if (!_mag_decl_saved && _standby) {
|
||||||
_mag_decl_saved = update_mag_decl(_param_ekf2_mag_decl);
|
_mag_decl_saved = update_mag_decl(_param_ekf2_mag_decl);
|
||||||
|
|||||||
Reference in New Issue
Block a user