#include <Stepper.h>
#include <Arduino.h>
#include "HidProxWeigand.h"
 
#define RDR_INT0 1         // Reader interrupt for DATA 0.
#define RDR_INT1 0         // Reader interrupt for DATA 1.
 
#define PIN_DATA0 0        // The pin to use for DATA 0.
#define PIN_DATA1 1        // The pin to use for DATA 1.
 
 
/* 
 * Written by: Henry Borsuk
 * 
 * Code based off of example code from GitHub user "cyrusbuilt"
 * The following project is designed to be used with the Arduino MKR-1000.
 * 
 * PINS
 * FOLLOWING PINS ARE FOR ARDUINO-MKR1000
 * Item             Pin Number
 * Buzzer           5
 * RFID DATA0       0       
 * RFID DATA1       1
 * Servo            8,9,10,11
 * LED GREEN        4
 * Lock Button      3
 * Unlock Button    2
 * Locked Signal    6
 * Unlocked Signal  7
 *
 */
 
int approvedCards[3] = {81558,81722,55988}; // Array of approved cards
bool doorLocked = false; //Global status variable
bool spinMotorToLock = false; 
 
 
//Declaring pin variables
const int buzzer = 5;
const int greenLED = 4;
const int unlockButton = 2;
const int lockButton = 3;
const int lockedSignal = 7;
const int unlockedSignal = 6;
const int stepsPerRev = 200;
 
ProxReaderInfo* reader1;   // Card reader 1.
Stepper lockMotor(stepsPerRev, 8, 9, 10, 11);
 
// Function for handling card reads.
void cardReadHandler(ProxReaderInfo* reader) {
    Serial.print(F("Card read: "));
    Serial.print(reader->facilityCode);
    Serial.print(F(":"));
    Serial.println(reader->cardCode);
    int cardRead = reader->cardCode;
     
     
    if(reader->cardCode == 81722 || reader->cardCode == 81558 || reader->cardCode == 55988){
      Serial.println("VALID CARD");
      if(doorLocked == true){
        unlockDoor();
      }
      else if(doorLocked == false){
        lockDoor();
      }
    }
    else {
      Serial.println("INVALID CARD");
    }
}
 
// Handle interrupt for DATA 0.
void handleInterrupt0() {
    if (reader1 != NULL) {
        reader1->ISR_Data0();
    }
}
 
// Handle interrupt for DATA 1.
void handleInterrupt1() {
    if (reader1 != NULL) {
        reader1->ISR_Data1();
    }
}
//Function that unlocks the door
void unlockDoor(){
  lockMotor.setSpeed(180);
  lockMotor.step(-100);
  delay(500);
  digitalWrite(greenLED, LOW);
  digitalWrite(buzzer,LOW);
  delay(500);
  digitalWrite(buzzer,HIGH);
  Serial.println("Door Unlocked");
  //digitalWrite(greenLED, HIGH);
  doorLocked = false;
  digitalWrite(unlockedSignal, HIGH);
  digitalWrite(lockedSignal, LOW);
}
//Function that locks the door
void lockDoor(){
  lockMotor.setSpeed(180);
  lockMotor.step(100);
  delay(500);
  digitalWrite(greenLED, LOW);
  digitalWrite(buzzer,LOW);
  delay(200);
  digitalWrite(greenLED,HIGH);
  digitalWrite(buzzer,HIGH);
  delay(200);
  digitalWrite(greenLED, LOW);
  digitalWrite(buzzer,LOW);
  delay(200);
  digitalWrite(greenLED,HIGH);
  digitalWrite(buzzer,HIGH);
  Serial.println("Door Locked");
  doorLocked = true;
  digitalWrite(lockedSignal, HIGH);
  digitalWrite(unlockedSignal,LOW);
}
 
//Deprecated function
boolean checkValid(int card)
{
  for(int i = 0; i < 3; i++)
  {
    Serial.print("Card Read: "); Serial.println(card);
    Serial.print("Approved Card "); Serial.print(i); Serial.print(" "); Serial.println(approvedCards[i]); 
    if(card == approvedCards[i])
    {
      return true;
    }
    else
    {
      return false;
    }
  }
}
//Code that is run initially at startup
void setup() {
    Serial.begin(9600);
    //Setting up all GPIO pins
    pinMode(buzzer, OUTPUT);
    digitalWrite(buzzer,HIGH);
     
    pinMode(greenLED, OUTPUT);
    digitalWrite(greenLED, HIGH);
 
    pinMode(lockButton, INPUT);
    pinMode(unlockButton, INPUT);
    pinMode(lockedSignal, OUTPUT);
    pinMode(unlockedSignal, OUTPUT);
    digitalWrite(lockedSignal, LOW);
    digitalWrite(unlockedSignal,HIGH);
    lockMotor.setSpeed(180);
    //delay(500);
    lockMotor.step(100);
    while (!Serial) {
        delay(10);
    }
    // Create the reader and attach it to the system.
    reader1 = HidProxWeigand.addReader(PIN_DATA0, PIN_DATA1, cardReadHandler);
 
    // Attach interrupt handlers for reader.
    HidProxWeigand_AttachReaderInterrupts(RDR_INT0, RDR_INT1, handleInterrupt0, handleInterrupt1);
}
 
void loop() {
    // Process any cards that have been read.
    HidProxWeigand.loop();
    if(digitalRead(lockButton) == HIGH){ //Checks buttons to unlock or lock door from inside
      lockDoor();
    }
    if(digitalRead(unlockButton) == HIGH){
      unlockDoor();
    }
    if(spinMotorToLock){
      lockMotor.step(200);
      delay(500);
      spinMotorToLock = false;
    }
}