Diff: main.cpp

Revision:

2:dc387d9de7c4

Parent:

1:3cc91fc2fb1c

--- a/main.cpp	Fri Oct 26 10:19:17 2018 +0000
+++ b/main.cpp	Fri Oct 26 10:28:22 2018 +0000
@@ -6,6 +6,11 @@
 AnalogIn emg3( A2 );
 
 // Variabelen EMG
+const double m1 =0.5000;
+const double m2 =-0.8090;
+const double n0 =0.5000;
+const double n1 =-0.8090;
+const double n2 =0;
 const double a1 =0.9565;
 const double a2 =-1.9131;
 const double b0 =0.9565;
@@ -25,11 +30,14 @@
 // Filteren
 void filterEMG()
 {   
-highpassFilter1 = fabs(biquad(emg0.read(), a1, a2, b0, b1, b2));
+notchFilter1 = biquad(emg0.read(), m1, m2, n0, n1, n2);
+highpassFilter1 = fabs(biquad(notchFilter1, a1, a2, b0, b1, b2));
 lowpassFilter1 = biquad(highpassFilter1, c1, c2, d0, d1, d2);
-highpassFilter2 = fabs(biquad(emg1.read(), a1, a2, b0, b1, b2));
+notchFilter2 = biquad(emg1.read(), m1, m2, n0, n1, n2);
+highpassFilter2 = fabs(biquad(notchFilter2, a1, a2, b0, b1, b2));
 lowpassFilter2 = biquad(highpassFilter2, c1, c2, d0, d1, d2);
-highpassFilter3 = fabs(biquad(emg2.read(), a1, a2, b0, b1, b2));
+notchFilter3 = biquad(emg2.read(), m1, m2, n0, n1, n2);
+highpassFilter3 = fabs(biquad(notchFilter2, a1, a2, b0, b1, b2));
 lowpassFilter3 = biquad(highpassFilter3, c1, c2, d0, d1, d2);
 }