Simple Incremental LPF filter

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

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