#include <stdio.h>
#include <Servo.h>
#define TRIGGER 2
#define ECHO 3
#define LED 8
#define SERVOPIN 5

Servo servomotor;
long tiempo;
long distancia;


void Trigger(){
  digitalWrite(TRIGGER, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIGGER, LOW);
}

void setup() {
  Serial.begin(9600);
  pinMode(TRIGGER, OUTPUT);
  servomotor.attach(SERVOPIN);
  servomotor.write(90);
}

void loop() {
  digitalWrite(LED, LOW);
  servomotor.write(90);
  Trigger();
  tiempo= pulseIn(ECHO, HIGH);
  distancia = tiempo/59;
  Serial.print("La distancia medida es: ");
  Serial.print(distancia);
  Serial.println("cm");
  if(distancia <= 50){
    servomotor.write(0);
    digitalWrite(LED, HIGH);
  }

  delay(1000);
  


}