#include <Wire.h> 
#include <LiquidCrystal_I2C.h>
#include <Servo.h>

LiquidCrystal_I2C lcd(0x27, 16, 2); // Dirección del LCD I2C 0x27, 16 columnas y 2 filas
Servo servoMotor;

const int trigPin = 2;
const int echoPin = 3;
const int servoPin = 9;

void setup() {
  Serial.begin(9600);
  lcd.init();
  lcd.backlight();
  
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  
  servoMotor.attach(servoPin);
  servoMotor.write(0); // Inicialmente la puerta está cerrada a 0 grados
}

void loop() {
  long duration, distance;
  
  // Limpiar el LCD
  lcd.clear();
  
  // Generar un pulso en el pin trigPin
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  
  // Medir la duración del pulso recibido en el pin echoPin
  duration = pulseIn(echoPin, HIGH);
  
  // Calcular la distancia en centímetros
  distance = duration * 0.034 / 2;
  
  // Mostrar la distancia en el LCD
  lcd.setCursor(0, 0);
  lcd.print("Distancia: ");
  lcd.print(distance);
  lcd.print(" cm");
  
  // Control de la puerta basado en la distancia medida
  if (distance > 20) {
    lcd.setCursor(0, 1);
    lcd.print("Puerta: Cerrado");
    servoMotor.write(0); // Cerrar la puerta a 0 grados
  } else if (distance <= 20 && distance > 10) {
    lcd.setCursor(0, 1);
    lcd.print("Puerta: Abriendo");
    servoMotor.write(45); // Abrir la puerta a 45 grados
  } else if (distance <= 10 && distance >= 2) {
    lcd.setCursor(0, 1);
    lcd.print("Puerta: Abierto");
    servoMotor.write(90); // Abrir la puerta a 90 grados
  }
  
  delay(500); // Espera para la siguiente lectura
}