Danijel Pranjić / HCSR04

'

https://os.mbed.com/media/uploads/danijel28/indikatorudaljenostiobjekta.cpp

hcsr04.cpp

Committer:
danijel28
Date:
2020-02-04
Revision:
1:6f2201f12897
Parent:
0:86b2086be101

File content as of revision 1:6f2201f12897:

#include "hcsr04.h"
#include "mbed.h"

HCSR04::HCSR04(PinName t, PinName e) : triger(t), echo(e) {}
long HCSR04::echo_trajanjeImpulsa()
{

    timer.reset();  //Resetiranje timera na 0
    triger=0;   // Triger u logičkoj "0"
    wait_us(2);
    triger=1;   //  Triger u logičkoj "1"
    wait_us(10);
    triger=0;  // Triger u logičkoj "0"
    while(!echo);
    timer.start(); // Timer počinje brojati kada triger pošalje impuls
    while(echo);
    timer.stop();
    return timer.read_us();

}

//Vraća udaljenost u centimetrima
long HCSR04::udaljenost()
{
    trajanjeImpulsa = echo_trajanjeImpulsa();
    udaljenost_cm = (trajanjeImpulsa/2)/29.1; 
    return udaljenost_cm;
}