Capteur_US

Dependencies:   mbed DRV8825

captUS.cpp

Committer:
g0dd4
Date:
2020-09-28
Revision:
15:43f5bda97488
Parent:
1:2fe8c402ee79
Child:
16:4c0b1647e8ae

File content as of revision 15:43f5bda97488:

//Nom du fichier : captUS.cpp
#include "pins.h"

// Variables globales & timers
float us_out[6];
Timer tps;
Ticker ticker_US;

void captUS_init(){
    tps.reset();
    tps.start();
}

void captUS_trig(){
    tps.reset();
    trigger=1;
    wait_us(20);
    trigger=0;
}

void echoRise1(){us_out[0]=tps.read_us();}
void echoFall1(){us_out[0]=(tps.read_us()-us_out[0])/2;}

void echoRise2(){us_out[1]=tps.read_us();}
void echoFall2(){us_out[1]=(tps.read_us()-us_out[1])/2;}

void echoRise3(){us_out[2]=tps.read_us();}
void echoFall3(){us_out[2]=(tps.read_us()-us_out[2])/2;}

void echoRise4(){us_out[3]=tps.read_us();}
void echoFall4(){us_out[3]=(tps.read_us()-us_out[3])/2;}

void echoRise5(){us_out[4]=tps.read_us();}
void echoFall5(){us_out[4]=(tps.read_us()-us_out[4])/2;}

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;    
}