#include <ESP32Servo.h>

// Pins
const int servoPin = 13;
const int triggerPin = 12;
const int echoPin = 14;
const int openButtonPin = 32;
const int closeButtonPin = 25;
const int redLedPin = 27;
const int greenLedPin = 26;

float duration_us, distance_cm;


Servo myServo;
long duration, distance;

void setup() {
    Serial.begin(9600);
      pinMode(12, OUTPUT);
        pinMode(14, INPUT);
          pinMode(26, OUTPUT);
            pinMode(27, OUTPUT);
              pinMode(32, INPUT_PULLUP);
                pinMode(25, INPUT_PULLUP);
                  myServo.attach(13);
                    digitalWrite(27, HIGH); // Start with red LED on (door closed)
                    }

                    void loop() {
                      handleUltrasonicSensor();
                        handleManualButtons();
                        }

                        void handleUltrasonicSensor() {
                          digitalWrite(12, LOW);
                            delayMicroseconds(2);
                              digitalWrite(12, HIGH);
                                delayMicroseconds(10);
                                  digitalWrite(12, LOW);
                                    duration = pulseIn(14, HIGH);
                                      distance = duration * 0.034 / 2;
                                        if (distance < 50) { // Distance threshold in cm
                                            openDoor();
                                              } else {
                                                  closeDoor();
                                                    }
                                                    }

                                                    void openDoor() {
                                                      myServo.write(90); // Adjust angle as needed
                                                        digitalWrite(26, HIGH);
                                                          digitalWrite(27, LOW);
                                                          }

                                                          void closeDoor() {
                                                            myServo.write(0); // Adjust angle as needed
                                                              digitalWrite(26, LOW);
                                                                digitalWrite(27, HIGH);
                                                                }

                                                                void handleManualButtons() {
                                                                  if (digitalRead(32) == LOW) {
                                                                      openDoor();
                                                                        }
                                                                          if (digitalRead(25) == LOW) {
                                                                              closeDoor();
                                                                                }
}