Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-07 08:28:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

Filter: fixed ordering of samples in notch reset

Browse Source
This commit is contained in:
Andrew Tridgell 2022-06-11 20:36:01 +10:00
parent d653499efc
commit 7c782dda88
1 changed files with 4 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
libraries/Filter/NotchFilter.cpp
View File

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