Skip to content

Commit

Permalink
refactor: mifare classic write block
Browse files Browse the repository at this point in the history
  • Loading branch information
@DeimosHall
DeimosHall committed Aug 31, 2023
1 parent ea5b4ca commit 2a1a873
Showing 1 changed file with 137 additions and 140 deletions.
277 changes: 137 additions & 140 deletions examples/MifareClassic_write_block/MifareClassic_write_block.ino
View file
Original file line number Diff line number Diff line change
@@ -1,184 +1,181 @@
/**
* Example to write a Mifare Classic block 4 and show its information
* Authors:
* Example to write a Mifare Classic block 4 and show its information
* Authors:
* Salvador Mendoza - @Netxing - salmg.net
* For Electronic Cats - electroniccats.com
*
*
* March 2020
*
* This code is beerware; if you see me (or any other collaborator
* member) at the local, and you've found our code helpful,
*
* This code is beerware; if you see me (or any other collaborator
* member) at the local, and you've found our code helpful,
* please buy us a round!
* Distributed as-is; no warranty is given.
*/

#include "Electroniccats_PN7150.h"
#define PN7150_IRQ (15)
#define PN7150_VEN (14)
#define PN7150_ADDR (0x28)

#define BLK_NB_MFC 4 // Block that wants to be read
#define KEY_MFC 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF // Default Mifare Classic key
#include "Electroniccats_PN7150.h"
#define PN7150_IRQ (11)
#define PN7150_VEN (13)
#define PN7150_ADDR (0x28)

// Data to be written in the Mifare Classic block
#define DATA_WRITE_MFC 0x00, 0x11, 0x22, 0x33, 0x44, 0x55, 0x66, 0x77, 0x88, 0x99, 0xaa, 0xbb, 0xcc, 0xdd, 0xee, 0xff

Electroniccats_PN7150 nfc(PN7150_IRQ, PN7150_VEN, PN7150_ADDR); // creates a global NFC device interface object, attached to pins 7 (IRQ) and 8 (VEN) and using the default I2C address 0x28
RfIntf_t RfInterface; //Intarface to save data for multiple tags
#define BLK_NB_MFC 4 // Block that wants to be read
#define KEY_MFC 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF // Default Mifare Classic key

uint8_t mode = 1; // modes: 1 = Reader/ Writer, 2 = Emulation
// Data to be written in the Mifare Classic block
#define DATA_WRITE_MFC 0x00, 0x11, 0x22, 0x33, 0x44, 0x55, 0x66, 0x77, 0x88, 0x99, 0xaa, 0xbb, 0xcc, 0xdd, 0xee, 0xff

void ResetMode(){ //Reset the configuration mode after each reading
Serial.println("Re-initializing...");
nfc.ConfigMode(mode);
nfc.StartDiscovery(mode);
}
Electroniccats_PN7150 nfc(PN7150_IRQ, PN7150_VEN, PN7150_ADDR); // creates a global NFC device interface object, attached to pins 7 (IRQ) and 8 (VEN) and using the default I2C address 0x28

