test FDRM-KL25Z + RFID-RC522
Fork of FRDM_MFRC522 by
main.cpp
- Committer:
- fblanc
- Date:
- 2015-02-12
- Revision:
- 2:00c97f5dfeaf
- Parent:
- 1:8e41a7b03f45
File content as of revision 2:00c97f5dfeaf:
/**
* @ version Forks dec 2014
* @date 27/12/2014
* @author F.BLANC
*/
#define VERSION "RFID_2014_12_27"
#include "mbed.h"
#include "MFRC522.h"
#if defined(TARGET_KL25Z)
/* KL25Z Pins for MFRC522 SPI interface */
#define CIBLE "KL25Z"
#define SPI_MOSI PTD2
#define SPI_MISO PTD3
#define SPI_SCLK PTD1
#define SPI_CS PTD0
/* KL25Z Pin for MFRC522 reset */
#define MF_RESET PTD5
/* KL25Z Pins for UART Debug port */
//#define UART_RX PTA1
//#define UART_TX PTA2
#define UART_RX USBRX
#define UART_TX USBTX
#elif defined(TARGET_LPC11U24)
#define CIBLE "LPC11U24"
/* LPC11U24 Pins for MFRC522 SPI interface */
#define SPI_MOSI P0_9
#define SPI_MISO P0_8
#define SPI_SCLK P1_29
#define SPI_CS P0_2
/* LPC11U24 Pin for MFRC522 reset */
#define MF_RESET P1_13
/* LPC11U24 Pins for UART Debug port */
#define UART_RX P0_18
#define UART_TX P0_19
/* LED Pins */
#define LED_RED P0_7
#define LED_GREEN P1_22
#endif
DigitalOut LedRed (LED_RED);
DigitalOut LedGreen (LED_GREEN);
Serial DebugUART(UART_TX, UART_RX);
MFRC522 RfChip (SPI_MOSI, SPI_MISO, SPI_SCLK, SPI_CS, MF_RESET);
/* Local functions */
void DumpMifareClassicToSerial (MFRC522::Uid *uid, uint8_t piccType, MFRC522::MIFARE_Key *key);
void DumpMifareClassicSectorToSerial(MFRC522::Uid *uid, MFRC522::MIFARE_Key *key, uint8_t sector);
void DumpMifareUltralightToSerial (void);
/**
* Dumps debug info about the selected PICC to Serial.
* On success the PICC is halted after dumping the data.
* For MIFARE Classic the factory default key of 0xFFFFFFFFFFFF is tried.
*/
void DumpToSerial(MFRC522::Uid *uid)
{
MFRC522::MIFARE_Key key;
// UID
printf("Card UID: ");
for (uint8_t i = 0; i < uid->size; i++) {
printf(" %X02", uid->uidByte[i]);
}
printf("\n\r");
// PICC type
uint8_t piccType = RfChip.PICC_GetType(uid->sak);
printf("PICC Type: %s \n\r", RfChip.PICC_GetTypeName(piccType));
// Dump contents
switch (piccType) {
case MFRC522::PICC_TYPE_MIFARE_MINI:
case MFRC522::PICC_TYPE_MIFARE_1K:
case MFRC522::PICC_TYPE_MIFARE_4K:
// All keys are set to FFFFFFFFFFFFh at chip delivery from the factory.
for (uint8_t i = 0; i < 6; i++) {
key.keyByte[i] = 0xFF;
}
DumpMifareClassicToSerial(uid, piccType, &key);
break;
case MFRC522::PICC_TYPE_MIFARE_UL:
DumpMifareUltralightToSerial();
break;
case MFRC522::PICC_TYPE_TNP3XXX:
printf("Dumping memory contents not implemented for that PICC type. \n\r");
break;
case MFRC522::PICC_TYPE_ISO_14443_4:
case MFRC522::PICC_TYPE_ISO_18092:
case MFRC522::PICC_TYPE_MIFARE_PLUS:
printf("Dumping memory contents not implemented for that PICC type. \n\r");
break;
case MFRC522::PICC_TYPE_UNKNOWN:
case MFRC522::PICC_TYPE_NOT_COMPLETE:
default:
break; // No memory dump here
}
printf("\n\r");
RfChip.PICC_HaltA(); // Already done if it was a MIFARE Classic PICC.
} // End PICC_DumpToSerial()
/**
* Dumps memory contents of a MIFARE Classic PICC.
* On success the PICC is halted after dumping the data.
*/
void DumpMifareClassicToSerial(MFRC522::Uid *uid, uint8_t piccType, MFRC522::MIFARE_Key *key)
{
uint8_t no_of_sectors = 0;
switch (piccType) {
case MFRC522::PICC_TYPE_MIFARE_MINI:
// Has 5 sectors * 4 blocks/sector * 16 bytes/block = 320 bytes.
no_of_sectors = 5;
break;
case MFRC522::PICC_TYPE_MIFARE_1K:
// Has 16 sectors * 4 blocks/sector * 16 bytes/block = 1024 bytes.
no_of_sectors = 16;
break;
case MFRC522::PICC_TYPE_MIFARE_4K:
// Has (32 sectors * 4 blocks/sector + 8 sectors * 16 blocks/sector) * 16 bytes/block = 4096 bytes.
no_of_sectors = 40;
break;
default:
// Should not happen. Ignore.
break;
}
// Dump sectors, highest address first.
if (no_of_sectors) {
printf("Sector Block 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 AccessBits \n\r");
printf("----------------------------------------------------------------------------------------- \n\r");
for (uint8_t i = no_of_sectors - 1; i > 0; i--) {
DumpMifareClassicSectorToSerial(uid, key, i);
}
}
RfChip.PICC_HaltA(); // Halt the PICC before stopping the encrypted session.
RfChip.PCD_StopCrypto1();
} // End PICC_DumpMifareClassicToSerial()
/**
* Dumps memory contents of a sector of a MIFARE Classic PICC.
* Uses PCD_Authenticate(), MIFARE_Read() and PCD_StopCrypto1.
* Always uses PICC_CMD_MF_AUTH_KEY_A because only Key A can always read the sector trailer access bits.
*/
void DumpMifareClassicSectorToSerial(MFRC522::Uid *uid, MFRC522::MIFARE_Key *key, uint8_t sector)
{
uint8_t status;
uint8_t firstBlock; // Address of lowest address to dump actually last block dumped)
uint8_t no_of_blocks; // Number of blocks in sector
bool isSectorTrailer; // Set to true while handling the "last" (ie highest address) in the sector.
// The access bits are stored in a peculiar fashion.
// There are four groups:
// g[3] Access bits for the sector trailer, block 3 (for sectors 0-31) or block 15 (for sectors 32-39)
// g[2] Access bits for block 2 (for sectors 0-31) or blocks 10-14 (for sectors 32-39)
// g[1] Access bits for block 1 (for sectors 0-31) or blocks 5-9 (for sectors 32-39)
// g[0] Access bits for block 0 (for sectors 0-31) or blocks 0-4 (for sectors 32-39)
// Each group has access bits [C1 C2 C3]. In this code C1 is MSB and C3 is LSB.
// The four CX bits are stored together in a nible cx and an inverted nible cx_.
uint8_t c1, c2, c3; // Nibbles
uint8_t c1_, c2_, c3_; // Inverted nibbles
bool invertedError = false; // True if one of the inverted nibbles did not match
uint8_t g[4]; // Access bits for each of the four groups.
uint8_t group; // 0-3 - active group for access bits
bool firstInGroup; // True for the first block dumped in the group
// Determine position and size of sector.
if (sector < 32) {
// Sectors 0..31 has 4 blocks each
no_of_blocks = 4;
firstBlock = sector * no_of_blocks;
} else if (sector < 40) {
// Sectors 32-39 has 16 blocks each
no_of_blocks = 16;
firstBlock = 128 + (sector - 32) * no_of_blocks;
} else {
// Illegal input, no MIFARE Classic PICC has more than 40 sectors.
return;
}
// Dump blocks, highest address first.
uint8_t byteCount;
uint8_t buffer[18];
uint8_t blockAddr;
isSectorTrailer = true;
for (uint8_t blockOffset = no_of_blocks - 1; blockOffset > 0; blockOffset--) {
blockAddr = firstBlock + blockOffset;
// Sector number - only on first line
if (isSectorTrailer) {
printf(" %2d ", sector);
} else {
printf(" ");
}
// Block number
printf(" %3d ", blockAddr);
// Establish encrypted communications before reading the first block
if (isSectorTrailer) {
status = RfChip.PCD_Authenticate(MFRC522::PICC_CMD_MF_AUTH_KEY_A, firstBlock, key, uid);
if (status != MFRC522::STATUS_OK) {
printf("PCD_Authenticate() failed: %s \r\n", RfChip.GetStatusCodeName(status));
return;
}
}
// Read block
byteCount = sizeof(buffer);
status = RfChip.MIFARE_Read(blockAddr, buffer, &byteCount);
if (status != MFRC522::STATUS_OK) {
printf("MIFARE_Read() failed: %s \r\n", RfChip.GetStatusCodeName(status));
continue;
}
// Dump data
for (uint8_t index = 0; index < 16; index++) {
printf(" %3d", buffer[index]);
// if ((index % 4) == 3)
// {
// printf(" ");
// }
}
// Parse sector trailer data
if (isSectorTrailer) {
c1 = buffer[7] >> 4;
c2 = buffer[8] & 0xF;
c3 = buffer[8] >> 4;
c1_ = buffer[6] & 0xF;
c2_ = buffer[6] >> 4;
c3_ = buffer[7] & 0xF;
invertedError = (c1 != (~c1_ & 0xF)) || (c2 != (~c2_ & 0xF)) || (c3 != (~c3_ & 0xF));
g[0] = ((c1 & 1) << 2) | ((c2 & 1) << 1) | ((c3 & 1) << 0);
g[1] = ((c1 & 2) << 1) | ((c2 & 2) << 0) | ((c3 & 2) >> 1);
g[2] = ((c1 & 4) << 0) | ((c2 & 4) >> 1) | ((c3 & 4) >> 2);
g[3] = ((c1 & 8) >> 1) | ((c2 & 8) >> 2) | ((c3 & 8) >> 3);
isSectorTrailer = false;
}
// Which access group is this block in?
if (no_of_blocks == 4) {
group = blockOffset;
firstInGroup = true;
} else {
group = blockOffset / 5;
firstInGroup = (group == 3) || (group != (blockOffset + 1) / 5);
}
if (firstInGroup) {
// Print access bits
printf(" [ %d %d %d ] ", (g[group] >> 2) & 1, (g[group] >> 1) & 1, (g[group] >> 0) & 1);
if (invertedError) {
printf(" Inverted access bits did not match! ");
}
}
if (group != 3 && (g[group] == 1 || g[group] == 6)) {
// Not a sector trailer, a value block
printf(" Addr = 0x%02X, Value = 0x%02X%02X%02X%02X", buffer[12],
buffer[3],
buffer[2],
buffer[1],
buffer[0]);
}
printf("\n\r");
}
return;
} // End PICC_DumpMifareClassicSectorToSerial()
/**
* Dumps memory contents of a MIFARE Ultralight PICC.
*/
void DumpMifareUltralightToSerial(void)
{
uint8_t status;
uint8_t byteCount;
uint8_t buffer[18];
uint8_t i;
printf("Page 0 1 2 3");
// Try the mpages of the original Ultralight. Ultralight C has more pages.
for (uint8_t page = 0; page < 16; page +=4) {
// Read pages
byteCount = sizeof(buffer);
status = RfChip.MIFARE_Read(page, buffer, &byteCount);
if (status != MFRC522::STATUS_OK) {
printf("MIFARE_Read() failed: %s \n\r", RfChip.GetStatusCodeName(status));
break;
}
// Dump data
for (uint8_t offset = 0; offset < 4; offset++) {
i = page + offset;
printf(" %2d ", i); // Pad with spaces
for (uint8_t index = 0; index < 4; index++) {
i = 4 * offset + index;
printf(" %02X ", buffer[i]);
}
printf("\n\r");
}
}
} // End PICC_DumpMifareUltralightToSerial()
int main()
{
/* Set debug UART speed */
printf("\n\rUART 115200 baud\n\r");
DebugUART.baud(115200);
printf("\n\r%s %s\n\r",VERSION,CIBLE);
/* Init. RC522 Chip */
RfChip.PCD_Init();
/* Read RC522 version */
uint8_t temp = RfChip.PCD_ReadRegister(MFRC522::VersionReg);
printf("MFRC522 version: %d\n\r", temp & 0x07);
printf("\n\r");
while(1) {
LedRed = 1;
LedGreen = 1;
// Look for new cards
if ( ! RfChip.PICC_IsNewCardPresent()) {
wait_ms(500);
continue;
}
LedRed = 0;
// Select one of the cards
if ( ! RfChip.PICC_ReadCardSerial()) {
wait_ms(500);
continue;
}
LedRed = 1;
LedGreen = 0;
// Dump debug info about the card. PICC_HaltA() is automatically called.
DumpToSerial(&(RfChip.uid));
wait_ms(200);
}
}
frederic blanc
