EMG filter. Waarden nog niet perfekt.

Dependencies:   HIDScope mbed

Revision:
0:2956e3501f8a
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Filter.cpp	Fri Oct 21 12:11:52 2016 +0000
@@ -0,0 +1,14 @@
+#include "Filter.h"
+
+double Filter(double u, double &v1, double &v2, const double a1, const double a2, const double b0, const double b1, const double b2, const double gain)
+{
+    
+    double v = u - a1*v1 - a2*v2;
+    double y = gain * (b0*v + b1*v1 + b2*v2);
+    
+    v2 = v1;
+    v1 = v;
+    
+    return y;
+    
+}
\ No newline at end of file