Automatyczny szlaban

// Automatyczny szlaban
// Czy jedzie auto (coś bliżej niż 15 cm)? Wtedy brzęczyk piszczy i szlaban się otwiera.

#include <Servo.h>

const int TRIG_PIN = 9;       // Trig z HC-SR04 na pinie 9
const int ECHO_PIN = 10;      // Echo z HC-SR04 na pinie 10
const int SERVO_PIN = 5;      // Pomarańczowy/żółty przewód servo na pinie 5
const int BRZECZYK_PIN = 8;   // S brzęczyka na pinie 8
const int BLISKO = 15;        // Od tej odległości (cm) szlaban się otwiera

const int ZAMKNIETE = 0;      // Kąt, gdy szlaban jest zamknięty
const int OTWARTE = 90;       // Kąt, gdy szlaban jest otwarty

Servo szlaban;

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

void setup() {
  Serial.begin(9600);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pinMode(BRZECZYK_PIN, OUTPUT);
  szlaban.attach(SERVO_PIN);
  szlaban.write(ZAMKNIETE);
}

void loop() {
  long odleglosc = zmierzOdleglosc();

  if (odleglosc < BLISKO) {
    Serial.println(F("Auto! Szlaban otw."));
    digitalWrite(BRZECZYK_PIN, HIGH);   // Krótki pisk
    delay(100);
    digitalWrite(BRZECZYK_PIN, LOW);

    szlaban.write(OTWARTE);
    delay(1000);
    // Zostaje otwarty, póki auto tam stoi
    while (zmierzOdleglosc() < BLISKO) {
      delay(200);
    }
    delay(2000);                      // Jeszcze chwilę czekamy, aż auto naprawdę odjedzie
    szlaban.write(ZAMKNIETE);
    Serial.println(F("Szlaban zamk."));
  }
  delay(100);
}