// Ultrasonic sensor pins
#define TRIG_PIN 27
#define ECHO_PIN 26
#define servoPin 14
#define LED2_PIN 19
#define BUZZER_PIN 23
#define LED_PIN 18
#define BLYNK_TEMPLATE_ID "TMPL67XgIKVBE"
#define BLYNK_TEMPLATE_NAME "uas"
#define BLYNK_AUTH_TOKEN "bZS2EHlJtKTufkhCa1ijMa_A9b5yME7w"

#include <Wire.h>
#include <LiquidCrystal_I2C.h>
#include <ESP32Servo.h>
#include <WiFi.h>
#include <BlynkSimpleEsp32.h>
#include <NTPClient.h>
#include <WiFiUdp.h>

// LCD I2C Address
LiquidCrystal_I2C lcd(0x27, 16, 2);
Servo myServo;

// Blynk credentials
char auth[] = "bZS2EHlJtKTufkhCa1ijMa_A9b5yME7w"; // Blynk token
char ssid[] = "Wokwi-GUEST";        // WiFi SSID
char pass[] = "";    // WiFi password

// NTP Client setup
WiFiUDP ntpUDP;
NTPClient timeClient(ntpUDP, "pool.ntp.org", 28800, 60000); // WITA: UTC+8

void setup() {
  // Initialize Serial Monitor
  Serial.begin(115200);
  myServo.attach(servoPin);

  // Initialize LCD
  lcd.init();
  lcd.begin(16, 2);
  lcd.backlight();

  // Initialize pins
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pinMode(LED_PIN, OUTPUT);
  pinMode(LED2_PIN, OUTPUT);
  pinMode(BUZZER_PIN, OUTPUT);

  // Connect to WiFi and Blynk
  Blynk.begin(auth, ssid, pass);

  // Initialize NTP Client
  timeClient.begin();
}

// Main loop
void loop() {
  Blynk.run(); // Run Blynk

  // Ultrasonic sensor logic
  long duration = 0;
  int distance = 0;

  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);

  // Set duration and calculate distance
  duration = pulseIn(ECHO_PIN, HIGH);
  distance = duration * 0.034 / 2;

  // Update time from NTP server
  timeClient.update();
  String formattedTime = timeClient.getFormattedTime();

  // Display distance and time on LCD
  lcd.setCursor(0, 0);
  if (distance > 0 && distance < 10) {
    lcd.print("PORTAL TERBUKA       ");
  } else {
    lcd.print("PORTAL TUTUP        ");
  }

  lcd.setCursor(0, 1);
  lcd.print(formattedTime);

  if (distance > 0 && distance < 10) {
    // Object detected, close servo and turn on LED2, turn off LED
    myServo.write(0); // Close servo
    digitalWrite(LED_PIN, LOW); // LED OFF
    digitalWrite(LED2_PIN, HIGH); // LED2 ON
    delay(3000); // Delay for 3 seconds
  } else {
    // No object detected, open servo and turn on LED
    myServo.write(90); // Open servo
    digitalWrite(LED_PIN, HIGH); // LED ON
    digitalWrite(LED2_PIN, LOW); // LED2 OFF
  }

  // Print distance to Serial Monitor
  Serial.print("Distance: ");
  Serial.print(distance);
  Serial.println(" cm");

  delay(500); // Delay for stability
}