aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_NavEKF3: Unblock initial yaw alignment message

Browse Source
This commit is contained in:
Paul Riseborough 2020-09-22 19:13:58 +10:00 committed by Andrew Tridgell
parent f81abd73d6
commit 0b96f046c2
1 changed files with 3 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
libraries/AP_NavEKF3/AP_NavEKF3_MagFusion.cpp
View File

@ -94,14 +94,14 @@ void NavEKF3_core::controlMagYawReset()
// Perform a reset of magnetic field states and reset yaw to corrected magnetic heading
if (magYawResetRequest && use_compass()) {
// set yaw from a single mag sample
setYawFromMag();
// send initial alignment status to console
if (!yawAlignComplete) {
gcs().send_text(MAV_SEVERITY_INFO, "EKF3 IMU%u initial yaw alignment complete",(unsigned)imu_index);
}
// set yaw from a single mag sample
setYawFromMag();
// send in-flight yaw alignment status to console
if (finalResetRequest) {
gcs().send_text(MAV_SEVERITY_INFO, "EKF3 IMU%u in-flight yaw alignment complete",(unsigned)imu_index);