#include <LiquidCrystal.h>

// Konfigurasi LCD
LiquidCrystal lcd(12, 11, A1, A0, 13, 10);

// Pin Relay
const int relay1  = 7; // Katup Selenoid
const int relay21 = 6; // Saklar manual motor 1
const int relay22 = 5; // Saklar manual motor 2
const int relay31 = 4; // Saklar Motor Pencucian 1
const int relay32 = 3; // Saklar Motor Pencucian 2
const int relay4  = 2; // Drain Motor

// Pin Sensor Ultrasonik
const int trigPin = 9;
const int echoPin = 8;

// Pin Tombol
const int tombolMode = A2;
const int tombolAir = A3;
const int tombolEksekusi = A4;
const int buzzerPin = A5;

// Variabel untuk pilihan
int mode = 1;      // 1: Normal, 2: Bilas 2x, 3: Cepat
int levelAir = 1;  // 1: Low, 2: Mid, 3: High

void setup() {
  lcd.begin(16, 2);
  pinMode(relay1, OUTPUT);
  pinMode(relay21, OUTPUT);
  pinMode(relay22, OUTPUT);
  pinMode(relay31, OUTPUT);
  pinMode(relay32, OUTPUT);
  pinMode(relay4, OUTPUT); 
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode(tombolMode, INPUT_PULLUP);
  pinMode(tombolAir, INPUT_PULLUP);
  pinMode(tombolEksekusi, INPUT_PULLUP);
  pinMode(buzzerPin, OUTPUT); // Konfigurasi pin buzzer

  //Setup posisi relay awal
  digitalWrite(relay1,  LOW);
  digitalWrite(relay21, HIGH); //alihkan timer manual 1 ke relay motor 1
  digitalWrite(relay22, HIGH); //alihkan timer manual 2 ke relay motor 2
  digitalWrite(relay31, LOW);
  digitalWrite(relay32, LOW);
  digitalWrite(relay4,  LOW);

  // Tampilan awal dengan bunyi buzzer
  lcd.print("Ayo Umbah-umbah");
  for (int i = 0; i < 1; i++) {     // Ulangi 1 kali
    tone(buzzerPin, 1000, 1000);    // Bunyikan buzzer (1000 Hz, selama 1 detik)
    delay(1000);                    // Tunggu 1 detik (untuk durasi bunyi selesai)
    delay(300);                     // Anti-bouncing
  }

  // Tampilkan menu pilihan
  tampilkanPilihan();
    for (int i = 0; i < 2; i++) {    // Ulangi 1 kali
    tone(buzzerPin, 1000, 300);      // Bunyikan buzzer (1000 Hz, selama 0.3 detik)
    delay(300);                      // Tunggu 1 detik (untuk durasi bunyi selesai)
    delay(200);                      // Jeda 1 detik sebelum bunyi berikutnya
    delay(300);                      // Anti-bouncing
  }
}

void loop() {
  // Pilihan mode
  if (digitalRead(tombolMode) == LOW) {
    mode = (mode % 3) + 1;
    tampilkanPilihan();
    delay(300); // Anti-bouncing
  }

  // Pilihan level air
  if (digitalRead(tombolAir) == LOW) {
    levelAir = (levelAir % 3) + 1;
    tampilkanPilihan();
    delay(300); // Anti-bouncing
  }

  // Eksekusi
  if (digitalRead(tombolEksekusi) == LOW) {
    eksekusiProgram();
    delay(300); // Anti-bouncing
  }
}

void tampilkanPilihan() {
  lcd.clear();
  lcd.setCursor(0, 0);
  lcd.print("Mode: ");
  if (mode == 1) lcd.print("Normal");
  else if (mode == 2) lcd.print("Bilas 2x");
  else if (mode == 3) lcd.print("Cepat");
  

  lcd.setCursor(0, 1);
  lcd.print("Level Air: ");
  if (levelAir == 1) lcd.print("Low");
  else if (levelAir == 2) lcd.print("Mid");
  else if (levelAir == 3) lcd.print("High");
}

void eksekusiProgram() {
  lcd.clear();
  lcd.print("Sedang proses:");

  // Isi air
  lcd.setCursor(0, 1);
  lcd.print("Mengisi air...");
  isiAir();
  
  // Proses pencucian
  if (mode == 1) {
    lcd.setCursor(0, 1);
    lcd.print("Mode: Normal   ");
    prosesNormal();
  } else if (mode == 2) {
    lcd.setCursor(0, 1);
    lcd.print("Mode: Bilas 2x ");
    prosesBilas2x();
  } else if (mode == 3) {
    lcd.setCursor(0, 1);
    lcd.print("Mode: Cepat    ");
    prosesCepat();
  }

  // Alarm selesai
  lcd.setCursor(0, 1);
  lcd.clear();
  lcd.print("Sudah Selesai!");
  lcd.setCursor(0, 1);
  lcd.print("Siap digaringkan!");
  bunyikanAlarm();
  delay(2000);
}

long bacaLevelAir() {
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);

  long duration = pulseIn(echoPin, HIGH);
  long distance = duration * 0.034 / 2; // Mengonversi waktu ke jarak (cm)
  return distance;
}

