diff --git a/src/main/sensors/gyro.c b/src/main/sensors/gyro.c index 8275368e51..bf396e58a0 100644 --- a/src/main/sensors/gyro.c +++ b/src/main/sensors/gyro.c @@ -949,6 +949,12 @@ static FAST_CODE FAST_CODE_NOINLINE void gyroUpdateSensor(gyroSensor_t *gyroSens return; } + if (gyroDebugMode == DEBUG_NONE) { + filterGyro(gyroSensor); + } else { + filterGyroDebug(gyroSensor); + } + #ifdef USE_GYRO_OVERFLOW_CHECK if (gyroConfig()->checkOverflow && !gyroHasOverflowProtection) { checkForOverflow(gyroSensor, currentTimeUs); @@ -961,12 +967,6 @@ static FAST_CODE FAST_CODE_NOINLINE void gyroUpdateSensor(gyroSensor_t *gyroSens } #endif - if (gyroDebugMode == DEBUG_NONE) { - filterGyro(gyroSensor); - } else { - filterGyroDebug(gyroSensor); - } - #ifdef USE_GYRO_DATA_ANALYSE if (isDynamicFilterActive()) { gyroDataAnalyse(&gyroSensor->gyroAnalyseState, gyroSensor->notchFilterDyn);