De hele robot in 1 keer bam

Dependencies:   mbed QEI Servo HIDScope biquadFilter MODSERIAL FastPWM

Revision:
46:8a8fa8e602a1
Parent:
45:d09040915cfe
Child:
47:63b5ccd969e9
Child:
49:80970a03083b
--- a/main.cpp	Thu Oct 31 14:14:23 2019 +0000
+++ b/main.cpp	Thu Oct 31 14:37:21 2019 +0000
@@ -1102,7 +1102,12 @@
     }
 
     // Do stuff until end condition is met
-    doStuff();
+    demo_state_machine();
+    
+    scope.set(0, emg1 );
+    scope.set(1, Vx );
+    scope.set(2, emg2 );
+    scope.set(3, Vy );
 
     // State transition guard
     if ( switch2_pressed == true ) {
@@ -1199,8 +1204,6 @@
     scope.set(1, Vx );
     scope.set(2, emg2 );
     scope.set(3, Vy );
-    //scope.set(2, emg2_out );
-    //scope.set(3, emg3_out );
     scope.send();
 
     led_g = !led_g;