void setup() {
    lastTime = millis();
    currentTime = millis();
    lcd.begin(16, 2);
    Entrance.setServo();
    Exit.setServo();
}