Práctica 7
En esta práctica vamos a medir distancia con el sensor de ultrasonidos. El sensor emite un ultrasonido por el trigger que al rebotar en un objeto vuelve al sensor y lo recibe por el echo. El programa calculará la distancia a la que se encuentra el objeto dependiendo del tiempo que tarde en recibir el ultrasonidoy lo mostrará en el monitor serie.
double distancia; double fnc_ultrasonic_distance(int _t, int _e){ unsigned long dur=0; digitalWrite(_t, LOW); delayMicroseconds(5); digitalWrite(_t, HIGH); delayMicroseconds(10); digitalWrite(_t, LOW); dur = pulseIn(_e, HIGH, 18000); return (dur/57); } void setup() { Serial.begin(9600); pinMode(4, OUTPUT); pinMode(6, INPUT); } void loop() { distancia = fnc_ultrasonic_distance(4,6); Serial.println(); Serial.print(distancia); delay(1000); }
Comentarios
Publicar un comentario