// Pin untuk sensor ultrasonik pertama.

#define trigPin1 4
#define echoPin1 5
#define led 6


long duration1, distance1;  // Variabel untuk sensor ultrasonik pertama


void setup() {
  pinMode(trigPin1, OUTPUT);
  pinMode(echoPin1, INPUT);
   pinMode(led, OUTPUT);
  Serial.begin(9600);  // Inisialisasi komunikasi serial
}

void loop() {
  // Mengukur jarak dari sensor ultrasonik pertama (kontrol servo)
  digitalWrite(trigPin1, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin1, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin1, LOW);
  duration1 = pulseIn(echoPin1, HIGH);
  distance1 = duration1 * 0.034 / 2;


  // Kondisi untuk sensor ultrasonik pertama
  if (distance1 <= 25) {  // Jika jarak <= 10 cm
    delay(1000);  // Menunggu selama 2 detik
    Serial.println(distance1);
     Serial.println(" cm");
     digitalWrite(led, HIGH);
     delay(1000);
  } else if ( distance1 <= 30 && distance1 <= 50) {
  digitalWrite(led, HIGH);
} else {
  digitalWrite(led, LOW);
}
  // Delay untuk stabilisasi sensor
delay(500);
}