#define BLYNK_TEMPLATE_ID "TMPL6xq9ko4PV"
#define BLYNK_TEMPLATE_NAME "Sensor Ultrasonik"
#define BLYNK_AUTH_TOKEN "yjelkTQvbI4ybIED2YNlgmKRaZyKIFwt"

#define BLYNK_PRINT Serial
#include <BlynkSimpleEsp32.h>

char auth[]=BLYNK_AUTH_TOKEN;
char ssid[]="Wokwi-GUEST";  //Jika tidak simulasi pakai ssid asli
char pass[]="";  //jika tidak simulasi pakai password asli
BlynkTimer timer;

#include <Wire.h>
#include <LiquidCrystal_I2C.h>  
LiquidCrystal_I2C lcd(0x27, 16,2);

#define TRIG_PIN 13 // ESP32 pin GIOP23 connected to Ultrasonic Sensor's TRIG pin
#define ECHO_PIN 12 // ESP32 pin GIOP22 connected to Ultrasonic Sensor's ECHO pin
#define LEDMERAH 14
#define LEDHIJAU 26
#define LEDKUNING 27

long durasi, jarak;

void setup()
 {
    // begin serial port
    Serial.begin (9600);
    Blynk.begin(auth, ssid,pass);
    lcd.init();
    lcd.setBacklight(255); 

    lcd.clear();
    lcd.setCursor (0,0);
    lcd.print(" *** BELAJAR ***");
    lcd.setCursor(0,1);
    lcd.print("*SENSOR  PARKIR*");
    delay(5000);
    lcd.clear();

    // configure the trigger pin to output mode
    pinMode(TRIG_PIN, OUTPUT);
    // configure the echo pin to input mode
    pinMode(ECHO_PIN, INPUT);
    pinMode(LEDMERAH, OUTPUT);
    pinMode(LEDHIJAU, OUTPUT);
    pinMode(LEDKUNING, OUTPUT);
    delayMicroseconds(8);

}

void loop() 
{
  Blynk.run();
  timer.run();
  
      digitalWrite(TRIG_PIN, HIGH);
      delayMicroseconds(10);
      digitalWrite(TRIG_PIN, LOW);
    
      durasi = pulseIn(ECHO_PIN, HIGH);      
      jarak= (durasi/2)/ 29,1;  

      Serial.print("jarak benda :  ");
      Serial.print(jarak);
      Serial.println(" Cm");
      Blynk.virtualWrite(V0, jarak);
      
      if (jarak >300) 
      {
        digitalWrite(LEDHIJAU, HIGH);
        digitalWrite(LEDMERAH, LOW);
        digitalWrite(LEDKUNING, LOW);
        Blynk.virtualWrite(V2,"JARAK AMAN TERKENDALI");

        lcd.setCursor (0,0);
        lcd.print(" *** JARAK ***");
        lcd.setCursor (0,1);
        lcd.print(" ***  AMAN  *** ");
        delay(500);
        lcd.clear();      

      }
      else if((jarak >100) && (jarak <300))
      {
        digitalWrite(LEDHIJAU, LOW);
        digitalWrite(LEDMERAH, LOW);
        digitalWrite(LEDKUNING, HIGH);
        Blynk.virtualWrite(V2,"AWAS HATI-HATI");

        lcd.setCursor (0,0);
        lcd.print(" ***  AWAS  *** ");
        lcd.setCursor (0,1);
        lcd.print(" * HATI  HATI * ");
        delay(500);
        lcd.clear(); 
      }
      else
      {
        digitalWrite(LEDHIJAU, LOW);
        digitalWrite(LEDMERAH, HIGH);
        digitalWrite(LEDKUNING, LOW);
        Blynk.virtualWrite(V2,"AWAS BAHAYA JARAK TERLALU DEKAT");
        
        lcd.setCursor (0,0);
        lcd.print(" ***  AWAS  *** ");
        lcd.setCursor (0,1);
        lcd.print("*TERLALU  DEKAT*");
        delay(500);
        lcd.clear();         
      }
    }