Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-24 00:35:34 +03:00
Code Issues Wiki Activity

Added notch filter from betaflight (#592)

Browse source
This commit is contained in:
Martin Budden 2016-09-14 17:20:55 +01:00 • committed by Konstantin Sharlaimov
parent c806a7e568
commit daf9ba7dde
6 changed files with 94 additions and 57 deletions
Download patch file Download diff file Expand all files Collapse all files

4
src/main/sensors/acceleration.c
View file

@ -58,7 +58,7 @@ void accInit(uint32_t targetLooptime)
accTargetLooptime = targetLooptime;
if (accLpfCutHz) {
for (int axis = 0; axis < 3; axis++) {
biquadFilterInit(&accFilter[axis], accLpfCutHz, accTargetLooptime);
biquadFilterInitLPF(&accFilter[axis], accLpfCutHz, accTargetLooptime);
}
}
}
@ -223,7 +223,7 @@ void setAccelerationFilter(uint8_t initialAccLpfCutHz)
accLpfCutHz = initialAccLpfCutHz;
if (accTargetLooptime) {
for (int axis = 0; axis < XYZ_AXIS_COUNT; axis++) {
biquadFilterInit(&accFilter[axis], accLpfCutHz, accTargetLooptime);
biquadFilterInitLPF(&accFilter[axis], accLpfCutHz, accTargetLooptime);
}
}
}