Control de distancia con Sensor ultrasónico HC-04 y 3 leds

Funcionamiento

Para este proyecto usaremos el Sensor ultrasónico HC-04 y tres leds, uno rojo, uno naranja y uno verde, el led verde se encenderá cuando un objeto esté a una distancia entre 20 y 40 cm, el led naranja se encenderá, cuando el objeto esté entre 10 y 20 cm, y el led verde se encenderá, cuando el objeto este, entre 0 y 10 cm.

Componentes

Arduino Uno o equivalente
Sensor ultrasónico HC-04
3 LEDs (rojo, naranja y verde)
3 resistencias (230 Ω)
Cableado
Fuente de alimentación

Conexiones

Conecta el sensor HC-04:

VCC a 5V de Arduino
GND a GND de Arduino
TRIG a pin 10 de Arduino
ECHO a pin 9 de Arduino

Conecta los LEDs:

Rojo: pin 7 de Arduino
Naranja: pin 5 de Arduino
Verde: pin 3 de Arduino
Resistencias en serie con cada LED

Código

int TRIG = 10;
int ECO = 9;
int LED1 = 3; //Led Verde
int LED2 = 5; //Led Naranja
int LED3 = 7; //Led Rojo

int DURATION;
int LENGHT;

void setup(){
  Serial.begin(9600);
  pinMode(TRIG, OUTPUT);
  pinMode(ECO, OUTPUT);
  pinMode(LED1, OUTPUT);
  pinMode(LED2, OUTPUT);
  pinMode(LED3, OUTPUT);  
}

void loop(){
  digitalWrite(TRIG, HIGH);
  delay(1);
  digitalWrite(TRIG, LOW);
  DURATION = pulseIn(ECO, HIGH);
  LENGHT = DURATION / 59;

  Serial.print(LENGHT);
  delay(200);

  if(LENGHT >= 20 && LENGHT <= 40){
    delay(50);
    digitalWrite(LED3, HIGH);
    delay(50);
    digitalWrite(LED2, LOW);
    delay(50);
    digitalWrite(LED1, LOW);
  }
  else if (LENGHT >= 10 && LENGHT < 20){
    delay(50);
    digitalWrite(LED3, LOW);
    delay(50);
    digitalWrite(LED2, HIGH);
    delay(50);
    digitalWrite(LED1, LOW);
  }
  else if (LENGHT >= 0 && LENGHT < 10)
  {
    delay(50);
    digitalWrite(LED3, LOW);
    delay(50);
    digitalWrite(LED2, LOW);
    delay(50);
    digitalWrite(LED1, HIGH);
  }
  else{
    delay(50);
    digitalWrite(LED3, LOW);
    delay(50);
    digitalWrite(LED2, LOW);
    delay(50);
    digitalWrite(LED1, LOW);
  }