void isiAir() {
  long targetLevel;

  // Tentukan target level air berdasarkan pilihan levelAir
  if (levelAir == 1) targetLevel = 30; // Low (30 cm dari sensor)
  else if (levelAir == 2) targetLevel = 20; // Mid (20 cm dari sensor)
  else if (levelAir == 3) targetLevel = 10; // High (10 cm dari sensor)

  // Nyalakan katup selenoid untuk mulai mengisi air
  digitalWrite(relay1, HIGH);

  // Isi air hingga mencapai target level
  while (bacaLevelAir() > targetLevel) {
    lcd.setCursor(0, 1);
    lcd.print("Air: ");
    lcd.print(bacaLevelAir());
    lcd.print(" cm      ");
    delay(500); // Tunggu sebentar sebelum membaca lagi
  }

  // Matikan katup selenoid
  digitalWrite(relay1, LOW);
}

void prosesNormal() {
  // Isi air sebelum pencucian
  lcd.setCursor(0, 1);
  lcd.print("Isi Air...      ");
  isiAir();

  // Pencucian
  lcd.setCursor(0, 1);
  lcd.print("Mencuci...     ");
  mencucinormal(); // Panggil fungsi mencuci
  //while (true); // Hentikan loop setelah selesai
  delay(2000); // 2 detik (test)
  
  // Pengurasan
  lcd.setCursor(0, 1);
  lcd.print("Menguras...    ");
  digitalWrite(relay4, HIGH);
  delay(2000); // 2 detik (test)
  digitalWrite(relay4, LOW);

  // Isi air sebelum pembilasan
  lcd.setCursor(0, 1);
  lcd.print("Isi Air...      ");
  isiAir();

  // Pembilasan 1
  lcd.setCursor(0, 1);
  lcd.print("Membilas...    ");
  digitalWrite(relay4, HIGH);
  delay(2000); // 2 detik (test)
  digitalWrite(relay4, LOW);
  
  // Pengurasan
  lcd.setCursor(0, 1);
  lcd.print("Menguras...    ");
  digitalWrite(relay4, HIGH);
  delay(2000); // 2 detik (test)
  digitalWrite(relay4, LOW);
}

void prosesBilas2x() {
  // Rendam
  isiAir();
  delay(10000); // 10 menit
  
  // Pencucian
  digitalWrite(relay4, HIGH);
  delay(15000); // 15 menit
  digitalWrite(relay4, LOW);
  
  // Pengurasan
  digitalWrite(relay4, HIGH);
  delay(5000);
  digitalWrite(relay4, LOW);
  
  // Pembilasan 1
  isiAir();
  digitalWrite(relay4, HIGH);
  delay(5000);
  digitalWrite(relay4, LOW);
  
  digitalWrite(relay4, HIGH);
  delay(5000);
  digitalWrite(relay4, LOW);
  
  // Pembilasan 2
  isiAir();
  digitalWrite(relay4, HIGH);
  delay(5000);
  digitalWrite(relay4, LOW);
  
  digitalWrite(relay4, HIGH);
  delay(5000);
  digitalWrite(relay4, LOW);
}

void prosesCepat() {
  // Pencucian
  isiAir();
  digitalWrite(relay4, HIGH);
  delay(10000); // 10 menit
  digitalWrite(relay4, LOW);
  
  // Pengurasan
  digitalWrite(relay4, HIGH);
  delay(5000);
  digitalWrite(relay4, LOW);
  
  // Pembilasan 1
  isiAir();
  digitalWrite(relay4, HIGH);
  delay(5000);
  digitalWrite(relay4, LOW);
  
  digitalWrite(relay4, HIGH);
  delay(5000);
  digitalWrite(relay4, LOW);
}

void mencucinormal() {
  unsigned long startMillis = millis();      // Catat waktu mulai
  const unsigned long totalTime = 10 * 1000; // Total waktu pencucian: 1 menit
  const unsigned long switchInterval = 1000; // Waktu pergantian relay: 1 detik
  bool relay31On = true;

  while (millis() - startMillis < totalTime) {
    // Hitung waktu tersisa
    unsigned long remainingTime = (totalTime - (millis() - startMillis)) / 1000; // Dalam detik

    // Tampilkan waktu di LCD
    lcd.setCursor(0, 1);
    lcd.print("Cuci: ");
    lcd.print(remainingTime);
    lcd.print(" dtk   "); // Cetak waktu tersisa

    // Pergantian relay
    if (relay31On) {
      digitalWrite(relay31, HIGH); // Relay 31 aktif
      digitalWrite(relay32, LOW);  // Relay 32 mati
    } else {
      digitalWrite(relay31, LOW);  // Relay 31 mati
      digitalWrite(relay32, HIGH); // Relay 32 aktif
    }

    // Tunggu selama switchInterval
    delay(switchInterval);

    // Matikan relay sementara sebelum berganti
    digitalWrite(relay31, LOW);
    digitalWrite(relay32, LOW);
    delay(1000); // Jeda 1 detik untuk mencegah kerusakan relay

    // Tukar status relay
    relay31On = !relay31On;
  }

  // Matikan semua relay setelah selesai
  digitalWrite(relay31, LOW);
  digitalWrite(relay32, LOW);

  // Tampilan selesai
  lcd.setCursor(0, 1);
  lcd.clear();
  lcd.print("Selesai mencuci!");
}




void bunyikanAlarm() {
  for (int i = 0; i < 5; i++) {     // Ulangi 5 kali
    tone(buzzerPin, 1000, 1000);    // Bunyikan buzzer (1000 Hz, selama 1 detik)
    delay(1000);                    // Tunggu 1 detik (untuk durasi bunyi selesai)
    delay(1000);                    // Jeda 1 detik sebelum bunyi berikutnya
  }
}