Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-23 00:04:02 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_NavEKF3: Don't allow yaw alignment until tilt alignment completed

Browse Source
This commit is contained in:
Paul Riseborough 2021-03-13 17:38:23 +11:00 committed by Andrew Tridgell
parent a07427fd30
commit 073e273732
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_NavEKF3/AP_NavEKF3_MagFusion.cpp
View File

@ -41,7 +41,7 @@ void NavEKF3_core::controlMagYawReset()
// check if the spin rate is OK - high spin rates can cause angular alignment errors
bool angRateOK = deltaRotVecTemp.length() < 0.1745f;
initialResetAllowed = angRateOK;
initialResetAllowed = angRateOK && tiltAlignComplete;
flightResetAllowed = angRateOK && !onGround;
}