medidor de distancia con sensor y leds

 long cm = 0;

long readUltrasonicDistance(int triggerPin, int echoPin)

{

  pinMode(triggerPin, OUTPUT);  

  digitalWrite(triggerPin, LOW);

  delayMicroseconds(2);

  // Establece el pin de activación en estado ALTO durante 10 microsegundos

  digitalWrite(triggerPin, HIGH);

  delayMicroseconds(10);

  digitalWrite(triggerPin, LOW);

  pinMode(echoPin, INPUT);

  // Lee el pin de eco y devuelve el tiempo de viaje de la onda de sonido en microsegundos * 0.01723

  return (pulseIn(echoPin, HIGH)*0.01723);

  

}


void setup()

{

  Serial.begin(9600);

  pinMode(2, OUTPUT);

  pinMode(3, OUTPUT);

  pinMode(4, OUTPUT);

}


void loop()

{

  cm =readUltrasonicDistance(7, 6);  //determinamos la distancia para que las luces se prendan//


  Serial.print(cm);

  Serial.println("cm");

  

  if (cm > 250) {

    digitalWrite(2, LOW);

    digitalWrite(3, LOW);

    digitalWrite(4, LOW);

  }

  if (cm <= 250 && cm > 175) {

    digitalWrite(2, HIGH);

    digitalWrite(3, LOW);

    digitalWrite(4, LOW);

  }

  if (cm <= 175 && cm > 100) {

    digitalWrite(2, HIGH);

    digitalWrite(3, HIGH);

    digitalWrite(4, LOW);

  }

  if (cm <= 100) {

    digitalWrite(2, HIGH);

    digitalWrite(3, HIGH);

    digitalWrite(4, HIGH);

  }


  delay(100); // Esperar 100 milisegundos

}




Comentarios

Entradas populares de este blog

Grúa con servomotores

(Python) Programas

(phyton) jeraquia de operaciones