MFRC522 Writing and reading RFID tag

Dependencies:   mbed

Committer:
sheralikhan
Date:
Mon Apr 10 05:47:48 2017 +0000
Revision:
0:f7bdb80c0ef2
Child:
1:0cc7ec8623d2
Writing and reading

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sheralikhan 0:f7bdb80c0ef2 1 //Test of cheap 13.56 Mhz RFID-RC522 module from eBay
sheralikhan 0:f7bdb80c0ef2 2 //This code is based on Martin Olejar's MFRC522 library. Minimal changes
sheralikhan 0:f7bdb80c0ef2 3 //Adapted for Nucleo STM32 F401RE. Should work on other Nucleos too
sheralikhan 0:f7bdb80c0ef2 4
sheralikhan 0:f7bdb80c0ef2 5 //Connect as follows:
sheralikhan 0:f7bdb80c0ef2 6 //RFID pins -> Nucleo header CN5 (Arduino-compatible header)
sheralikhan 0:f7bdb80c0ef2 7 //----------------------------------------
sheralikhan 0:f7bdb80c0ef2 8 //RFID IRQ=pin5 -> Not used. Leave open
sheralikhan 0:f7bdb80c0ef2 9 //RFID MISO=pin4 -> Nucleo SPI_MISO=PA_6=D12
sheralikhan 0:f7bdb80c0ef2 10 //RFID MOSI=pin3 -> Nucleo SPI_MOSI=PA_7=D11
sheralikhan 0:f7bdb80c0ef2 11 //RFID SCK=pin2 -> Nucleo SPI_SCK =PA_5=D13
sheralikhan 0:f7bdb80c0ef2 12 //RFID SDA=pin1 -> Nucleo SPI_CS =PB_6=D10
sheralikhan 0:f7bdb80c0ef2 13 //RFID RST=pin7 -> Nucleo =PA_9=D8
sheralikhan 0:f7bdb80c0ef2 14 //3.3V and Gnd to the respective pins
sheralikhan 0:f7bdb80c0ef2 15
sheralikhan 0:f7bdb80c0ef2 16 #include "mbed.h"
sheralikhan 0:f7bdb80c0ef2 17 #include "MFRC522.h"
sheralikhan 0:f7bdb80c0ef2 18 #include "SPI.h"
sheralikhan 0:f7bdb80c0ef2 19 #define VERSION "RFID_2017_04_03"
sheralikhan 0:f7bdb80c0ef2 20 #define CIBLE "WIZwiki-W7500"
sheralikhan 0:f7bdb80c0ef2 21
sheralikhan 0:f7bdb80c0ef2 22
sheralikhan 0:f7bdb80c0ef2 23 // ARMmbed WIZwiki W7500 Pin for MFRC522 SPI Communication
sheralikhan 0:f7bdb80c0ef2 24 #define SPI_MOSI D11
sheralikhan 0:f7bdb80c0ef2 25 #define SPI_MISO D12
sheralikhan 0:f7bdb80c0ef2 26 #define SPI_SCLK D13
sheralikhan 0:f7bdb80c0ef2 27 #define SPI_CS D10
sheralikhan 0:f7bdb80c0ef2 28
sheralikhan 0:f7bdb80c0ef2 29 // Nucleo Pin for MFRC522 reset (pick another D pin if you need D8)
sheralikhan 0:f7bdb80c0ef2 30 #define MF_RESET D9
sheralikhan 0:f7bdb80c0ef2 31
sheralikhan 0:f7bdb80c0ef2 32 DigitalOut LedGreen(D7);
sheralikhan 0:f7bdb80c0ef2 33 DigitalOut LedRed(D6);
sheralikhan 0:f7bdb80c0ef2 34 DigitalOut LedYellow(D5);
sheralikhan 0:f7bdb80c0ef2 35
sheralikhan 0:f7bdb80c0ef2 36 //Serial connection to PC for output
sheralikhan 0:f7bdb80c0ef2 37 Serial pc(USBTX, USBRX);
sheralikhan 0:f7bdb80c0ef2 38
sheralikhan 0:f7bdb80c0ef2 39 MFRC522 RfChip (SPI_MOSI, SPI_MISO, SPI_SCLK, SPI_CS, MF_RESET);
sheralikhan 0:f7bdb80c0ef2 40
sheralikhan 0:f7bdb80c0ef2 41 //* Local functions */
sheralikhan 0:f7bdb80c0ef2 42 void DumpToSerial(MFRC522::Uid *uid);
sheralikhan 0:f7bdb80c0ef2 43 void DumpMifareClassicToSerial (MFRC522::Uid *uid, uint8_t piccType, MFRC522::MIFARE_Key *key);
sheralikhan 0:f7bdb80c0ef2 44 void DumpMifareClassicSectorToSerial(MFRC522::Uid *uid, MFRC522::MIFARE_Key *key, uint8_t sector);
sheralikhan 0:f7bdb80c0ef2 45 void DumpMifareUltralightToSerial (void);
sheralikhan 0:f7bdb80c0ef2 46
sheralikhan 0:f7bdb80c0ef2 47 /**
sheralikhan 0:f7bdb80c0ef2 48 * Dumps debug info about the selected PICC to Serial.
sheralikhan 0:f7bdb80c0ef2 49 * On success the PICC is halted after dumping the data.
sheralikhan 0:f7bdb80c0ef2 50 * For MIFARE Classic the factory default key of 0xFFFFFFFFFFFF is tried.
sheralikhan 0:f7bdb80c0ef2 51 */
sheralikhan 0:f7bdb80c0ef2 52
sheralikhan 0:f7bdb80c0ef2 53 void WriteToRfidTag(MFRC522::Uid *uid)
sheralikhan 0:f7bdb80c0ef2 54 {
sheralikhan 0:f7bdb80c0ef2 55
sheralikhan 0:f7bdb80c0ef2 56 MFRC522::MIFARE_Key key;
sheralikhan 0:f7bdb80c0ef2 57 MFRC522::StatusCode status;
sheralikhan 0:f7bdb80c0ef2 58 uint8_t buffer[16];
sheralikhan 0:f7bdb80c0ef2 59 uint8_t block;
sheralikhan 0:f7bdb80c0ef2 60 uint8_t len;
sheralikhan 0:f7bdb80c0ef2 61 while(true) {
sheralikhan 0:f7bdb80c0ef2 62 LedGreen=1;
sheralikhan 0:f7bdb80c0ef2 63 for (uint8_t i = 0; i < 6; i++) {
sheralikhan 0:f7bdb80c0ef2 64 key.keyByte[i] = 0xFF;
sheralikhan 0:f7bdb80c0ef2 65 }
sheralikhan 0:f7bdb80c0ef2 66 // Look for new cards
sheralikhan 0:f7bdb80c0ef2 67 if ( ! RfChip.PICC_IsNewCardPresent()) {
sheralikhan 0:f7bdb80c0ef2 68 continue;
sheralikhan 0:f7bdb80c0ef2 69 }
sheralikhan 0:f7bdb80c0ef2 70
sheralikhan 0:f7bdb80c0ef2 71 // Select one of the cards
sheralikhan 0:f7bdb80c0ef2 72 if ( ! RfChip.PICC_ReadCardSerial()) {
sheralikhan 0:f7bdb80c0ef2 73 continue;
sheralikhan 0:f7bdb80c0ef2 74 }
sheralikhan 0:f7bdb80c0ef2 75
sheralikhan 0:f7bdb80c0ef2 76 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 77 pc.printf("Card UID: "); //Dump UID
sheralikhan 0:f7bdb80c0ef2 78 for (uint8_t i = 0; i < RfChip.uid.size; i++) {
sheralikhan 0:f7bdb80c0ef2 79 pc.printf(RfChip.uid.uidByte[i] < 0x10 ? " 0" : " ");
sheralikhan 0:f7bdb80c0ef2 80 printf(" %X", RfChip.uid.uidByte[i]);
sheralikhan 0:f7bdb80c0ef2 81 }
sheralikhan 0:f7bdb80c0ef2 82 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 83 pc.printf("PICC type: "); // Dump PICC type
sheralikhan 0:f7bdb80c0ef2 84 uint8_t piccType = RfChip.PICC_GetType(RfChip.uid.sak);
sheralikhan 0:f7bdb80c0ef2 85 pc.printf( RfChip.PICC_GetTypeName(piccType));
sheralikhan 0:f7bdb80c0ef2 86 LedGreen=0;
sheralikhan 0:f7bdb80c0ef2 87
sheralikhan 0:f7bdb80c0ef2 88 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 89 pc.printf("Enter 1 block: "); // Enter Data
sheralikhan 0:f7bdb80c0ef2 90 len=sizeof(buffer);
sheralikhan 0:f7bdb80c0ef2 91 for(uint8_t i = 0; i < len; i++) {
sheralikhan 0:f7bdb80c0ef2 92 buffer[i] = pc.putc(pc.getc());
sheralikhan 0:f7bdb80c0ef2 93 }
sheralikhan 0:f7bdb80c0ef2 94 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 95 block = 1;
sheralikhan 0:f7bdb80c0ef2 96 pc.printf("Authenticating using key A...");
sheralikhan 0:f7bdb80c0ef2 97 status = (MFRC522::StatusCode)RfChip.PCD_Authenticate(MFRC522::PICC_CMD_MF_AUTH_KEY_A, block, &key, &(RfChip.uid));
sheralikhan 0:f7bdb80c0ef2 98 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 99 pc.printf("PCD_Authenticate() failed: ");
sheralikhan 0:f7bdb80c0ef2 100 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 101 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 102 continue;
sheralikhan 0:f7bdb80c0ef2 103 }
sheralikhan 0:f7bdb80c0ef2 104 // Write block
sheralikhan 0:f7bdb80c0ef2 105 status = (MFRC522::StatusCode)RfChip.MIFARE_Write(block, buffer, 16);
sheralikhan 0:f7bdb80c0ef2 106 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 107 pc.printf("MIFARE_Write() failed: ");
sheralikhan 0:f7bdb80c0ef2 108 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 109 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 110 continue;
sheralikhan 0:f7bdb80c0ef2 111 } else {
sheralikhan 0:f7bdb80c0ef2 112 LedYellow=1;
sheralikhan 0:f7bdb80c0ef2 113 pc.printf("Succesfully Written to tag: ");
sheralikhan 0:f7bdb80c0ef2 114 }
sheralikhan 0:f7bdb80c0ef2 115 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 116 pc.printf("Enter 2 block: "); // Enter Data
sheralikhan 0:f7bdb80c0ef2 117 len=sizeof(buffer);
sheralikhan 0:f7bdb80c0ef2 118 for(uint8_t i = 0; i < len; i++) {
sheralikhan 0:f7bdb80c0ef2 119 buffer[i] = pc.putc(pc.getc());
sheralikhan 0:f7bdb80c0ef2 120 }
sheralikhan 0:f7bdb80c0ef2 121 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 122 block = 2;
sheralikhan 0:f7bdb80c0ef2 123 pc.printf("Authenticating using key A...");
sheralikhan 0:f7bdb80c0ef2 124 status = (MFRC522::StatusCode)RfChip.PCD_Authenticate(MFRC522::PICC_CMD_MF_AUTH_KEY_A, block, &key, &(RfChip.uid));
sheralikhan 0:f7bdb80c0ef2 125 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 126 pc.printf("PCD_Authenticate() failed: ");
sheralikhan 0:f7bdb80c0ef2 127 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 128 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 129 continue;
sheralikhan 0:f7bdb80c0ef2 130 }
sheralikhan 0:f7bdb80c0ef2 131
sheralikhan 0:f7bdb80c0ef2 132 // Write block
sheralikhan 0:f7bdb80c0ef2 133 status = (MFRC522::StatusCode)RfChip.MIFARE_Write(block, buffer, 16);
sheralikhan 0:f7bdb80c0ef2 134 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 135 pc.printf("MIFARE_Write() failed: ");
sheralikhan 0:f7bdb80c0ef2 136 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 137 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 138 continue;
sheralikhan 0:f7bdb80c0ef2 139 } else {
sheralikhan 0:f7bdb80c0ef2 140 LedYellow=1;
sheralikhan 0:f7bdb80c0ef2 141 pc.printf("Succesfully Written to tag: ");
sheralikhan 0:f7bdb80c0ef2 142 }
sheralikhan 0:f7bdb80c0ef2 143 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 144 pc.printf("Enter 8 block: "); // Enter Data
sheralikhan 0:f7bdb80c0ef2 145 len=sizeof(buffer);
sheralikhan 0:f7bdb80c0ef2 146 for(uint8_t i = 0; i < len; i++) {
sheralikhan 0:f7bdb80c0ef2 147 buffer[i] = pc.putc(pc.getc());
sheralikhan 0:f7bdb80c0ef2 148 }
sheralikhan 0:f7bdb80c0ef2 149 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 150 block = 8;
sheralikhan 0:f7bdb80c0ef2 151 pc.printf("Authenticating using key A...");
sheralikhan 0:f7bdb80c0ef2 152 status = (MFRC522::StatusCode)RfChip.PCD_Authenticate(MFRC522::PICC_CMD_MF_AUTH_KEY_A, block, &key, &(RfChip.uid));
sheralikhan 0:f7bdb80c0ef2 153 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 154 pc.printf("PCD_Authenticate() failed: ");
sheralikhan 0:f7bdb80c0ef2 155 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 156 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 157 continue;
sheralikhan 0:f7bdb80c0ef2 158 }
sheralikhan 0:f7bdb80c0ef2 159 // Write block
sheralikhan 0:f7bdb80c0ef2 160 status = (MFRC522::StatusCode)RfChip.MIFARE_Write(block, buffer, 16);
sheralikhan 0:f7bdb80c0ef2 161 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 162 pc.printf("MIFARE_Write() failed: ");
sheralikhan 0:f7bdb80c0ef2 163 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 164 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 165 continue;
sheralikhan 0:f7bdb80c0ef2 166 } else {
sheralikhan 0:f7bdb80c0ef2 167 LedYellow=1;
sheralikhan 0:f7bdb80c0ef2 168 pc.printf("Succesfully Written to tag: ");
sheralikhan 0:f7bdb80c0ef2 169 }
sheralikhan 0:f7bdb80c0ef2 170 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 171 pc.printf("Enter 33 block: "); // Enter Data
sheralikhan 0:f7bdb80c0ef2 172 len=sizeof(buffer);
sheralikhan 0:f7bdb80c0ef2 173 for(uint8_t i = 0; i < len; i++) {
sheralikhan 0:f7bdb80c0ef2 174 buffer[i] = pc.putc(pc.getc());
sheralikhan 0:f7bdb80c0ef2 175 }
sheralikhan 0:f7bdb80c0ef2 176 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 177 block = 33;
sheralikhan 0:f7bdb80c0ef2 178 pc.printf("Authenticating using key A...");
sheralikhan 0:f7bdb80c0ef2 179 status = (MFRC522::StatusCode)RfChip.PCD_Authenticate(MFRC522::PICC_CMD_MF_AUTH_KEY_A, block, &key, &(RfChip.uid));
sheralikhan 0:f7bdb80c0ef2 180 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 181 pc.printf("PCD_Authenticate() failed: ");
sheralikhan 0:f7bdb80c0ef2 182 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 183 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 184 continue;
sheralikhan 0:f7bdb80c0ef2 185 }
sheralikhan 0:f7bdb80c0ef2 186
sheralikhan 0:f7bdb80c0ef2 187 // Write block
sheralikhan 0:f7bdb80c0ef2 188 status = (MFRC522::StatusCode)RfChip.MIFARE_Write(block, buffer, 16);
sheralikhan 0:f7bdb80c0ef2 189 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 190 pc.printf("MIFARE_Write() failed: ");
sheralikhan 0:f7bdb80c0ef2 191 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 192 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 193 continue;
sheralikhan 0:f7bdb80c0ef2 194 } else {
sheralikhan 0:f7bdb80c0ef2 195 LedYellow=1;
sheralikhan 0:f7bdb80c0ef2 196 pc.printf("Succesfully Written to tag: ");
sheralikhan 0:f7bdb80c0ef2 197 }
sheralikhan 0:f7bdb80c0ef2 198 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 199 pc.printf("Enter 44 block: "); // Enter Data
sheralikhan 0:f7bdb80c0ef2 200 len=sizeof(buffer);
sheralikhan 0:f7bdb80c0ef2 201 for(uint8_t i = 0; i < len; i++) {
sheralikhan 0:f7bdb80c0ef2 202 buffer[i] = pc.putc(pc.getc());
sheralikhan 0:f7bdb80c0ef2 203 }
sheralikhan 0:f7bdb80c0ef2 204 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 205 block = 44;
sheralikhan 0:f7bdb80c0ef2 206 pc.printf("Authenticating using key A...");
sheralikhan 0:f7bdb80c0ef2 207 status = (MFRC522::StatusCode)RfChip.PCD_Authenticate(MFRC522::PICC_CMD_MF_AUTH_KEY_A, block, &key, &(RfChip.uid));
sheralikhan 0:f7bdb80c0ef2 208 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 209 pc.printf("PCD_Authenticate() failed: ");
sheralikhan 0:f7bdb80c0ef2 210 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 211 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 212 continue;
sheralikhan 0:f7bdb80c0ef2 213 }
sheralikhan 0:f7bdb80c0ef2 214 // Write block
sheralikhan 0:f7bdb80c0ef2 215 status = (MFRC522::StatusCode)RfChip.MIFARE_Write(block, buffer, 16);
sheralikhan 0:f7bdb80c0ef2 216 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 217 pc.printf("MIFARE_Write() failed: ");
sheralikhan 0:f7bdb80c0ef2 218 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 219 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 220 continue;
sheralikhan 0:f7bdb80c0ef2 221 } else {
sheralikhan 0:f7bdb80c0ef2 222 LedYellow=1;
sheralikhan 0:f7bdb80c0ef2 223 pc.printf("Succesfully Written to tag: ");
sheralikhan 0:f7bdb80c0ef2 224 }
sheralikhan 0:f7bdb80c0ef2 225 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 226 pc.printf("Enter 52 block: "); // Enter Data
sheralikhan 0:f7bdb80c0ef2 227 len=sizeof(buffer);
sheralikhan 0:f7bdb80c0ef2 228 for(uint8_t i = 0; i < len; i++) {
sheralikhan 0:f7bdb80c0ef2 229 buffer[i] = pc.putc(pc.getc());
sheralikhan 0:f7bdb80c0ef2 230 }
sheralikhan 0:f7bdb80c0ef2 231 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 232 block = 52;
sheralikhan 0:f7bdb80c0ef2 233 pc.printf("Authenticating using key A...");
sheralikhan 0:f7bdb80c0ef2 234 status = (MFRC522::StatusCode)RfChip.PCD_Authenticate(MFRC522::PICC_CMD_MF_AUTH_KEY_A, block, &key, &(RfChip.uid));
sheralikhan 0:f7bdb80c0ef2 235 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 236 pc.printf("PCD_Authenticate() failed: ");
sheralikhan 0:f7bdb80c0ef2 237 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 238 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 239 continue;
sheralikhan 0:f7bdb80c0ef2 240 }
sheralikhan 0:f7bdb80c0ef2 241
sheralikhan 0:f7bdb80c0ef2 242 // Write block
sheralikhan 0:f7bdb80c0ef2 243 status = (MFRC522::StatusCode)RfChip.MIFARE_Write(block, buffer, 16);
sheralikhan 0:f7bdb80c0ef2 244 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 245 pc.printf("MIFARE_Write() failed: ");
sheralikhan 0:f7bdb80c0ef2 246 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 247 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 248 continue;
sheralikhan 0:f7bdb80c0ef2 249 } else {
sheralikhan 0:f7bdb80c0ef2 250 LedYellow=1;
sheralikhan 0:f7bdb80c0ef2 251 pc.printf("Succesfully Written to tag: ");
sheralikhan 0:f7bdb80c0ef2 252 }
sheralikhan 0:f7bdb80c0ef2 253 /* printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 254 pc.printf("Enter 14 block: "); // Enter Data
sheralikhan 0:f7bdb80c0ef2 255 len=sizeof(buffer);
sheralikhan 0:f7bdb80c0ef2 256 for(uint8_t i = 0; i < len; i++) {
sheralikhan 0:f7bdb80c0ef2 257 buffer[i] = pc.putc(pc.getc());
sheralikhan 0:f7bdb80c0ef2 258 }
sheralikhan 0:f7bdb80c0ef2 259 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 260 block = 14;
sheralikhan 0:f7bdb80c0ef2 261 pc.printf("Authenticating using key A...");
sheralikhan 0:f7bdb80c0ef2 262 status = (MFRC522::StatusCode)RfChip.PCD_Authenticate(MFRC522::PICC_CMD_MF_AUTH_KEY_A, block, &key, &(RfChip.uid));
sheralikhan 0:f7bdb80c0ef2 263 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 264 pc.printf("PCD_Authenticate() failed: ");
sheralikhan 0:f7bdb80c0ef2 265 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 266 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 267 continue;
sheralikhan 0:f7bdb80c0ef2 268 }
sheralikhan 0:f7bdb80c0ef2 269
sheralikhan 0:f7bdb80c0ef2 270 // Write block
sheralikhan 0:f7bdb80c0ef2 271 status = (MFRC522::StatusCode)RfChip.MIFARE_Write(block, buffer, 16);
sheralikhan 0:f7bdb80c0ef2 272 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 273 pc.printf("MIFARE_Write() failed: ");
sheralikhan 0:f7bdb80c0ef2 274 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 275 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 276 continue;
sheralikhan 0:f7bdb80c0ef2 277 } else {
sheralikhan 0:f7bdb80c0ef2 278 LedYellow=1;
sheralikhan 0:f7bdb80c0ef2 279 pc.printf("Succesfully Written to tag: ");
sheralikhan 0:f7bdb80c0ef2 280 }
sheralikhan 0:f7bdb80c0ef2 281 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 282 pc.printf("Enter 17 block: "); // Enter Data
sheralikhan 0:f7bdb80c0ef2 283 len=sizeof(buffer);
sheralikhan 0:f7bdb80c0ef2 284 for(uint8_t i = 0; i < len; i++) {
sheralikhan 0:f7bdb80c0ef2 285 buffer[i] = pc.putc(pc.getc());
sheralikhan 0:f7bdb80c0ef2 286 }
sheralikhan 0:f7bdb80c0ef2 287 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 288 block = 17;
sheralikhan 0:f7bdb80c0ef2 289 pc.printf("Authenticating using key A...");
sheralikhan 0:f7bdb80c0ef2 290 status = (MFRC522::StatusCode)RfChip.PCD_Authenticate(MFRC522::PICC_CMD_MF_AUTH_KEY_A, block, &key, &(RfChip.uid));
sheralikhan 0:f7bdb80c0ef2 291 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 292 pc.printf("PCD_Authenticate() failed: ");
sheralikhan 0:f7bdb80c0ef2 293 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 294 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 295 continue;
sheralikhan 0:f7bdb80c0ef2 296 }
sheralikhan 0:f7bdb80c0ef2 297
sheralikhan 0:f7bdb80c0ef2 298 // Write block
sheralikhan 0:f7bdb80c0ef2 299 status = (MFRC522::StatusCode)RfChip.MIFARE_Write(block, buffer, 16);
sheralikhan 0:f7bdb80c0ef2 300 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 301 pc.printf("MIFARE_Write() failed: ");
sheralikhan 0:f7bdb80c0ef2 302 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 303 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 304 continue;
sheralikhan 0:f7bdb80c0ef2 305 } else {
sheralikhan 0:f7bdb80c0ef2 306 LedYellow=1;
sheralikhan 0:f7bdb80c0ef2 307 pc.printf("Succesfully Written to tag: ");
sheralikhan 0:f7bdb80c0ef2 308 }
sheralikhan 0:f7bdb80c0ef2 309 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 310 pc.printf("Enter 19 block: "); // Enter Data
sheralikhan 0:f7bdb80c0ef2 311 len=sizeof(buffer);
sheralikhan 0:f7bdb80c0ef2 312 for(uint8_t i = 0; i < len; i++) {
sheralikhan 0:f7bdb80c0ef2 313 buffer[i] = pc.putc(pc.getc());
sheralikhan 0:f7bdb80c0ef2 314 }
sheralikhan 0:f7bdb80c0ef2 315 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 316 block = 18;
sheralikhan 0:f7bdb80c0ef2 317 pc.printf("Authenticating using key A...");
sheralikhan 0:f7bdb80c0ef2 318 status = (MFRC522::StatusCode)RfChip.PCD_Authenticate(MFRC522::PICC_CMD_MF_AUTH_KEY_A, block, &key, &(RfChip.uid));
sheralikhan 0:f7bdb80c0ef2 319 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 320 pc.printf("PCD_Authenticate() failed: ");
sheralikhan 0:f7bdb80c0ef2 321 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 322 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 323 continue;
sheralikhan 0:f7bdb80c0ef2 324 }
sheralikhan 0:f7bdb80c0ef2 325
sheralikhan 0:f7bdb80c0ef2 326 // Write block
sheralikhan 0:f7bdb80c0ef2 327 status = (MFRC522::StatusCode)RfChip.MIFARE_Write(block, buffer, 16);
sheralikhan 0:f7bdb80c0ef2 328 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 329 pc.printf("MIFARE_Write() failed: ");
sheralikhan 0:f7bdb80c0ef2 330 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 331 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 332 continue;
sheralikhan 0:f7bdb80c0ef2 333 } else {
sheralikhan 0:f7bdb80c0ef2 334 LedYellow=1;
sheralikhan 0:f7bdb80c0ef2 335 pc.printf("Succesfully Written to tag: ");
sheralikhan 0:f7bdb80c0ef2 336 }
sheralikhan 0:f7bdb80c0ef2 337 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 338 pc.printf("Enter 20 block: "); // Enter Data
sheralikhan 0:f7bdb80c0ef2 339 len=sizeof(buffer);
sheralikhan 0:f7bdb80c0ef2 340 for(uint8_t i = 0; i < len; i++) {
sheralikhan 0:f7bdb80c0ef2 341 buffer[i] = pc.putc(pc.getc());
sheralikhan 0:f7bdb80c0ef2 342 }
sheralikhan 0:f7bdb80c0ef2 343 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 344 block = 20;
sheralikhan 0:f7bdb80c0ef2 345 pc.printf("Authenticating using key A...");
sheralikhan 0:f7bdb80c0ef2 346 status = (MFRC522::StatusCode)RfChip.PCD_Authenticate(MFRC522::PICC_CMD_MF_AUTH_KEY_A, block, &key, &(RfChip.uid));
sheralikhan 0:f7bdb80c0ef2 347 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 348 pc.printf("PCD_Authenticate() failed: ");
sheralikhan 0:f7bdb80c0ef2 349 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 350 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 351 continue;
sheralikhan 0:f7bdb80c0ef2 352 }
sheralikhan 0:f7bdb80c0ef2 353
sheralikhan 0:f7bdb80c0ef2 354 // Write block
sheralikhan 0:f7bdb80c0ef2 355 status = (MFRC522::StatusCode)RfChip.MIFARE_Write(block, buffer, 16);
sheralikhan 0:f7bdb80c0ef2 356 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 357 pc.printf("MIFARE_Write() failed: ");
sheralikhan 0:f7bdb80c0ef2 358 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 359 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 360 continue;
sheralikhan 0:f7bdb80c0ef2 361 } else {
sheralikhan 0:f7bdb80c0ef2 362 LedYellow=1;
sheralikhan 0:f7bdb80c0ef2 363 pc.printf("Succesfully Written to tag: ");
sheralikhan 0:f7bdb80c0ef2 364 }
sheralikhan 0:f7bdb80c0ef2 365 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 366 pc.printf("Enter 60 block: "); // Enter Data
sheralikhan 0:f7bdb80c0ef2 367 len=sizeof(buffer);
sheralikhan 0:f7bdb80c0ef2 368 for(uint8_t i = 0; i < len; i++) {
sheralikhan 0:f7bdb80c0ef2 369 buffer[i] = pc.putc(pc.getc());
sheralikhan 0:f7bdb80c0ef2 370 }*/
sheralikhan 0:f7bdb80c0ef2 371 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 372 block = 60;
sheralikhan 0:f7bdb80c0ef2 373 pc.printf("Authenticating using key A...");
sheralikhan 0:f7bdb80c0ef2 374 status = (MFRC522::StatusCode)RfChip.PCD_Authenticate(MFRC522::PICC_CMD_MF_AUTH_KEY_A, block, &key, &(RfChip.uid));
sheralikhan 0:f7bdb80c0ef2 375 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 376 pc.printf("PCD_Authenticate() failed: ");
sheralikhan 0:f7bdb80c0ef2 377 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 378 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 379 continue;
sheralikhan 0:f7bdb80c0ef2 380 }
sheralikhan 0:f7bdb80c0ef2 381
sheralikhan 0:f7bdb80c0ef2 382 // Write block
sheralikhan 0:f7bdb80c0ef2 383 status = (MFRC522::StatusCode)RfChip.MIFARE_Write(block, buffer, 16);
sheralikhan 0:f7bdb80c0ef2 384 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 385 pc.printf("MIFARE_Write() failed: ");
sheralikhan 0:f7bdb80c0ef2 386 pc.printf(RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 387 LedRed=1;
sheralikhan 0:f7bdb80c0ef2 388 continue;
sheralikhan 0:f7bdb80c0ef2 389 } else {
sheralikhan 0:f7bdb80c0ef2 390 LedYellow=1;
sheralikhan 0:f7bdb80c0ef2 391 pc.printf("Succesfully Written to tag: ");
sheralikhan 0:f7bdb80c0ef2 392 }
sheralikhan 0:f7bdb80c0ef2 393 DumpToSerial(&(RfChip.uid));
sheralikhan 0:f7bdb80c0ef2 394 wait_ms(200);
sheralikhan 0:f7bdb80c0ef2 395 }
sheralikhan 0:f7bdb80c0ef2 396
sheralikhan 0:f7bdb80c0ef2 397 }
sheralikhan 0:f7bdb80c0ef2 398
sheralikhan 0:f7bdb80c0ef2 399 void DumpToSerial(MFRC522::Uid *uid)
sheralikhan 0:f7bdb80c0ef2 400 {
sheralikhan 0:f7bdb80c0ef2 401 MFRC522::MIFARE_Key key;
sheralikhan 0:f7bdb80c0ef2 402
sheralikhan 0:f7bdb80c0ef2 403 // Print Card UID
sheralikhan 0:f7bdb80c0ef2 404 printf("Card UID: ");
sheralikhan 0:f7bdb80c0ef2 405 for (uint8_t i = 0; i < RfChip.uid.size; i++) {
sheralikhan 0:f7bdb80c0ef2 406 printf(" %X", RfChip.uid.uidByte[i]);
sheralikhan 0:f7bdb80c0ef2 407 }
sheralikhan 0:f7bdb80c0ef2 408 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 409
sheralikhan 0:f7bdb80c0ef2 410 // Print Card type
sheralikhan 0:f7bdb80c0ef2 411 uint8_t piccType = RfChip.PICC_GetType(RfChip.uid.sak);
sheralikhan 0:f7bdb80c0ef2 412 printf("PICC Type: %s \n\r", RfChip.PICC_GetTypeName(piccType));
sheralikhan 0:f7bdb80c0ef2 413 wait_ms(1000);
sheralikhan 0:f7bdb80c0ef2 414
sheralikhan 0:f7bdb80c0ef2 415 // Dump contents
sheralikhan 0:f7bdb80c0ef2 416 switch (piccType) {
sheralikhan 0:f7bdb80c0ef2 417 case MFRC522::PICC_TYPE_MIFARE_MINI:
sheralikhan 0:f7bdb80c0ef2 418 case MFRC522::PICC_TYPE_MIFARE_1K:
sheralikhan 0:f7bdb80c0ef2 419 case MFRC522::PICC_TYPE_MIFARE_4K:
sheralikhan 0:f7bdb80c0ef2 420 // All keys are set to FFFFFFFFFFFFh at chip delivery from the factory.
sheralikhan 0:f7bdb80c0ef2 421 for (uint8_t i = 0; i < 6; i++) {
sheralikhan 0:f7bdb80c0ef2 422 key.keyByte[i] = 0xFF;
sheralikhan 0:f7bdb80c0ef2 423 }
sheralikhan 0:f7bdb80c0ef2 424 DumpMifareClassicToSerial(uid, piccType, &key);
sheralikhan 0:f7bdb80c0ef2 425 break;
sheralikhan 0:f7bdb80c0ef2 426
sheralikhan 0:f7bdb80c0ef2 427 case MFRC522::PICC_TYPE_MIFARE_UL:
sheralikhan 0:f7bdb80c0ef2 428 DumpMifareUltralightToSerial();
sheralikhan 0:f7bdb80c0ef2 429 break;
sheralikhan 0:f7bdb80c0ef2 430 case MFRC522::PICC_TYPE_TNP3XXX:
sheralikhan 0:f7bdb80c0ef2 431 printf("Dumping memory contents not implemented for that PICC type. \n\r");
sheralikhan 0:f7bdb80c0ef2 432 break;
sheralikhan 0:f7bdb80c0ef2 433 case MFRC522::PICC_TYPE_ISO_14443_4:
sheralikhan 0:f7bdb80c0ef2 434 case MFRC522::PICC_TYPE_ISO_18092:
sheralikhan 0:f7bdb80c0ef2 435 case MFRC522::PICC_TYPE_MIFARE_PLUS:
sheralikhan 0:f7bdb80c0ef2 436 printf("Dumping memory contents not implemented for that PICC type. \n\r");
sheralikhan 0:f7bdb80c0ef2 437 break;
sheralikhan 0:f7bdb80c0ef2 438
sheralikhan 0:f7bdb80c0ef2 439 case MFRC522::PICC_TYPE_UNKNOWN:
sheralikhan 0:f7bdb80c0ef2 440 case MFRC522::PICC_TYPE_NOT_COMPLETE:
sheralikhan 0:f7bdb80c0ef2 441 default:
sheralikhan 0:f7bdb80c0ef2 442 break; // No memory dump here
sheralikhan 0:f7bdb80c0ef2 443 }
sheralikhan 0:f7bdb80c0ef2 444
sheralikhan 0:f7bdb80c0ef2 445 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 446
sheralikhan 0:f7bdb80c0ef2 447 RfChip.PICC_HaltA(); // Already done if it was a MIFARE Classic PICC.
sheralikhan 0:f7bdb80c0ef2 448 } // End PICC_DumpToSerial()
sheralikhan 0:f7bdb80c0ef2 449
sheralikhan 0:f7bdb80c0ef2 450 /**
sheralikhan 0:f7bdb80c0ef2 451 * Dumps memory contents of a MIFARE Classic PICC.
sheralikhan 0:f7bdb80c0ef2 452 * On success the PICC is halted after dumping the data.
sheralikhan 0:f7bdb80c0ef2 453 */
sheralikhan 0:f7bdb80c0ef2 454 void DumpMifareClassicToSerial(MFRC522::Uid *uid, uint8_t piccType, MFRC522::MIFARE_Key *key)
sheralikhan 0:f7bdb80c0ef2 455 {
sheralikhan 0:f7bdb80c0ef2 456 uint8_t no_of_sectors = 0;
sheralikhan 0:f7bdb80c0ef2 457 switch (piccType) {
sheralikhan 0:f7bdb80c0ef2 458 case MFRC522::PICC_TYPE_MIFARE_MINI:
sheralikhan 0:f7bdb80c0ef2 459 // Has 5 sectors * 4 blocks/sector * 16 bytes/block = 320 bytes.
sheralikhan 0:f7bdb80c0ef2 460 no_of_sectors = 5;
sheralikhan 0:f7bdb80c0ef2 461 break;
sheralikhan 0:f7bdb80c0ef2 462
sheralikhan 0:f7bdb80c0ef2 463 case MFRC522::PICC_TYPE_MIFARE_1K:
sheralikhan 0:f7bdb80c0ef2 464 // Has 16 sectors * 4 blocks/sector * 16 bytes/block = 1024 bytes.
sheralikhan 0:f7bdb80c0ef2 465 no_of_sectors = 16;
sheralikhan 0:f7bdb80c0ef2 466 break;
sheralikhan 0:f7bdb80c0ef2 467
sheralikhan 0:f7bdb80c0ef2 468 case MFRC522::PICC_TYPE_MIFARE_4K:
sheralikhan 0:f7bdb80c0ef2 469 // Has (32 sectors * 4 blocks/sector + 8 sectors * 16 blocks/sector) * 16 bytes/block = 4096 bytes.
sheralikhan 0:f7bdb80c0ef2 470 no_of_sectors = 40;
sheralikhan 0:f7bdb80c0ef2 471 break;
sheralikhan 0:f7bdb80c0ef2 472
sheralikhan 0:f7bdb80c0ef2 473 default:
sheralikhan 0:f7bdb80c0ef2 474 // Should not happen. Ignore.
sheralikhan 0:f7bdb80c0ef2 475 break;
sheralikhan 0:f7bdb80c0ef2 476 }
sheralikhan 0:f7bdb80c0ef2 477
sheralikhan 0:f7bdb80c0ef2 478 // Dump sectors, highest address first.
sheralikhan 0:f7bdb80c0ef2 479 if (no_of_sectors) {
sheralikhan 0:f7bdb80c0ef2 480 printf("Sector Block 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 AccessBits \n\r");
sheralikhan 0:f7bdb80c0ef2 481 printf("----------------------------------------------------------------------------------------- \n\r");
sheralikhan 0:f7bdb80c0ef2 482 for (int8_t i = no_of_sectors-1 ; i>= 0; i--) {
sheralikhan 0:f7bdb80c0ef2 483
sheralikhan 0:f7bdb80c0ef2 484 DumpMifareClassicSectorToSerial(uid, key, i);
sheralikhan 0:f7bdb80c0ef2 485
sheralikhan 0:f7bdb80c0ef2 486
sheralikhan 0:f7bdb80c0ef2 487 }
sheralikhan 0:f7bdb80c0ef2 488 }
sheralikhan 0:f7bdb80c0ef2 489
sheralikhan 0:f7bdb80c0ef2 490 RfChip.PICC_HaltA(); // Halt the PICC before stopping the encrypted session.
sheralikhan 0:f7bdb80c0ef2 491 RfChip.PCD_StopCrypto1();
sheralikhan 0:f7bdb80c0ef2 492 } // End PICC_DumpMifareClassicToSerial()
sheralikhan 0:f7bdb80c0ef2 493
sheralikhan 0:f7bdb80c0ef2 494 /**
sheralikhan 0:f7bdb80c0ef2 495 * Dumps memory contents of a sector of a MIFARE Classic PICC.
sheralikhan 0:f7bdb80c0ef2 496 * Uses PCD_Authenticate(), MIFARE_Read() and PCD_StopCrypto1.
sheralikhan 0:f7bdb80c0ef2 497 * Always uses PICC_CMD_MF_AUTH_KEY_A because only Key A can always read the sector trailer access bits.
sheralikhan 0:f7bdb80c0ef2 498 */
sheralikhan 0:f7bdb80c0ef2 499 void DumpMifareClassicSectorToSerial(MFRC522::Uid *uid, MFRC522::MIFARE_Key *key, uint8_t sector)
sheralikhan 0:f7bdb80c0ef2 500 {
sheralikhan 0:f7bdb80c0ef2 501 uint8_t status;
sheralikhan 0:f7bdb80c0ef2 502 uint8_t firstBlock; // Address of lowest address to dump actually last block dumped)
sheralikhan 0:f7bdb80c0ef2 503 uint8_t no_of_blocks; // Number of blocks in sector
sheralikhan 0:f7bdb80c0ef2 504 bool isSectorTrailer; // Set to true while handling the "last" (ie highest address) in the sector.
sheralikhan 0:f7bdb80c0ef2 505
sheralikhan 0:f7bdb80c0ef2 506 // The access bits are stored in a peculiar fashion.
sheralikhan 0:f7bdb80c0ef2 507 // There are four groups:
sheralikhan 0:f7bdb80c0ef2 508 // g[3] Access bits for the sector trailer, block 3 (for sectors 0-31) or block 15 (for sectors 32-39)
sheralikhan 0:f7bdb80c0ef2 509 // g[2] Access bits for block 2 (for sectors 0-31) or blocks 10-14 (for sectors 32-39)
sheralikhan 0:f7bdb80c0ef2 510 // g[1] Access bits for block 1 (for sectors 0-31) or blocks 5-9 (for sectors 32-39)
sheralikhan 0:f7bdb80c0ef2 511 // g[0] Access bits for block 0 (for sectors 0-31) or blocks 0-4 (for sectors 32-39)
sheralikhan 0:f7bdb80c0ef2 512 // Each group has access bits [C1 C2 C3]. In this code C1 is MSB and C3 is LSB.
sheralikhan 0:f7bdb80c0ef2 513 // The four CX bits are stored together in a nible cx and an inverted nible cx_.
sheralikhan 0:f7bdb80c0ef2 514 uint8_t c1, c2, c3; // Nibbles
sheralikhan 0:f7bdb80c0ef2 515 uint8_t c1_, c2_, c3_; // Inverted nibbles
sheralikhan 0:f7bdb80c0ef2 516 bool invertedError = false; // True if one of the inverted nibbles did not match
sheralikhan 0:f7bdb80c0ef2 517 uint8_t g[4]; // Access bits for each of the four groups.
sheralikhan 0:f7bdb80c0ef2 518 uint8_t group; // 0-3 - active group for access bits
sheralikhan 0:f7bdb80c0ef2 519 bool firstInGroup; // True for the first block dumped in the group
sheralikhan 0:f7bdb80c0ef2 520
sheralikhan 0:f7bdb80c0ef2 521 // Determine position and size of sector.
sheralikhan 0:f7bdb80c0ef2 522 if (sector < 32) {
sheralikhan 0:f7bdb80c0ef2 523 // Sectors 0..31 has 4 blocks each
sheralikhan 0:f7bdb80c0ef2 524 no_of_blocks = 4;
sheralikhan 0:f7bdb80c0ef2 525 firstBlock = sector * no_of_blocks;
sheralikhan 0:f7bdb80c0ef2 526 } else if (sector < 40) {
sheralikhan 0:f7bdb80c0ef2 527 // Sectors 32-39 has 16 blocks each
sheralikhan 0:f7bdb80c0ef2 528 no_of_blocks = 16;
sheralikhan 0:f7bdb80c0ef2 529 firstBlock = 128 + (sector - 32) * no_of_blocks;
sheralikhan 0:f7bdb80c0ef2 530 } else {
sheralikhan 0:f7bdb80c0ef2 531 // Illegal input, no MIFARE Classic PICC has more than 40 sectors.
sheralikhan 0:f7bdb80c0ef2 532 return;
sheralikhan 0:f7bdb80c0ef2 533 }
sheralikhan 0:f7bdb80c0ef2 534
sheralikhan 0:f7bdb80c0ef2 535 // Dump blocks, highest address first.
sheralikhan 0:f7bdb80c0ef2 536 uint8_t byteCount;
sheralikhan 0:f7bdb80c0ef2 537 uint8_t buffer[18];
sheralikhan 0:f7bdb80c0ef2 538 uint8_t blockAddr;
sheralikhan 0:f7bdb80c0ef2 539 isSectorTrailer = true;
sheralikhan 0:f7bdb80c0ef2 540 for (int8_t blockOffset = no_of_blocks - 1; blockOffset >= 0; blockOffset--) {
sheralikhan 0:f7bdb80c0ef2 541 blockAddr = firstBlock + blockOffset;
sheralikhan 0:f7bdb80c0ef2 542
sheralikhan 0:f7bdb80c0ef2 543 // Sector number - only on first line
sheralikhan 0:f7bdb80c0ef2 544 if (isSectorTrailer) {
sheralikhan 0:f7bdb80c0ef2 545 printf(" %2d ", sector);
sheralikhan 0:f7bdb80c0ef2 546 } else {
sheralikhan 0:f7bdb80c0ef2 547 printf(" ");
sheralikhan 0:f7bdb80c0ef2 548 }
sheralikhan 0:f7bdb80c0ef2 549
sheralikhan 0:f7bdb80c0ef2 550 // Block number
sheralikhan 0:f7bdb80c0ef2 551 printf(" %3d ", blockAddr);
sheralikhan 0:f7bdb80c0ef2 552
sheralikhan 0:f7bdb80c0ef2 553 // Establish encrypted communications before reading the first block
sheralikhan 0:f7bdb80c0ef2 554 if (isSectorTrailer) {
sheralikhan 0:f7bdb80c0ef2 555 status = RfChip.PCD_Authenticate(MFRC522::PICC_CMD_MF_AUTH_KEY_A, firstBlock, key, uid);
sheralikhan 0:f7bdb80c0ef2 556 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 557 printf("PCD_Authenticate() failed: %s \r\n", RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 558 return;
sheralikhan 0:f7bdb80c0ef2 559 }
sheralikhan 0:f7bdb80c0ef2 560 }
sheralikhan 0:f7bdb80c0ef2 561
sheralikhan 0:f7bdb80c0ef2 562 // Read block
sheralikhan 0:f7bdb80c0ef2 563 byteCount = sizeof(buffer);
sheralikhan 0:f7bdb80c0ef2 564 status = RfChip.MIFARE_Read(blockAddr, buffer, &byteCount);
sheralikhan 0:f7bdb80c0ef2 565 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 566 printf("MIFARE_Read() failed: %s \r\n", RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 567 continue;
sheralikhan 0:f7bdb80c0ef2 568 }
sheralikhan 0:f7bdb80c0ef2 569
sheralikhan 0:f7bdb80c0ef2 570 // Dump data
sheralikhan 0:f7bdb80c0ef2 571 for (uint8_t index = 0; index < 16; index++) {
sheralikhan 0:f7bdb80c0ef2 572 printf(" %3d", buffer[index]);
sheralikhan 0:f7bdb80c0ef2 573 // if ((index % 4) == 3)
sheralikhan 0:f7bdb80c0ef2 574 // {
sheralikhan 0:f7bdb80c0ef2 575 // printf(" ");
sheralikhan 0:f7bdb80c0ef2 576 // }
sheralikhan 0:f7bdb80c0ef2 577 }
sheralikhan 0:f7bdb80c0ef2 578
sheralikhan 0:f7bdb80c0ef2 579 // Parse sector trailer data
sheralikhan 0:f7bdb80c0ef2 580 if (isSectorTrailer) {
sheralikhan 0:f7bdb80c0ef2 581 c1 = buffer[7] >> 4;
sheralikhan 0:f7bdb80c0ef2 582 c2 = buffer[8] & 0xF;
sheralikhan 0:f7bdb80c0ef2 583 c3 = buffer[8] >> 4;
sheralikhan 0:f7bdb80c0ef2 584 c1_ = buffer[6] & 0xF;
sheralikhan 0:f7bdb80c0ef2 585 c2_ = buffer[6] >> 4;
sheralikhan 0:f7bdb80c0ef2 586 c3_ = buffer[7] & 0xF;
sheralikhan 0:f7bdb80c0ef2 587 invertedError = (c1 != (~c1_ & 0xF)) || (c2 != (~c2_ & 0xF)) || (c3 != (~c3_ & 0xF));
sheralikhan 0:f7bdb80c0ef2 588
sheralikhan 0:f7bdb80c0ef2 589 g[0] = ((c1 & 1) << 2) | ((c2 & 1) << 1) | ((c3 & 1) << 0);
sheralikhan 0:f7bdb80c0ef2 590 g[1] = ((c1 & 2) << 1) | ((c2 & 2) << 0) | ((c3 & 2) >> 1);
sheralikhan 0:f7bdb80c0ef2 591 g[2] = ((c1 & 4) << 0) | ((c2 & 4) >> 1) | ((c3 & 4) >> 2);
sheralikhan 0:f7bdb80c0ef2 592 g[3] = ((c1 & 8) >> 1) | ((c2 & 8) >> 2) | ((c3 & 8) >> 3);
sheralikhan 0:f7bdb80c0ef2 593 isSectorTrailer = false;
sheralikhan 0:f7bdb80c0ef2 594 }
sheralikhan 0:f7bdb80c0ef2 595
sheralikhan 0:f7bdb80c0ef2 596 // Which access group is this block in?
sheralikhan 0:f7bdb80c0ef2 597 if (no_of_blocks == 4) {
sheralikhan 0:f7bdb80c0ef2 598 group = blockOffset;
sheralikhan 0:f7bdb80c0ef2 599 firstInGroup = true;
sheralikhan 0:f7bdb80c0ef2 600 } else {
sheralikhan 0:f7bdb80c0ef2 601 group = blockOffset / 5;
sheralikhan 0:f7bdb80c0ef2 602 firstInGroup = (group == 3) || (group != (blockOffset + 1) / 5);
sheralikhan 0:f7bdb80c0ef2 603 }
sheralikhan 0:f7bdb80c0ef2 604
sheralikhan 0:f7bdb80c0ef2 605 if (firstInGroup) {
sheralikhan 0:f7bdb80c0ef2 606 // Print access bits
sheralikhan 0:f7bdb80c0ef2 607 printf(" [ %d %d %d ] ", (g[group] >> 2) & 1, (g[group] >> 1) & 1, (g[group] >> 0) & 1);
sheralikhan 0:f7bdb80c0ef2 608 if (invertedError) {
sheralikhan 0:f7bdb80c0ef2 609 printf(" Inverted access bits did not match! ");
sheralikhan 0:f7bdb80c0ef2 610 }
sheralikhan 0:f7bdb80c0ef2 611 }
sheralikhan 0:f7bdb80c0ef2 612
sheralikhan 0:f7bdb80c0ef2 613 if (group != 3 && (g[group] == 1 || g[group] == 6)) {
sheralikhan 0:f7bdb80c0ef2 614 // Not a sector trailer, a value block
sheralikhan 0:f7bdb80c0ef2 615 printf(" Addr = 0x%02X, Value = 0x%02X%02X%02X%02X", buffer[12],
sheralikhan 0:f7bdb80c0ef2 616 buffer[3],
sheralikhan 0:f7bdb80c0ef2 617 buffer[2],
sheralikhan 0:f7bdb80c0ef2 618 buffer[1],
sheralikhan 0:f7bdb80c0ef2 619 buffer[0]);
sheralikhan 0:f7bdb80c0ef2 620 }
sheralikhan 0:f7bdb80c0ef2 621
sheralikhan 0:f7bdb80c0ef2 622 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 623 }
sheralikhan 0:f7bdb80c0ef2 624
sheralikhan 0:f7bdb80c0ef2 625 return;
sheralikhan 0:f7bdb80c0ef2 626 } // End PICC_DumpMifareClassicSectorToSerial()
sheralikhan 0:f7bdb80c0ef2 627
sheralikhan 0:f7bdb80c0ef2 628 /**
sheralikhan 0:f7bdb80c0ef2 629 * Dumps memory contents of a MIFARE Ultralight PICC.
sheralikhan 0:f7bdb80c0ef2 630 */
sheralikhan 0:f7bdb80c0ef2 631 void DumpMifareUltralightToSerial(void)
sheralikhan 0:f7bdb80c0ef2 632 {
sheralikhan 0:f7bdb80c0ef2 633 uint8_t status;
sheralikhan 0:f7bdb80c0ef2 634 uint8_t byteCount;
sheralikhan 0:f7bdb80c0ef2 635 uint8_t buffer[18];
sheralikhan 0:f7bdb80c0ef2 636 uint8_t i;
sheralikhan 0:f7bdb80c0ef2 637
sheralikhan 0:f7bdb80c0ef2 638 printf("Page 0 1 2 3");
sheralikhan 0:f7bdb80c0ef2 639 // Try the mpages of the original Ultralight. Ultralight C has more pages.
sheralikhan 0:f7bdb80c0ef2 640 for (uint8_t page = 0; page < 16; page +=4) {
sheralikhan 0:f7bdb80c0ef2 641 // Read pages
sheralikhan 0:f7bdb80c0ef2 642 byteCount = sizeof(buffer);
sheralikhan 0:f7bdb80c0ef2 643 status = RfChip.MIFARE_Read(page, buffer, &byteCount);
sheralikhan 0:f7bdb80c0ef2 644 if (status != MFRC522::STATUS_OK) {
sheralikhan 0:f7bdb80c0ef2 645 printf("MIFARE_Read() failed: %s \n\r", RfChip.GetStatusCodeName(status));
sheralikhan 0:f7bdb80c0ef2 646 break;
sheralikhan 0:f7bdb80c0ef2 647 }
sheralikhan 0:f7bdb80c0ef2 648
sheralikhan 0:f7bdb80c0ef2 649 // Dump data
sheralikhan 0:f7bdb80c0ef2 650 for (uint8_t offset = 0; offset < 4; offset++) {
sheralikhan 0:f7bdb80c0ef2 651 i = page + offset;
sheralikhan 0:f7bdb80c0ef2 652 printf(" %2d ", i); // Pad with spaces
sheralikhan 0:f7bdb80c0ef2 653 for (uint8_t index = 0; index < 4; index++) {
sheralikhan 0:f7bdb80c0ef2 654 i = 4 * offset + index;
sheralikhan 0:f7bdb80c0ef2 655 printf(" %02X ", buffer[i]);
sheralikhan 0:f7bdb80c0ef2 656 }
sheralikhan 0:f7bdb80c0ef2 657
sheralikhan 0:f7bdb80c0ef2 658 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 659 }
sheralikhan 0:f7bdb80c0ef2 660 }
sheralikhan 0:f7bdb80c0ef2 661 } // End PICC_DumpMifareUltralightToSerial()
sheralikhan 0:f7bdb80c0ef2 662
sheralikhan 0:f7bdb80c0ef2 663 int main()
sheralikhan 0:f7bdb80c0ef2 664 {
sheralikhan 0:f7bdb80c0ef2 665 /* Set debug UART speed */
sheralikhan 0:f7bdb80c0ef2 666 printf("\n\rUART 9600 baud\n\r");
sheralikhan 0:f7bdb80c0ef2 667 pc.baud(9600);
sheralikhan 0:f7bdb80c0ef2 668 printf("\n\r%s %s\n\r",VERSION,CIBLE);
sheralikhan 0:f7bdb80c0ef2 669
sheralikhan 0:f7bdb80c0ef2 670 /* Init. RC522 Chip */
sheralikhan 0:f7bdb80c0ef2 671 RfChip.PCD_Init();
sheralikhan 0:f7bdb80c0ef2 672
sheralikhan 0:f7bdb80c0ef2 673 /* Read RC522 version */
sheralikhan 0:f7bdb80c0ef2 674 uint8_t temp = RfChip.PCD_ReadRegister(MFRC522::VersionReg);
sheralikhan 0:f7bdb80c0ef2 675 printf("MFRC522 version: %d\n\r", temp & 0x07);
sheralikhan 0:f7bdb80c0ef2 676 printf("\n\r");
sheralikhan 0:f7bdb80c0ef2 677
sheralikhan 0:f7bdb80c0ef2 678 while(1) {
sheralikhan 0:f7bdb80c0ef2 679
sheralikhan 0:f7bdb80c0ef2 680 LedGreen = 1;
sheralikhan 0:f7bdb80c0ef2 681
sheralikhan 0:f7bdb80c0ef2 682 // Look for new cards
sheralikhan 0:f7bdb80c0ef2 683 if ( ! RfChip.PICC_IsNewCardPresent()) {
sheralikhan 0:f7bdb80c0ef2 684 wait_ms(500);
sheralikhan 0:f7bdb80c0ef2 685 continue;
sheralikhan 0:f7bdb80c0ef2 686 }
sheralikhan 0:f7bdb80c0ef2 687
sheralikhan 0:f7bdb80c0ef2 688 LedRed = 0;
sheralikhan 0:f7bdb80c0ef2 689
sheralikhan 0:f7bdb80c0ef2 690 // Select one of the cards
sheralikhan 0:f7bdb80c0ef2 691 if ( ! RfChip.PICC_ReadCardSerial()) {
sheralikhan 0:f7bdb80c0ef2 692 wait_ms(500);
sheralikhan 0:f7bdb80c0ef2 693 continue;
sheralikhan 0:f7bdb80c0ef2 694 }
sheralikhan 0:f7bdb80c0ef2 695
sheralikhan 0:f7bdb80c0ef2 696 LedGreen = 0;
sheralikhan 0:f7bdb80c0ef2 697
sheralikhan 0:f7bdb80c0ef2 698 //Write name to RFID tags
sheralikhan 0:f7bdb80c0ef2 699 WriteToRfidTag(&(RfChip.uid));
sheralikhan 0:f7bdb80c0ef2 700 wait_ms(200);
sheralikhan 0:f7bdb80c0ef2 701
sheralikhan 0:f7bdb80c0ef2 702 }
sheralikhan 0:f7bdb80c0ef2 703 }