'

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers hcsr04.cpp Source File

hcsr04.cpp

00001 #include "hcsr04.h"
00002 #include "mbed.h"
00003 
00004 HCSR04::HCSR04(PinName t, PinName e) : triger(t), echo(e) {}
00005 long HCSR04::echo_trajanjeImpulsa()
00006 {
00007 
00008     timer.reset();  //Resetiranje timera na 0
00009     triger=0;   // Triger u logičkoj "0"
00010     wait_us(2);
00011     triger=1;   //  Triger u logičkoj "1"
00012     wait_us(10);
00013     triger=0;  // Triger u logičkoj "0"
00014     while(!echo);
00015     timer.start(); // Timer počinje brojati kada triger pošalje impuls
00016     while(echo);
00017     timer.stop();
00018     return timer.read_us();
00019 
00020 }
00021 
00022 //Vraća udaljenost u centimetrima
00023 long HCSR04::udaljenost()
00024 {
00025     trajanjeImpulsa = echo_trajanjeImpulsa();
00026     udaljenost_cm = (trajanjeImpulsa/2)/29.1; 
00027     return udaljenost_cm;
00028 }