Ultrazuvcno mjerenje udaljenosti
Dependencies: mbed
Diff: hcsr04.cpp
- Revision:
- 0:4fb151e9c106
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/hcsr04.cpp Fri Jun 19 16:59:54 2015 +0000 @@ -0,0 +1,24 @@ +#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; +} \ No newline at end of file