Revision 0:0910b24c9da3, committed 2015-12-09

Comitter:

ldelinic

Date:

Wed Dec 09 12:37:26 2015 +0000

Commit message:

Najbolji program za mjerenje udaljenosti i dioptrije

Changed in this revision

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/HCSR04.cpp	Wed Dec 09 12:37:26 2015 +0000
@@ -0,0 +1,45 @@
+#include "mbed.h"
+#include "HCSR04.h"
+
+HCSR04::HCSR04(PinName echoPin, PinName triggerPin): echo(echoPin), trigger(triggerPin){
+    
+    init();
+
+  }
+    
+void HCSR04::init(){
+    
+    echo.rise(this, &HCSR04::startTimer);            //na rastucem bridu zapocni timer
+    
+    echo.fall(this, &HCSR04::stopTimer);             //na padajucem bridu zaustavi timer
+    
+    distance = -1;                                   //pocetna udaljenost
+}
+
+void HCSR04::startTimer(){
+    
+    timer.start();      //zapocni brojanje
+    
+}
+    
+void HCSR04::stopTimer(){
+    
+    timer.stop();
+}
+    
+void HCSR04::startMeasurement(){
+    
+    trigger=1;
+    wait_us(10);
+    trigger=0;
+    wait_ms(25);
+    distance=timer.read()*1e6/58;
+    timer.reset();
+}
+
+float HCSR04::getDistance_cm(){
+    
+    startMeasurement();
+    return distance;    
+    }
+

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/HCSR04.h	Wed Dec 09 12:37:26 2015 +0000
@@ -0,0 +1,25 @@
+
+
+
+class  HCSR04 {
+        
+    public:
+    
+    HCSR04(PinName echoPin, PinName triggerPin);
+    float getDistance_cm();
+    
+    
+    private:
+    
+    InterruptIn echo;
+    DigitalOut trigger;
+    Timer timer;
+    float distance;
+    
+    void startTimer();
+    void stopTimer();
+    void init();
+    void startMeasurement();
+    
+};
+