#include <Servo.h>

Servo Motor;

int angulo = 0;
int trigger = 2; 
int echo = 3; 

void setup() {
  Motor.attach(9);
  pinMode(trigger, OUTPUT);
  pinMode(echo, INPUT);
}

void loop() {
  long duracion, distancia;
  digitalWrite(trigger, LOW);
  delayMicroseconds(2); 
  digitalWrite(trigger, HIGH);
  delayMicroseconds(10); 
  digitalWrite(trigger, LOW);
  duracion = pulseIn(echo, HIGH);
  distancia = (duracion/2) / 29.1;

  if (distancia < 20) { 
    for (angulo=0; angulo <= 80; angulo += 1){
      Motor.write(angulo);
      delay(25);
    }

    for (angulo=80; angulo >= 0; angulo -= 1){
      Motor.write(angulo);
      delay(25);
    }
  }
}