diff --git a/libraries/AP_NavEKF3/AP_NavEKF3.cpp b/libraries/AP_NavEKF3/AP_NavEKF3.cpp index 915f78c311..a000cb1aa6 100644 --- a/libraries/AP_NavEKF3/AP_NavEKF3.cpp +++ b/libraries/AP_NavEKF3/AP_NavEKF3.cpp @@ -978,7 +978,7 @@ void NavEKF3::checkLaneSwitch(void) void NavEKF3::requestYawReset(void) { for (uint8_t i = 0; i < num_cores; i++) { - core[primary].EKFGSF_requestYawReset(); + core[i].EKFGSF_requestYawReset(); } }