#include <LiquidCrystal_I2C.h>

#define ledMerah 13
#define ledKuning 12
#define ledHijau 11
#define pinBuzzer 4
#define ECHO_PIN 2
#define TRIG_PIN 3

LiquidCrystal_I2C lcd(0x27, 16, 2);

int potpin = 0;
int val;

float readDistanceCM() {
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  int duration = pulseIn(ECHO_PIN, HIGH);
  return duration * 0.034 / 2;
}

void setup() {
  Serial.begin(115200);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pinMode(ledHijau, OUTPUT);
  pinMode(ledKuning, OUTPUT);
  pinMode(ledMerah, OUTPUT);
  pinMode(pinBuzzer, OUTPUT);

  //lcd.begin();
  lcd.begin(16, 2);
  // you can now interact with the LCD, e.g.:
  lcd.print("SMK Negeri 8");
  lcd.setCursor(0, 1);
  lcd.print("Tangerang");
  delay(10000);
}

void loop(){
  float distance = readDistanceCM();
  Serial.print("Measured distance:  ");
  Serial.print(readDistanceCM());
  delay(100);

  if(distance <= 50){
    digitalWrite(ledMerah, HIGH);
    digitalWrite(ledMerah, LOW);
    digitalWrite(ledHijau, LOW);
    tone(pinBuzzer, 1000);
    delay(200);
    tone(pinBuzzer, 500);
    delay(200);
    Serial.println("LED Merah Hidup, Buzzer Hidup");
    Serial.println("Speaker Buzzer Hidup");

    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("LED Merah Hidup");
    lcd.setCursor(0, 1);  
    lcd.print("Buzzer Hidup");
  }
  
  else if(distance > 100 && distance <=200){
    digitalWrite(ledMerah, LOW);
    digitalWrite(ledKuning, HIGH);
    digitalWrite(ledHijau, LOW);
    noTone(pinBuzzer);
    Serial.println("LED Kuning Hidup, Lainnya Mati");

    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("LED Kuning Hidup");
    lcd.setCursor(0, 1);
    lcd.print("Lainnya Mati");
  }
  else if(distance > 200){
    digitalWrite(ledMerah, LOW);
    digitalWrite(ledKuning, LOW);
    digitalWrite(ledHijau, HIGH);
    noTone(pinBuzzer);
    Serial.println("LED Hijau Hidup, Lainnya Mati");

    lcd.clear();
    lcd.setCursor(0,0);
    lcd.print("LED Hijau Hidup");
    lcd.setCursor(0, 1);
    lcd.print("Lainnya Mati");
  }
  delay(1000);
}