AP_NavEKF: Don't reset filterDiverged status immediately during reset
AP_NAvEKF: Set filterDiverged true if covariance blows up