#define ECHO_PIN 5
#define TRIG_PIN 4
#define ledMerah 8
#define ledKuning 7
#define ledHijau 6
#define ledUngu 13
#define ledOrange 12
#define ledHijautua 6
#define ledBirumuda 10

void setup () {
  Serial.begin(115200);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pinMode(ledMerah, OUTPUT);
  pinMode(ledKuning, OUTPUT);
  pinMode(ledHijau, OUTPUT);
  pinMode(ledUngu, OUTPUT);
  pinMode(ledOrange, OUTPUT);
  pinMode(ledHijautua, OUTPUT);
  pinMode(ledBirumuda, OUTPUT);
}

float readDistanceCM(){
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, HIGH);
  int duration = pulseIn(ECHO_PIN,HIGH);
  return duration * 0.034 / 2;
}

void loop(){
  float distance = readDistanceCM();

  Serial.print("Measured distance: ");
  Serial.print(readDistanceCM());

  if(distance <= 50){
    digitalWrite(ledMerah, HIGH);
    digitalWrite(ledKuning, LOW);
    digitalWrite(ledHijau, LOW);
    digitalWrite(ledUngu, LOW);
    digitalWrite(ledOrange, LOW);
    digitalWrite(ledHijautua, LOW);
    digitalWrite(ledBirumuda, LOW);
  }
  else if(distance <= 100){
    digitalWrite(ledMerah, LOW);
    digitalWrite(ledKuning, HIGH);
    digitalWrite(ledHijau, LOW);
    digitalWrite(ledUngu, LOW);
    digitalWrite(ledOrange, LOW);
    digitalWrite(ledHijautua, LOW);
    digitalWrite(ledBirumuda, LOW);
  }
  else if(distance <= 150){
    digitalWrite(ledMerah, LOW);
    digitalWrite(ledKuning, LOW);
    digitalWrite(ledHijau, HIGH);
    digitalWrite(ledUngu, LOW);
    digitalWrite(ledOrange, LOW);
    digitalWrite(ledHijautua, LOW);
    digitalWrite(ledBirumuda, LOW);
  }
  else if(distance <= 200){
    digitalWrite(ledMerah, LOW);
    digitalWrite(ledKuning, LOW);
    digitalWrite(ledHijau, LOW);
    digitalWrite(ledUngu, LOW);
    digitalWrite(ledOrange, LOW);
    digitalWrite(ledHijautua, LOW);
    digitalWrite(ledBirumuda, HIGH);
  }
  else if(distance <= 250){
    digitalWrite(ledMerah, LOW);
    digitalWrite(ledKuning, LOW);
    digitalWrite(ledHijau, LOW);
    digitalWrite(ledUngu, HIGH);
    digitalWrite(ledOrange, LOW);
    digitalWrite(ledHijautua, LOW);
    digitalWrite(ledBirumuda, LOW);
  }
  else if(distance <= 300){
    digitalWrite(ledMerah, LOW);
    digitalWrite(ledKuning, LOW);
    digitalWrite(ledHijau, LOW);
    digitalWrite(ledUngu, LOW);
    digitalWrite(ledOrange, HIGH);
    digitalWrite(ledHijautua, LOW);
    digitalWrite(ledBirumuda, LOW);
  }
  else{
    digitalWrite(ledMerah, LOW);
    digitalWrite(ledKuning, LOW);
    digitalWrite(ledHijau, LOW);
    digitalWrite(ledUngu, LOW);
    digitalWrite(ledOrange, HIGH);
    digitalWrite(ledHijautua, LOW);
    digitalWrite(ledBirumuda, LOW);
 }
 delay(100);
}