parent
6b433d8568
commit
7a6fbc1702
13871
obj/betaflight_CC3D.hex
13871
obj/betaflight_CC3D.hex
File diff suppressed because it is too large
Load Diff
13754
obj/betaflight_NAZE.hex
13754
obj/betaflight_NAZE.hex
File diff suppressed because it is too large
Load Diff
File diff suppressed because it is too large
Load Diff
File diff suppressed because it is too large
Load Diff
|
@ -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) {
|
||||
|
|
Loading…
Reference in New Issue