#include <WiFi.h>

const char ssid[] = "Wokwi-GUEST";
const char pass[] = "";

#define trigPin 19
#define echoPin 18

int led1 = 4;
int led2 = 16;
int led3 = 17;

void setup() {
  Serial.begin(115200);

   // Input = Sensor
  pinMode(trigPin, OUTPUT); // Mengatur pin trig sebagai output
  pinMode(echoPin, INPUT);  // Mengatur pin echo sebagai input

   pinMode(led1, OUTPUT);
  pinMode(led2, OUTPUT);
  pinMode(led3, OUTPUT);

  // Memulai koneksi WiFi
  WiFi.begin(ssid, pass);

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

  Serial.println("\nTerhubung ke WiFi!");
  Serial.print("IP Address: ");
  Serial.println(WiFi.localIP());
}

void loop() {
  
  // Ultrasonic
  long duration, distance;
  
  digitalWrite(trigPin, LOW); 
  delayMicroseconds(2); 
  
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10); 
  digitalWrite(trigPin, LOW);
  
  duration = pulseIn(echoPin, HIGH);
  
  distance = (duration / 2) / 29.1; // Menghitung jarak dalam cm
  
  Serial.print("Distance: ");
  Serial.print(distance);
  Serial.println(" cm"); // Mencetak jarak ke Serial Monitor
  
 
  
  digitalWrite(led1, HIGH);
  digitalWrite(led2, LOW);
  digitalWrite(led3, LOW);
  delay(delayled(distance)); 
  
  digitalWrite(led1, LOW);
  digitalWrite(led2, HIGH);
  digitalWrite(led3, LOW);
  delay(delayled(distance)); 

  digitalWrite(led1, LOW);
  digitalWrite(led2, LOW);
  digitalWrite(led3, HIGH);
  delay(delayled(distance)); 
  
}

int delayled(int dist)
{
  if(dist > 50){
  return 2000;
  }else if(dist >20){
    return 1000;
  }else{
    return 300;
  }
}