Automatische Schranke

// Automatische Schranke
// Kommt ein Auto (etwas näher als 15 cm)? Dann piept der Summer und die Schranke geht auf.

#include <Servo.h>

const int TRIG_PIN = 9;       // Trig des HC-SR04 an Pin 9
const int ECHO_PIN = 10;      // Echo des HC-SR04 an Pin 10
const int SERVO_PIN = 5;      // Orange/gelbe Leitung des Servos an Pin 5
const int SUMMER_PIN = 8;     // S des Summers an Pin 8
const int NAH_DRAN = 15;      // Ab diesem Abstand (cm) geht die Schranke auf

const int ZU = 0;             // Winkel, wenn die Schranke zu ist
const int OFFEN = 90;         // Winkel, wenn die Schranke offen ist

Servo schranke;

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

void setup() {
  Serial.begin(9600);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pinMode(SUMMER_PIN, OUTPUT);
  schranke.attach(SERVO_PIN);
  schranke.write(ZU);
}

void loop() {
  long abstand = missAbstand();

  if (abstand < NAH_DRAN) {
    Serial.println(F("Auto gesehen! Schranke auf."));
    digitalWrite(SUMMER_PIN, HIGH);   // Kurzer Piepton
    delay(100);
    digitalWrite(SUMMER_PIN, LOW);

    schranke.write(OFFEN);
    delay(1000);
    // Offen bleiben, solange das Auto noch da ist
    while (missAbstand() < NAH_DRAN) {
      delay(200);
    }
    delay(2000);                      // Noch kurz warten, bis das Auto wirklich weg ist
    schranke.write(ZU);
    Serial.println(F("Schranke zu."));
  }
  delay(100);
}