#include <SPI.h>
#include <MFRC522.h>

//RC522 1
#define RST_PIN 22 // RST-PIN for RC522 - RFID - SPI - Module GPIO-0
#define SS_PIN  21  // SDA-PIN for RC522 - RFID - SPI - Module GPIO-15

//RC522 2
#define RST_PIN_2 17 // RST-PIN for RC522 - RFID - SPI - Module GPIO-0
#define SS_PIN_2  16  // SDA-PIN for RC522 - RFID - SPI - Module GPIO-16

int tag[4];

MFRC522 rfid_1(SS_PIN, RST_PIN);   // Create MFRC522 instance
MFRC522 rfid_2(SS_PIN_2, RST_PIN_2);   // Create MFRC522 instance


void dump_byte_array(byte *buffer, byte bufferSize) {
  for (byte i = 0; i < bufferSize; i++) {
    Serial.print(buffer[i] < 0x10 ? "" : ".");
    Serial.print(buffer[i], DEC);
    tag[i] = buffer[i];
  }
}

void read_first_rfid()
{
  if ( ! rfid_1.PICC_ReadCardSerial()) {
    delay(50);
    return;
  }
  Serial.println("First RFID Tag Detected...");
  Serial.print(F("Card UID:"));
  dump_byte_array(rfid_1.uid.uidByte, rfid_1.uid.size);
  Serial.println();

  delay(3000);
}

void read_second_rfid()
{
  if ( ! rfid_2.PICC_ReadCardSerial()) {
    delay(50);
    return;
  }
  Serial.println("Second RFID Tag Detected...");
  Serial.print(F("Card UID:"));
  dump_byte_array(rfid_2.uid.uidByte, rfid_2.uid.size);
  Serial.println();

  delay(3000);
}

void detect_first_rfid()
{
  if ( ! rfid_1.PICC_IsNewCardPresent())
  {
    return;
  }
  read_first_rfid();
}

void detect_second_rfid()
{
  if ( ! rfid_2.PICC_IsNewCardPresent())
  {
    return;
  }
  read_second_rfid();
}



void setup()
{
  // Initialize serial communications
  Serial.begin(9600);
  delay(10);
  SPI.begin();           // Init SPI bus
  rfid_1.PCD_Init();    // Init MFRC522
  rfid_2.PCD_Init();    // Init MFRC522
}

void loop()
{
  detect_first_rfid();
  detect_second_rfid();
}