frederic blanc
test FDRM-KL25Z + RFID-RC522
Fork of
FRDM_MFRC522
by 
Martin Olejar
Diff: main.cpp
- Revision:
- 2:00c97f5dfeaf
- Parent:
- 1:8e41a7b03f45
--- a/main.cpp Wed Dec 18 00:46:40 2013 +0000
+++ b/main.cpp Thu Feb 12 13:00:53 2015 +0000
@@ -1,23 +1,31 @@
+/**
+ * @ 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 SPI_MOSI PTC6
-#define SPI_MISO PTC7
-#define SPI_SCLK PTC5
-#define SPI_CS PTC4
+#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 PTC3
+#define MF_RESET PTD5
/* KL25Z Pins for UART Debug port */
-#define UART_RX PTA1
-#define UART_TX PTA2
-
+//#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
@@ -55,52 +63,53 @@
*/
void DumpToSerial(MFRC522::Uid *uid)
{
- MFRC522::MIFARE_Key key;
+ 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");
+ // 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));
+ // 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;
+ // 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_ISO_14443_4:
- case MFRC522::PICC_TYPE_ISO_18092:
- case MFRC522::PICC_TYPE_MIFARE_PLUS:
- case MFRC522::PICC_TYPE_TNP3XXX:
- printf("Dumping memory contents not implemented for that PICC type. \n\r");
- 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
- }
+ case MFRC522::PICC_TYPE_UNKNOWN:
+ case MFRC522::PICC_TYPE_NOT_COMPLETE:
+ default:
+ break; // No memory dump here
+ }
- printf("\n\r");
+ printf("\n\r");
- RfChip.PICC_HaltA(); // Already done if it was a MIFARE Classic PICC.
+ RfChip.PICC_HaltA(); // Already done if it was a MIFARE Classic PICC.
} // End PICC_DumpToSerial()
/**
@@ -109,42 +118,39 @@
*/
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;
+ 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_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;
+ 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;
- }
+ 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);
+ // 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();
+ RfChip.PICC_HaltA(); // Halt the PICC before stopping the encrypted session.
+ RfChip.PCD_StopCrypto1();
} // End PICC_DumpMifareClassicToSerial()
/**
@@ -154,147 +160,131 @@
*/
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
+ 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.
- // 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;
- }
+ // 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
- // 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(" ");
+ // 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;
}
- // Block number
- printf(" %3d ", blockAddr);
+ // 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;
- // 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;
- }
- }
+ // Sector number - only on first line
+ if (isSectorTrailer) {
+ printf(" %2d ", sector);
+ } else {
+ printf(" ");
+ }
+
+ // Block number
+ printf(" %3d ", blockAddr);
- // 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;
- }
+ // 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;
+ }
+ }
- // Dump data
- for (uint8_t index = 0; index < 16; index++)
- {
- printf(" %3d", buffer[index]);
+ // 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;
+ }
- // 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));
+ // 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);
+ }
- 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;
+ 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");
}
- // 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;
+ return;
} // End PICC_DumpMifareClassicSectorToSerial()
/**
@@ -302,81 +292,74 @@
*/
void DumpMifareUltralightToSerial(void)
{
- uint8_t status;
- uint8_t byteCount;
- uint8_t buffer[18];
- uint8_t i;
+ 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;
- }
+ 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]);
- }
+ // 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");
+ printf("\n\r");
+ }
}
- }
} // End PICC_DumpMifareUltralightToSerial()
int main()
{
- /* Set debug UART speed */
- DebugUART.baud(115200);
- printf("< mbed RFID demo >\n\r");
- printf("\n\r");
+ /* 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();
+ /* 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");
+ /* 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;
+ while(1) {
+ LedRed = 1;
+ LedGreen = 1;
- // Look for new cards
- if ( ! RfChip.PICC_IsNewCardPresent())
- {
- wait_ms(500);
- continue;
- }
+ // Look for new cards
+ if ( ! RfChip.PICC_IsNewCardPresent()) {
+ wait_ms(500);
+ continue;
+ }
- LedRed = 0;
+ LedRed = 0;
- // Select one of the cards
- if ( ! RfChip.PICC_ReadCardSerial())
- {
- wait_ms(500);
- continue;
- }
+ // Select one of the cards
+ if ( ! RfChip.PICC_ReadCardSerial()) {
+ wait_ms(500);
+ continue;
+ }
- LedRed = 1;
- LedGreen = 0;
+ LedRed = 1;
+ LedGreen = 0;
- // Dump debug info about the card. PICC_HaltA() is automatically called.
- DumpToSerial(&(RfChip.uid));
- wait_ms(200);
- }
+ // Dump debug info about the card. PICC_HaltA() is automatically called.
+ DumpToSerial(&(RfChip.uid));
+ wait_ms(200);
+ }
}