#include <Servo.h>

const int trigPin = 10;  // Pin del Trigger del sensor ultrasónico
const int echoPin = 11;  // Pin del Echo del sensor ultrasónico
const int servoPin = 9;  // Pin del servo motor

Servo myServo;

void setup() {
  Serial.begin(9600);
  myServo.attach(servoPin);
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
}

void loop() {
  long duration, distance;

  // Generar un pulso ultrasónico
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);

  // Medir la duración del pulso de retorno
  duration = pulseIn(echoPin, HIGH);

  // Calcular la distancia en centímetros
  distance = (duration / 2) / 29.1;

  // Imprimir la distancia en el monitor serial
  Serial.print("Distancia: ");
  Serial.print(distance);
  Serial.println(" cm");

  // Si la distancia es menor a 10 cm, girar el servo 90 grados durante 5 segundos
  if (distance < 10) {
    myServo.write(90);    // Ángulo de 90 grados
    delay(5000);          // Esperar 5 segundos
    myServo.write(0);      // Volver a la posición inicial (0 grados)
    delay(1000);          // Esperar 1 segundo antes de reiniciar
  }
}