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

constdT for gyro fliter

Browse source 
dTGyro
This commit is contained in:
borisbstyle 2015-08-15 15:48:38 +02:00
parent 6f13859345
commit 00ae128e3d
2 changed files with 6 additions and 2 deletions
Download patch file Download diff file Expand all files Collapse all files

7
src/main/mw.c
View file

@ -689,10 +689,15 @@ void processRx(void)
// Gyro Low Pass
void filterGyro(void) {
int axis;
static float dTGyro;
static filterStatePt1_t gyroADCState[XYZ_AXIS_COUNT];
if (!dTGyro) {
dTGyro = (float)targetLooptime * 0.000001f;
}
for (axis = 0; axis < XYZ_AXIS_COUNT; axis++) {
gyroADC[axis] = filterApplyPt1(gyroADC[axis], &gyroADCState[axis], currentProfile->pidProfile.gyro_cut_hz, dT);
gyroADC[axis] = filterApplyPt1(gyroADC[axis], &gyroADCState[axis], currentProfile->pidProfile.gyro_cut_hz, dTGyro);
}
}
void getArmingChannel(modeActivationCondition_t *modeActivationConditions, uint8_t *armingChannel) {