Utilizando el sensor HC-SR04.
1.
Crear
una función de tipo float para medir:
float fnMedirDistancia( int _dadoPinTrig, int _dadoPinEcho
) {
2.
Al
pin convertirlo de salida. Por las dudas desactivar el pin y luego activarlo
por unos micrones de segundo y desactivarlo. El activarlo será para emitir un
sonido en ultrafrecuencia:
pinMode( _dadoPinTrig,
OUTPUT ) ;
digitalWrite(
_dadoPin, LOW ) ;
delayMicroseconds( 2 );
digitalWrite(
_dadoPin, HIGH ) ;
delayMicroseconds( 10 ) ;
digitalWrite(
_dadoPin, LOW ) ;
3.
Ahora
convertirlo en entrada y esperar a que vuelva el eco:
pinMode( _dadoPinEcho,
INPUT ) ;
float
_tiempoEspera = pulseIn( _dadoPin, HIGH ) ;
4.
Conociendo
la velocidad del sonido, el tiempo en que el sonido va y vuelve como eco, se
puede averiguar la distancia hasta el elemento más próximo a menos de 4 metros.
float _cm =
_tiempoEspera / 59 ;
return _cm ;
Comentarios
Publicar un comentario