Browse Source

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

main
Daniel Agar 3 years ago
parent
commit
ecdade3638
  1. 3
      src/modules/ekf2/EKF/mag_control.cpp

3
src/modules/ekf2/EKF/mag_control.cpp

@ -183,8 +183,9 @@ void Ekf::runInAirYawReset(const Vector3f &mag_sample) @@ -183,8 +183,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();
}

Loading…
Cancel
Save