diff --git a/libraries/AP_NavEKF3/AP_NavEKF3_Control.cpp b/libraries/AP_NavEKF3/AP_NavEKF3_Control.cpp index 2b21ae3315..8fd587c136 100644 --- a/libraries/AP_NavEKF3/AP_NavEKF3_Control.cpp +++ b/libraries/AP_NavEKF3/AP_NavEKF3_Control.cpp @@ -45,11 +45,6 @@ void NavEKF3_core::controlFilterModes() */ uint8_t NavEKF3_core::effective_magCal(void) const { - // if we are on the 2nd core and _magCal is 3 then treat it as - // 2. This is a workaround for a mag fusion problem - if (frontend->_magCal ==3 && imu_index == 1) { - return 2; - } return frontend->_magCal; }