Biblioteca para uso do ultrassom HC-SR04
Dependents: Sonar-HC-SR04 CarrinhoLabirinto Nucleo_Us_ticker_20160803 ProjetoSO ... more
Diff: HCSR04.cpp
- Revision:
- 0:d1d7bb1c1f6c
- Child:
- 2:9daf23ed9d84
- Child:
- 3:12d6d751f4fc
diff -r 000000000000 -r d1d7bb1c1f6c HCSR04.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/HCSR04.cpp Thu Feb 05 19:00:51 2015 +0000 @@ -0,0 +1,30 @@ +#include "HCSR04.h" +#include "mbed.h" + + +HCSR04::HCSR04(PinName trigger, PinName echo) : _t(trigger), _e(echo) { + wait(0.1); + } + +float HCSR04::getCm(void){ + distcm = readEcho()/58; + return distcm; + } + +float HCSR04::getIn(void){ + distin = readEcho()/148; + return distin; + } + +float HCSR04::readEcho(void){ + _t=1; //Inicio do trigger + wait_us(10); //10us de pulso + _t=0; //Fim do trigger + while(!_e); + _tempo.start(); + while(_e); + tdist = _tempo.read_us(); //Leitura do tempo transcorrido + _tempo.stop(); //Paro o temporizador + _tempo.reset(); //Reset para o próximo ciclo + return tdist; +} \ No newline at end of file