fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-10 12:51:36 +08:00
Code Issues Packages Projects Releases Wiki Activity

ekf2: mag in air reset fall back to regular resetMagHeading() if realignYawGPS() fails

Browse Source
This commit is contained in:
Daniel Agar
2022-04-04 10:42:54 -04:00
parent 4234e9a390
commit 9a929e0857
1 changed files with 2 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/ekf2/EKF/mag_control.cpp
+2 -1
View File
@@ -197,8 +197,9 @@ void Ekf::runInAirYawReset(const Vector3f &mag_sample)
if (_control_status.flags.gps && _control_status.flags.fixed_wing) {
has_realigned_yaw = realignYawGPS(mag_sample);
}
} else if (canResetMagHeading()) {
if (!has_realigned_yaw && canResetMagHeading()) {
has_realigned_yaw = resetMagHeading();
}