//servo - LCD - MQTT - CCTV - YOLO
//Simulasi Lampu PJU otomatis
//Nyoman yudi kurniawan
//www.aisi555.com
// yolo di : https://colab.research.google.com/drive/1enwllsPpcd2Jdw5AHAI_RuPkMtP0FMBo?usp=sharing


// Servo Lib ESP32
#include <ESP32Servo.h>
//untuk menghubungkan ESP dengan perangkat WiFi
#include <WiFi.h>
//mengirim data ke server MQTT  
#include <PubSubClient.h>
//Library LCD i2c
#include <Wire.h>
#include <LiquidCrystal_I2C.h>

#define topik "/unesa/lampu"

const int servoPin = 18;
const int pirPin = 23;

Servo servo;

WiFiClient espClient;
PubSubClient client(espClient);

const char* ssid = "Wokwi-GUEST"; ///  wifi ssid 
const char* password = "";
//variabel string untuk menyimpan alamat server MQTT
const char* mqtt_server = "broker.hivemq.com";


// Sesuaikan alamat I2C LCD Anda (biasanya 0x27 atau 0x3F)
LiquidCrystal_I2C lcd(0x27, 20, 4); // 20 kolom, 4 baris


//untuk menginisialisasi dan mengatur koneksi WiFi pada perangkat.
void setup_wifi() { 
  delay(10);
  Serial.println();
  Serial.print("Connecting to ");
  Serial.println(ssid);

  WiFi.mode(WIFI_STA); 
  WiFi.begin(ssid, password);

  while (WiFi.status() != WL_CONNECTED) { 
    delay(500);
    Serial.print(".");
  }


  Serial.println("");
  Serial.println("WiFi connected");
  Serial.println("IP address: ");
  Serial.println(WiFi.localIP());
}



void reconnect() {
  while (!client.connected()) {
    Serial.print("Attempting MQTT connection...");
    String clientId = "Unesa-";
    clientId += String(random(0xffff), HEX);
    // Attempt to connect
    if (client.connect(clientId.c_str())) {
      Serial.println("connected");
      Serial.println("subscribe to topic: ");
      Serial.println(topik);
      client.subscribe(topik); //subscribe ke topic servo
    }
  
     else {
      Serial.print("failed, rc=");
      Serial.print(client.state());
      delay(5000);
    }
  }
}

void init_lcd()
{

  lcd.init();                      // initialize the lcd 
  // Print a message to the LCD.
  lcd.backlight();
  lcd.setCursor(0,0);
  lcd.print(" -= Demo Yolo PJU =-");
  lcd.setCursor(0,1);
  lcd.print( "  Kelas KomJar 2025");
  lcd.setCursor(0,2);
  lcd.print( "S2 Informatika Unesa");
}



void setup() {
  pinMode(pirPin, INPUT); 
  init_lcd();
  Serial.begin(115200);
  setup_wifi();
  client.setServer(mqtt_server, 1883);
  client.setCallback(mqtt_callback);
  servo.attach(servoPin, 500, 2400);
  servo.write(45); //posisi awal

}


void loop() {
  if (!client.connected()) 
   {
    reconnect();
   }
   else client.loop(); //cek terus kalau ada data masuk
  


}






void mqtt_callback(char* topic, byte* payload, unsigned int length) {
  Serial.print("Message arrived in topic: ");
  Serial.println(topic);

  // Buat string dari payload
  String message = "";
  for (int i = 0; i < length; i++) {
    message += (char)payload[i];
  }

  Serial.println("Pesan Masuk: " + message);

     // Bersihkan di LCD (20x4)
     lcd.clear();

     if( message == "0"){
         Serial.println(" ");
         Serial.println("Kodisi Lampu: Mati - servo 0");       
     
        lcd.print("Kontrol CCTV - Lampu");
        lcd.setCursor(0,1);
        lcd.print("  Lampu :  Mati");
        lcd.setCursor(0,2);
        lcd.print(" Servo : posisi 0");
        lcd.setCursor(0,3);
        lcd.print(" ***************** ");
        servo.write(0);    

     }
     else if( message == "1"){
        Serial.println(" ");
        Serial.println("Kodisi Lampu: 25% - servo 45");       
     
        lcd.print("Kontrol CCTV - Lampu");
        lcd.setCursor(0,1);
        lcd.print("  Lampu :  25%");
        lcd.setCursor(0,2);
        lcd.print(" Servo : posisi 45");
        lcd.setCursor(0,3);
        lcd.print(" ***************** ");
        servo.write(45);    
     }
     else if( message == "2"){
        Serial.println(" ");
        Serial.println("Kodisi Lampu: 50% - servo 90");       
     
        lcd.print("Kontrol CCTV - Lampu");
        lcd.setCursor(0,1);
        lcd.print("  Lampu :  50%");
        lcd.setCursor(0,2);
        lcd.print(" Servo : posisi 90");
        lcd.setCursor(0,3);
        lcd.print(" ***************** ");
        servo.write(90);    
     }
     else if( message == "3"){
        Serial.println(" ");
        Serial.println("Kodisi Lampu: 75% - servo 135");       
     
        lcd.print("Kontrol CCTV - Lampu");
        lcd.setCursor(0,1);
        lcd.print("  Lampu :  75%");
        lcd.setCursor(0,2);
        lcd.print(" Servo : posisi 135");
        lcd.setCursor(0,3);
        lcd.print(" ***************** ");
        servo.write(135);    
     }
     else if( message == "4"){
        Serial.println(" ");
        Serial.println("Kodisi Lampu: 100% - servo 180");       
     
        lcd.print("Kontrol CCTV - Lampu");
        lcd.setCursor(0,1);
        lcd.print("  Lampu :  100%");
        lcd.setCursor(0,2);
        lcd.print(" Servo : posisi 180");
        lcd.setCursor(0,3);
        lcd.print(" ***************** ");
        servo.write(180);    
     }

 

}