Bart Vaart
atoombom
Dependencies: Encoder HIDScope mbed
Diff: LowPassFilter.cpp
- Revision:
- 18:4ebf5e640f0c
- Child:
- 20:4fe3cab02341
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/LowPassFilter.cpp Mon Sep 28 10:11:01 2015 +0000
@@ -0,0 +1,21 @@
+#include "encoder.h"
+#include "led_flipper.h"
+
+// Define a Ticker, variables for storage, input and output
+Ticker biquadTicker;
+double v1 = 0, v2 = 0, u = 0, y = 0;
+const double a1 = 1.2, a2 = 2.3, b0 = 1.2, b1 = 2.2, b2 = 0.3;
+// Implement the computation function
+void computeBiquad()
+{
+ double v = u − a1∗v1 − a2∗v2;
+ y = b0∗v + b1∗v1 + b2∗v2;
+ v2 = v1;
+ v1 = v;
+}
+
+double filter()
+{
+ biquadTicker.attach(&computeBiquad, 0.01); // 100 Hz
+ while(1) {}
+}
\ No newline at end of file