Ultrazuvcno mjerenje udaljenosti
Dependencies: mbed
hcsr04.cpp@0:4fb151e9c106, 2015-06-19 (annotated)
- Committer:
- markomileticbj
- Date:
- Fri Jun 19 16:59:54 2015 +0000
- Revision:
- 0:4fb151e9c106
Ultrazvucno mjerenje udaljenosti
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
markomileticbj | 0:4fb151e9c106 | 1 | #include "hcsr04.h" |
markomileticbj | 0:4fb151e9c106 | 2 | #include "mbed.h" |
markomileticbj | 0:4fb151e9c106 | 3 | |
markomileticbj | 0:4fb151e9c106 | 4 | HCSR04::HCSR04(PinName t, PinName e) : triger(t), echo(e) {} |
markomileticbj | 0:4fb151e9c106 | 5 | float HCSR04::echo_trajanje() |
markomileticbj | 0:4fb151e9c106 | 6 | { |
markomileticbj | 0:4fb151e9c106 | 7 | tmr.reset(); |
markomileticbj | 0:4fb151e9c106 | 8 | triger=1; |
markomileticbj | 0:4fb151e9c106 | 9 | wait_us(20); |
markomileticbj | 0:4fb151e9c106 | 10 | triger=0; |
markomileticbj | 0:4fb151e9c106 | 11 | while(echo==0); |
markomileticbj | 0:4fb151e9c106 | 12 | tmr.start(); |
markomileticbj | 0:4fb151e9c106 | 13 | while(echo==1); |
markomileticbj | 0:4fb151e9c106 | 14 | tmr.stop(); |
markomileticbj | 0:4fb151e9c106 | 15 | return tmr.read_us(); |
markomileticbj | 0:4fb151e9c106 | 16 | } |
markomileticbj | 0:4fb151e9c106 | 17 | |
markomileticbj | 0:4fb151e9c106 | 18 | float HCSR04::udaljenost() |
markomileticbj | 0:4fb151e9c106 | 19 | { |
markomileticbj | 0:4fb151e9c106 | 20 | trajanje = echo_trajanje(); |
markomileticbj | 0:4fb151e9c106 | 21 | trajanje = (trajanje/2)*343 ; |
markomileticbj | 0:4fb151e9c106 | 22 | udaljenost_cm = trajanje/10000 ; |
markomileticbj | 0:4fb151e9c106 | 23 | return udaljenost_cm; |
markomileticbj | 0:4fb151e9c106 | 24 | } |