Browse Source

ekf, control: make sure mag fusion doesn't start anymore when we have GPS heading fusion active

master
Andreas Antener 6 years ago committed by Paul Riseborough
parent
commit
4f19d457c4
  1. 2
      EKF/control.cpp

2
EKF/control.cpp

@ -1384,7 +1384,7 @@ void Ekf::controlMagFusion() @@ -1384,7 +1384,7 @@ void Ekf::controlMagFusion()
// check for new magnetometer data that has fallen behind the fusion time horizon
// If we are using external vision data for heading then no magnetometer fusion is used
if (!_control_status.flags.ev_yaw && _mag_data_ready) {
if (!_control_status.flags.ev_yaw && !_control_status.flags.gps_yaw && _mag_data_ready) {
// We need to reset the yaw angle after climbing away from the ground to enable
// recovery from ground level magnetic interference.

Loading…
Cancel
Save