Ingresso controllato in banca

In questo progetto desidero simulare l'ingresso in una banca la cui porta è controllata da due sensori: uno touch capacitivo(di fattura artigianale) per entrare ed uno ad ultrasuoni per uscire.
Ho introdotto un contatore che indica il numero di clienti presenti nella banca che si aggiorna ogni volta che uno dei due sensori si attiva aumentando (touch) o diminuendo (ultrasuoni) di una unità.
Due led, uno verde ed uno rosso, indicano rispettivamente che l'ingresso è libero oppure occupato.
Il tempo di attesa impostato per compiere l'azione di ingresso/uscita è di 5s.
Un buzzer emetterà un suono, differenziato, per segnalare un ingresso oppure un'uscita.
Infine, ed è capitato per caso, ho utilizzato un servomotore per far muovere una parte di un modellino di cartone che simula l'apertura e la chiusura della porta della banca. La costruzione non è stata realizzata bene, vista l'improvvisazione, ma rende lo stesso l'idea.

Per realizzare questo progetto mi sono servito di:
1) un sensore touch capacitivo, realizzato da me, per gli ingressi;
2) un sensore HC-SR04 ad ultrasuoni, opportunamente tarato, che apre la porta in caso di segnale di uscita;
3) un display LCD 1602 con interfaccia I2C per segnalare il numero di clienti presenti in banca;
4) un buzzer/speacker che emette un suono ogni volta che si attivano i sensori;
5) due led, uno rosso ed uno verde, per segnalare le operazione di ingresso e di uscita;
6) un servomotore per comandare una ipotetica porta in apertura e chiusura.

Collegamenti:
a) sensore touch
Esso è connesso col suo unico contatto al pin digitale 7 insieme ad un terminale di una resistenza di 1 Mohm mentre l'altro terminale va al pin digitale 8;
b) sensore HC-SR04
Esso è provvisto di 4 terminali, due dei quali sono collegati con l'alimentazione (+5V e GND) mentre gli altri due ai pin digitali 9 (Trig) e 10 (Echo);
c) LED
Connessi alla scheda tramite una resistenza di 220 ohm che collega l'anodo al pin digitale 12 (ROSSO) e al pin digitale 13 (VERDE) mentre il catodo va al GND;
d) display LCD
Due terminali all'alimentazione (+5V e GND) mentre gli altri due ai pin analogici A5 (SCL) ed A4 (SDA);
e) buzzer/speacker
Connesso con un terminale al GND e con l'altro al pin digitale 2;
f) servomotore
Dei tre terminali disponibili due si collegano con l'alimentazione (+5V e GND) mentre quello centrale va connesso al pin digitale PWM 3.

Il codice relativo al progetto è disponibile al link: controllo banca.