/* RFID door lock code example.

* Visit the video: https://www.youtube.com/watch?v=X7hUSqS86DM

* Visit webpage tutorial: http://www.ELECTRONOOBS.com/eng_arduino_tut26.php
*
* Connections: http://www.ELECTRONOOBS.com/eng_arduino_tut26_sch1.php */

#include <SPI.h>
#include <MFRC522.h> //Downlaod the library:
http://www.electronoobs.com/eng_arduino_MFRC522.php
#include <Servo.h>

//LCD config
#include <Wire.h>
#include <LiquidCrystal_I2C.h> //Downlaod the library:
http://www.electronoobs.com/eng_arduino_liq_crystal.php
LiquidCrystal_I2C lcd(0x3f,20,4); //sometimes the adress is not 0x3f. Change to 0x27 if it dosn't
work.

#define RST_PIN 9 //Pin 9 is for the RC522 reset

#define SS_PIN 10 //Pin 10 is the SS (SDA) of RC522 module
MFRC522 mfrc522(SS_PIN, RST_PIN); //Create anew RC522 object
Servo motor_1;

//Variables
boolean door_opened=false;
boolean first_read=false;
boolean normal_mode=true;
boolean countdown = false;
int timer=0;
int user_added=0;
int add_ID_counter = 0;

//I/O
int buzzer_pin=7;
int outside_close = 4; //pin for the button of the outside open
int inside_close = 6; //pin for the button of the inside close
int inside_open = 5; //pin for the button of the inside open

void setup() {
SPI.begin(); //Start a new SPI bus
mfrc522.PCD_Init(); // Startt the MFRC522
motor_1.attach(3); //Set digital pin D3 to be the PWM signal for the servo motor
pinMode(buzzer_pin,OUTPUT); //Set digital pin D7 to be the buzzer OUTPUT

//Config of the i2c LCD screen

lcd.init();
lcd.backlight();
 lcd.setCursor(0,0);
lcd.print("Place card here!");
lcd.setCursor(0,1);
lcd.print(" ");
motor_1.writeMicroseconds(1000); //Put the servo in to the close position
}

byte ActualUID[4]; //This will store the ID each time we read a new ID code

byte USER1[4]= {0x09, 0x92, 0x53, 0x28} ; //Master ID code Change it for yor tag. First use the READ
exampel and check your ID

byte USER2[4]= {0x00, 0x00, 0x00, 0x00} ; //Empty ID of USER2

byte USER3[4]= {0x00, 0x00, 0x00, 0x00} ; //Empty ID of USER3
byte USER4[4]= {0x00, 0x00, 0x00, 0x00} ; //Empty ID of USER4
byte USER5[4]= {0x00, 0x00, 0x00, 0x00} ; //Empty ID of USER5

