diff --git a/src/control/lpf.cpp b/src/control/lpf.cpp new file mode 100644 index 0000000..583e510 --- /dev/null +++ b/src/control/lpf.cpp @@ -0,0 +1,17 @@ +#include "src/control/lpf.h" + +namespace control { + + +incrementalLPF::incrementalLPF() +: m_filtered(0) +{ +} + +double incrementalLPF::filter(double latestValue) +{ + m_filtered = m_filtered*0.95 + latestValue*0.05; + return m_filtered; +} + +} // namespace control \ No newline at end of file diff --git a/src/control/lpf.h b/src/control/lpf.h new file mode 100644 index 0000000..af15588 --- /dev/null +++ b/src/control/lpf.h @@ -0,0 +1,19 @@ +#pragma once + +namespace control { + +class incrementalLPF +{ + +public: + + incrementalLPF(); + + double filter(double latestValue); + +private: + + double m_filtered; +}; + +} // namespace control \ No newline at end of file