void PrintBuf(const byte * data, const uint32_t numBytes){ //Print hex data buffer in format
void PrintBuf(const byte* data, const uint32_t numBytes) { // Print hex data buffer in format
uint32_t szPos;
for (szPos=0; szPos < numBytes; szPos++)
{
for (szPos = 0; szPos < numBytes; szPos++) {
Serial.print(F("0x"));
// Append leading 0 for small values
if (data[szPos] <= 0xF)
Serial.print(F("0"));
Serial.print(data[szPos]&0xff, HEX);
if ((numBytes > 1) && (szPos != numBytes - 1))
{
Serial.print(data[szPos] & 0xff, HEX);
if ((numBytes > 1) && (szPos != numBytes - 1)) {
Serial.print(F(" "));
}
}
Serial.println();
}

uint8_t PCD_MIFARE_scenario (void){
Serial.println("Start reading process...");
bool status;
unsigned char Resp[256];
unsigned char RespSize;
/* Authenticate sector 1 with generic keys */
unsigned char Auth[] = {0x40, BLK_NB_MFC/4, 0x10, KEY_MFC};
/* Read block 4 */
unsigned char Read[] = {0x10, 0x30, BLK_NB_MFC};
/* Write block 4 */
unsigned char WritePart1[] = {0x10, 0xA0, BLK_NB_MFC};
unsigned char WritePart2[] = {0x10, DATA_WRITE_MFC};

/* Authenticate */
status = nfc.readerTagCmd(Auth, sizeof(Auth), Resp, &RespSize);
if((status == NFC_ERROR) || (Resp[RespSize-1] != 0)){
Serial.println("Auth error!");
return 1;
}

/* Read block */
status = nfc.readerTagCmd(Read, sizeof(Read), Resp, &RespSize);
if((status == NFC_ERROR) || (Resp[RespSize-1] != 0)){
Serial.print("Error reading block!");
return 2;
}
Serial.print("------------------------Sector ");
Serial.print(BLK_NB_MFC/4, DEC);
Serial.println("-------------------------");
Serial.print("-------------------------Block ");
Serial.print(BLK_NB_MFC, DEC);
Serial.println("-------------------------");
PrintBuf(Resp+1, RespSize-2);

/* Write block */
status = nfc.readerTagCmd(WritePart1, sizeof(WritePart1), Resp, &RespSize);
if((status == NFC_ERROR) || (Resp[RespSize-1] != 0)){
Serial.print("Error writing block!");
return 3;
}
status = nfc.readerTagCmd(WritePart2, sizeof(WritePart2), Resp, &RespSize);
if((status == NFC_ERROR) || (Resp[RespSize-1] != 0)){
Serial.print("Error writing block!");
return 4;
}
/* Read block again to see te changes*/
status = nfc.readerTagCmd(Read, sizeof(Read), Resp, &RespSize);
if((status == NFC_ERROR) || (Resp[RespSize-1] != 0))
{
Serial.print("Error reading block!");
return 5;
}
Serial.print("------------------------Sector ");
Serial.print(BLK_NB_MFC/4, DEC);
Serial.println("-------------------------");
Serial.print("----------------- New Data in Block ");
Serial.print(BLK_NB_MFC, DEC);
Serial.println("-----------------");
PrintBuf(Resp+1, RespSize-2);
return 0;
uint8_t PCD_MIFARE_scenario(void) {
Serial.println("Start reading process...");
bool status;
unsigned char Resp[256];
unsigned char RespSize;
/* Authenticate sector 1 with generic keys */
unsigned char Auth[] = {0x40, BLK_NB_MFC / 4, 0x10, KEY_MFC};
/* Read block 4 */
unsigned char Read[] = {0x10, 0x30, BLK_NB_MFC};
/* Write block 4 */
unsigned char WritePart1[] = {0x10, 0xA0, BLK_NB_MFC};
unsigned char WritePart2[] = {0x10, DATA_WRITE_MFC};

/* Authenticate */
status = nfc.readerTagCmd(Auth, sizeof(Auth), Resp, &RespSize);
if ((status == NFC_ERROR) || (Resp[RespSize - 1] != 0)) {
Serial.println("Auth error!");
return 1;
}

/* Read block */
status = nfc.readerTagCmd(Read, sizeof(Read), Resp, &RespSize);
if ((status == NFC_ERROR) || (Resp[RespSize - 1] != 0)) {
Serial.print("Error reading block!");
return 2;
}
Serial.print("------------------------Sector ");
Serial.print(BLK_NB_MFC / 4, DEC);
Serial.println("-------------------------");
Serial.print("-------------------------Block ");
Serial.print(BLK_NB_MFC, DEC);
Serial.println("-------------------------");
PrintBuf(Resp + 1, RespSize - 2);

/* Write block */
status = nfc.readerTagCmd(WritePart1, sizeof(WritePart1), Resp, &RespSize);
if ((status == NFC_ERROR) || (Resp[RespSize - 1] != 0)) {
Serial.print("Error writing block!");
return 3;
}
status = nfc.readerTagCmd(WritePart2, sizeof(WritePart2), Resp, &RespSize);
if ((status == NFC_ERROR) || (Resp[RespSize - 1] != 0)) {
Serial.print("Error writing block!");
return 4;
}
/* Read block again to see te changes*/
status = nfc.readerTagCmd(Read, sizeof(Read), Resp, &RespSize);
if ((status == NFC_ERROR) || (Resp[RespSize - 1] != 0)) {
Serial.print("Error reading block!");
return 5;
}
Serial.print("------------------------Sector ");
Serial.print(BLK_NB_MFC / 4, DEC);
Serial.println("-------------------------");
Serial.print("----------------- New Data in Block ");
Serial.print(BLK_NB_MFC, DEC);
Serial.println("-----------------");
PrintBuf(Resp + 1, RespSize - 2);
return 0;
}

void setup(){
void setup() {
Serial.begin(9600);
while(!Serial);
Serial.println("Write mifare classic data block 4 with PN7150");

if (nfc.connectNCI()) { //Wake up the board
while (!Serial)
;
Serial.println("Read mifare classic data block 4 with PN7150");

Serial.println("Initializing...");
if (nfc.connectNCI()) { // Wake up the board
Serial.println("Error while setting up the mode, check connections!");
while (1);
while (1)
;
}

if (nfc.configureSettings()) {
Serial.println("The Configure Settings is failed!");
while (1);
while (1)
;
}
if(nfc.ConfigMode(mode)){ //Set up the configuration mode

if (nfc.configMode()) { // Set up the configuration mode
Serial.println("The Configure Mode is failed!!");
while (1);
while (1)
;
}
nfc.StartDiscovery(mode); //NCI Discovery mode
Serial.println("Waiting for an Mifare Classic Card ...");
nfc.startDiscovery(); // NCI Discovery mode
Serial.println("Waiting for an Mifare Classic Card...");
}

void loop(){
if(!nfc.WaitForDiscoveryNotification(&RfInterface)){ // Waiting to detect cards
switch(RfInterface.Protocol) {
case PROT_MIFARE:
void loop() {
if (nfc.isTagDetected()) {
switch (nfc.remoteDevice.getProtocol()) {
case nfc.protocol.MIFARE:
Serial.println(" - Found MIFARE card");
switch(RfInterface.ModeTech) { //Indetify card technology
case (MODE_POLL | TECH_PASSIVE_NFCA):
char tmp[16];
Serial.print("\tSENS_RES = ");
sprintf(tmp, "0x%.2X",RfInterface.Info.NFC_APP.SensRes[0]);
Serial.print(tmp); Serial.print(" ");
sprintf(tmp, "0x%.2X",RfInterface.Info.NFC_APP.SensRes[1]);
Serial.print(tmp); Serial.println(" ");

Serial.print("\tNFCID = ");
PrintBuf(RfInterface.Info.NFC_APP.NfcId, RfInterface.Info.NFC_APP.NfcIdLen);

if(RfInterface.Info.NFC_APP.SelResLen != 0) {
Serial.print("\tSEL_RES = ");
sprintf(tmp, "0x%.2X",RfInterface.Info.NFC_APP.SelRes[0]);
Serial.print(tmp); Serial.println(" ");
}
switch (nfc.remoteDevice.getModeTech()) { // Indetify card technology
case (nfc.tech.PASSIVE_NFCA):
char tmp[16];
Serial.print("\tSENS_RES = ");
sprintf(tmp, "0x%.2X", nfc.remoteDevice.getSensRes()[0]);
Serial.print(tmp);
Serial.print(" ");
sprintf(tmp, "0x%.2X", nfc.remoteDevice.getSensRes()[1]);
Serial.print(tmp);
Serial.println(" ");

Serial.print("\tNFCID = ");
PrintBuf(nfc.remoteDevice.getNFCID(), nfc.remoteDevice.getNFCIDLen());

if (nfc.remoteDevice.getSelResLen() != 0) {
Serial.print("\tSEL_RES = ");
sprintf(tmp, "0x%.2X", nfc.remoteDevice.getSelRes()[0]);
Serial.print(tmp);
Serial.println(" ");
}
break;
}
PCD_MIFARE_scenario();
break;
}
PCD_MIFARE_scenario();
break;

default:
Serial.println(" - Found a card, but it is not Mifare");
break;
Serial.println(" - Found a card, but it is not Mifare");
break;
}
//* It can detect multiple cards at the same time if they use the same protocol
if(RfInterface.MoreTags) {
nfc.activateNextTagDiscovery();

//* It can detect multiple cards at the same time if they use the same protocol
if (nfc.remoteDevice.hasMoreTags()) {
nfc.activateNextTagDiscovery();
}
//* Wait for card removal
nfc.processReaderMode(RfInterface, PRESENCE_CHECK);

Serial.println("Remove the Card");
nfc.waitForTagRemoval();
Serial.println("CARD REMOVED!");

nfc.stopDiscovery();
nfc.StartDiscovery(mode);
}
ResetMode();

Serial.println("Restarting...");
nfc.reset();
Serial.println("Waiting for an Mifare Classic Card...");
delay(500);
}

0 comments on commit 2a1a873

Please sign in to comment.