Script 15-10-2019

Dependencies:   Servoaansturing mbed QEI HIDScope biquadFilter MODSERIAL FastPWM

Revision:
27:7305319c11e8
Parent:
26:7ae60739b310
--- a/main.cpp	Tue Oct 29 12:36:03 2019 +0000
+++ b/main.cpp	Tue Oct 29 13:00:10 2019 +0000
@@ -175,12 +175,6 @@
     filtered_EMG_biceps_left=bqcbl2.step(filtered_EMG_biceps_left_abs);
     filtered_EMG_calf=bqck2.step(filtered_EMG_calf_abs);
     
-    // De gefilterde EMG-signalen kunnen tevens visueel worden weergegeven in de HIDScope  
-    scope.set(0, filtered_EMG_biceps_right); 
-    scope.set(1, normalized_EMG_biceps_right);
-    scope.set(2, filtered_EMG_calf);
-    scope.send();
-    
     // Tijdens de kalibratie moet vervolgens een maximale spierspanning worden bepaald, die 
     // later kan worden gebruikt voor een normalisatie. De spieren worden hiertoe gedurende 
     // 5 seconden maximaal aangespannen. De EMG waarden worden bij elkaar opgeteld,
@@ -215,6 +209,12 @@
     normalized_EMG_biceps_right=filtered_EMG_biceps_right/mean_EMG_biceps_right;
     normalized_EMG_biceps_left=filtered_EMG_biceps_left/mean_EMG_biceps_left;
     normalized_EMG_calf=filtered_EMG_calf/mean_EMG_calf;
+    
+    // De gefilterde EMG-signalen kunnen tevens visueel worden weergegeven in de HIDScope  
+    scope.set(0, normalized_EMG_biceps_right); 
+    scope.set(1, normalized_EMG_biceps_left);
+    scope.set(2, normalized_EMG_calf);
+    scope.send(); 
          
     switch (currentState) 
     { 
@@ -350,6 +350,7 @@
                                     motor2_dir.write(1);
                                     motor1.write(0.9);
                                     motor1_dir.write(1);
+                                    pc.printf("Ik zit in normalized_EMG_biceps_right < 0.3");
                                     if (normalized_EMG_calf >= 0.3)
                                         {
                                             // motor1_dir = !motor1_dir;
@@ -364,6 +365,7 @@
                             motor2_dir.write(1);
                             motor1.write(0.9);
                             motor1_dir.write(1);
+                            pc.printf("Ik zit in normalized_EMG_biceps_left >= 0.3");
                             if (normalized_EMG_calf >= 0.3)
                                 {
                                     // motor1_dir = !motor1_dir;