#define ECHO_PIN 2
#define TRIG_PIN 15
#define biru 21
#define hijau 19
#define kuning 18
#define merah 5
#define buzzer 22

void setup() {
  Serial.begin(115200);
  pinMode(LED_BUILTIN, OUTPUT);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pinMode(biru, OUTPUT);
  pinMode(hijau, OUTPUT);
  pinMode(kuning, OUTPUT);
  pinMode(merah, OUTPUT);
  pinMode(buzzer, OUTPUT);
}

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 loop() {
  float y = readDistanceCM();

  Serial.print("jarak: ");
  Serial.println(y);

  delay(600);

  if (y > 50 && y < 100){
    digitalWrite(biru, HIGH);
    digitalWrite(hijau, LOW);
    digitalWrite(kuning, LOW);
    digitalWrite(merah, LOW);
  }
  else if (y > 100 && y < 200){
    digitalWrite(biru, HIGH);
    digitalWrite(hijau, HIGH);
    digitalWrite(kuning, LOW);
    digitalWrite(merah, LOW);
  }
  else if (y > 200 && y < 300){
    digitalWrite(biru, HIGH);
    digitalWrite(hijau, HIGH);
    digitalWrite(kuning, HIGH);
    digitalWrite(merah, LOW);
  }
  else if (y > 300 && y < 400){
    digitalWrite(biru, HIGH);
    digitalWrite(hijau, HIGH);
    digitalWrite(kuning, HIGH);
    digitalWrite(merah, HIGH);
    tone(22, 1000);
    delay(100);
    noTone(22);
    delay(100);
  }
  else {
    Serial.println("jarak terlalu dekat");
    digitalWrite(biru, HIGH);
    digitalWrite(hijau,HIGH);
    digitalWrite(kuning, HIGH);
    digitalWrite(merah, HIGH);
    delay(100);
    digitalWrite(biru, LOW);
    digitalWrite(hijau, LOW);
    digitalWrite(kuning, LOW);
    digitalWrite(merah, LOW);
    tone(22, 1000);
    delay(100);
    noTone(22);
    delay(100);

  }
}