diff options
| author | Anton Babushkin <anton.babushkin@me.com> | 2014-04-22 11:13:11 +0200 |
|---|---|---|
| committer | Anton Babushkin <anton.babushkin@me.com> | 2014-04-22 11:13:11 +0200 |
| commit | 302233a34f23a57b67d4ebb8ba3e553ad9d8c445 (patch) | |
| tree | 9fa902073c358151e1ca27430e00919048006d76 /src/lib/mathlib/math/filter/LowPassFilter2p.cpp | |
| parent | dfd9601b571057e73668d9b39d584bc4eb9cc305 (diff) | |
| parent | f0e28a60ca216ec147b359eef5500f190f192c82 (diff) | |
| download | px4-firmware-302233a34f23a57b67d4ebb8ba3e553ad9d8c445.tar.gz px4-firmware-302233a34f23a57b67d4ebb8ba3e553ad9d8c445.tar.bz2 px4-firmware-302233a34f23a57b67d4ebb8ba3e553ad9d8c445.zip | |
Merge branch 'master' into mpc_local_pos
Diffstat (limited to 'src/lib/mathlib/math/filter/LowPassFilter2p.cpp')
| -rw-r--r-- | src/lib/mathlib/math/filter/LowPassFilter2p.cpp | 7 |
1 files changed, 6 insertions, 1 deletions
diff --git a/src/lib/mathlib/math/filter/LowPassFilter2p.cpp b/src/lib/mathlib/math/filter/LowPassFilter2p.cpp index 3699d9bce..6f640c9f9 100644 --- a/src/lib/mathlib/math/filter/LowPassFilter2p.cpp +++ b/src/lib/mathlib/math/filter/LowPassFilter2p.cpp @@ -69,7 +69,7 @@ float LowPassFilter2p::apply(float sample) // do the filtering float delay_element_0 = sample - _delay_element_1 * _a1 - _delay_element_2 * _a2; if (isnan(delay_element_0) || isinf(delay_element_0)) { - // don't allow bad values to propogate via the filter + // don't allow bad values to propagate via the filter delay_element_0 = sample; } float output = delay_element_0 * _b0 + _delay_element_1 * _b1 + _delay_element_2 * _b2; @@ -81,5 +81,10 @@ float LowPassFilter2p::apply(float sample) return output; } +float LowPassFilter2p::reset(float sample) { + _delay_element_1 = _delay_element_2 = sample; + return apply(sample); +} + } // namespace math |