#define pinBuzzer 5
#define pinEcho 6
#define pinTrig 7
#define pinMerah 8
#define pinKuning 9
#define pinHijau 10

void setup() {
  Serial.begin(115200);
  pinMode(pinBuzzer, OUTPUT);
  pinMode(pinEcho, INPUT);
  pinMode(pinTrig, OUTPUT);
  pinMode(pinMerah, OUTPUT);
  pinMode(pinKuning, OUTPUT);
  pinMode(pinHijau, OUTPUT);
}

void loop() {
  int jarak = ukur_jarak();
  //Serial.print(jarak);
  if (jarak<25) {
    digitalWrite(pinMerah, HIGH);
    delay(100);
    digitalWrite(pinMerah, LOW);
    delay(100);
    tone(pinBuzzer,700,100);
  } else if (jarak<50) {
    digitalWrite(pinKuning, HIGH);
    delay(200);
    digitalWrite(pinKuning, LOW);
    delay(200);
    tone(pinBuzzer,1000,200);
  } else if (jarak<100) {
    digitalWrite(pinHijau, HIGH);
    delay(200);
    digitalWrite(pinHijau, LOW);
    delay(200);
    tone(pinBuzzer,1500,200);
  }
}

float ukur_jarak() {
  digitalWrite(pinTrig, LOW);
  delayMicroseconds(2);
  digitalWrite(pinTrig, HIGH);
  delayMicroseconds(10);
  digitalWrite(pinEcho, LOW);
  int hasil = pulseIn(pinEcho, HIGH);
  return hasil * 0.03425 / 2;
}