#include <Servo.h>

// Definir los pines para el sensor ultrasónico
#define TRIGGER_PIN 3
#define ECHO_PIN 2
const float sonido = 34300.0;
// Crear una instancia del objeto Servo
Servo miServo;

void setup() {
  // Configurar los pines del sensor ultrasónico
  pinMode(TRIGGER_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);

  // Conectar el servomotor al pin 9
  miServo.attach(6);
}

void loop() {
  // Enviar un pulso ultrasónico
  digitalWrite(TRIGGER_PIN, LOW);
  delayMicroseconds(5);
  digitalWrite(TRIGGER_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIGGER_PIN, LOW);

  // Medir el tiempo que tarda en volver el pulso
  long duracion = pulseIn(ECHO_PIN, HIGH);
  float distancia = duracion * 0.000001 * sonido / 2.0;

  // Calcular la distancia en centímetros
  //long distancia = duracion / 29 / 2;
  Serial.println("distancia");

  // Si la distancia es menor a un cierto umbral...
  if (distancia < 100) {
    // ... mover el servomotor a 180 grados
    miServo.write(180);
    delay(500); // Esperar un segundo
  } else {
    miServo.write(0); // Volver a la posición inicial
    delay(500); // Esperar un segundo
  }
  
}