Sbarra automatica

// Sbarra automatica
// Arriva un'auto (qualcosa a meno di 15 cm)? Allora il cicalino fa beep e la sbarra si apre.

#include <Servo.h>

const int TRIG_PIN = 9;       // Trig del HC-SR04 sul pin 9
const int ECHO_PIN = 10;      // Echo del HC-SR04 sul pin 10
const int SERVO_PIN = 5;      // Filo arancione/giallo del servo sul pin 5
const int CICALINO_PIN = 8;   // S del cicalino sul pin 8
const int VICINO = 15;        // Da questa distanza (cm) la sbarra si apre

const int CHIUSO = 0;         // Angolo quando la sbarra è chiusa
const int APERTO = 90;        // Angolo quando la sbarra è aperta

Servo sbarra;

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

void setup() {
  Serial.begin(9600);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pinMode(CICALINO_PIN, OUTPUT);
  sbarra.attach(SERVO_PIN);
  sbarra.write(CHIUSO);
}

void loop() {
  long distanza = misuraDistanza();

  if (distanza < VICINO) {
    Serial.println(F("Auto vista! Sbarra aperta."));
    digitalWrite(CICALINO_PIN, HIGH); // Beep breve
    delay(100);
    digitalWrite(CICALINO_PIN, LOW);

    sbarra.write(APERTO);
    delay(1000);
    // Resta aperta finché l'auto è ancora lì
    while (misuraDistanza() < VICINO) {
      delay(200);
    }
    delay(2000);                      // Aspetta ancora un po' finché l'auto è davvero via
    sbarra.write(CHIUSO);
    Serial.println(F("Sbarra chiusa."));
  }
  delay(100);
}