const int trigPin = 5;
const int echoPin = 18;

#define KecepatanSuara 0.0343

long durasi;
float Jarak;

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

void loop() {
  
  digitalWrite(trigPin, LOW);
  delayMicroseconds(10);

  digitalWrite(trigPin, HIGH);
  delayMicroseconds(100);
  digitalWrite(trigPin, LOW);
  
  durasi = pulseIn(echoPin, HIGH);
  
  Jarak = durasi * KecepatanSuara/2;
   
  Serial.print("Jarak (cm): ");
  Serial.println(Jarak);
  delay(1000);

  digitalWrite(15, HIGH);
  delay(2000);
  digitalWrite(15, LOW);
  delay(2000);

  digitalWrite(4, HIGH);
  delay(1000);
  digitalWrite(4, LOW);
  delay(1000);

}