Browse Source

EKF: Output mag sensor isolation warning first time only

master
Paul Riseborough 8 years ago
parent
commit
596b8220e2
  1. 2
      EKF/ekf_helper.cpp

2
EKF/ekf_helper.cpp

@ -372,7 +372,7 @@ bool Ekf::realignYawGPS() @@ -372,7 +372,7 @@ bool Ekf::realignYawGPS()
ECL_WARN("EKF bad yaw corrected using GPS course");
// declare the magnetomer as failed if a bad yaw has occurred more than once
if (_flt_mag_align_complete && (_num_bad_flight_yaw_events >= 2)) {
if (_flt_mag_align_complete && (_num_bad_flight_yaw_events >= 2) && !_control_status.flags.mag_fault) {
ECL_WARN("EKF stopping magnetometer use");
_control_status.flags.mag_fault = true;
}

Loading…
Cancel
Save