Automatische slagboom

// Automatische slagboom
// Komt er een auto aan (iets dichter dan 15 cm)? Dan piept de zoemer en gaat de slagboom open.

#include <Servo.h>

const int TRIG_PIN = 9;       // Trig van de HC-SR04 op pin 9
const int ECHO_PIN = 10;      // Echo van de HC-SR04 op pin 10
const int SERVO_PIN = 5;      // Oranje/gele draad van de servo op pin 5
const int ZOEMER_PIN = 8;     // S van de zoemer op pin 8
const int DICHTBIJ = 15;      // Vanaf deze afstand (cm) gaat de slagboom open

const int DICHT = 0;          // Hoek als de slagboom dicht is
const int OPEN = 90;          // Hoek als de slagboom open is

Servo slagboom;

long meetAfstand() {
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  long tijd = pulseIn(ECHO_PIN, HIGH, 30000);
  if (tijd == 0) return 999;
  return tijd / 58;
}

void setup() {
  Serial.begin(9600);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pinMode(ZOEMER_PIN, OUTPUT);
  slagboom.attach(SERVO_PIN);
  slagboom.write(DICHT);
}

void loop() {
  long afstand = meetAfstand();

  if (afstand < DICHTBIJ) {
    Serial.println(F("Auto gezien! Slagboom open."));
    digitalWrite(ZOEMER_PIN, HIGH);   // Kort piepje
    delay(100);
    digitalWrite(ZOEMER_PIN, LOW);

    slagboom.write(OPEN);
    delay(1000);
    // Open blijven zolang de auto er nog staat
    while (meetAfstand() < DICHTBIJ) {
      delay(200);
    }
    delay(2000);                      // Nog even wachten tot de auto echt weg is
    slagboom.write(DICHT);
    Serial.println(F("Slagboom dicht."));
  }
  delay(100);
}