Diff: main.cpp

Revision:

0:4b5aa5fe3ff4

Child:

1:27fb38198323

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Thu Apr 06 09:34:26 2017 +0000
@@ -0,0 +1,358 @@
+//Test of cheap 13.56 Mhz RFID-RC522 module from eBay
+//This code is based on Martin Olejar's MFRC522 library. Minimal changes
+//Adapted for Nucleo STM32 F401RE. Should work on other Nucleos too
+
+//Connect as follows:
+//RFID pins        ->  Nucleo header CN5 (Arduino-compatible header)
+//----------------------------------------
+//RFID IRQ=pin5    ->   Not used. Leave open
+//RFID MISO=pin4   ->   Nucleo SPI_MISO=PA_6=D12
+//RFID MOSI=pin3   ->   Nucleo SPI_MOSI=PA_7=D11
+//RFID SCK=pin2    ->   Nucleo SPI_SCK =PA_5=D13
+//RFID SDA=pin1    ->   Nucleo SPI_CS  =PB_6=D10
+//RFID RST=pin7    ->   Nucleo         =PA_9=D8
+//3.3V and Gnd to the respective pins
+
+#include "mbed.h"
+#include "MFRC522.h"
+#include "SPI.h"
+#define VERSION "RFID_2017_03_20"
+#define CIBLE "WIZwiki-W7500"
+
+
+// ARMmbed WIZwiki W7500 Pin for MFRC522 SPI Communication
+#define SPI_MOSI    D11
+#define SPI_MISO    D12
+#define SPI_SCLK    D13
+#define SPI_CS      D10
+
+// Nucleo Pin for MFRC522 reset (pick another D pin if you need D8)
+#define MF_RESET    D9
+
+DigitalOut LedGreen(D7);
+DigitalOut LedRed(D6);
+DigitalOut LedYellow(D5);
+
+//Serial connection to PC for output
+Serial pc(USBTX, USBRX);
+
+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;
+
+    // Print Card UID
+    printf("Card UID: ");
+    for (uint8_t i = 0; i < RfChip.uid.size; i++) {
+        printf(" %X", RfChip.uid.uidByte[i]);
+    }
+    printf("\n\r");
+
+    // Print Card type
+    uint8_t piccType = RfChip.PICC_GetType(RfChip.uid.sak);
+    printf("PICC Type: %s \n\r", RfChip.PICC_GetTypeName(piccType));
+    wait_ms(1000);
+
+    // 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 (int8_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 (int8_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 9600 baud\n\r");
+    pc.baud(9600);
+    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);
+
+    }
+}
\ No newline at end of file