//Medicion de distancia con sensor ultrasonico
int triger=2; // Pulso
int echo=4; // Echo recivido
void setup()
{
Serial.begin(9600); // inicializamos el puerto serie
}
void loop()
{
long pulso, inches, cm; // Variables de medicion
pinMode(triger, OUTPUT); // ponemos el triger como salida
digitalWrite(triger, LOW); // lo inicializamos bajo
delayMicroseconds(2); // esperamos 2 microsegundos
digitalWrite(triger, HIGH); // lo activamos
pinMode(echo, INPUT); // ponemos el echo como entrada
pulso = pulseIn(echo, HIGH); // medimos el pulso de salida del sensoR
// Convertimos el tiempo en distancia
inches = microsecToin(pulso);
cm = microsecTocm(pulso);
Serial.print(inches);
Serial.print("in, ");
Serial.print(cm);
Serial.print("cm");
Serial.println();
delay(750);
}
long microsecToin(long microsec)
{ return microsec / 74 / 2; }
long microsecTocm(long microsec)
{ return microsec / 29 / 2; }
// http://www.pesadillo.com/pesadillo/?p=10067
No hay comentarios:
Publicar un comentario