#include <LiquidCrystal_I2C.h>
LiquidCrystal_I2C lcd (0x27,16,2);

#include <Servo.h>
Servo servo;

#include <Wire.h>

int stato=0;
int A=0;
int B=0;
int C=0;

void setup() {
  lcd.init();
  Wire.begin();
  pinMode(2, INPUT_PULLUP);
  pinMode(3, INPUT_PULLUP);
  pinMode(5, OUTPUT);
  pinMode(6, OUTPUT);
  servo.attach(4);
  }

void loop() {
  if(!digitalRead(2)==HIGH){
    lcd.setBacklight(1);
    delay(200);
    stato++;
  }
  if(stato==0){
    servo.write(90);
    digitalWrite(11, HIGH);
    digitalWrite(10, HIGH);
    lcd.setCursor(2,0);
    lcd.print("PORTA APERTA");
    lcd.setCursor(0,1);
    lcd.print("      ");
    lcd.setCursor(6,1);
    lcd.print("*");
    lcd.setCursor(7,1);
    lcd.print("*");
    lcd.setCursor(8,1);
    lcd.print("*");
    lcd.setCursor(9,1);
    lcd.print("       ");
   
  }
  if(stato==1){
    servo.write(0);
    digitalWrite(5, LOW);
    digitalWrite(6, LOW);
    lcd.setCursor(2,0);
    lcd.print("DIGITARE PIN");
    lcd.setCursor(6,1);
    lcd.print("*");
    lcd.setCursor(7,1);
    lcd.print("*");
    lcd.setCursor(8,1);
    lcd.print("*");
   }
   if(stato==2){
     servo.write(0);
    digitalWrite(5, LOW);
    digitalWrite(6, LOW);
    lcd.setCursor(2,0);
    lcd.print("DIGITARE PIN");
    lcd.setCursor(0,1);
    lcd.print(A);
    lcd.print("*");
    lcd.print("*");
    lcd.print(" I CIFRA     ");
    if(!digitalRead(3)==HIGH){
      delay(200);
      A++;
    }
    if(A>9){
      A=0;
    }
   }if(stato==3){
     servo.write(0);
    digitalWrite(5, LOW);
    digitalWrite(6, LOW);
    lcd.setCursor(2,0);
    lcd.print("DIGITARE PIN");
    lcd.setCursor(0,1);
    lcd.print(A);
    lcd.print(B);
    lcd.print("*");
    lcd.print(" II CIFRA    ");
    if(!digitalRead(3)==HIGH){
      delay(200);
      B++;
    }
    if(B>9){
      B=0;
    }
   }
   if(stato==4){
     servo.write(0);
    digitalWrite(5, LOW);
    digitalWrite(6, LOW);
    lcd.setCursor(2,0);
    lcd.print("DIGITARE PIN");
    lcd.setCursor(0,1);
    lcd.print(A);
    lcd.print(B);
    lcd.print(C);
    lcd.print(" III CIFRA   ");
    if(!digitalRead(3)==HIGH){
      delay(200);
      C++;
    }
    if(C>9){
      C=0;
    }
   }
   if(stato==5){
     if(A==1&&B==2&&C==3){
       servo.write(90);
       digitalWrite(5, HIGH);
       digitalWrite(6, HIGH);
       lcd.setCursor(0,0);
       lcd.print("   PIN ESATTO ");
     lcd.setCursor(0,1);
     lcd.print("*");
     lcd.print("*");
     lcd.print("*");
     lcd.print("             ");
     }
   }
   if(stato==6){
     stato=0;
     A=0;
     B=0;
     C=0;
     lcd.setBacklight(0);
   }
  
}