#include <LiquidCrystal.h>

LiquidCrystal lcd(12, 11, 5, 4, 3, 2);

const int trigPin = 6;
const int echoPin = 7;
const int trigPin2 = 9;
const int echoPin2 = 1;
const int buzzerPin = 8;

float temps;
float temps2;
int distance;
int distance2;

bool ctrue = false;
bool c2true = false;
int entree = 0;

int personnesPresentes = 0;
const int maxPersonnes = 5;

bool messageAffiche = false;

void setup() {
    lcd.begin(16, 2);
    lcd.print("Veuillez entrer");
  
    pinMode(trigPin, OUTPUT);
	pinMode(echoPin, INPUT);
	pinMode(trigPin2, OUTPUT);
	pinMode(echoPin2, INPUT);
    pinMode(buzzerPin, OUTPUT);
}

void loop() {
    Distance();
    Distance2();
    CIsTrue();
    CTwoIsTrue();
    PersonnesPresentes();
    SetMessage();
}

void CIsTrue() {
	if (distance >= 200 && entree == 0)
		ctrue = false;
  
    else if (distance < 200 &(entree == 0 || entree == -1))
		ctrue = true;
}

void CTwoIsTrue() {
	if (distance2 >= 200 && entree == 0)
		c2true = false;
  
    else if (distance2 < 200 && (entree == 0 || entree == 1))
		c2true = true;
}

void PersonnesPresentes() {
	if (entree == 0 && ctrue && !c2true) entree = 1;
  
    else if (entree == 0 && !ctrue && c2true) entree = -1;
  
    if (entree == 1 && c2true) {
        personnesPresentes += 1;
        ctrue = false;
        c2true = false;
        delay(625);
       	entree = 0;
	}
    else if (entree == -1 && ctrue) {
	  	personnesPresentes -= 1;
      	ctrue = false;
      	c2true = false;
      	delay(625);
        entree = 0;
	}
  
    if(personnesPresentes < 0) personnesPresentes = 0;
}

int Distance() {
	digitalWrite(trigPin, LOW);
	delayMicroseconds(2);
  
	digitalWrite(trigPin, HIGH);
	delayMicroseconds(10);
	digitalWrite(trigPin, LOW);

	temps = pulseIn(echoPin, HIGH);

	distance = temps * 0.0347 / 2;

    return(distance);
}

int Distance2() {
	digitalWrite(trigPin2, LOW);
	delayMicroseconds(2);
  
	digitalWrite(trigPin2, HIGH);
	delayMicroseconds(10);
	digitalWrite(trigPin2, LOW);
  
	temps2 = pulseIn(echoPin2, HIGH);
  
	distance2 = temps2 * 0.0347 / 2;
  
    return(distance2);
}

void SetMessage() {
	if (personnesPresentes > maxPersonnes) {
        lcd.setCursor(0, 0);
        lcd.print("N'ENTREZ PAS!!!");
        tone(buzzerPin, 440);
        messageAffiche = false;
	}
    else if (!messageAffiche && personnesPresentes <= maxPersonnes) {
        lcd.setCursor(0, 0);
        lcd.print("Veuillez entrer");
        messageAffiche = true;
	}
  
    lcd.setCursor(0, 1);
    lcd.print(personnesPresentes);
    if(personnesPresentes < 10) {
        lcd.setCursor(1, 1);
        lcd.print(" ");
	}
}