#define trigpin1 27
#define echopin1 26
#define trigpin2 25
#define echopin2 33
#define trigpin3 17
#define echopin3 18

long durasi1, jarak1;
long durasi2, jarak2;
long durasi3, jarak3;

void setup() {
  Serial.begin(9600);
  pinMode(trigpin1, OUTPUT);
  pinMode(echopin1, INPUT);
  pinMode(trigpin2, OUTPUT);
  pinMode(echopin2, INPUT);
  pinMode(trigpin3, OUTPUT);
  pinMode(echopin3, INPUT);
  delay(1000);
}

void loop() {
  // Sensor 1
  digitalWrite(trigpin1, HIGH);
  delayMicroseconds(10); 
  digitalWrite(trigpin1, LOW);
  durasi1 = pulseIn(echopin1, HIGH);
  jarak1 = (durasi1 / 2) / 29.1;

  // Sensor 2
  digitalWrite(trigpin2, HIGH);
  delayMicroseconds(10); 
  digitalWrite(trigpin2, LOW);
  durasi2 = pulseIn(echopin2, HIGH);
  jarak2 = (durasi2 / 2) / 29.1;

  // Sensor 3
  digitalWrite(trigpin3, HIGH);
  delayMicroseconds(10); 
  digitalWrite(trigpin3, LOW);
  durasi3 = pulseIn(echopin3, HIGH);
  jarak3 = (durasi3 / 2) / 29.1;

  // Print results
  Serial.print("Jarak Sensor 1: "); 
  Serial.print(jarak1);
  Serial.println(" cm");

  Serial.print("Jarak Sensor 2: "); 
  Serial.print(jarak2);
  Serial.println(" cm");

  Serial.print("Jarak Sensor 3: "); 
  Serial.print(jarak3);
  Serial.println(" cm");

  // Determine closest object
  if (jarak1 < 5) {
    Serial.println("Objek terdekat adalah Sensor 1");
  } else if (jarak2 < 5) {
    Serial.println("Objek terdekat adalah Sensor 2");
  } else if (jarak3 < 5) {
    Serial.println("Objek terdekat adalah Sensor 3");
  } else {
    Serial.println("Tidak dapat menentukan objek terdekat");
  }

  delay(1000);
}