Diff: captUS.cpp

Revision:

15:43f5bda97488

Parent:

1:2fe8c402ee79

Child:

16:4c0b1647e8ae

--- a/captUS.cpp	Wed Sep 16 12:31:54 2020 +0000
+++ b/captUS.cpp	Mon Sep 28 19:17:00 2020 +0000
@@ -7,12 +7,14 @@
 Ticker ticker_US;
 
 void captUS_init(){
-    tps.start();}
+    tps.reset();
+    tps.start();
+}
 
 void captUS_trig(){
     tps.reset();
     trigger=1;
-    wait(0.00002);
+    wait_us(20);
     trigger=0;
 }
 
@@ -33,3 +35,26 @@
 
 void echoRise6(){us_out[5]=tps.read_us();}
 void echoFall6(){us_out[5]=(tps.read_us()-us_out[5])/2;}
+
+
+float* convertToDistance(){
+    /**************************************
+     *création d'un tableau où l'ensemble *
+     *des distance serons stockées        *
+     **************************************/
+    float distance[6];
+    
+    /**************************************
+     * Nous convertisons grâce au valeur  *
+     * qui sont retournées par echoRiseX  *
+     * et echoFallx                       *
+     **************************************/
+    for(char i = 0; i<6;i++)
+        distance[i] = 10*(us_out[i].read_us()-correction)/58.0 ;
+    
+    /*************************************
+     * Nous retournons le tableau qui    *
+     * contiens l'ensemble des distances *
+     *************************************/ 
+    return distance;    
+}