fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-03 04:31:36 +08:00
Code Issues Packages Projects Releases Wiki Activity

Making lowpass filter init bullet proof

Browse Source
This commit is contained in:
Lorenz Meier
2014-07-16 08:47:12 +02:00
parent 9470ac4e0f
commit b08e3d21cd
1 changed files with 10 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/mathlib/math/filter/LowPassFilter2p.hpp
+10 -2
View File
@@ -46,10 +46,18 @@ class __EXPORT LowPassFilter2p
{ {
public: public:
// constructor // constructor
LowPassFilter2p(float sample_freq, float cutoff_freq) { LowPassFilter2p(float sample_freq, float cutoff_freq) :
_cutoff_freq(cutoff_freq),
_a1(0.0f),
_a2(0.0f),
_b0(0.0f),
_b1(0.0f),
_b2(0.0f),
_delay_element_1(0.0f),
_delay_element_2(0.0f)
{
// set initial parameters // set initial parameters
set_cutoff_frequency(sample_freq, cutoff_freq); set_cutoff_frequency(sample_freq, cutoff_freq);
_delay_element_1 = _delay_element_2 = 0;
} }
/** /**