#define ECHO 2
#define TRIG 3
#define LEDM 13
#define LEDB 12
#define LEDK 11
#define LEDH 10

void setup() {
  Serial.begin(115200);
  pinMode(LEDM, OUTPUT);
  pinMode(LEDB, OUTPUT);
  pinMode(LEDK, OUTPUT);
  pinMode(LEDH, OUTPUT);
  pinMode(TRIG, OUTPUT);
  pinMode(ECHO, INPUT);
}

float nilaiSensor() {
  digitalWrite(TRIG, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG, LOW);
  int duration = pulseIn(ECHO, HIGH);
  return duration * 0.034 / 2;
}

void loop() {
  float jarak = nilaiSensor();

  if (jarak >= 25 && jarak <= 50) {
    digitalWrite(LEDM, 1);
    Serial.print("LED Merah ON | ");
  }
  else {
    digitalWrite(LEDM, 0);
  }

    if (jarak >= 51 && jarak <= 75) {
    digitalWrite(LEDB, 1);
    Serial.print("LED Biru ON | ");
  }
  else {
    digitalWrite(LEDB, 0);
  }

    if (jarak >= 76 && jarak <= 100) {
    digitalWrite(LEDK, 1);
    Serial.print("LED Kuning ON | ");
  }
  else {
    digitalWrite(LEDK, 0);
  }

    if (jarak >= 101 && jarak <= 125) {
    digitalWrite(LEDH, 1);
    Serial.print("LED Hijau ON | ");
  }
  else {
    digitalWrite(LEDH, 0);
    Serial.print("LED Mati semua | ");
  }

  Serial.print("Jarak: ");
  Serial.println(nilaiSensor());

  delay(100);
}