Buscar este blog

lunes, 16 de febrero de 2015

Lectura de distancia con Arduino y sensor ultrasonico

//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