Merge pull request #1699 from martinbudden/bf_gyro_filter_init_fix
Fixed incorrect initialisation of gyro PT1 filter
This commit is contained in:
commit
1bfeabfa96
|
@ -74,7 +74,7 @@ void gyroInit(const gyroConfig_t *gyroConfigToUse)
|
||||||
softLpfFilter[axis] = &gyroFilterLPF[axis];
|
softLpfFilter[axis] = &gyroFilterLPF[axis];
|
||||||
biquadFilterInitLPF(softLpfFilter[axis], gyroConfig->gyro_soft_lpf_hz, gyro.targetLooptime);
|
biquadFilterInitLPF(softLpfFilter[axis], gyroConfig->gyro_soft_lpf_hz, gyro.targetLooptime);
|
||||||
}
|
}
|
||||||
} else if (gyroConfig->gyro_soft_lpf_type == FILTER_BIQUAD) {
|
} else if (gyroConfig->gyro_soft_lpf_type == FILTER_PT1) {
|
||||||
softLpfFilterApplyFn = (filterApplyFnPtr)pt1FilterApply;
|
softLpfFilterApplyFn = (filterApplyFnPtr)pt1FilterApply;
|
||||||
const float gyroDt = (float) gyro.targetLooptime * 0.000001f;
|
const float gyroDt = (float) gyro.targetLooptime * 0.000001f;
|
||||||
for (int axis = 0; axis < 3; axis++) {
|
for (int axis = 0; axis < 3; axis++) {
|
||||||
|
|
Loading…
Reference in New Issue