Fix for unset gyroADCf when notch2 disabled

This commit is contained in:
borisbstyle 2017-01-06 09:59:21 +01:00
parent 41e904e200
commit 075b387167
1 changed files with 3 additions and 1 deletions

View File

@ -441,7 +441,9 @@ void gyroUpdate(void)
gyroADCf = notchFilter1ApplyFn(notchFilter1[axis], gyroADCf);
gyro.gyroADCf[axis] = notchFilter2ApplyFn(notchFilter2[axis], gyroADCf);
gyroADCf = notchFilter2ApplyFn(notchFilter2[axis], gyroADCf);
gyro.gyroADCf[axis] = gyroADCf;
if (!calibrationComplete) {
gyroADC[axis] = lrintf(gyro.gyroADCf[axis] / gyro.dev.scale);