Applied engineering Team / Mbed 2 deprecated hcsr04

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