FRC - Hackathon / Mbed 2 deprecated FRC_2019_test

programme test hackathon 2019

Dependencies:   mbed lib_FRC_2019

Diff: main.cpp

Revision:
9:234439133426
Parent:
8:7b0fa8a914c0
--- a/main.cpp	Thu Jun 06 12:34:37 2019 +0000
+++ b/main.cpp	Fri Jun 07 06:06:52 2019 +0000
@@ -58,7 +58,8 @@
     pc.printf ("\n\r1\n");
     wait (1);
     
-    motor.setSpeed (0,0);
+    
+    //motor.setSpeed (0,0);
 
     while (1) {
         pc.printf ("\rCap = %5.2lf\n", boussole.getBearing());
@@ -98,7 +99,7 @@
         motor.getSpeed (&vG, &vD);
 
         pc.printf ("\rEtape = %d : x = %5.1lf, y = %5.1lf, theta = %5.1lf - speedG = %5.1lf, speedD = %5.1lf\n", etatmvt, x, y, 180*theta/PI, vG, vD);
-/*
+
         switch (etatmvt) {
             case 0 :
                 // On avance de 50cm (coordonnés X = 500, Y = 0)
@@ -157,7 +158,7 @@
                 }
                 break;
         }
-*/
+
         pc.printf ("\n\n");
         led1 = !led1;
         led2 = !led2;