Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-15 12:25:20 +03:00
Code Issues Wiki Activity

move definition of dataThreshold

Browse source
This commit is contained in:
ctzsnooze 2018-08-15 19:13:00 +10:00
parent c6a2ba18ef
commit 2bc6f92c1b
1 changed files with 1 additions and 2 deletions
Download patch file Download diff file Expand all files Collapse all files

3
src/main/sensors/gyroanalyse.c
View file

@ -263,7 +263,6 @@ static FAST_CODE_NOINLINE void gyroDataAnalyseUpdate(gyroAnalyseState_t *state,
float fftWeightedSum = 0; float fftWeightedSum = 0;
float dataAvg = 0; float dataAvg = 0;
float dataMax = 0; float dataMax = 0;
float dataThreshold;
bool fftPeakDetected = false; bool fftPeakDetected = false;
bool fftPeakFinished = false; bool fftPeakFinished = false;
@ -280,7 +279,7 @@ static FAST_CODE_NOINLINE void gyroDataAnalyseUpdate(gyroAnalyseState_t *state,
dataAvg = dataAvg / FFT_BIN_COUNT; dataAvg = dataAvg / FFT_BIN_COUNT;
//peak, once increasing, must be more than 80% above average and 1.4 times average //peak, once increasing, must be more than 80% above average and 1.4 times average
dataThreshold = MAX(1.4f * dataAvg, (0.8f * dataMax + 0.2f * dataAvg)); float dataThreshold = MAX(1.4f * dataAvg, (0.8f * dataMax + 0.2f * dataAvg));
// iterate over fft data and calculate weighted indices // iterate over fft data and calculate weighted indices
fftPeakDetected = false; fftPeakDetected = false;
for (int i = 1 + fftBinOffset; i < FFT_BIN_COUNT; i++) { for (int i = 1 + fftBinOffset; i < FFT_BIN_COUNT; i++) {