#include <Arduino.h>
#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#include <ESP32Servo.h>
#include <RTClib.h>

#define OLED_RESET    -1
Adafruit_SSD1306 display(OLED_RESET);
RTC_DS3231 rtc;

const int trigPin1 = 12;
const int echoPin1 = 13;
const int trigPin2 = 14;
const int echoPin2 = 15;
const int distanceThreshold = 150;
int counter = 0;

const int redLed1 = 5;
const int greenLed1 = 4;
const int redLed2 = 16;
const int greenLed2 = 17;

const int buttonPin = 2;
const int buttonPin2 = 23;

Servo doorServo;
Servo doorServo2;

unsigned long previousMillis1 = 0;
unsigned long previousMillis2 = 0;
const long interval = 4500;
const long interval2 = 8000;

int incar = 0;
int outcar = 0;

// Variabel untuk bergantian tampilan
bool showTime = true; // Menunjukkan waktu
unsigned long displayMillis = 0; // Waktu untuk berganti tampilan
const long displayInterval = 3000; // Interval untuk berganti tampilan (3 detik)

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

  pinMode(trigPin1, OUTPUT);
  pinMode(echoPin1, INPUT);
  pinMode(trigPin2, OUTPUT);
  pinMode(echoPin2, INPUT);
  
  pinMode(redLed1, OUTPUT);
  pinMode(greenLed1, OUTPUT);
  pinMode(redLed2, OUTPUT);
  pinMode(greenLed2, OUTPUT);

  pinMode(buttonPin, INPUT_PULLUP);
  pinMode(buttonPin2, INPUT_PULLUP);

  doorServo.attach(18);
  doorServo2.attach(19);

  if (!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) {
    Serial.println(F("SSD1306 allocation failed"));
    while (1);
  }

  if (!rtc.begin()) {
    Serial.println("Couldn't find RTC");
    while (1);
  }

  display.display();
  delay(2000);
  display.clearDisplay();
  display.setTextSize(2);
  display.setTextColor(SSD1306_WHITE);
  display.setCursor(15,0);
  display.println("E-PARKIR");
  display.display();
}

void loop() {
  
  long duration1, duration2, distance1, distance2;
  unsigned long currentMillis = millis();

  // Membaca sensor ultrasonik
  digitalWrite(trigPin1, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin1, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin1, LOW);
  duration1 = pulseIn(echoPin1, HIGH);
  distance1 = (duration1/2) / 29.1;

  digitalWrite(trigPin2, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin2, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin2, LOW);
  duration2 = pulseIn(echoPin2, HIGH);
  distance2 = (duration2/2) / 29.1;

  // Menghitung jumlah mobil
  if (distance1 < distanceThreshold && distance2 < distanceThreshold) {
    counter = 0;
    digitalWrite(redLed1, HIGH);
    digitalWrite(greenLed1, LOW);
    digitalWrite(redLed2, HIGH);
    digitalWrite(greenLed2, LOW);
  } else if (distance1 < distanceThreshold || distance2 < distanceThreshold) {
    counter = 1;
    if (distance1 < distanceThreshold) {
      digitalWrite(redLed1, HIGH);
      digitalWrite(greenLed1, LOW);
      digitalWrite(redLed2, LOW);
      digitalWrite(greenLed2, HIGH);
    } else {
      digitalWrite(redLed1, LOW);
      digitalWrite(greenLed1, HIGH);
      digitalWrite(redLed2, HIGH);
      digitalWrite(greenLed2, LOW);
    }
  } else {
    counter = 2;
    digitalWrite(redLed1, LOW);
    digitalWrite(greenLed1, HIGH);
    digitalWrite(redLed2, LOW);
    digitalWrite(greenLed2, HIGH);
  }

  // Mengontrol servo pintu
  if (digitalRead(buttonPin) == LOW) {
    // Cek jika sisa slot parkir lebih dari 0
    if (counter > 0) {
      doorServo.write(0); // Buka pintu
      previousMillis1 = currentMillis; // Reset waktu terakhir
      incar++; // Tambah jumlah mobil yang masuk
    }
  } else {
    if (currentMillis - previousMillis1 >= interval) {
      doorServo.write(90); // Tutup pintu setelah interval
    }
  }

  if (digitalRead(buttonPin2) == LOW) {
    // Cek jika sisa slot parkir lebih dari 0
    if (counter > 0) {
      doorServo2.write(0); // Buka pintu
      previousMillis2 = currentMillis; // Reset waktu terakhir
      outcar++; // Tambah jumlah mobil yang keluar
    }
  } else {
    if (currentMillis - previousMillis2 >= interval2) {
      doorServo2.write(90); // Tutup pintu setelah interval
    }
  }

  // Berganti tampilan
  if (currentMillis - displayMillis >= displayInterval) {
    showTime = !showTime; // Ganti tampilan
    displayMillis = currentMillis; // Reset timer
  }

  // Menampilkan informasi ke OLED
  display.clearDisplay();
  
  if (showTime) {
    // Menampilkan waktu
    DateTime now = rtc.now();
    display.setTextSize(1);
    display.setCursor(0,0);
    display.print("TANGGAL: ");
    display.print(now.year(), DEC);
    display.print('/');
    display.print(now.month(), DEC);
    display.print('/');
    display.print(now.day(), DEC);
    
    display.setCursor(0,10);
    display.print("WAKTU: ");
    display.print(now.hour(), DEC);
    display.print(':');
    if (now.minute() < 10) display.print('0');
    display.print(now.minute(), DEC);
    display.print(':');
    if (now.second() < 10) display.print('0');
    display.print(now.second(), DEC);
  } else {
    // Menampilkan slot parkir tanpa spasi
    display.setTextSize(1);
    display.setCursor(0,0);
    display.print("JUMLAH MASUK: ");
    display.println(incar);
    display.print("JUMLAH KELUAR: ");
    display.println(outcar);
    display.print("SISA PARKIR: ");
    display.println(counter);
  }

  display.display();
  delay(100); // Tunggu sebentar sebelum membaca ulang
}