#define PIN_TRIG 12
#define PIN_ECHO 13
#define ledMerah 2
#define ledKuning 3
#define ledHijau 4
#define ledPutih 7

#define ledBiruTerang 8

void setup() {
  Serial.begin(115200);
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);
  pinMode(ledMerah, OUTPUT);
  pinMode(ledKuning, OUTPUT);
  pinMode(ledHijau, OUTPUT);

  pinMode(ledBiruTerang, OUTPUT);
  pinMode(ledPutih, OUTPUT);
}
void loop() {
  // Start a new measurement:
  digitalWrite(PIN_TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, LOW);
  // Read the result:
  int duration = pulseIn(PIN_ECHO, HIGH);
  Serial.print("Distance in CM: ");
  Serial.println(duration / 58);
  int jarak = duration / 58;
  if (jarak <= 100){
    digitalWrite(ledMerah, HIGH);
    digitalWrite(ledKuning, LOW);
    digitalWrite(ledHijau, LOW);
    digitalWrite(ledBiruTerang, LOW);
    digitalWrite(ledPutih, LOW);
  }else if(jarak >= 101 and jarak <= 200 ){
    digitalWrite(ledMerah, LOW);
    digitalWrite(ledKuning, HIGH);
    digitalWrite(ledHijau, LOW);
    digitalWrite(ledBiruTerang, LOW);
    digitalWrite(ledPutih, LOW);
  }else if(jarak >= 201 and jarak <= 350){
    digitalWrite(ledMerah, LOW);
    digitalWrite(ledKuning, LOW);
    digitalWrite(ledHijau, HIGH);
    digitalWrite(ledBiruTerang, LOW);
    digitalWrite(ledPutih, LOW);
  }
  
  if(jarak >= 350) {
    digitalWrite(ledBiruTerang, HIGH);
    digitalWrite(ledPutih, LOW);
    delay(1000);
    digitalWrite(ledBiruTerang, LOW);
    digitalWrite(ledPutih, HIGH);
    delay(1000);
  }
  
  
  // else{
  // digitalWrite(ledM, LOW);
  // }
  // delay(1000);
}