Dependencies:   mbed DRV8825

Revision:
19:c419033c0967
Parent:
18:48246daf0c06
Child:
20:7d206773f39e
--- a/debugPC.cpp	Wed Oct 07 20:00:45 2020 +0000
+++ b/debugPC.cpp	Mon Oct 12 19:17:40 2020 +0000
@@ -186,10 +186,15 @@
             //comptD = 0;
             //test1();
             //consigneOrientation = (180*3.1415)/180;
-            xC = (double)0;
-            yC = (double)100;
-            fnc=1;
-            //mot_en();
+            //xC = (double)0;
+            //yC = (double)100;
+            //fnc=1;
+            
+            indice++;
+            fnc = objEtape[indice];
+            xC = objX[indice];
+            yC = objY[indice];
+            mot_en();
             break;
         case 9:     //cdon
             pc.printf("Results ALL Encoders ON/OFF\n\r");
@@ -294,6 +299,7 @@
             bt.printf("O = %lf\n\r", O);
             bt.printf("consigneAngl = %lf\n\r", consigneOrientation);
             bt.printf("consigneDist = %lf\n\r", distanceCible);
+            bt.printf("indice = %d\n\r", indice);
             //bt.printf("O = %lf\n\r", (O*180)/_PI_);
             //bt.printf("vitG = %lf\n\r", vitG);
             //bt.printf("vitD = %lf\n\r", vitD);