PX4 Firmware
PX4 Autopilot Software http://px4.io
LowPassFilter2p.hpp
Go to the documentation of this file.
1
/****************************************************************************
2
*
3
* Copyright (C) 2012 PX4 Development Team. All rights reserved.
4
*
5
* Redistribution and use in source and binary forms, with or without
6
* modification, are permitted provided that the following conditions
7
* are met:
8
*
9
* 1. Redistributions of source code must retain the above copyright
10
* notice, this list of conditions and the following disclaimer.
11
* 2. Redistributions in binary form must reproduce the above copyright
12
* notice, this list of conditions and the following disclaimer in
13
* the documentation and/or other materials provided with the
14
* distribution.
15
* 3. Neither the name PX4 nor the names of its contributors may be
16
* used to endorse or promote products derived from this software
17
* without specific prior written permission.
18
*
19
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
20
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
21
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
22
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
23
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
24
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
25
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
26
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
27
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
29
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30
* POSSIBILITY OF SUCH DAMAGE.
31
*
32
****************************************************************************/
33
34
/// @file LowPassFilter.h
35
/// @brief A class to implement a second order low pass filter
36
/// Author: Leonard Hall <LeonardTHall@gmail.com>
37
/// Adapted for PX4 by Andrew Tridgell
38
39
#pragma once
40
41
namespace
math
42
{
43
class
__EXPORT
LowPassFilter2p
44
{
45
public
:
46
47
LowPassFilter2p
(
float
sample_freq,
float
cutoff_freq)
48
{
49
// set initial parameters
50
set_cutoff_frequency(sample_freq, cutoff_freq);
51
}
52
53
// Change filter parameters
54
void
set_cutoff_frequency(
float
sample_freq,
float
cutoff_freq);
55
56
/**
57
* Add a new raw value to the filter
58
*
59
* @return retrieve the filtered result
60
*/
61
float
apply(
float
sample
);
62
63
// Return the cutoff frequency
64
float
get_cutoff_freq
()
const
{
return
_cutoff_freq; }
65
66
// Reset the filter state to this value
67
float
reset
(
float
sample);
68
69
private
:
70
71
float
_cutoff_freq{0.0f};
72
73
float
_a1{0.0f};
74
float
_a2{0.0f};
75
76
float
_b0{0.0f};
77
float
_b1{0.0f};
78
float
_b2{0.0f};
79
80
float
_delay_element_1{0.0f};
// buffered sample -1
81
float
_delay_element_2{0.0f};
// buffered sample -2
82
};
83
84
}
// namespace math
__EXPORT
Definition:
I2C.hpp:51
sample
Definition:
test_EKF_ringbuffer.cpp:38
lps22hb::reset
int reset(enum LPS22HB_BUS busid)
Reset the driver.
Definition:
lps22hb_main.cpp:182
math::LowPassFilter2p
Definition:
LowPassFilter2p.hpp:43
math::LowPassFilter2p::get_cutoff_freq
float get_cutoff_freq() const
Definition:
LowPassFilter2p.hpp:64
math
Definition:
LowPassFilter2p.cpp:40
math::LowPassFilter2p::LowPassFilter2p
LowPassFilter2p(float sample_freq, float cutoff_freq)
Definition:
LowPassFilter2p.hpp:47
src
lib
mathlib
math
filter
LowPassFilter2p.hpp
Generated by
1.8.13