int verde = 16;
int amarillo = 4;
int rojo = 2;
int trigpin = 5;
int trigecho = 18;
void setup() {
Serial.begin(115200);
pinMode(verde, OUTPUT);
pinMode(amarillo, OUTPUT);
pinMode(rojo, OUTPUT);
pinMode(trigpin, OUTPUT);
pinMode(trigecho, INPUT);
}
void loop() {
digitalWrite(trigpin, HIGH);
delayMicroseconds(10);
digitalWrite(trigpin, LOW);
long duracion = pulseIn(trigecho, HIGH);
float distancia = duracion * 0.034 / 2;
Serial.print("Distancia: ");
Serial.print(distancia);
Serial.println(" cm");
if(distancia > 8){
digitalWrite(verde, HIGH);
digitalWrite(amarillo, LOW);
digitalWrite(rojo, LOW);
}else if(distancia >= 4 && distancia <= 8){
digitalWrite(verde, LOW);
digitalWrite(amarillo, HIGH);
digitalWrite(rojo, LOW);
}else if(distancia < 4){
digitalWrite(verde, LOW);
digitalWrite(amarillo, LOW);
digitalWrite(rojo, HIGH);
}
}