const int echoPin = 5;
const int ledPinBlue = 15;
const int ledPinYellow = 2;
const int trigPin = 21;

#define KecepatanSuara 0.034

long durasi;
float Jarak,cm;

void setup(){
  Serial.begin(115200);
  pinMode(trigPin, OUTPUT); 
  pinMode(echoPin, INPUT);
  pinMode(ledPinBlue, OUTPUT);
  pinMode(ledPinYellow, OUTPUT);
}

void loop(){
  long durasi, jarak ;
  digitalWrite(trigPin, LOW);
  delayMicroseconds(5);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  
  durasi = pulseIn(echoPin, HIGH);

  jarak = (durasi * 0.0343)/2;
  Serial.print(jarak);
  Serial.print("cm");
  Serial.print("\n");

  if(jarak < 10 ){
    digitalWrite(ledPinYellow, HIGH);
    digitalWrite(ledPinBlue, LOW);
    Serial.print("LED KUNING ON");
    Serial.print("\n");
    Serial.print("LED BIRU OFF");
    Serial.print("\n");
  }
  
  if(jarak < 100 && jarak >= 10){
    digitalWrite(ledPinBlue, HIGH);
    digitalWrite(ledPinYellow, LOW);
    Serial.print("LED BIRU ON");
    Serial.print("\n");
    Serial.print("LED KUNING OFF");
    Serial.print("\n");
  }

   if(jarak >= 100 ){
    digitalWrite(ledPinYellow, HIGH);
    digitalWrite(ledPinBlue, LOW);
    Serial.print("LED KUNING ON");
    Serial.print("\n");
    Serial.print("LED BIRU OFF");
    Serial.print("\n");
  }

  delay(1000);
}