#include <Servo.h>

Servo motor;

const int trigPin = 7;
const int echoPin = 2;

//sensor

long duracion;
int distancia;

void setup(){
  Serial.begin(9600);
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode(11, OUTPUT);
  pinMode(14, OUTPUT);
  motor.attach(45);
}

void loop(){

// sensor ultrasonico

  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.print(distancia);
  Serial.println(" cm ");

// Condicion de led rojos y verdes

 if(distancia <= 20)
  {
  digitalWrite(14, HIGH); 
  delay(100);
  digitalWrite(11, LOW); 
  delay(100);  
      motor.write(180);
  }

  if(distancia > 20)
  {
  digitalWrite(14, LOW); 
  delay(100);  
  digitalWrite(11, HIGH); 
  delay(100);
      motor.write(0);
}
}