Remco Dasselaar / Mbed 2 deprecated TotalControlEmg2

Dependencies:   HIDScope MODSERIAL QEI TextLCD mbed

Fork of TotalControlEmg2 by Remco Dasselaar

Revision:
31:074b9d03d816
Parent:
30:8ae855348d22
Child:
32:40691708c68c
--- a/main.cpp	Mon Oct 19 10:09:42 2015 +0000
+++ b/main.cpp	Mon Oct 19 10:30:32 2015 +0000
@@ -251,18 +251,28 @@
                 pwmM1.write(0.25);               // Motor aanzetten, laag vermogen
                 btn = false;                        
                 while(state==KALIBRATE_PEND){                    
-                    if(regelaarFlag){                        
+                    if(emgFlag){                        
                         pc.printf("");          // lege regel printen, anders doet setknop het niet
-                        regelaarFlag = false; 
+                        emgFlag = false;
                         
-                                           
-                        if (btn){               // Als setknop ingedrukt is reset
+                        int modeL = defMode(emgL, potL, true);
+                        int modeR = defMode(emgR, potR, false);
+                                                                                                                   
+                        if (btn || (modeL == 3) || (modeR == 3)){               // Als setknop ingedrukt is reset
                             pwmM1.write(0);             // Motor 1 stilzetten
                             enc1.reset();               // encoder 1 resetten
                             PRINT("Pendulum kalibrated\r\n");
                             btn = false;                // knop op false
                             state = AIM;                // volgende fase                            
                             }
+                        else if(modeL == 2){
+                            pwmM1.write(0);             // Pendulum stilzetten
+                            PRINT("Pendulum off\r\n");
+                            }
+                        else if(modeL == 3){
+                            pwmM1.write(0.025);         // Pendulum aanzetten
+                            PRINT("Pendulum on\r\n");
+                            }
                         }             
                     }
                 break;