Bart Vaart
atoombom
Dependencies: Encoder HIDScope mbed
Diff: LowPassFilter.cpp
- Revision:
- 20:4fe3cab02341
- Parent:
- 18:4ebf5e640f0c
--- a/LowPassFilter.cpp Mon Sep 28 10:12:00 2015 +0000
+++ b/LowPassFilter.cpp Mon Sep 28 10:25:22 2015 +0000
@@ -1,21 +1,16 @@
#include "encoder.h"
-#include "led_flipper.h"
+#include "LowPassFilter.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 computeBiquad()
{
- double v = u − a1∗v1 − a2∗v2;
- y = b0∗v + b1∗v1 + b2∗v2;
+ double v = u - a1*v1 - a2*v2;
+ y = b0*v + b1*v1 + b2*2;
v2 = v1;
v1 = v;
+ return y;
}
-
-double filter()
-{
- biquadTicker.attach(&computeBiquad, 0.01); // 100 Hz
- while(1) {}
-}
\ No newline at end of file