#include <Servo.h>
const int trigPin = 9;
const int echoPin = 8;
const int servoPin = 10;
const int verdes = 3;
const int rojos = 2;
Servo myServo;
void setup() {
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(verdes, OUTPUT);
pinMode(rojos, OUTPUT);
myServo.attach(servoPin);
myServo.write(0);
Serial.begin(9600);
}
void loop() {
long duro, despacio;
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duro = pulseIn(echoPin, HIGH);
despacio = (duro / 2) / 29.1;
if (despacio <= 10) {
myServo.write(90);
digitalWrite(verdes, LOW);
digitalWrite(rojos, HIGH);
} else {
myServo.write(0);
digitalWrite(verdes, HIGH);
digitalWrite(rojos, LOW);
}
delay(500);
}