void loop() {

if(digitalRead(outside_close)) //If the button is pressed, we close the door

{
door_opened=false;
first_read=false;
countdown = false;
add_ID_counter = 0;
motor_1.writeMicroseconds(1000);
lcd.setCursor(0,0);
lcd.print(" Door closed ");
lcd.setCursor(0,1);
lcd.print(" from OUTSIDE ");
digitalWrite(buzzer_pin,HIGH);
delay(300);
digitalWrite(buzzer_pin,LOW);
delay(4000);
lcd.setCursor(0,0);
lcd.print("Place card here!");
lcd.setCursor(0,1);
lcd.print(" DOOR CLOSED ");
}

if(digitalRead(inside_close)) //If the button is pressed, we close the door

{
door_opened=false;
first_read=false;
countdown = false;
add_ID_counter = 0;
motor_1.writeMicroseconds(1000);
lcd.setCursor(0,0);
 lcd.print(" Door closed ");
lcd.setCursor(0,1);
lcd.print(" from INSIDE ");
digitalWrite(buzzer_pin,HIGH);
delay(300);
digitalWrite(buzzer_pin,LOW);
delay(4000);
lcd.setCursor(0,0);
lcd.print("Place card here!");
lcd.setCursor(0,1);
lcd.print(" DOOR CLOSED ");
}

if(digitalRead(inside_open)) //If the button is pressed, we open the door

{
door_opened=true;
first_read=false;
countdown = false;
add_ID_counter = 0;
motor_1.writeMicroseconds(1500);
lcd.setCursor(0,0);
lcd.print(" Door open ");
lcd.setCursor(0,1);
lcd.print(" from INSIDE ");
digitalWrite(buzzer_pin,HIGH);
delay(300);
digitalWrite(buzzer_pin,LOW);
delay(4000);
lcd.setCursor(0,0);
lcd.print("Place card here!");
lcd.setCursor(0,1);
lcd.print(" DOOR OPENED ");
}

if(normal_mode)
{

if(countdown)
{
if(add_ID_counter > 300)
{
countdown = false;
first_read=false;
add_ID_counter = 0;
lcd.setCursor(0,0);
lcd.print("New ID canceled");
lcd.setCursor(0,1);
lcd.print(" ");
 digitalWrite(buzzer_pin,HIGH);
delay(1000);
digitalWrite(buzzer_pin,LOW);
delay(4000);
lcd.setCursor(0,0);
lcd.print("Place card here!");
lcd.setCursor(0,1);
lcd.print(" ");
}

if(add_ID_counter == 50)
{
lcd.setCursor(15,1);
lcd.print("5");
digitalWrite(buzzer_pin,HIGH);
delay(100);
digitalWrite(buzzer_pin,LOW);
}

if(add_ID_counter == 100)
{
lcd.setCursor(15,1);
lcd.print("4");
digitalWrite(buzzer_pin,HIGH);
delay(100);
digitalWrite(buzzer_pin,LOW);
}

if(add_ID_counter == 150)
{
lcd.setCursor(15,1);
lcd.print("3");
digitalWrite(buzzer_pin,HIGH);
delay(100);
digitalWrite(buzzer_pin,LOW);
}

if(add_ID_counter == 200)
{
lcd.setCursor(15,1);
lcd.print("2");
digitalWrite(buzzer_pin,HIGH);
delay(100);
digitalWrite(buzzer_pin,LOW);
}

if(add_ID_counter == 250)
{
lcd.setCursor(15,1);
lcd.print("1");
digitalWrite(buzzer_pin,HIGH);
 delay(100);
digitalWrite(buzzer_pin,LOW);
}

add_ID_counter = add_ID_counter+1;
delay(10);
}

// Check if there are any new ID card in front of the sensor

if ( mfrc522.PICC_IsNewCardPresent())
{
//Select the found card
if ( mfrc522.PICC_ReadCardSerial())
{
// We store the read ID into 4 bytes with a for loop
for (byte i = 0; i < mfrc522.uid.size; i++) {
ActualUID[i]=mfrc522.uid.uidByte[i];
}

//Compare the UID and check if the new iD is on the user listz

if(first_read)
{
if(compareArray(ActualUID,USER1))
{
countdown=false;
add_ID_counter = 0;
digitalWrite(buzzer_pin,HIGH);
delay(300);
digitalWrite(buzzer_pin,LOW);
normal_mode=false;
lcd.setCursor(0,0);
lcd.print("Place New ID in:");
lcd.setCursor(0,1);
lcd.print(" 3 ");
digitalWrite(buzzer_pin,HIGH);
delay(100);
digitalWrite(buzzer_pin,LOW);
delay(1000);
lcd.setCursor(0,1);
lcd.print(" 2 ");
digitalWrite(buzzer_pin,HIGH);
delay(100);
digitalWrite(buzzer_pin,LOW);
delay(1000);
lcd.setCursor(0,1);
lcd.print(" 1 ");
 digitalWrite(buzzer_pin,HIGH);
delay(100);
digitalWrite(buzzer_pin,LOW);
delay(1000);
lcd.setCursor(0,1);
lcd.print(" NOW! ");
digitalWrite(buzzer_pin,HIGH);
delay(500);
digitalWrite(buzzer_pin,LOW);

}
else
{
first_read=false;

}
}

if(!first_read)
{
if(compareArray(ActualUID,USER1))
{
lcd.setCursor(0,0);
lcd.print(" Access granted ");
lcd.setCursor(0,1);
lcd.print(" MASTER USER ");
digitalWrite(buzzer_pin,HIGH); //use analogWrite(buzzer_pin,200); for non
active buzzer
delay(300);
digitalWrite(buzzer_pin,LOW); //use analog write for non active buzzer
motor_1.writeMicroseconds(1500);
door_opened=true;
first_read=true;
countdown=true;
delay(3000);
lcd.setCursor(0,0);
lcd.print("Put MASTER card");
lcd.setCursor(0,1);
lcd.print("for new ID 6");
digitalWrite(buzzer_pin,HIGH);
delay(100);
digitalWrite(buzzer_pin,LOW);

}
else if(compareArray(ActualUID,USER2))
{
lcd.setCursor(0,0);
lcd.print(" Access granted ");
lcd.setCursor(0,1);
lcd.print(" USER 2 ");
 digitalWrite(buzzer_pin,HIGH); //use analogWrite(buzzer_pin,200); for non
active buzzer
delay(300);
digitalWrite(buzzer_pin,LOW); //use analog write for non active buzzer
motor_1.writeMicroseconds(1500);
door_opened=true;
first_read=true;
delay(3000);
lcd.setCursor(0,0);
lcd.print("Last use: USER2");
lcd.setCursor(0,1);
lcd.print(" Door OPENED ");
}
else if(compareArray(ActualUID,USER3))
{
lcd.setCursor(0,0);
lcd.print(" Access granted ");
lcd.setCursor(0,1);
lcd.print(" USER 3 ");
digitalWrite(buzzer_pin,HIGH); //use analogWrite(buzzer_pin,200); for non
active buzzer
delay(300);
digitalWrite(buzzer_pin,LOW); //use analog write for non active buzzer
motor_1.writeMicroseconds(1500);
door_opened=true;
first_read=true;
delay(3000);
lcd.setCursor(0,0);
lcd.print("Last use: USER3");
lcd.setCursor(0,1);
lcd.print(" Door OPENED ");
}
else if(compareArray(ActualUID,USER4))
{
lcd.setCursor(0,0);
lcd.print(" Access granted ");
lcd.setCursor(0,1);
lcd.print(" USER 4 ");
digitalWrite(buzzer_pin,HIGH); //use analogWrite(buzzer_pin,200); for non
active buzzer
delay(300);
digitalWrite(buzzer_pin,LOW); //use analog write for non active buzzer
motor_1.writeMicroseconds(1500);
door_opened=true;
first_read=true;
delay(3000);
lcd.setCursor(0,0);
lcd.print("Last use: USER4");
lcd.setCursor(0,1);
lcd.print(" Door OPENED ");
}
 else if(compareArray(ActualUID,USER5))
{
lcd.setCursor(0,0);
lcd.print(" Access granted ");
lcd.setCursor(0,1);
lcd.print(" USER 5 ");
digitalWrite(buzzer_pin,HIGH); //use analogWrite(buzzer_pin,200); for non
active buzzer
delay(300);
digitalWrite(buzzer_pin,LOW); //use analog write for non active buzzer
motor_1.writeMicroseconds(1500);
door_opened=true;
first_read=true;
delay(3000);
lcd.setCursor(0,0);
lcd.print("Last use: USER5");
lcd.setCursor(0,1);
lcd.print(" Door OPENED ");
}
else
{
lcd.setCursor(0,0);
lcd.print(" Access denied ");
lcd.setCursor(0,1);
lcd.print(" UNKNOWN ID ");
analogWrite(buzzer_pin,200); //use analogWrite(buzzer_pin,200); for non
active buzzer
delay(1500);
analogWrite(buzzer_pin,LOW); //use analog write for non active buzzer
motor_1.writeMicroseconds(1000);
door_opened=false;
first_read=false;
delay(3000);
lcd.setCursor(0,0);
lcd.print("Place card here!");
lcd.setCursor(0,1);
lcd.print(" Door CLOSED ");
}
}

// Terminamos la lectura de la tarjeta tarjeta actual

mfrc522.PICC_HaltA();

}
 }
}//end normal mode

if(!normal_mode)
{
// Revisamos si hay nuevas tarjetas presentes
if ( mfrc522.PICC_IsNewCardPresent())
{
//Seleccionamos una tarjeta
if ( mfrc522.PICC_ReadCardSerial())
{
// Enviamos serialemente su UID

for (byte i = 0; i < mfrc522.uid.size; i++) {

ActualUID[i]=mfrc522.uid.uidByte[i];
}

//Compare the read ID and the stored USERS

if(user_added==4)
{
lcd.setCursor(0,0);
lcd.print(" User list is ");
lcd.setCursor(0,1);
lcd.print(" FULL ");
digitalWrite(buzzer_pin,HIGH); //use analogWrite(buzzer_pin,200); for non active
buzzer
delay(3000);
digitalWrite(buzzer_pin,LOW); //use analog write for non active buzzer
lcd.setCursor(0,0);
lcd.print("Place card here!");
lcd.setCursor(0,1);
lcd.print(" ");
}

if(user_added==3)
{
USER5[0] = ActualUID[0];
USER5[1] = ActualUID[1];
USER5[2] = ActualUID[2];
 USER5[3] = ActualUID[3];
user_added = user_added+1;
lcd.setCursor(0,0);
lcd.print("New user stored ");
lcd.setCursor(0,1);
lcd.print(" as USER 5 ");
digitalWrite(buzzer_pin,HIGH); //use analogWrite(buzzer_pin,200); for non active
buzzer
delay(300);
digitalWrite(buzzer_pin,LOW); //use analog write for non active buzzer
delay(1000);
normal_mode=true;
first_read=false;
delay(3000);
lcd.setCursor(0,0);
lcd.print("Place card here!");
lcd.setCursor(0,1);
lcd.print(" ");
}

if(user_added==2)
{
USER4[0] = ActualUID[0];
USER4[1] = ActualUID[1];
USER4[2] = ActualUID[2];
USER4[3] = ActualUID[3];
user_added = user_added+1;
lcd.setCursor(0,0);
lcd.print("New user stored ");
lcd.setCursor(0,1);
lcd.print(" as USER 4 ");
digitalWrite(buzzer_pin,HIGH); //use analogWrite(buzzer_pin,200); for non active
buzzer
delay(300);
digitalWrite(buzzer_pin,LOW); //use analog write for non active buzzer
delay(1000);
normal_mode=true;
first_read=false;
delay(3000);
lcd.setCursor(0,0);
lcd.print("Place card here!");
lcd.setCursor(0,1);
lcd.print(" ");
}

if(user_added==1)
{
USER3[0] = ActualUID[0];
USER3[1] = ActualUID[1];
USER3[2] = ActualUID[2];
USER3[3] = ActualUID[3];
 user_added = user_added+1;
lcd.setCursor(0,0);
lcd.print("New user stored ");
lcd.setCursor(0,1);
lcd.print(" as USER 3 ");
digitalWrite(buzzer_pin,HIGH); //use analogWrite(buzzer_pin,200); for non active
buzzer
delay(300);
digitalWrite(buzzer_pin,LOW); //use analog write for non active buzzer
delay(1000);
normal_mode=true;
first_read=false;
delay(3000);
lcd.setCursor(0,0);
lcd.print("Place card here!");
lcd.setCursor(0,1);
lcd.print(" ");
}

if(user_added==0)
{
USER2[0] = ActualUID[0];
USER2[1] = ActualUID[1];
USER2[2] = ActualUID[2];
USER2[3] = ActualUID[3];
user_added = user_added+1;
lcd.setCursor(0,0);
lcd.print("New user stored ");
lcd.setCursor(0,1);
lcd.print(" as USER 2 ");
digitalWrite(buzzer_pin,HIGH); //use analogWrite(buzzer_pin,200); for non active
buzzer
delay(300);
digitalWrite(buzzer_pin,LOW); //use analog write for non active buzzer
delay(1000);
normal_mode=true;
first_read=false;
delay(3000);
lcd.setCursor(0,0);
lcd.print("Place card here!");
lcd.setCursor(0,1);
lcd.print(" ");
}

}
}//end ID add mode

}
//Compare the 4 bytes of the users and the received ID
boolean compareArray(byte array1[],byte array2[])
{
if(array1[0] != array2[0])return(false);
if(array1[1] != array2[1])return(false);
if(array1[2] != array2[2])return(false);
if(array1[3] != array2[3])return(false);
return(true);
}