#include <Arduino.h>

#define ECHOPIN 4   // Pin TRIG sensor HC-SR04
#define TRIGPIN 2  // Pin ECHO sensor HC-SR04
//#define LEDRED 21  // Pin koneksi data LED bar
//#define LEDYELLOW 19 // Pin koneksi data LED bar
//#define LEDGREEN 18 // Pin koneksi data LED bar
//#define LED_COUNT 8  // Jumlah LED pada bar Anda
//#define LEDPIN 19   // Pin LED pada ESP32
#define kecepatanSuara 0.034  //#define digunakan untuk membuat sebuah konstanta

byte led1 = 18;
byte led2 = 19;
byte led3 = 21;

float jarakcm;

void setup() 
{
  Serial.begin(115200);  // Starts the serial communication
 // pinMode(LEDPIN,OUTPUT);
  pinMode(TRIGPIN,OUTPUT);
  pinMode(ECHOPIN,INPUT);
  pinMode(led1, OUTPUT);
  pinMode(led2, OUTPUT);
  pinMode(led3, OUTPUT);
  int color;
 }

void loop() 
{
  // ambil jarak dari sensor
  unsigned long durasi = 0;
  //memerintahkan sensor ultrasonik
  digitalWrite(TRIGPIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIGPIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIGPIN, LOW);

  //mencari durasi waktu
  durasi = pulseIn(ECHOPIN,HIGH);

  //menghitung jarak
  jarakcm = durasi * kecepatanSuara / 2;

  Serial.print("Jarak = ");
  Serial.println(jarakcm);

  //matikan semua LED
  digitalWrite(led1, LOW);
  digitalWrite(led2, LOW);
  digitalWrite(led3, LOW);
  
  //jika jarak kurang dari sama dengan 10
  if(jarakcm<=100){
    digitalWrite(led1, HIGH);
  }
  if(jarakcm>100 && jarakcm<=250){
    digitalWrite(led1, HIGH);
    digitalWrite(led2, HIGH);
  }
  if(jarakcm>250 && jarakcm<=400){
    digitalWrite(led1, HIGH);
    digitalWrite(led2, HIGH);
    digitalWrite(led3, HIGH);
  }

  digitalWrite(color, BCYR);
 
  delay(1000); // this speeds up the simulation
}