2nd draft

Dependencies:   HIDScope MODSERIAL QEI biquadFilter mbed Servo

Fork of robot_mockup by Martijn Kern

Revision:
59:ca85ce2b1ffc
Parent:
58:db11481da856
Child:
60:6541eec8d6ad
--- a/main.cpp	Wed Oct 28 07:45:42 2015 +0000
+++ b/main.cpp	Wed Oct 28 08:08:19 2015 +0000
@@ -87,7 +87,7 @@
 /*--------------------------------------------------------------------------------------------------------------------
 ---- DECLARE VARIABLES -----------------------------------------------------------------------------------------------
 --------------------------------------------------------------------------------------------------------------------*/
-volatile bool debug = true;
+volatile bool debug = false;
 
 //EMG variables: raw EMG - filtered EMG - maximum voluntary contraction - max amplitude during relaxation. 
 double emg_biceps; double biceps_power; double bicepsMVC = 0; double bicepsmin=0;  
@@ -449,6 +449,7 @@
 
 void debug_trigger(){
     debug=!debug;
+    printf("Debug triggered: %s \r\n", debug ? "ON" : "OFF");
 }
 
 void debugging()
@@ -1165,7 +1166,7 @@
    pc.printf("\n\r");
    //endbox
    
-   wait(1);
+   wait(0.2);
    pc.printf("[C]alibration\r\n"); wait(0.2);
    pc.printf("[T]RIG Control with WASD\r\n"); wait(0.2);
    pc.printf("[D]LS Control with WASD\r\n"); wait(0.2);