Integrasi Sistem Smart Gate

#include <Servo.h>

// ── Pin Configuration ──────────────
#define TRIG_PIN   2
#define ECHO_PIN   3
#define SERVO_PIN  9
#define LED_HIJAU  11
#define LED_MERAH  12
#define BUZZER_PIN 8

// ── System Config ───────────────
#define JARAK_DETEKSI  15   // cm
#define DELAY_TUTUP    3000 // ms, waktu palang terbuka

Servo gateServo;
bool gerbangTerbuka = false;
unsigned long waktuBuka = 0;

void setup() {
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pinMode(LED_HIJAU, OUTPUT);
  pinMode(LED_MERAH, OUTPUT);
  pinMode(BUZZER_PIN, OUTPUT);
  
  gateServo.attach(SERVO_PIN);
  tutupGerbang();
  
  Serial.begin(9600);
  Serial.println("Smart Gate System v1.0 - SIAP");
}

long bacaJarak() {
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  
  long durasi = pulseIn(ECHO_PIN, HIGH);
  return durasi * 0.034 / 2;
}

void bukaGerbang() {
  gateServo.write(90);
  digitalWrite(LED_HIJAU, HIGH);
  digitalWrite(LED_MERAH, LOW);
  tone(BUZZER_PIN, 800, 200);
  gerbangTerbuka = true;
  waktuBuka = millis();
  Serial.println("✓ GERBANG TERBUKA");
}

void tutupGerbang() {
  gateServo.write(0);
  digitalWrite(LED_HIJAU, LOW);
  digitalWrite(LED_MERAH, HIGH);
  tone(BUZZER_PIN, 400, 200);
  gerbangTerbuka = false;
  Serial.println("■ GERBANG TERTUTUP");
}

void loop() {
  long jarak = bacaJarak();
  Serial.print("Jarak: "); Serial.print(jarak); Serial.println(" cm");
  
  if (jarak > 0 && jarak < JARAK_DETEKSI && !gerbangTerbuka) {
    bukaGerbang();
  }
  
  if (gerbangTerbuka && millis() - waktuBuka > DELAY_TUTUP) {
    tutupGerbang();
  }
  
  delay(200);
}