rtgvc
Dependencies: MFRC522_new mbed
Fork of Reading_RFID_MFRC522_WIZWiki_W7500 by
main.cpp@0:4b5aa5fe3ff4, 2017-04-06 (annotated)
- Committer:
- sheralikhan
- Date:
- Thu Apr 06 09:34:26 2017 +0000
- Revision:
- 0:4b5aa5fe3ff4
- Child:
- 1:27fb38198323
Done
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| sheralikhan | 0:4b5aa5fe3ff4 | 1 | //Test of cheap 13.56 Mhz RFID-RC522 module from eBay |
| sheralikhan | 0:4b5aa5fe3ff4 | 2 | //This code is based on Martin Olejar's MFRC522 library. Minimal changes |
| sheralikhan | 0:4b5aa5fe3ff4 | 3 | //Adapted for Nucleo STM32 F401RE. Should work on other Nucleos too |
| sheralikhan | 0:4b5aa5fe3ff4 | 4 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 5 | //Connect as follows: |
| sheralikhan | 0:4b5aa5fe3ff4 | 6 | //RFID pins -> Nucleo header CN5 (Arduino-compatible header) |
| sheralikhan | 0:4b5aa5fe3ff4 | 7 | //---------------------------------------- |
| sheralikhan | 0:4b5aa5fe3ff4 | 8 | //RFID IRQ=pin5 -> Not used. Leave open |
| sheralikhan | 0:4b5aa5fe3ff4 | 9 | //RFID MISO=pin4 -> Nucleo SPI_MISO=PA_6=D12 |
| sheralikhan | 0:4b5aa5fe3ff4 | 10 | //RFID MOSI=pin3 -> Nucleo SPI_MOSI=PA_7=D11 |
| sheralikhan | 0:4b5aa5fe3ff4 | 11 | //RFID SCK=pin2 -> Nucleo SPI_SCK =PA_5=D13 |
| sheralikhan | 0:4b5aa5fe3ff4 | 12 | //RFID SDA=pin1 -> Nucleo SPI_CS =PB_6=D10 |
| sheralikhan | 0:4b5aa5fe3ff4 | 13 | //RFID RST=pin7 -> Nucleo =PA_9=D8 |
| sheralikhan | 0:4b5aa5fe3ff4 | 14 | //3.3V and Gnd to the respective pins |
| sheralikhan | 0:4b5aa5fe3ff4 | 15 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 16 | #include "mbed.h" |
| sheralikhan | 0:4b5aa5fe3ff4 | 17 | #include "MFRC522.h" |
| sheralikhan | 0:4b5aa5fe3ff4 | 18 | #include "SPI.h" |
| sheralikhan | 0:4b5aa5fe3ff4 | 19 | #define VERSION "RFID_2017_03_20" |
| sheralikhan | 0:4b5aa5fe3ff4 | 20 | #define CIBLE "WIZwiki-W7500" |
| sheralikhan | 0:4b5aa5fe3ff4 | 21 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 22 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 23 | // ARMmbed WIZwiki W7500 Pin for MFRC522 SPI Communication |
| sheralikhan | 0:4b5aa5fe3ff4 | 24 | #define SPI_MOSI D11 |
| sheralikhan | 0:4b5aa5fe3ff4 | 25 | #define SPI_MISO D12 |
| sheralikhan | 0:4b5aa5fe3ff4 | 26 | #define SPI_SCLK D13 |
| sheralikhan | 0:4b5aa5fe3ff4 | 27 | #define SPI_CS D10 |
| sheralikhan | 0:4b5aa5fe3ff4 | 28 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 29 | // Nucleo Pin for MFRC522 reset (pick another D pin if you need D8) |
| sheralikhan | 0:4b5aa5fe3ff4 | 30 | #define MF_RESET D9 |
| sheralikhan | 0:4b5aa5fe3ff4 | 31 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 32 | DigitalOut LedGreen(D7); |
| sheralikhan | 0:4b5aa5fe3ff4 | 33 | DigitalOut LedRed(D6); |
| sheralikhan | 0:4b5aa5fe3ff4 | 34 | DigitalOut LedYellow(D5); |
| sheralikhan | 0:4b5aa5fe3ff4 | 35 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 36 | //Serial connection to PC for output |
| sheralikhan | 0:4b5aa5fe3ff4 | 37 | Serial pc(USBTX, USBRX); |
| sheralikhan | 0:4b5aa5fe3ff4 | 38 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 39 | MFRC522 RfChip (SPI_MOSI, SPI_MISO, SPI_SCLK, SPI_CS, MF_RESET); |
| sheralikhan | 0:4b5aa5fe3ff4 | 40 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 41 | //* Local functions */ |
| sheralikhan | 0:4b5aa5fe3ff4 | 42 | void DumpMifareClassicToSerial (MFRC522::Uid *uid, uint8_t piccType, MFRC522::MIFARE_Key *key); |
| sheralikhan | 0:4b5aa5fe3ff4 | 43 | void DumpMifareClassicSectorToSerial(MFRC522::Uid *uid, MFRC522::MIFARE_Key *key, uint8_t sector); |
| sheralikhan | 0:4b5aa5fe3ff4 | 44 | void DumpMifareUltralightToSerial (void); |
| sheralikhan | 0:4b5aa5fe3ff4 | 45 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 46 | /** |
| sheralikhan | 0:4b5aa5fe3ff4 | 47 | * Dumps debug info about the selected PICC to Serial. |
| sheralikhan | 0:4b5aa5fe3ff4 | 48 | * On success the PICC is halted after dumping the data. |
| sheralikhan | 0:4b5aa5fe3ff4 | 49 | * For MIFARE Classic the factory default key of 0xFFFFFFFFFFFF is tried. |
| sheralikhan | 0:4b5aa5fe3ff4 | 50 | */ |
| sheralikhan | 0:4b5aa5fe3ff4 | 51 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 52 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 53 | void DumpToSerial(MFRC522::Uid *uid) |
| sheralikhan | 0:4b5aa5fe3ff4 | 54 | { |
| sheralikhan | 0:4b5aa5fe3ff4 | 55 | MFRC522::MIFARE_Key key; |
| sheralikhan | 0:4b5aa5fe3ff4 | 56 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 57 | // Print Card UID |
| sheralikhan | 0:4b5aa5fe3ff4 | 58 | printf("Card UID: "); |
| sheralikhan | 0:4b5aa5fe3ff4 | 59 | for (uint8_t i = 0; i < RfChip.uid.size; i++) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 60 | printf(" %X", RfChip.uid.uidByte[i]); |
| sheralikhan | 0:4b5aa5fe3ff4 | 61 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 62 | printf("\n\r"); |
| sheralikhan | 0:4b5aa5fe3ff4 | 63 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 64 | // Print Card type |
| sheralikhan | 0:4b5aa5fe3ff4 | 65 | uint8_t piccType = RfChip.PICC_GetType(RfChip.uid.sak); |
| sheralikhan | 0:4b5aa5fe3ff4 | 66 | printf("PICC Type: %s \n\r", RfChip.PICC_GetTypeName(piccType)); |
| sheralikhan | 0:4b5aa5fe3ff4 | 67 | wait_ms(1000); |
| sheralikhan | 0:4b5aa5fe3ff4 | 68 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 69 | // Dump contents |
| sheralikhan | 0:4b5aa5fe3ff4 | 70 | switch (piccType) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 71 | case MFRC522::PICC_TYPE_MIFARE_MINI: |
| sheralikhan | 0:4b5aa5fe3ff4 | 72 | case MFRC522::PICC_TYPE_MIFARE_1K: |
| sheralikhan | 0:4b5aa5fe3ff4 | 73 | case MFRC522::PICC_TYPE_MIFARE_4K: |
| sheralikhan | 0:4b5aa5fe3ff4 | 74 | // All keys are set to FFFFFFFFFFFFh at chip delivery from the factory. |
| sheralikhan | 0:4b5aa5fe3ff4 | 75 | for (uint8_t i = 0; i < 6; i++) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 76 | key.keyByte[i] = 0xFF; |
| sheralikhan | 0:4b5aa5fe3ff4 | 77 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 78 | DumpMifareClassicToSerial(uid, piccType, &key); |
| sheralikhan | 0:4b5aa5fe3ff4 | 79 | break; |
| sheralikhan | 0:4b5aa5fe3ff4 | 80 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 81 | case MFRC522::PICC_TYPE_MIFARE_UL: |
| sheralikhan | 0:4b5aa5fe3ff4 | 82 | DumpMifareUltralightToSerial(); |
| sheralikhan | 0:4b5aa5fe3ff4 | 83 | break; |
| sheralikhan | 0:4b5aa5fe3ff4 | 84 | case MFRC522::PICC_TYPE_TNP3XXX: |
| sheralikhan | 0:4b5aa5fe3ff4 | 85 | printf("Dumping memory contents not implemented for that PICC type. \n\r"); |
| sheralikhan | 0:4b5aa5fe3ff4 | 86 | break; |
| sheralikhan | 0:4b5aa5fe3ff4 | 87 | case MFRC522::PICC_TYPE_ISO_14443_4: |
| sheralikhan | 0:4b5aa5fe3ff4 | 88 | case MFRC522::PICC_TYPE_ISO_18092: |
| sheralikhan | 0:4b5aa5fe3ff4 | 89 | case MFRC522::PICC_TYPE_MIFARE_PLUS: |
| sheralikhan | 0:4b5aa5fe3ff4 | 90 | printf("Dumping memory contents not implemented for that PICC type. \n\r"); |
| sheralikhan | 0:4b5aa5fe3ff4 | 91 | break; |
| sheralikhan | 0:4b5aa5fe3ff4 | 92 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 93 | case MFRC522::PICC_TYPE_UNKNOWN: |
| sheralikhan | 0:4b5aa5fe3ff4 | 94 | case MFRC522::PICC_TYPE_NOT_COMPLETE: |
| sheralikhan | 0:4b5aa5fe3ff4 | 95 | default: |
| sheralikhan | 0:4b5aa5fe3ff4 | 96 | break; // No memory dump here |
| sheralikhan | 0:4b5aa5fe3ff4 | 97 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 98 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 99 | printf("\n\r"); |
| sheralikhan | 0:4b5aa5fe3ff4 | 100 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 101 | RfChip.PICC_HaltA(); // Already done if it was a MIFARE Classic PICC. |
| sheralikhan | 0:4b5aa5fe3ff4 | 102 | } // End PICC_DumpToSerial() |
| sheralikhan | 0:4b5aa5fe3ff4 | 103 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 104 | /** |
| sheralikhan | 0:4b5aa5fe3ff4 | 105 | * Dumps memory contents of a MIFARE Classic PICC. |
| sheralikhan | 0:4b5aa5fe3ff4 | 106 | * On success the PICC is halted after dumping the data. |
| sheralikhan | 0:4b5aa5fe3ff4 | 107 | */ |
| sheralikhan | 0:4b5aa5fe3ff4 | 108 | void DumpMifareClassicToSerial(MFRC522::Uid *uid, uint8_t piccType, MFRC522::MIFARE_Key *key) |
| sheralikhan | 0:4b5aa5fe3ff4 | 109 | { |
| sheralikhan | 0:4b5aa5fe3ff4 | 110 | uint8_t no_of_sectors = 0; |
| sheralikhan | 0:4b5aa5fe3ff4 | 111 | switch (piccType) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 112 | case MFRC522::PICC_TYPE_MIFARE_MINI: |
| sheralikhan | 0:4b5aa5fe3ff4 | 113 | // Has 5 sectors * 4 blocks/sector * 16 bytes/block = 320 bytes. |
| sheralikhan | 0:4b5aa5fe3ff4 | 114 | no_of_sectors = 5; |
| sheralikhan | 0:4b5aa5fe3ff4 | 115 | break; |
| sheralikhan | 0:4b5aa5fe3ff4 | 116 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 117 | case MFRC522::PICC_TYPE_MIFARE_1K: |
| sheralikhan | 0:4b5aa5fe3ff4 | 118 | // Has 16 sectors * 4 blocks/sector * 16 bytes/block = 1024 bytes. |
| sheralikhan | 0:4b5aa5fe3ff4 | 119 | no_of_sectors = 16; |
| sheralikhan | 0:4b5aa5fe3ff4 | 120 | break; |
| sheralikhan | 0:4b5aa5fe3ff4 | 121 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 122 | case MFRC522::PICC_TYPE_MIFARE_4K: |
| sheralikhan | 0:4b5aa5fe3ff4 | 123 | // Has (32 sectors * 4 blocks/sector + 8 sectors * 16 blocks/sector) * 16 bytes/block = 4096 bytes. |
| sheralikhan | 0:4b5aa5fe3ff4 | 124 | no_of_sectors = 40; |
| sheralikhan | 0:4b5aa5fe3ff4 | 125 | break; |
| sheralikhan | 0:4b5aa5fe3ff4 | 126 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 127 | default: |
| sheralikhan | 0:4b5aa5fe3ff4 | 128 | // Should not happen. Ignore. |
| sheralikhan | 0:4b5aa5fe3ff4 | 129 | break; |
| sheralikhan | 0:4b5aa5fe3ff4 | 130 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 131 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 132 | // Dump sectors, highest address first. |
| sheralikhan | 0:4b5aa5fe3ff4 | 133 | if (no_of_sectors) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 134 | printf("Sector Block 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 AccessBits \n\r"); |
| sheralikhan | 0:4b5aa5fe3ff4 | 135 | printf("----------------------------------------------------------------------------------------- \n\r"); |
| sheralikhan | 0:4b5aa5fe3ff4 | 136 | for (int8_t i = no_of_sectors-1 ; i>= 0; i--) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 137 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 138 | DumpMifareClassicSectorToSerial(uid, key, i); |
| sheralikhan | 0:4b5aa5fe3ff4 | 139 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 140 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 141 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 142 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 143 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 144 | RfChip.PICC_HaltA(); // Halt the PICC before stopping the encrypted session. |
| sheralikhan | 0:4b5aa5fe3ff4 | 145 | RfChip.PCD_StopCrypto1(); |
| sheralikhan | 0:4b5aa5fe3ff4 | 146 | } // End PICC_DumpMifareClassicToSerial() |
| sheralikhan | 0:4b5aa5fe3ff4 | 147 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 148 | /** |
| sheralikhan | 0:4b5aa5fe3ff4 | 149 | * Dumps memory contents of a sector of a MIFARE Classic PICC. |
| sheralikhan | 0:4b5aa5fe3ff4 | 150 | * Uses PCD_Authenticate(), MIFARE_Read() and PCD_StopCrypto1. |
| sheralikhan | 0:4b5aa5fe3ff4 | 151 | * Always uses PICC_CMD_MF_AUTH_KEY_A because only Key A can always read the sector trailer access bits. |
| sheralikhan | 0:4b5aa5fe3ff4 | 152 | */ |
| sheralikhan | 0:4b5aa5fe3ff4 | 153 | void DumpMifareClassicSectorToSerial(MFRC522::Uid *uid, MFRC522::MIFARE_Key *key, uint8_t sector) |
| sheralikhan | 0:4b5aa5fe3ff4 | 154 | { |
| sheralikhan | 0:4b5aa5fe3ff4 | 155 | uint8_t status; |
| sheralikhan | 0:4b5aa5fe3ff4 | 156 | uint8_t firstBlock; // Address of lowest address to dump actually last block dumped) |
| sheralikhan | 0:4b5aa5fe3ff4 | 157 | uint8_t no_of_blocks; // Number of blocks in sector |
| sheralikhan | 0:4b5aa5fe3ff4 | 158 | bool isSectorTrailer; // Set to true while handling the "last" (ie highest address) in the sector. |
| sheralikhan | 0:4b5aa5fe3ff4 | 159 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 160 | // The access bits are stored in a peculiar fashion. |
| sheralikhan | 0:4b5aa5fe3ff4 | 161 | // There are four groups: |
| sheralikhan | 0:4b5aa5fe3ff4 | 162 | // g[3] Access bits for the sector trailer, block 3 (for sectors 0-31) or block 15 (for sectors 32-39) |
| sheralikhan | 0:4b5aa5fe3ff4 | 163 | // g[2] Access bits for block 2 (for sectors 0-31) or blocks 10-14 (for sectors 32-39) |
| sheralikhan | 0:4b5aa5fe3ff4 | 164 | // g[1] Access bits for block 1 (for sectors 0-31) or blocks 5-9 (for sectors 32-39) |
| sheralikhan | 0:4b5aa5fe3ff4 | 165 | // g[0] Access bits for block 0 (for sectors 0-31) or blocks 0-4 (for sectors 32-39) |
| sheralikhan | 0:4b5aa5fe3ff4 | 166 | // Each group has access bits [C1 C2 C3]. In this code C1 is MSB and C3 is LSB. |
| sheralikhan | 0:4b5aa5fe3ff4 | 167 | // The four CX bits are stored together in a nible cx and an inverted nible cx_. |
| sheralikhan | 0:4b5aa5fe3ff4 | 168 | uint8_t c1, c2, c3; // Nibbles |
| sheralikhan | 0:4b5aa5fe3ff4 | 169 | uint8_t c1_, c2_, c3_; // Inverted nibbles |
| sheralikhan | 0:4b5aa5fe3ff4 | 170 | bool invertedError = false; // True if one of the inverted nibbles did not match |
| sheralikhan | 0:4b5aa5fe3ff4 | 171 | uint8_t g[4]; // Access bits for each of the four groups. |
| sheralikhan | 0:4b5aa5fe3ff4 | 172 | uint8_t group; // 0-3 - active group for access bits |
| sheralikhan | 0:4b5aa5fe3ff4 | 173 | bool firstInGroup; // True for the first block dumped in the group |
| sheralikhan | 0:4b5aa5fe3ff4 | 174 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 175 | // Determine position and size of sector. |
| sheralikhan | 0:4b5aa5fe3ff4 | 176 | if (sector < 32) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 177 | // Sectors 0..31 has 4 blocks each |
| sheralikhan | 0:4b5aa5fe3ff4 | 178 | no_of_blocks = 4; |
| sheralikhan | 0:4b5aa5fe3ff4 | 179 | firstBlock = sector * no_of_blocks; |
| sheralikhan | 0:4b5aa5fe3ff4 | 180 | } else if (sector < 40) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 181 | // Sectors 32-39 has 16 blocks each |
| sheralikhan | 0:4b5aa5fe3ff4 | 182 | no_of_blocks = 16; |
| sheralikhan | 0:4b5aa5fe3ff4 | 183 | firstBlock = 128 + (sector - 32) * no_of_blocks; |
| sheralikhan | 0:4b5aa5fe3ff4 | 184 | } else { |
| sheralikhan | 0:4b5aa5fe3ff4 | 185 | // Illegal input, no MIFARE Classic PICC has more than 40 sectors. |
| sheralikhan | 0:4b5aa5fe3ff4 | 186 | return; |
| sheralikhan | 0:4b5aa5fe3ff4 | 187 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 188 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 189 | // Dump blocks, highest address first. |
| sheralikhan | 0:4b5aa5fe3ff4 | 190 | uint8_t byteCount; |
| sheralikhan | 0:4b5aa5fe3ff4 | 191 | uint8_t buffer[18]; |
| sheralikhan | 0:4b5aa5fe3ff4 | 192 | uint8_t blockAddr; |
| sheralikhan | 0:4b5aa5fe3ff4 | 193 | isSectorTrailer = true; |
| sheralikhan | 0:4b5aa5fe3ff4 | 194 | for (int8_t blockOffset = no_of_blocks - 1; blockOffset >= 0; blockOffset--) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 195 | blockAddr = firstBlock + blockOffset; |
| sheralikhan | 0:4b5aa5fe3ff4 | 196 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 197 | // Sector number - only on first line |
| sheralikhan | 0:4b5aa5fe3ff4 | 198 | if (isSectorTrailer) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 199 | printf(" %2d ", sector); |
| sheralikhan | 0:4b5aa5fe3ff4 | 200 | } else { |
| sheralikhan | 0:4b5aa5fe3ff4 | 201 | printf(" "); |
| sheralikhan | 0:4b5aa5fe3ff4 | 202 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 203 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 204 | // Block number |
| sheralikhan | 0:4b5aa5fe3ff4 | 205 | printf(" %3d ", blockAddr); |
| sheralikhan | 0:4b5aa5fe3ff4 | 206 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 207 | // Establish encrypted communications before reading the first block |
| sheralikhan | 0:4b5aa5fe3ff4 | 208 | if (isSectorTrailer) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 209 | status = RfChip.PCD_Authenticate(MFRC522::PICC_CMD_MF_AUTH_KEY_A, firstBlock, key, uid); |
| sheralikhan | 0:4b5aa5fe3ff4 | 210 | if (status != MFRC522::STATUS_OK) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 211 | printf("PCD_Authenticate() failed: %s \r\n", RfChip.GetStatusCodeName(status)); |
| sheralikhan | 0:4b5aa5fe3ff4 | 212 | return; |
| sheralikhan | 0:4b5aa5fe3ff4 | 213 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 214 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 215 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 216 | // Read block |
| sheralikhan | 0:4b5aa5fe3ff4 | 217 | byteCount = sizeof(buffer); |
| sheralikhan | 0:4b5aa5fe3ff4 | 218 | status = RfChip.MIFARE_Read(blockAddr, buffer, &byteCount); |
| sheralikhan | 0:4b5aa5fe3ff4 | 219 | if (status != MFRC522::STATUS_OK) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 220 | printf("MIFARE_Read() failed: %s \r\n", RfChip.GetStatusCodeName(status)); |
| sheralikhan | 0:4b5aa5fe3ff4 | 221 | continue; |
| sheralikhan | 0:4b5aa5fe3ff4 | 222 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 223 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 224 | // Dump data |
| sheralikhan | 0:4b5aa5fe3ff4 | 225 | for (uint8_t index = 0; index < 16; index++) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 226 | printf(" %3d", buffer[index]); |
| sheralikhan | 0:4b5aa5fe3ff4 | 227 | // if ((index % 4) == 3) |
| sheralikhan | 0:4b5aa5fe3ff4 | 228 | // { |
| sheralikhan | 0:4b5aa5fe3ff4 | 229 | // printf(" "); |
| sheralikhan | 0:4b5aa5fe3ff4 | 230 | // } |
| sheralikhan | 0:4b5aa5fe3ff4 | 231 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 232 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 233 | // Parse sector trailer data |
| sheralikhan | 0:4b5aa5fe3ff4 | 234 | if (isSectorTrailer) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 235 | c1 = buffer[7] >> 4; |
| sheralikhan | 0:4b5aa5fe3ff4 | 236 | c2 = buffer[8] & 0xF; |
| sheralikhan | 0:4b5aa5fe3ff4 | 237 | c3 = buffer[8] >> 4; |
| sheralikhan | 0:4b5aa5fe3ff4 | 238 | c1_ = buffer[6] & 0xF; |
| sheralikhan | 0:4b5aa5fe3ff4 | 239 | c2_ = buffer[6] >> 4; |
| sheralikhan | 0:4b5aa5fe3ff4 | 240 | c3_ = buffer[7] & 0xF; |
| sheralikhan | 0:4b5aa5fe3ff4 | 241 | invertedError = (c1 != (~c1_ & 0xF)) || (c2 != (~c2_ & 0xF)) || (c3 != (~c3_ & 0xF)); |
| sheralikhan | 0:4b5aa5fe3ff4 | 242 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 243 | g[0] = ((c1 & 1) << 2) | ((c2 & 1) << 1) | ((c3 & 1) << 0); |
| sheralikhan | 0:4b5aa5fe3ff4 | 244 | g[1] = ((c1 & 2) << 1) | ((c2 & 2) << 0) | ((c3 & 2) >> 1); |
| sheralikhan | 0:4b5aa5fe3ff4 | 245 | g[2] = ((c1 & 4) << 0) | ((c2 & 4) >> 1) | ((c3 & 4) >> 2); |
| sheralikhan | 0:4b5aa5fe3ff4 | 246 | g[3] = ((c1 & 8) >> 1) | ((c2 & 8) >> 2) | ((c3 & 8) >> 3); |
| sheralikhan | 0:4b5aa5fe3ff4 | 247 | isSectorTrailer = false; |
| sheralikhan | 0:4b5aa5fe3ff4 | 248 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 249 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 250 | // Which access group is this block in? |
| sheralikhan | 0:4b5aa5fe3ff4 | 251 | if (no_of_blocks == 4) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 252 | group = blockOffset; |
| sheralikhan | 0:4b5aa5fe3ff4 | 253 | firstInGroup = true; |
| sheralikhan | 0:4b5aa5fe3ff4 | 254 | } else { |
| sheralikhan | 0:4b5aa5fe3ff4 | 255 | group = blockOffset / 5; |
| sheralikhan | 0:4b5aa5fe3ff4 | 256 | firstInGroup = (group == 3) || (group != (blockOffset + 1) / 5); |
| sheralikhan | 0:4b5aa5fe3ff4 | 257 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 258 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 259 | if (firstInGroup) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 260 | // Print access bits |
| sheralikhan | 0:4b5aa5fe3ff4 | 261 | printf(" [ %d %d %d ] ", (g[group] >> 2) & 1, (g[group] >> 1) & 1, (g[group] >> 0) & 1); |
| sheralikhan | 0:4b5aa5fe3ff4 | 262 | if (invertedError) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 263 | printf(" Inverted access bits did not match! "); |
| sheralikhan | 0:4b5aa5fe3ff4 | 264 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 265 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 266 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 267 | if (group != 3 && (g[group] == 1 || g[group] == 6)) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 268 | // Not a sector trailer, a value block |
| sheralikhan | 0:4b5aa5fe3ff4 | 269 | printf(" Addr = 0x%02X, Value = 0x%02X%02X%02X%02X", buffer[12], |
| sheralikhan | 0:4b5aa5fe3ff4 | 270 | buffer[3], |
| sheralikhan | 0:4b5aa5fe3ff4 | 271 | buffer[2], |
| sheralikhan | 0:4b5aa5fe3ff4 | 272 | buffer[1], |
| sheralikhan | 0:4b5aa5fe3ff4 | 273 | buffer[0]); |
| sheralikhan | 0:4b5aa5fe3ff4 | 274 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 275 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 276 | printf("\n\r"); |
| sheralikhan | 0:4b5aa5fe3ff4 | 277 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 278 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 279 | return; |
| sheralikhan | 0:4b5aa5fe3ff4 | 280 | } // End PICC_DumpMifareClassicSectorToSerial() |
| sheralikhan | 0:4b5aa5fe3ff4 | 281 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 282 | /** |
| sheralikhan | 0:4b5aa5fe3ff4 | 283 | * Dumps memory contents of a MIFARE Ultralight PICC. |
| sheralikhan | 0:4b5aa5fe3ff4 | 284 | */ |
| sheralikhan | 0:4b5aa5fe3ff4 | 285 | void DumpMifareUltralightToSerial(void) |
| sheralikhan | 0:4b5aa5fe3ff4 | 286 | { |
| sheralikhan | 0:4b5aa5fe3ff4 | 287 | uint8_t status; |
| sheralikhan | 0:4b5aa5fe3ff4 | 288 | uint8_t byteCount; |
| sheralikhan | 0:4b5aa5fe3ff4 | 289 | uint8_t buffer[18]; |
| sheralikhan | 0:4b5aa5fe3ff4 | 290 | uint8_t i; |
| sheralikhan | 0:4b5aa5fe3ff4 | 291 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 292 | printf("Page 0 1 2 3"); |
| sheralikhan | 0:4b5aa5fe3ff4 | 293 | // Try the mpages of the original Ultralight. Ultralight C has more pages. |
| sheralikhan | 0:4b5aa5fe3ff4 | 294 | for (uint8_t page = 0; page < 16; page +=4) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 295 | // Read pages |
| sheralikhan | 0:4b5aa5fe3ff4 | 296 | byteCount = sizeof(buffer); |
| sheralikhan | 0:4b5aa5fe3ff4 | 297 | status = RfChip.MIFARE_Read(page, buffer, &byteCount); |
| sheralikhan | 0:4b5aa5fe3ff4 | 298 | if (status != MFRC522::STATUS_OK) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 299 | printf("MIFARE_Read() failed: %s \n\r", RfChip.GetStatusCodeName(status)); |
| sheralikhan | 0:4b5aa5fe3ff4 | 300 | break; |
| sheralikhan | 0:4b5aa5fe3ff4 | 301 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 302 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 303 | // Dump data |
| sheralikhan | 0:4b5aa5fe3ff4 | 304 | for (uint8_t offset = 0; offset < 4; offset++) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 305 | i = page + offset; |
| sheralikhan | 0:4b5aa5fe3ff4 | 306 | printf(" %2d ", i); // Pad with spaces |
| sheralikhan | 0:4b5aa5fe3ff4 | 307 | for (uint8_t index = 0; index < 4; index++) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 308 | i = 4 * offset + index; |
| sheralikhan | 0:4b5aa5fe3ff4 | 309 | printf(" %02X ", buffer[i]); |
| sheralikhan | 0:4b5aa5fe3ff4 | 310 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 311 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 312 | printf("\n\r"); |
| sheralikhan | 0:4b5aa5fe3ff4 | 313 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 314 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 315 | } // End PICC_DumpMifareUltralightToSerial() |
| sheralikhan | 0:4b5aa5fe3ff4 | 316 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 317 | int main() |
| sheralikhan | 0:4b5aa5fe3ff4 | 318 | { |
| sheralikhan | 0:4b5aa5fe3ff4 | 319 | /* Set debug UART speed */ |
| sheralikhan | 0:4b5aa5fe3ff4 | 320 | printf("\n\rUART 9600 baud\n\r"); |
| sheralikhan | 0:4b5aa5fe3ff4 | 321 | pc.baud(9600); |
| sheralikhan | 0:4b5aa5fe3ff4 | 322 | printf("\n\r%s %s\n\r",VERSION,CIBLE); |
| sheralikhan | 0:4b5aa5fe3ff4 | 323 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 324 | /* Init. RC522 Chip */ |
| sheralikhan | 0:4b5aa5fe3ff4 | 325 | RfChip.PCD_Init(); |
| sheralikhan | 0:4b5aa5fe3ff4 | 326 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 327 | /* Read RC522 version */ |
| sheralikhan | 0:4b5aa5fe3ff4 | 328 | uint8_t temp = RfChip.PCD_ReadRegister(MFRC522::VersionReg); |
| sheralikhan | 0:4b5aa5fe3ff4 | 329 | printf("MFRC522 version: %d\n\r", temp & 0x07); |
| sheralikhan | 0:4b5aa5fe3ff4 | 330 | printf("\n\r"); |
| sheralikhan | 0:4b5aa5fe3ff4 | 331 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 332 | while(1) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 333 | LedRed = 1; |
| sheralikhan | 0:4b5aa5fe3ff4 | 334 | LedGreen = 1; |
| sheralikhan | 0:4b5aa5fe3ff4 | 335 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 336 | // Look for new cards |
| sheralikhan | 0:4b5aa5fe3ff4 | 337 | if ( ! RfChip.PICC_IsNewCardPresent()) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 338 | wait_ms(500); |
| sheralikhan | 0:4b5aa5fe3ff4 | 339 | continue; |
| sheralikhan | 0:4b5aa5fe3ff4 | 340 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 341 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 342 | LedRed = 0; |
| sheralikhan | 0:4b5aa5fe3ff4 | 343 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 344 | // Select one of the cards |
| sheralikhan | 0:4b5aa5fe3ff4 | 345 | if ( ! RfChip.PICC_ReadCardSerial()) { |
| sheralikhan | 0:4b5aa5fe3ff4 | 346 | wait_ms(500); |
| sheralikhan | 0:4b5aa5fe3ff4 | 347 | continue; |
| sheralikhan | 0:4b5aa5fe3ff4 | 348 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 349 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 350 | LedRed = 1; |
| sheralikhan | 0:4b5aa5fe3ff4 | 351 | LedGreen = 0; |
| sheralikhan | 0:4b5aa5fe3ff4 | 352 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 353 | // Dump debug info about the card. PICC_HaltA() is automatically called. |
| sheralikhan | 0:4b5aa5fe3ff4 | 354 | DumpToSerial(&(RfChip.uid)); |
| sheralikhan | 0:4b5aa5fe3ff4 | 355 | wait_ms(200); |
| sheralikhan | 0:4b5aa5fe3ff4 | 356 | |
| sheralikhan | 0:4b5aa5fe3ff4 | 357 | } |
| sheralikhan | 0:4b5aa5fe3ff4 | 358 | } |
