Diff: main.cpp

Revision:

5:41d4aac93351

Parent:

4:8ed071e5e3c9

--- a/main.cpp	Fri Oct 13 11:57:15 2017 +0000
+++ b/main.cpp	Fri Oct 13 14:24:12 2017 +0000
@@ -13,27 +13,27 @@
 int n=0;
 
 //Benoemen van de variabelen die in de VOID's gebruikt gaan worden
-double emga = emg0.read();          //EMG1
+double emga = emg0.read();                         //EMG1
 double emgb = emg1.read();          //EMG2
 
 // coëfficienten notch filter
-double an[3]={1.0000, -0.0000, 0.9561};
-double bn[3]={0.9780, -0.0000, 0.9780};
+double an[3]={1.0000, -0.0000, 0.9490};
+double bn[3]={0.9745, -0.0000, 0.9745};
 
 // innitial conditions notch filter
 double emg_nf[3]={0,0,0};
 double emg_in[3]={0, 0, 0};
 
 //Aanmaken filter coëfficienten
-double ah[3]={1.0000, -1.9778, 0.9780};
-double bh[3]={0.9890, -1.9779, 0.9890};
+double ah[3]={1.0000, -1.9933, 0.9934};
+double bh[3]={0.9967, -1.9933, 0.9967};
 
 //innitial conditions high pass filter
 double emg_hpf[3]={0, 0, 0};
 
 // coëfficienten low pass filter
-double al[5]={1.0000, -3.5897, 4.8513, -2.9241, 0.6630};
-double bl[5]={0.0000312, 0.0001250, 0.0001874, 0.0001250, 0.0000312};
+double al[5]={1.0000, -3.9179, 5.7571, -3.7603, 0.9212};
+double bl[5]={0.0585e-6, 0.2338e-6, 0.3507e-6, 0.2338e-6, 0.0585e-6};
 
 //innitial conditions low pass filter
 double emg_lpf[5]={0, 0, 0, 0, 0};
@@ -49,9 +49,8 @@
     {
     timer.reset(); 
 
-        emga = emg0.read();
-        emgb = emg1.read();
-        emg_in[0]=emga-emgb;
+        emga=emg0.read();
+        emg_in[0]=emga;
         
             //Filter cascade
                     // notch filter
@@ -100,8 +99,8 @@
         motor1MagnitudePin = 0;
         motor1DirectionPin = 0;
         }
-    scope.set(0, emg_in[0]);
-    scope.set(1, emg_lpf[0]);
+    scope.set(0, emg_in[1]);
+    scope.set(1, emg_lpf[1]);
     scope.send();
   
     if (n==100)