mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-07-08 23:30:34 +08:00
add 2nd order low pass block
This commit is contained in:
@@ -198,6 +198,14 @@ int blockHighPassTest()
|
||||
return 0;
|
||||
}
|
||||
|
||||
float BlockLowPass2::update(float input)
|
||||
{
|
||||
if (_lp.get_cutoff_freq() != getFCutParam()) {
|
||||
_lp.set_cutoff_frequency(_fs, getFCutParam());
|
||||
}
|
||||
return _lp.apply(input);
|
||||
}
|
||||
|
||||
float BlockIntegral::update(float input)
|
||||
{
|
||||
// trapezoidal integration
|
||||
|
||||
Reference in New Issue
Block a user