#include <DHT.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#include <Wire.h>

// OLED display definitions
#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64
#define OLED_RESET     -1
#define OLED_ADDRESS   0x3C
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);

// Pin definitions
#define PIR_PIN 2
#define RELAY_OPEN_PIN 8
#define RELAY_CLOSE_PIN 9
#define LED_OPEN_PIN 7
#define LED_CLOSE_PIN 6
#define DHTPIN 10
#define DHTTYPE DHT22
#define TRIG_PIN 11
#define ECHO_PIN 12

DHT dht(DHTPIN, DHTTYPE);

void setup() {
  Serial.begin(9600);

  pinMode(PIR_PIN, INPUT);
  pinMode(RELAY_OPEN_PIN, OUTPUT);
  pinMode(RELAY_CLOSE_PIN, OUTPUT);
  pinMode(LED_OPEN_PIN, OUTPUT);
  pinMode(LED_CLOSE_PIN, OUTPUT);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);

  dht.begin();
  Wire.begin(); // Ensure I2C is initialized before display

  bool oled_initialized = display.begin(SSD1306_SWITCHCAPVCC, OLED_ADDRESS);
  if (!oled_initialized) {
    Serial.println(F("SSD1306 initialization failed. Check wiring or I2C address!"));
    while (true);
  }

  display.clearDisplay();
  display.setTextSize(1);
  display.setTextColor(SSD1306_WHITE);
  display.setCursor(0, 0);
  display.println("Garage Door Init...");
  display.display();
  delay(2000);
}

void loop() {
  float temp = dht.readTemperature();
  float hum = dht.readHumidity();

  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  long duration = pulseIn(ECHO_PIN, HIGH);
  float distance = duration * 0.034 / 2;

  int motion = digitalRead(PIR_PIN);

  display.clearDisplay();
  display.setCursor(0, 0);
  if (isnan(temp) || isnan(hum)) {
    display.println("DHT Error");
  } else {
    display.print("Temp: "); display.print(temp); display.println(" C");
    display.print("Hum: "); display.print(hum); display.println(" %");
  }
  display.print("Dist: "); display.print(distance); display.println(" cm");

  if (motion == HIGH && distance < 100) {
    digitalWrite(RELAY_OPEN_PIN, HIGH);
    digitalWrite(RELAY_CLOSE_PIN, LOW);
    digitalWrite(LED_OPEN_PIN, HIGH);
    digitalWrite(LED_CLOSE_PIN, LOW);
    display.println("Opening the door...");
    Serial.println("Opening the door...");
  } else {
    digitalWrite(RELAY_OPEN_PIN, LOW);
    digitalWrite(RELAY_CLOSE_PIN, HIGH);
    digitalWrite(LED_OPEN_PIN, LOW);
    digitalWrite(LED_CLOSE_PIN, HIGH);
    display.println("Closing the door...");
    Serial.println("Closing the door...");
  }

  display.display();
  delay(2000);
}