'
Embed:
(wiki syntax)
Show/hide line numbers
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 }
Generated on Wed Aug 3 2022 15:58:51 by
1.7.2