SENSOR ULTRASÓNICO. ENCENDIDO DE LED´s SEGÚN LA DISTANCIA

 #define trigPin 9

#define echoPin 8

void setup() {

 

Serial.begin(9600);

pinMode(trigPin,OUTPUT);

pinMode(echoPin,INPUT);

pinMode(4,OUTPUT);

pinMode(3,OUTPUT);

pinMode(2,OUTPUT);

}

void loop() {

long duracion,distancia;

digitalWrite(trigPin,LOW);

delayMicroseconds(2);

digitalWrite(trigPin,HIGH);

delayMicroseconds(10);

digitalWrite(trigPin,LOW);

duracion=pulseIn(echoPin,HIGH);

distancia=(duracion*0.034/2);

Serial.print(distancia);

Serial.println("cm");

delay(500);

if(distancia<50){

  digitalWrite(4,HIGH);

  digitalWrite(3,HIGH);

  digitalWrite(2,HIGH);

}

else if((distancia>=50)&&(distancia<200)){

  digitalWrite(4,LOW);

  digitalWrite(3,HIGH);

  digitalWrite(2,HIGH);

}

else if(distancia>=200){

digitalWrite(4,LOW);

digitalWrite(3,LOW);

digitalWrite(2,HIGH);

}

}