diff --git a/libraries/AP_NavEKF3/AP_NavEKF3_Control.cpp b/libraries/AP_NavEKF3/AP_NavEKF3_Control.cpp index 99a04592c1..51c894d107 100644 --- a/libraries/AP_NavEKF3/AP_NavEKF3_Control.cpp +++ b/libraries/AP_NavEKF3/AP_NavEKF3_Control.cpp @@ -121,7 +121,7 @@ void NavEKF3_core::setWindMagStateLearningMode() P[21][21] = bodyMagFieldVar.z; } else { // set the variances equal to the observation variances - for (uint8_t index=18; index<=21; index++) { + for (uint8_t index=16; index<=21; index++) { P[index][index] = sq(frontend->_magNoise); }