#include <Servo.h>

// memilih pin untuk Sensor HC-SR04
const int trigPin = 9;
const int echoPin = 10;

// untuk instaliasi Servo Motor
Servo myServo;

// Variabel untuk menghitung jarak
long duration;
int distance;

void setup() {
  // Set pin trig dan echo sebagai input dan output
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);

// menghubungkan Servo Motor ke pin 11
myServo.attach(11);

// agar palang tertutup diawal
myServo.write(0); // 0 derajat posisi servo

 // untuk memulai
Serial.begin(9600);
}

void loop() {
// untuk mengirim sinyal ultrasonik
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);

// menghitung waktu untuk kembali
duration = pulseIn(echoPin, HIGH);

// menghitung jaraknya dalam satuan centimeter
distance = duration * 0.034 / 2;

// untuk menampilkan jarak agar bisa dilihat
Serial.print("Jarak: ");
Serial.println(distance);

// jika kendaraan terdeksi di satuan centimeter (100cm), palang akan terbuka
if (distance < 100) {
myServo.write(90); // untuk meposisikan palang terbuka (satuan derajat) 90derajat untuk terbuka
delay(5000); // waktu untuk palang tertutup kembali setelah kendaraan menjauh dari sensor 100cm++
myServo.write(0);  // untuk menutup palang
}

delay(1000); // delay untuk menunggu giliran kendaraan lain masuk (jika ada kendaraan lagi didepan yang berjarak 100cm--)
}