fix EKF coning correction

prevDelAng==correctedDelAng so prevDelAng % correctedDelAng is a zero-length vector, so coning correction was not working. Reordered the code so that it does.