Applied engineering Team / Mbed 2 deprecated hcsr04

Ultrazuvcno mjerenje udaljenosti

Dependencies:   mbed

hcsr04.cpp

Committer:
markomileticbj
Date:
2015-06-19
Revision:
0:4fb151e9c106

File content as of revision 0:4fb151e9c106:

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

HCSR04::HCSR04(PinName t, PinName e) : triger(t), echo(e) {}
float HCSR04::echo_trajanje()
{
    tmr.reset();
    triger=1;
    wait_us(20);
    triger=0;
    while(echo==0);
    tmr.start();
    while(echo==1);
    tmr.stop();
    return tmr.read_us();
}

float HCSR04::udaljenost()
{
    trajanje = echo_trajanje();
    trajanje = (trajanje/2)*343  ;
    udaljenost_cm = trajanje/10000  ;
    return udaljenost_cm;
}