From 79dfaadb85159296375b44f1fc18b19e77ca0b81 Mon Sep 17 00:00:00 2001 From: Andrey Mironov Date: Mon, 23 Jul 2018 14:41:21 +0300 Subject: [PATCH] Fixed dynamic notch Q scaling --- src/main/sensors/gyroanalyse.c | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/src/main/sensors/gyroanalyse.c b/src/main/sensors/gyroanalyse.c index 7e8fd5c6c..8a2a2aeb1 100644 --- a/src/main/sensors/gyroanalyse.c +++ b/src/main/sensors/gyroanalyse.c @@ -117,7 +117,7 @@ void gyroDataAnalyseInit(uint32_t targetLooptimeUs) for (int axis = 0; axis < XYZ_AXIS_COUNT; axis++) { fftResult[axis].centerFreq = 200; // any init value biquadFilterInitLPF(&fftFreqFilter[axis], DYN_NOTCH_SMOOTH_FREQ_HZ, looptime); - biquadFilterInit(&fftGyroFilter[axis], FFT_BPF_HZ, 1000000 / FFT_SAMPLING_RATE_HZ, 0.001f * gyroConfig()->dyn_notch_quality, FILTER_BPF); + biquadFilterInit(&fftGyroFilter[axis], FFT_BPF_HZ, 1000000 / FFT_SAMPLING_RATE_HZ, 0.01f * gyroConfig()->dyn_notch_quality, FILTER_BPF); } dynamicNotchCutoff = (100.0f - gyroConfig()->dyn_notch_width_percent) / 100;