#include <ESP32Servo.h>
#include <NewPing.h>

// Define pins
#define SERVO_PIN 13
#define TRIG_PIN 12
#define ECHO_PIN 14
#define GREEN_LED_PIN 26
#define RED_LED_PIN 27
#define BUTTON_PIN 32

// Servo motor object
Servo myServo;

// Ultrasonic sensor object
NewPing sonar(12, 14, 400);

// Door state
bool isOpen = false;

// Button state
bool buttonPressed = false;

void setup() {
  // Initialize servo motor
    myServo.attach(13);
      myServo.write(0); // Close the door initially

        // Initialize ultrasonic sensor
          pinMode(12, OUTPUT);
            pinMode(14, INPUT);

              // Initialize LEDs
                pinMode(26, OUTPUT);
                  pinMode(27, OUTPUT);
                    digitalWrite(26, LOW);
                      digitalWrite(27, HIGH);

                        // Initialize push button
                          pinMode(32, INPUT_PULLUP);
                          }

                          void loop() {
                            // Check if the button is pressed
                              if (digitalRead(32) == LOW) {
                                  if (!buttonPressed) {
                                        buttonPressed = true;
                                              toggleDoor();
                                                  }
                                                    } else {
                                                        buttonPressed = false;
                                                          }

                                                            // Check if a car is present in the garage
                                                              int distance = sonar.ping_cm();
                                                                if (distance > 0 && distance < 20) {
                                                                    if (!isOpen) {
                                                                          openDoor();
                                                                              }
                                                                                } else {
                                                                                    if (isOpen) {
                                                                                          closeDoor();
                                                                                              }
                                                                                                }

                                                                                                  // Update LED states
                                                                                                    if (isOpen) {
                                                                                                        digitalWrite(26, HIGH);
                                                                                                            digitalWrite(27, LOW);
                                                                                                              } else {
                                                                                                                  digitalWrite(26, LOW);
                                                                                                                      digitalWrite(27, HIGH);
                                                                                                                        }

                                                                                                                          delay(100);
                                                                                                                          }

                                                                                                                          void openDoor() {
                                                                                                                            myServo.write(180); // Open the door
                                                                                                                              isOpen = true;
                                                                                                                              }

                                                                                                                              void closeDoor() {
                                                                                                                                myServo.write(0); // Close the door
                                                                                                                                  isOpen = false;
                                                                                                                                  }

                                                                                                                                  void toggleDoor() {
                                                                                                                                    if (isOpen) {
                                                                                                                                        closeDoor();
                                                                                                                                          } else {
                                                                                                                                              openDoor();
                                                                                                                                                }
                                                                                                                                                }