Diff: debugPC.cpp

Revision:

20:7d206773f39e

Parent:

19:c419033c0967

Child:

21:e5f0f5abb5ae

--- a/debugPC.cpp	Mon Oct 12 19:17:40 2020 +0000
+++ b/debugPC.cpp	Tue Oct 20 17:53:32 2020 +0000
@@ -189,12 +189,14 @@
             //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");
@@ -303,6 +305,10 @@
             //bt.printf("O = %lf\n\r", (O*180)/_PI_);
             //bt.printf("vitG = %lf\n\r", vitG);
             //bt.printf("vitD = %lf\n\r", vitD);
+            bt.printf("dist 1 = %f\n\r", ::distance[0]);
+            bt.printf("dist 2 = %f\n\r", ::distance[1]);
+            bt.printf("dist 6 = %f\n\r", ::distance[5]);
+            bt.printf("fnc = %d\n\r", fnc);
             break;
         default:
             pc.printf("Commande invalide\n\r");
@@ -378,6 +384,9 @@
 
 void affUltrasons()
 {
+    /*
+    // Données bruts
+
     // pc
     if(aff_US[0]) pc.printf("Tps US1 = %5.0f uS\n\r", us_out[0]);
     if(aff_US[1]) pc.printf("Tps US2 = %5.0f uS\n\r", us_out[1]);
@@ -395,6 +404,28 @@
     if(aff_US[4]) bt.printf("Tps US5 = %5.0f uS\n\r", us_out[4]);
     if(aff_US[5]) bt.printf("Tps US6 = %5.0f uS\n\r", us_out[5]);
     if(aff_US[0]||aff_US[1]||aff_US[2]||aff_US[3]||aff_US[4]||aff_US[5]) bt.printf("\n\r");
+    */
+
+    // Distances
+
+    // pc
+    pc.printf("distance[0] = %f\n\r", ::distance[0]);
+    //pc.printf("distance[1] = %f\n\r", ::distance[1]);
+    //pc.printf("distance[2] = %f\n\r", ::distance[2]);
+    //pc.printf("distance[3] = %f\n\r", ::distance[3]);
+    //pc.printf("distance[4] = %f\n\r", ::distance[4]);
+    //pc.printf("distance[5] = %f\n\r", ::distance[5]);
+    pc.printf("\n\r");
+
+    // bt
+    /*
+    bt.printf("distance[0] = %f\n\r", ::distance[0]);
+    bt.printf("distance[1] = %f\n\r", ::distance[1]);
+    bt.printf("distance[2] = %f\n\r", ::distance[2]);
+    bt.printf("distance[3] = %f\n\r", ::distance[3]);
+    bt.printf("distance[4] = %f\n\r", ::distance[4]);
+    bt.printf("distance[5] = %f\n\r", ::distance[5]);
+    */
 }
 
 void affCodeurs()