5
0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 14:38:30 -04:00

Filter: fixed ordering of samples in notch reset

This commit is contained in:
Andrew Tridgell 2022-06-11 20:36:01 +10:00
parent d653499efc
commit 7c782dda88

View File

@ -77,11 +77,11 @@ T NotchFilter<T>::apply(const T &sample)
if (!initialised || need_reset) {
// if we have not been initialised when return the input
// sample as output and update delayed samples
ntchsig2 = ntchsig1;
ntchsig1 = ntchsig;
ntchsig = sample;
signal2 = signal1;
signal1 = sample;
signal2 = sample;
ntchsig = sample;
ntchsig1 = sample;
ntchsig2 = sample;
need_reset = false;
return sample;
}