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

Merge pull request #2023 from martinbudden/bf_gyro_fixes

Browse source 
Minor fixes to gyro ISR code, as per review
This commit is contained in:
borisbstyle 2017-01-06 11:47:29 +01:00 • committed by GitHub
commit 9fe1ebd1aa
2 changed files with 10 additions and 1 deletions
Download patch file Download diff file Expand all files Collapse all files

7
src/main/sensors/gyro.c
View file

@ -66,7 +66,11 @@
gyro_t gyro; // gyro access functions
#if defined(GYRO_USES_SPI) && defined(USE_MPU_DATA_READY_SIGNAL)
static volatile int32_t gyroADC[XYZ_AXIS_COUNT];
#else
static int32_t gyroADC[XYZ_AXIS_COUNT];
#endif
static int32_t gyroZero[XYZ_AXIS_COUNT] = { 0, 0, 0 };
static const gyroConfig_t *gyroConfig;
@ -391,7 +395,8 @@ static bool gyroUpdateISR(gyroDev_t* gyroDev)
float gyroADCf = (float)gyroADC[axis] * gyroDev->scale;
gyroADCf = softLpfFilterApplyFn(softLpfFilter[axis], gyroADCf);
gyroADCf = notchFilter1ApplyFn(notchFilter1[axis], gyroADCf);
gyro.gyroADCf[axis] = notchFilter2ApplyFn(notchFilter2[axis], gyroADCf);
gyroADCf = notchFilter2ApplyFn(notchFilter2[axis], gyroADCf);
gyro.gyroADCf[axis] = gyroADCf;
}
return true;
}