Test

Dependencies:   mbed DRV8825

Revision:
21:e5f0f5abb5ae
Parent:
20:7d206773f39e
Child:
22:f891c2bce091
--- a/debugPC.cpp	Tue Oct 20 17:53:32 2020 +0000
+++ b/debugPC.cpp	Sun Oct 25 22:36:51 2020 +0000
@@ -305,9 +305,9 @@
             //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("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:
@@ -384,40 +384,42 @@
 
 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]);
-    if(aff_US[2]) pc.printf("Tps US3 = %5.0f uS\n\r", us_out[2]);
-    if(aff_US[3]) pc.printf("Tps US4 = %5.0f uS\n\r", us_out[3]);
-    if(aff_US[4]) pc.printf("Tps US5 = %5.0f uS\n\r", us_out[4]);
-    if(aff_US[5]) pc.printf("Tps US6 = %5.0f uS\n\r", us_out[5]);
+    if(aff_US[0]) pc.printf("Tps US1 = %5.0f uS\n\r", us_diff[0]);
+    if(aff_US[1]) pc.printf("Tps US2 = %5.0f uS\n\r", us_diff[1]);
+    if(aff_US[2]) pc.printf("Tps US3 = %5.0f uS\n\r", us_diff[2]);
+    if(aff_US[3]) pc.printf("Tps US4 = %5.0f uS\n\r", us_diff[3]);
+    if(aff_US[4]) pc.printf("Tps US5 = %5.0f uS\n\r", us_diff[4]);
+    if(aff_US[5]) pc.printf("Tps US6 = %5.0f uS\n\r", us_diff[5]);
     if(aff_US[0]||aff_US[1]||aff_US[2]||aff_US[3]||aff_US[4]||aff_US[5]) pc.printf("\n\r");
 
     // bt
-    if(aff_US[0]) bt.printf("Tps US1 = %5.0f uS\n\r", us_out[0]);
-    if(aff_US[1]) bt.printf("Tps US2 = %5.0f uS\n\r", us_out[1]);
-    if(aff_US[2]) bt.printf("Tps US3 = %5.0f uS\n\r", us_out[2]);
-    if(aff_US[3]) bt.printf("Tps US4 = %5.0f uS\n\r", us_out[3]);
-    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]) bt.printf("Tps US1 = %5.0f uS\n\r", us_diff[0]);
+    if(aff_US[1]) bt.printf("Tps US2 = %5.0f uS\n\r", us_diff[1]);
+    if(aff_US[2]) bt.printf("Tps US3 = %5.0f uS\n\r", us_diff[2]);
+    if(aff_US[3]) bt.printf("Tps US4 = %5.0f uS\n\r", us_diff[3]);
+    if(aff_US[4]) bt.printf("Tps US5 = %5.0f uS\n\r", us_diff[4]);
+    if(aff_US[5]) bt.printf("Tps US6 = %5.0f uS\n\r", us_diff[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("distance[0] = %lf\n\r", distt[0]);
+    pc.printf("distance[1] = %lf\n\r", distt[1]);
+    pc.printf("distance[2] = %lf\n\r", distt[2]);
+    pc.printf("distance[3] = %lf\n\r", distt[3]);
+    pc.printf("distance[4] = %lf\n\r", distt[4]);
+    pc.printf("distance[5] = %lf\n\r", distt[5]);
     pc.printf("\n\r");
 
     // bt
+
     /*
     bt.printf("distance[0] = %f\n\r", ::distance[0]);
     bt.printf("distance[1] = %f\n\r", ::distance[1]);