Merge pull request #107 from p-l-/fix-hfmf
[legacy-proxmark3.git] / client / cmdhfmf.c
blob2b5a5b87965dd7b36e283e9f94fe876f2e740dc7
1 //-----------------------------------------------------------------------------
2 // Copyright (C) 2011,2012 Merlok
3 //
4 // This code is licensed to you under the terms of the GNU GPL, version 2 or,
5 // at your option, any later version. See the LICENSE.txt file for the text of
6 // the license.
7 //-----------------------------------------------------------------------------
8 // High frequency MIFARE commands
9 //-----------------------------------------------------------------------------
11 #include "cmdhfmf.h"
13 static int CmdHelp(const char *Cmd);
15 int CmdHF14AMifare(const char *Cmd)
17 uint32_t uid = 0;
18 uint32_t nt = 0, nr = 0;
19 uint64_t par_list = 0, ks_list = 0, r_key = 0;
20 uint8_t isOK = 0;
21 uint8_t keyBlock[8] = {0};
23 UsbCommand c = {CMD_READER_MIFARE, {true, 0, 0}};
25 // message
26 printf("-------------------------------------------------------------------------\n");
27 printf("Executing command. Expected execution time: 25sec on average :-)\n");
28 printf("Press the key on the proxmark3 device to abort both proxmark3 and client.\n");
29 printf("-------------------------------------------------------------------------\n");
32 start:
33 clearCommandBuffer();
34 SendCommand(&c);
36 //flush queue
37 while (ukbhit()) getchar();
39 // wait cycle
40 while (true) {
41 printf(".");
42 fflush(stdout);
43 if (ukbhit()) {
44 getchar();
45 printf("\naborted via keyboard!\n");
46 break;
49 UsbCommand resp;
50 if (WaitForResponseTimeout(CMD_ACK,&resp,1000)) {
51 isOK = resp.arg[0] & 0xff;
52 uid = (uint32_t)bytes_to_num(resp.d.asBytes + 0, 4);
53 nt = (uint32_t)bytes_to_num(resp.d.asBytes + 4, 4);
54 par_list = bytes_to_num(resp.d.asBytes + 8, 8);
55 ks_list = bytes_to_num(resp.d.asBytes + 16, 8);
56 nr = bytes_to_num(resp.d.asBytes + 24, 4);
57 printf("\n\n");
58 if (!isOK) PrintAndLog("Proxmark can't get statistic info. Execution aborted.\n");
59 break;
63 printf("\n");
65 // error
66 if (isOK != 1) return 1;
68 // execute original function from util nonce2key
69 if (nonce2key(uid, nt, nr, par_list, ks_list, &r_key)) {
70 isOK = 2;
71 PrintAndLog("Key not found (lfsr_common_prefix list is null). Nt=%08x", nt);
72 } else {
73 printf("------------------------------------------------------------------\n");
74 PrintAndLog("Key found:%012"llx" \n", r_key);
76 num_to_bytes(r_key, 6, keyBlock);
77 isOK = mfCheckKeys(0, 0, 1, keyBlock, &r_key);
80 if (!isOK)
81 PrintAndLog("Found valid key:%012"llx, r_key);
82 else
84 if (isOK != 2) PrintAndLog("Found invalid key. ");
85 PrintAndLog("Failing is expected to happen in 25%% of all cases. Trying again with a different reader nonce...");
86 c.arg[0] = false;
87 goto start;
90 PrintAndLog("");
91 return 0;
94 int CmdHF14AMfWrBl(const char *Cmd)
96 uint8_t blockNo = 0;
97 uint8_t keyType = 0;
98 uint8_t key[6] = {0, 0, 0, 0, 0, 0};
99 uint8_t bldata[16] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
101 char cmdp = 0x00;
103 if (strlen(Cmd)<3) {
104 PrintAndLog("Usage: hf mf wrbl <block number> <key A/B> <key (12 hex symbols)> <block data (32 hex symbols)>");
105 PrintAndLog(" sample: hf mf wrbl 0 A FFFFFFFFFFFF 000102030405060708090A0B0C0D0E0F");
106 return 0;
109 blockNo = param_get8(Cmd, 0);
110 cmdp = param_getchar(Cmd, 1);
111 if (cmdp == 0x00) {
112 PrintAndLog("Key type must be A or B");
113 return 1;
115 if (cmdp != 'A' && cmdp != 'a') keyType = 1;
116 if (param_gethex(Cmd, 2, key, 12)) {
117 PrintAndLog("Key must include 12 HEX symbols");
118 return 1;
120 if (param_gethex(Cmd, 3, bldata, 32)) {
121 PrintAndLog("Block data must include 32 HEX symbols");
122 return 1;
124 PrintAndLog("--block no:%d, key type:%c, key:%s", blockNo, keyType?'B':'A', sprint_hex(key, 6));
125 PrintAndLog("--data: %s", sprint_hex(bldata, 16));
127 UsbCommand c = {CMD_MIFARE_WRITEBL, {blockNo, keyType, 0}};
128 memcpy(c.d.asBytes, key, 6);
129 memcpy(c.d.asBytes + 10, bldata, 16);
130 SendCommand(&c);
132 UsbCommand resp;
133 if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
134 uint8_t isOK = resp.arg[0] & 0xff;
135 PrintAndLog("isOk:%02x", isOK);
136 } else {
137 PrintAndLog("Command execute timeout");
140 return 0;
143 int CmdHF14AMfRdBl(const char *Cmd)
145 uint8_t blockNo = 0;
146 uint8_t keyType = 0;
147 uint8_t key[6] = {0, 0, 0, 0, 0, 0};
149 char cmdp = 0x00;
152 if (strlen(Cmd)<3) {
153 PrintAndLog("Usage: hf mf rdbl <block number> <key A/B> <key (12 hex symbols)>");
154 PrintAndLog(" sample: hf mf rdbl 0 A FFFFFFFFFFFF ");
155 return 0;
158 blockNo = param_get8(Cmd, 0);
159 cmdp = param_getchar(Cmd, 1);
160 if (cmdp == 0x00) {
161 PrintAndLog("Key type must be A or B");
162 return 1;
164 if (cmdp != 'A' && cmdp != 'a') keyType = 1;
165 if (param_gethex(Cmd, 2, key, 12)) {
166 PrintAndLog("Key must include 12 HEX symbols");
167 return 1;
169 PrintAndLog("--block no:%d, key type:%c, key:%s ", blockNo, keyType?'B':'A', sprint_hex(key, 6));
171 UsbCommand c = {CMD_MIFARE_READBL, {blockNo, keyType, 0}};
172 memcpy(c.d.asBytes, key, 6);
173 SendCommand(&c);
175 UsbCommand resp;
176 if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
177 uint8_t isOK = resp.arg[0] & 0xff;
178 uint8_t *data = resp.d.asBytes;
180 if (isOK)
181 PrintAndLog("isOk:%02x data:%s", isOK, sprint_hex(data, 16));
182 else
183 PrintAndLog("isOk:%02x", isOK);
184 } else {
185 PrintAndLog("Command execute timeout");
188 return 0;
191 int CmdHF14AMfRdSc(const char *Cmd)
193 int i;
194 uint8_t sectorNo = 0;
195 uint8_t keyType = 0;
196 uint8_t key[6] = {0, 0, 0, 0, 0, 0};
197 uint8_t isOK = 0;
198 uint8_t *data = NULL;
199 char cmdp = 0x00;
201 if (strlen(Cmd)<3) {
202 PrintAndLog("Usage: hf mf rdsc <sector number> <key A/B> <key (12 hex symbols)>");
203 PrintAndLog(" sample: hf mf rdsc 0 A FFFFFFFFFFFF ");
204 return 0;
207 sectorNo = param_get8(Cmd, 0);
208 if (sectorNo > 39) {
209 PrintAndLog("Sector number must be less than 40");
210 return 1;
212 cmdp = param_getchar(Cmd, 1);
213 if (cmdp != 'a' && cmdp != 'A' && cmdp != 'b' && cmdp != 'B') {
214 PrintAndLog("Key type must be A or B");
215 return 1;
217 if (cmdp != 'A' && cmdp != 'a') keyType = 1;
218 if (param_gethex(Cmd, 2, key, 12)) {
219 PrintAndLog("Key must include 12 HEX symbols");
220 return 1;
222 PrintAndLog("--sector no:%d key type:%c key:%s ", sectorNo, keyType?'B':'A', sprint_hex(key, 6));
224 UsbCommand c = {CMD_MIFARE_READSC, {sectorNo, keyType, 0}};
225 memcpy(c.d.asBytes, key, 6);
226 SendCommand(&c);
227 PrintAndLog(" ");
229 UsbCommand resp;
230 if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
231 isOK = resp.arg[0] & 0xff;
232 data = resp.d.asBytes;
234 PrintAndLog("isOk:%02x", isOK);
235 if (isOK) {
236 for (i = 0; i < (sectorNo<32?3:15); i++) {
237 PrintAndLog("data : %s", sprint_hex(data + i * 16, 16));
239 PrintAndLog("trailer: %s", sprint_hex(data + (sectorNo<32?3:15) * 16, 16));
241 } else {
242 PrintAndLog("Command execute timeout");
245 return 0;
248 uint8_t FirstBlockOfSector(uint8_t sectorNo)
250 if (sectorNo < 32) {
251 return sectorNo * 4;
252 } else {
253 return 32 * 4 + (sectorNo - 32) * 16;
257 uint8_t NumBlocksPerSector(uint8_t sectorNo)
259 if (sectorNo < 32) {
260 return 4;
261 } else {
262 return 16;
266 int CmdHF14AMfDump(const char *Cmd)
268 uint8_t sectorNo, blockNo;
270 uint8_t keyA[40][6];
271 uint8_t keyB[40][6];
272 uint8_t rights[40][4];
273 uint8_t carddata[256][16];
274 uint8_t numSectors = 16;
276 FILE *fin;
277 FILE *fout;
279 UsbCommand resp;
281 char cmdp = param_getchar(Cmd, 0);
282 switch (cmdp) {
283 case '0' : numSectors = 5; break;
284 case '1' :
285 case '\0': numSectors = 16; break;
286 case '2' : numSectors = 32; break;
287 case '4' : numSectors = 40; break;
288 default: numSectors = 16;
291 if (strlen(Cmd) > 1 || cmdp == 'h' || cmdp == 'H') {
292 PrintAndLog("Usage: hf mf dump [card memory]");
293 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
294 PrintAndLog("");
295 PrintAndLog("Samples: hf mf dump");
296 PrintAndLog(" hf mf dump 4");
297 return 0;
300 if ((fin = fopen("dumpkeys.bin","rb")) == NULL) {
301 PrintAndLog("Could not find file dumpkeys.bin");
302 return 1;
305 // Read keys A from file
306 for (sectorNo=0; sectorNo<numSectors; sectorNo++) {
307 if (fread( keyA[sectorNo], 1, 6, fin ) == 0) {
308 PrintAndLog("File reading error.");
309 fclose(fin);
310 return 2;
314 // Read keys B from file
315 for (sectorNo=0; sectorNo<numSectors; sectorNo++) {
316 if (fread( keyB[sectorNo], 1, 6, fin ) == 0) {
317 PrintAndLog("File reading error.");
318 fclose(fin);
319 return 2;
323 fclose(fin);
325 PrintAndLog("|-----------------------------------------|");
326 PrintAndLog("|------ Reading sector access bits...-----|");
327 PrintAndLog("|-----------------------------------------|");
329 for (sectorNo = 0; sectorNo < numSectors; sectorNo++) {
330 UsbCommand c = {CMD_MIFARE_READBL, {FirstBlockOfSector(sectorNo) + NumBlocksPerSector(sectorNo) - 1, 0, 0}};
331 memcpy(c.d.asBytes, keyA[sectorNo], 6);
332 SendCommand(&c);
334 if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
335 uint8_t isOK = resp.arg[0] & 0xff;
336 uint8_t *data = resp.d.asBytes;
337 if (isOK){
338 rights[sectorNo][0] = ((data[7] & 0x10)>>2) | ((data[8] & 0x1)<<1) | ((data[8] & 0x10)>>4); // C1C2C3 for data area 0
339 rights[sectorNo][1] = ((data[7] & 0x20)>>3) | ((data[8] & 0x2)<<0) | ((data[8] & 0x20)>>5); // C1C2C3 for data area 1
340 rights[sectorNo][2] = ((data[7] & 0x40)>>4) | ((data[8] & 0x4)>>1) | ((data[8] & 0x40)>>6); // C1C2C3 for data area 2
341 rights[sectorNo][3] = ((data[7] & 0x80)>>5) | ((data[8] & 0x8)>>2) | ((data[8] & 0x80)>>7); // C1C2C3 for sector trailer
342 } else {
343 PrintAndLog("Could not get access rights for sector %2d. Trying with defaults...", sectorNo);
344 rights[sectorNo][0] = rights[sectorNo][1] = rights[sectorNo][2] = 0x00;
345 rights[sectorNo][3] = 0x01;
347 } else {
348 PrintAndLog("Command execute timeout when trying to read access rights for sector %2d. Trying with defaults...", sectorNo);
349 rights[sectorNo][0] = rights[sectorNo][1] = rights[sectorNo][2] = 0x00;
350 rights[sectorNo][3] = 0x01;
354 PrintAndLog("|-----------------------------------------|");
355 PrintAndLog("|----- Dumping all blocks to file... -----|");
356 PrintAndLog("|-----------------------------------------|");
358 bool isOK = true;
359 for (sectorNo = 0; isOK && sectorNo < numSectors; sectorNo++) {
360 for (blockNo = 0; isOK && blockNo < NumBlocksPerSector(sectorNo); blockNo++) {
361 bool received = false;
363 if (blockNo == NumBlocksPerSector(sectorNo) - 1) { // sector trailer. At least the Access Conditions can always be read with key A.
364 UsbCommand c = {CMD_MIFARE_READBL, {FirstBlockOfSector(sectorNo) + blockNo, 0, 0}};
365 memcpy(c.d.asBytes, keyA[sectorNo], 6);
366 SendCommand(&c);
367 received = WaitForResponseTimeout(CMD_ACK,&resp,1500);
368 } else { // data block. Check if it can be read with key A or key B
369 uint8_t data_area = sectorNo<32?blockNo:blockNo/5;
370 if ((rights[sectorNo][data_area] == 0x03) || (rights[sectorNo][data_area] == 0x05)) { // only key B would work
371 UsbCommand c = {CMD_MIFARE_READBL, {FirstBlockOfSector(sectorNo) + blockNo, 1, 0}};
372 memcpy(c.d.asBytes, keyB[sectorNo], 6);
373 SendCommand(&c);
374 received = WaitForResponseTimeout(CMD_ACK,&resp,1500);
375 } else if (rights[sectorNo][data_area] == 0x07) { // no key would work
376 isOK = false;
377 PrintAndLog("Access rights do not allow reading of sector %2d block %3d", sectorNo, blockNo);
378 } else { // key A would work
379 UsbCommand c = {CMD_MIFARE_READBL, {FirstBlockOfSector(sectorNo) + blockNo, 0, 0}};
380 memcpy(c.d.asBytes, keyA[sectorNo], 6);
381 SendCommand(&c);
382 received = WaitForResponseTimeout(CMD_ACK,&resp,1500);
386 if (received) {
387 isOK = resp.arg[0] & 0xff;
388 uint8_t *data = resp.d.asBytes;
389 if (blockNo == NumBlocksPerSector(sectorNo) - 1) { // sector trailer. Fill in the keys.
390 data[0] = (keyA[sectorNo][0]);
391 data[1] = (keyA[sectorNo][1]);
392 data[2] = (keyA[sectorNo][2]);
393 data[3] = (keyA[sectorNo][3]);
394 data[4] = (keyA[sectorNo][4]);
395 data[5] = (keyA[sectorNo][5]);
396 data[10] = (keyB[sectorNo][0]);
397 data[11] = (keyB[sectorNo][1]);
398 data[12] = (keyB[sectorNo][2]);
399 data[13] = (keyB[sectorNo][3]);
400 data[14] = (keyB[sectorNo][4]);
401 data[15] = (keyB[sectorNo][5]);
403 if (isOK) {
404 memcpy(carddata[FirstBlockOfSector(sectorNo) + blockNo], data, 16);
405 PrintAndLog("Successfully read block %2d of sector %2d.", blockNo, sectorNo);
406 } else {
407 PrintAndLog("Could not read block %2d of sector %2d", blockNo, sectorNo);
408 break;
411 else {
412 isOK = false;
413 PrintAndLog("Command execute timeout when trying to read block %2d of sector %2d.", blockNo, sectorNo);
414 break;
419 if (isOK) {
420 if ((fout = fopen("dumpdata.bin","wb")) == NULL) {
421 PrintAndLog("Could not create file name dumpdata.bin");
422 return 1;
424 uint16_t numblocks = FirstBlockOfSector(numSectors - 1) + NumBlocksPerSector(numSectors - 1);
425 fwrite(carddata, 1, 16*numblocks, fout);
426 fclose(fout);
427 PrintAndLog("Dumped %d blocks (%d bytes) to file dumpdata.bin", numblocks, 16*numblocks);
430 return 0;
433 int CmdHF14AMfRestore(const char *Cmd)
435 uint8_t sectorNo,blockNo;
436 uint8_t keyType = 0;
437 uint8_t key[6] = {0xFF,0xFF,0xFF,0xFF,0xFF,0xFF};
438 uint8_t bldata[16] = {0x00};
439 uint8_t keyA[40][6];
440 uint8_t keyB[40][6];
441 uint8_t numSectors;
443 FILE *fdump;
444 FILE *fkeys;
446 char cmdp = param_getchar(Cmd, 0);
447 switch (cmdp) {
448 case '0' : numSectors = 5; break;
449 case '1' :
450 case '\0': numSectors = 16; break;
451 case '2' : numSectors = 32; break;
452 case '4' : numSectors = 40; break;
453 default: numSectors = 16;
456 if (strlen(Cmd) > 1 || cmdp == 'h' || cmdp == 'H') {
457 PrintAndLog("Usage: hf mf restore [card memory]");
458 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
459 PrintAndLog("");
460 PrintAndLog("Samples: hf mf restore");
461 PrintAndLog(" hf mf restore 4");
462 return 0;
465 if ((fkeys = fopen("dumpkeys.bin","rb")) == NULL) {
466 PrintAndLog("Could not find file dumpkeys.bin");
467 return 1;
470 for (sectorNo = 0; sectorNo < numSectors; sectorNo++) {
471 if (fread(keyA[sectorNo], 1, 6, fkeys) == 0) {
472 PrintAndLog("File reading error (dumpkeys.bin).");
474 fclose(fkeys);
475 return 2;
479 for (sectorNo = 0; sectorNo < numSectors; sectorNo++) {
480 if (fread(keyB[sectorNo], 1, 6, fkeys) == 0) {
481 PrintAndLog("File reading error (dumpkeys.bin).");
482 fclose(fkeys);
483 return 2;
487 fclose(fkeys);
489 if ((fdump = fopen("dumpdata.bin","rb")) == NULL) {
490 PrintAndLog("Could not find file dumpdata.bin");
491 return 1;
493 PrintAndLog("Restoring dumpdata.bin to card");
495 for (sectorNo = 0; sectorNo < numSectors; sectorNo++) {
496 for(blockNo = 0; blockNo < NumBlocksPerSector(sectorNo); blockNo++) {
497 UsbCommand c = {CMD_MIFARE_WRITEBL, {FirstBlockOfSector(sectorNo) + blockNo, keyType, 0}};
498 memcpy(c.d.asBytes, key, 6);
500 if (fread(bldata, 1, 16, fdump) == 0) {
501 PrintAndLog("File reading error (dumpdata.bin).");
502 fclose(fdump);
503 return 2;
506 if (blockNo == NumBlocksPerSector(sectorNo) - 1) { // sector trailer
507 bldata[0] = (keyA[sectorNo][0]);
508 bldata[1] = (keyA[sectorNo][1]);
509 bldata[2] = (keyA[sectorNo][2]);
510 bldata[3] = (keyA[sectorNo][3]);
511 bldata[4] = (keyA[sectorNo][4]);
512 bldata[5] = (keyA[sectorNo][5]);
513 bldata[10] = (keyB[sectorNo][0]);
514 bldata[11] = (keyB[sectorNo][1]);
515 bldata[12] = (keyB[sectorNo][2]);
516 bldata[13] = (keyB[sectorNo][3]);
517 bldata[14] = (keyB[sectorNo][4]);
518 bldata[15] = (keyB[sectorNo][5]);
521 PrintAndLog("Writing to block %3d: %s", FirstBlockOfSector(sectorNo) + blockNo, sprint_hex(bldata, 16));
523 memcpy(c.d.asBytes + 10, bldata, 16);
524 SendCommand(&c);
526 UsbCommand resp;
527 if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
528 uint8_t isOK = resp.arg[0] & 0xff;
529 PrintAndLog("isOk:%02x", isOK);
530 } else {
531 PrintAndLog("Command execute timeout");
536 fclose(fdump);
537 return 0;
540 int CmdHF14AMfNested(const char *Cmd)
542 int i, j, res, iterations;
543 sector *e_sector = NULL;
544 uint8_t blockNo = 0;
545 uint8_t keyType = 0;
546 uint8_t trgBlockNo = 0;
547 uint8_t trgKeyType = 0;
548 uint8_t SectorsCnt = 0;
549 uint8_t key[6] = {0, 0, 0, 0, 0, 0};
550 uint8_t keyBlock[14*6];
551 uint64_t key64 = 0;
552 bool transferToEml = false;
554 bool createDumpFile = false;
555 FILE *fkeys;
556 uint8_t standart[6] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
557 uint8_t tempkey[6] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
559 char cmdp, ctmp;
561 if (strlen(Cmd)<3) {
562 PrintAndLog("Usage:");
563 PrintAndLog(" all sectors: hf mf nested <card memory> <block number> <key A/B> <key (12 hex symbols)> [t,d]");
564 PrintAndLog(" one sector: hf mf nested o <block number> <key A/B> <key (12 hex symbols)>");
565 PrintAndLog(" <target block number> <target key A/B> [t]");
566 PrintAndLog("card memory - 0 - MINI(320 bytes), 1 - 1K, 2 - 2K, 4 - 4K, <other> - 1K");
567 PrintAndLog("t - transfer keys into emulator memory");
568 PrintAndLog("d - write keys to binary file");
569 PrintAndLog(" ");
570 PrintAndLog(" sample1: hf mf nested 1 0 A FFFFFFFFFFFF ");
571 PrintAndLog(" sample2: hf mf nested 1 0 A FFFFFFFFFFFF t ");
572 PrintAndLog(" sample3: hf mf nested 1 0 A FFFFFFFFFFFF d ");
573 PrintAndLog(" sample4: hf mf nested o 0 A FFFFFFFFFFFF 4 A");
574 return 0;
577 cmdp = param_getchar(Cmd, 0);
578 blockNo = param_get8(Cmd, 1);
579 ctmp = param_getchar(Cmd, 2);
581 if (ctmp != 'a' && ctmp != 'A' && ctmp != 'b' && ctmp != 'B') {
582 PrintAndLog("Key type must be A or B");
583 return 1;
586 if (ctmp != 'A' && ctmp != 'a')
587 keyType = 1;
589 if (param_gethex(Cmd, 3, key, 12)) {
590 PrintAndLog("Key must include 12 HEX symbols");
591 return 1;
594 if (cmdp == 'o' || cmdp == 'O') {
595 cmdp = 'o';
596 trgBlockNo = param_get8(Cmd, 4);
597 ctmp = param_getchar(Cmd, 5);
598 if (ctmp != 'a' && ctmp != 'A' && ctmp != 'b' && ctmp != 'B') {
599 PrintAndLog("Target key type must be A or B");
600 return 1;
602 if (ctmp != 'A' && ctmp != 'a')
603 trgKeyType = 1;
604 } else {
606 switch (cmdp) {
607 case '0': SectorsCnt = 05; break;
608 case '1': SectorsCnt = 16; break;
609 case '2': SectorsCnt = 32; break;
610 case '4': SectorsCnt = 40; break;
611 default: SectorsCnt = 16;
615 ctmp = param_getchar(Cmd, 4);
616 if (ctmp == 't' || ctmp == 'T') transferToEml = true;
617 else if (ctmp == 'd' || ctmp == 'D') createDumpFile = true;
619 ctmp = param_getchar(Cmd, 6);
620 transferToEml |= (ctmp == 't' || ctmp == 'T');
621 transferToEml |= (ctmp == 'd' || ctmp == 'D');
623 if (cmdp == 'o') {
624 PrintAndLog("--target block no:%3d, target key type:%c ", trgBlockNo, trgKeyType?'B':'A');
625 if (mfnested(blockNo, keyType, key, trgBlockNo, trgKeyType, keyBlock, true)) {
626 PrintAndLog("Nested error.");
627 return 2;
629 key64 = bytes_to_num(keyBlock, 6);
630 if (key64) {
631 PrintAndLog("Found valid key:%012"llx, key64);
633 // transfer key to the emulator
634 if (transferToEml) {
635 uint8_t sectortrailer;
636 if (trgBlockNo < 32*4) { // 4 block sector
637 sectortrailer = (trgBlockNo & 0x03) + 3;
638 } else { // 16 block sector
639 sectortrailer = (trgBlockNo & 0x0f) + 15;
641 mfEmlGetMem(keyBlock, sectortrailer, 1);
643 if (!trgKeyType)
644 num_to_bytes(key64, 6, keyBlock);
645 else
646 num_to_bytes(key64, 6, &keyBlock[10]);
647 mfEmlSetMem(keyBlock, sectortrailer, 1);
649 } else {
650 PrintAndLog("No valid key found");
653 else { // ------------------------------------ multiple sectors working
654 clock_t time1;
655 time1 = clock();
657 e_sector = calloc(SectorsCnt, sizeof(sector));
658 if (e_sector == NULL) return 1;
660 //test current key and additional standard keys first
661 memcpy(keyBlock, key, 6);
662 num_to_bytes(0xffffffffffff, 6, (uint8_t*)(keyBlock + 1 * 6));
663 num_to_bytes(0x000000000000, 6, (uint8_t*)(keyBlock + 2 * 6));
664 num_to_bytes(0xa0a1a2a3a4a5, 6, (uint8_t*)(keyBlock + 3 * 6));
665 num_to_bytes(0xb0b1b2b3b4b5, 6, (uint8_t*)(keyBlock + 4 * 6));
666 num_to_bytes(0xaabbccddeeff, 6, (uint8_t*)(keyBlock + 5 * 6));
667 num_to_bytes(0x4d3a99c351dd, 6, (uint8_t*)(keyBlock + 6 * 6));
668 num_to_bytes(0x1a982c7e459a, 6, (uint8_t*)(keyBlock + 7 * 6));
669 num_to_bytes(0xd3f7d3f7d3f7, 6, (uint8_t*)(keyBlock + 8 * 6));
670 num_to_bytes(0x714c5c886e97, 6, (uint8_t*)(keyBlock + 9 * 6));
671 num_to_bytes(0x587ee5f9350f, 6, (uint8_t*)(keyBlock + 10 * 6));
672 num_to_bytes(0xa0478cc39091, 6, (uint8_t*)(keyBlock + 11 * 6));
673 num_to_bytes(0x533cb6c723f6, 6, (uint8_t*)(keyBlock + 12 * 6));
674 num_to_bytes(0x8fd0a4f256e9, 6, (uint8_t*)(keyBlock + 13 * 6));
676 PrintAndLog("Testing known keys. Sector count=%d", SectorsCnt);
677 for (i = 0; i < SectorsCnt; i++) {
678 for (j = 0; j < 2; j++) {
679 if (e_sector[i].foundKey[j]) continue;
681 res = mfCheckKeys(FirstBlockOfSector(i), j, 6, keyBlock, &key64);
683 if (!res) {
684 e_sector[i].Key[j] = key64;
685 e_sector[i].foundKey[j] = 1;
690 // nested sectors
691 iterations = 0;
692 PrintAndLog("nested...");
693 bool calibrate = true;
694 for (i = 0; i < NESTED_SECTOR_RETRY; i++) {
695 for (uint8_t sectorNo = 0; sectorNo < SectorsCnt; sectorNo++) {
696 for (trgKeyType = 0; trgKeyType < 2; trgKeyType++) {
697 if (e_sector[sectorNo].foundKey[trgKeyType]) continue;
698 PrintAndLog("-----------------------------------------------");
699 if(mfnested(blockNo, keyType, key, FirstBlockOfSector(sectorNo), trgKeyType, keyBlock, calibrate)) {
700 PrintAndLog("Nested error.\n");
701 free(e_sector);
702 return 2; }
703 else {
704 calibrate = false;
707 iterations++;
709 key64 = bytes_to_num(keyBlock, 6);
710 if (key64) {
711 PrintAndLog("Found valid key:%012"llx, key64);
712 e_sector[sectorNo].foundKey[trgKeyType] = 1;
713 e_sector[sectorNo].Key[trgKeyType] = key64;
719 printf("Time in nested: %1.3f (%1.3f sec per key)\n\n", ((float)clock() - time1)/CLOCKS_PER_SEC, ((float)clock() - time1)/iterations/CLOCKS_PER_SEC);
721 PrintAndLog("-----------------------------------------------\nIterations count: %d\n\n", iterations);
722 //print them
723 PrintAndLog("|---|----------------|---|----------------|---|");
724 PrintAndLog("|sec|key A |res|key B |res|");
725 PrintAndLog("|---|----------------|---|----------------|---|");
726 for (i = 0; i < SectorsCnt; i++) {
727 PrintAndLog("|%03d| %012"llx" | %d | %012"llx" | %d |", i,
728 e_sector[i].Key[0], e_sector[i].foundKey[0], e_sector[i].Key[1], e_sector[i].foundKey[1]);
730 PrintAndLog("|---|----------------|---|----------------|---|");
732 // transfer them to the emulator
733 if (transferToEml) {
734 for (i = 0; i < SectorsCnt; i++) {
735 mfEmlGetMem(keyBlock, FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1, 1);
736 if (e_sector[i].foundKey[0])
737 num_to_bytes(e_sector[i].Key[0], 6, keyBlock);
738 if (e_sector[i].foundKey[1])
739 num_to_bytes(e_sector[i].Key[1], 6, &keyBlock[10]);
740 mfEmlSetMem(keyBlock, FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1, 1);
744 // Create dump file
745 if (createDumpFile) {
746 if ((fkeys = fopen("dumpkeys.bin","wb")) == NULL) {
747 PrintAndLog("Could not create file dumpkeys.bin");
748 free(e_sector);
749 return 1;
751 PrintAndLog("Printing keys to binary file dumpkeys.bin...");
752 for(i=0; i<SectorsCnt; i++) {
753 if (e_sector[i].foundKey[0]){
754 num_to_bytes(e_sector[i].Key[0], 6, tempkey);
755 fwrite ( tempkey, 1, 6, fkeys );
757 else{
758 fwrite ( &standart, 1, 6, fkeys );
761 for(i=0; i<SectorsCnt; i++) {
762 if (e_sector[i].foundKey[1]){
763 num_to_bytes(e_sector[i].Key[1], 6, tempkey);
764 fwrite ( tempkey, 1, 6, fkeys );
766 else{
767 fwrite ( &standart, 1, 6, fkeys );
770 fclose(fkeys);
773 free(e_sector);
775 return 0;
778 int CmdHF14AMfChk(const char *Cmd)
780 if (strlen(Cmd)<3) {
781 PrintAndLog("Usage: hf mf chk <block number>|<*card memory> <key type (A/B/?)> [t|d] [<key (12 hex symbols)>] [<dic (*.dic)>]");
782 PrintAndLog(" * - all sectors");
783 PrintAndLog("card memory - 0 - MINI(320 bytes), 1 - 1K, 2 - 2K, 4 - 4K, <other> - 1K");
784 PrintAndLog("d - write keys to binary file\n");
785 PrintAndLog("t - write keys to emulator memory");
786 PrintAndLog(" sample: hf mf chk 0 A 1234567890ab keys.dic");
787 PrintAndLog(" hf mf chk *1 ? t");
788 PrintAndLog(" hf mf chk *1 ? d");
789 return 0;
792 FILE * f;
793 char filename[FILE_PATH_SIZE]={0};
794 char buf[13];
795 uint8_t *keyBlock = NULL, *p;
796 uint8_t stKeyBlock = 20;
798 int i, res;
799 int keycnt = 0;
800 char ctmp = 0x00;
801 uint8_t blockNo = 0;
802 uint8_t SectorsCnt = 1;
803 uint8_t keyType = 0;
804 uint64_t key64 = 0;
806 int transferToEml = 0;
807 int createDumpFile = 0;
809 keyBlock = calloc(stKeyBlock, 6);
810 if (keyBlock == NULL) return 1;
812 uint64_t defaultKeys[] =
814 0xffffffffffff, // Default key (first key used by program if no user defined key)
815 0x000000000000, // Blank key
816 0xa0a1a2a3a4a5, // NFCForum MAD key
817 0xb0b1b2b3b4b5,
818 0xaabbccddeeff,
819 0x4d3a99c351dd,
820 0x1a982c7e459a,
821 0xd3f7d3f7d3f7,
822 0x714c5c886e97,
823 0x587ee5f9350f,
824 0xa0478cc39091,
825 0x533cb6c723f6,
826 0x8fd0a4f256e9
828 int defaultKeysSize = sizeof(defaultKeys) / sizeof(uint64_t);
830 for (int defaultKeyCounter = 0; defaultKeyCounter < defaultKeysSize; defaultKeyCounter++)
832 num_to_bytes(defaultKeys[defaultKeyCounter], 6, (uint8_t*)(keyBlock + defaultKeyCounter * 6));
835 if (param_getchar(Cmd, 0)=='*') {
836 blockNo = 3;
837 switch(param_getchar(Cmd+1, 0)) {
838 case '0': SectorsCnt = 5; break;
839 case '1': SectorsCnt = 16; break;
840 case '2': SectorsCnt = 32; break;
841 case '4': SectorsCnt = 40; break;
842 default: SectorsCnt = 16;
845 else
846 blockNo = param_get8(Cmd, 0);
848 ctmp = param_getchar(Cmd, 1);
849 switch (ctmp) {
850 case 'a': case 'A':
851 keyType = !0;
852 break;
853 case 'b': case 'B':
854 keyType = !1;
855 break;
856 case '?':
857 keyType = 2;
858 break;
859 default:
860 PrintAndLog("Key type must be A , B or ?");
861 return 1;
864 ctmp = param_getchar(Cmd, 2);
865 if (ctmp == 't' || ctmp == 'T') transferToEml = 1;
866 else if (ctmp == 'd' || ctmp == 'D') createDumpFile = 1;
868 for (i = transferToEml || createDumpFile; param_getchar(Cmd, 2 + i); i++) {
869 if (!param_gethex(Cmd, 2 + i, keyBlock + 6 * keycnt, 12)) {
870 if ( stKeyBlock - keycnt < 2) {
871 p = realloc(keyBlock, 6*(stKeyBlock+=10));
872 if (!p) {
873 PrintAndLog("Cannot allocate memory for Keys");
874 free(keyBlock);
875 return 2;
877 keyBlock = p;
879 PrintAndLog("chk key[%2d] %02x%02x%02x%02x%02x%02x", keycnt,
880 (keyBlock + 6*keycnt)[0],(keyBlock + 6*keycnt)[1], (keyBlock + 6*keycnt)[2],
881 (keyBlock + 6*keycnt)[3], (keyBlock + 6*keycnt)[4], (keyBlock + 6*keycnt)[5], 6);
882 keycnt++;
883 } else {
884 // May be a dic file
885 if ( param_getstr(Cmd, 2 + i,filename) >= FILE_PATH_SIZE ) {
886 PrintAndLog("File name too long");
887 free(keyBlock);
888 return 2;
891 if ( (f = fopen( filename , "r")) ) {
892 while( fgets(buf, sizeof(buf), f) ){
893 if (strlen(buf) < 12 || buf[11] == '\n')
894 continue;
896 while (fgetc(f) != '\n' && !feof(f)) ; //goto next line
898 if( buf[0]=='#' ) continue; //The line start with # is comment, skip
900 if (!isxdigit(buf[0])){
901 PrintAndLog("File content error. '%s' must include 12 HEX symbols",buf);
902 continue;
905 buf[12] = 0;
907 if ( stKeyBlock - keycnt < 2) {
908 p = realloc(keyBlock, 6*(stKeyBlock+=10));
909 if (!p) {
910 PrintAndLog("Cannot allocate memory for defKeys");
911 free(keyBlock);
912 return 2;
914 keyBlock = p;
916 memset(keyBlock + 6 * keycnt, 0, 6);
917 num_to_bytes(strtoll(buf, NULL, 16), 6, keyBlock + 6*keycnt);
918 PrintAndLog("chk custom key[%2d] %012"llx, keycnt, bytes_to_num(keyBlock + 6*keycnt, 6));
919 keycnt++;
920 memset(buf, 0, sizeof(buf));
922 fclose(f);
923 } else {
924 PrintAndLog("File: %s: not found or locked.", filename);
925 free(keyBlock);
926 return 1;
932 if (keycnt == 0) {
933 PrintAndLog("No key specified, trying default keys");
934 for (;keycnt < defaultKeysSize; keycnt++)
935 PrintAndLog("chk default key[%2d] %02x%02x%02x%02x%02x%02x", keycnt,
936 (keyBlock + 6*keycnt)[0],(keyBlock + 6*keycnt)[1], (keyBlock + 6*keycnt)[2],
937 (keyBlock + 6*keycnt)[3], (keyBlock + 6*keycnt)[4], (keyBlock + 6*keycnt)[5], 6);
940 // initialize storage for found keys
941 bool validKey[2][40];
942 uint8_t foundKey[2][40][6];
943 for (uint16_t t = 0; t < 2; t++) {
944 for (uint16_t sectorNo = 0; sectorNo < SectorsCnt; sectorNo++) {
945 validKey[t][sectorNo] = false;
946 for (uint16_t i = 0; i < 6; i++) {
947 foundKey[t][sectorNo][i] = 0xff;
952 for ( int t = !keyType; t < 2; keyType==2?(t++):(t=2) ) {
953 int b=blockNo;
954 for (int i = 0; i < SectorsCnt; ++i) {
955 PrintAndLog("--sector:%2d, block:%3d, key type:%C, key count:%2d ", i, b, t?'B':'A', keycnt);
956 uint32_t max_keys = keycnt>USB_CMD_DATA_SIZE/6?USB_CMD_DATA_SIZE/6:keycnt;
957 for (uint32_t c = 0; c < keycnt; c+=max_keys) {
958 uint32_t size = keycnt-c>max_keys?max_keys:keycnt-c;
959 res = mfCheckKeys(b, t, size, &keyBlock[6*c], &key64);
960 if (res != 1) {
961 if (!res) {
962 PrintAndLog("Found valid key:[%012"llx"]",key64);
963 num_to_bytes(key64, 6, foundKey[t][i]);
964 validKey[t][i] = true;
966 } else {
967 PrintAndLog("Command execute timeout");
970 b<127?(b+=4):(b+=16);
974 if (transferToEml) {
975 uint8_t block[16];
976 for (uint16_t sectorNo = 0; sectorNo < SectorsCnt; sectorNo++) {
977 if (validKey[0][sectorNo] || validKey[1][sectorNo]) {
978 mfEmlGetMem(block, FirstBlockOfSector(sectorNo) + NumBlocksPerSector(sectorNo) - 1, 1);
979 for (uint16_t t = 0; t < 2; t++) {
980 if (validKey[t][sectorNo]) {
981 memcpy(block + t*10, foundKey[t][sectorNo], 6);
984 mfEmlSetMem(block, FirstBlockOfSector(sectorNo) + NumBlocksPerSector(sectorNo) - 1, 1);
987 PrintAndLog("Found keys have been transferred to the emulator memory");
990 if (createDumpFile) {
991 FILE *fkeys = fopen("dumpkeys.bin","wb");
992 if (fkeys == NULL) {
993 PrintAndLog("Could not create file dumpkeys.bin");
994 free(keyBlock);
995 return 1;
997 for (uint16_t t = 0; t < 2; t++) {
998 fwrite(foundKey[t], 1, 6*SectorsCnt, fkeys);
1000 fclose(fkeys);
1001 PrintAndLog("Found keys have been dumped to file dumpkeys.bin. 0xffffffffffff has been inserted for unknown keys.");
1004 free(keyBlock);
1005 PrintAndLog("");
1006 return 0;
1009 int CmdHF14AMf1kSim(const char *Cmd)
1011 uint8_t uid[7] = {0, 0, 0, 0, 0, 0, 0};
1012 uint8_t exitAfterNReads = 0;
1013 uint8_t flags = 0;
1015 uint8_t cmdp = param_getchar(Cmd, 0);
1017 if (cmdp == 'h' || cmdp == 'H') {
1018 PrintAndLog("Usage: hf mf sim u <uid (8 hex symbols)> n <numreads> i x");
1019 PrintAndLog(" h this help");
1020 PrintAndLog(" u (Optional) UID. If not specified, the UID from emulator memory will be used");
1021 PrintAndLog(" n (Optional) Automatically exit simulation after <numreads> blocks have been read by reader. 0 = infinite");
1022 PrintAndLog(" i (Optional) Interactive, means that console will not be returned until simulation finishes or is aborted");
1023 PrintAndLog(" x (Optional) Crack, performs the 'reader attack', nr/ar attack against a legitimate reader, fishes out the key(s)");
1024 PrintAndLog("");
1025 PrintAndLog(" sample: hf mf sim u 0a0a0a0a ");
1026 return 0;
1028 uint8_t pnr = 0;
1029 if (param_getchar(Cmd, pnr) == 'u') {
1030 if(param_gethex(Cmd, pnr+1, uid, 8) == 0)
1032 flags |= FLAG_4B_UID_IN_DATA; // UID from packet
1033 } else if(param_gethex(Cmd,pnr+1,uid,14) == 0) {
1034 flags |= FLAG_7B_UID_IN_DATA;// UID from packet
1035 } else {
1036 PrintAndLog("UID, if specified, must include 8 or 14 HEX symbols");
1037 return 1;
1039 pnr +=2;
1041 if (param_getchar(Cmd, pnr) == 'n') {
1042 exitAfterNReads = param_get8(Cmd,pnr+1);
1043 pnr += 2;
1045 if (param_getchar(Cmd, pnr) == 'i' ) {
1046 //Using a flag to signal interactiveness, least significant bit
1047 flags |= FLAG_INTERACTIVE;
1048 pnr++;
1051 if (param_getchar(Cmd, pnr) == 'x' ) {
1052 //Using a flag to signal interactiveness, least significant bit
1053 flags |= FLAG_NR_AR_ATTACK;
1055 PrintAndLog(" uid:%s, numreads:%d, flags:%d (0x%02x) ",
1056 flags & FLAG_4B_UID_IN_DATA ? sprint_hex(uid,4):
1057 flags & FLAG_7B_UID_IN_DATA ? sprint_hex(uid,7): "N/A"
1058 , exitAfterNReads, flags,flags);
1061 UsbCommand c = {CMD_SIMULATE_MIFARE_CARD, {flags, exitAfterNReads,0}};
1062 memcpy(c.d.asBytes, uid, sizeof(uid));
1063 SendCommand(&c);
1065 if(flags & FLAG_INTERACTIVE)
1067 UsbCommand resp;
1068 PrintAndLog("Press pm3-button to abort simulation");
1069 while(! WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
1070 //We're waiting only 1.5 s at a time, otherwise we get the
1071 // annoying message about "Waiting for a response... "
1075 return 0;
1078 int CmdHF14AMfDbg(const char *Cmd)
1080 int dbgMode = param_get32ex(Cmd, 0, 0, 10);
1081 if (dbgMode > 4) {
1082 PrintAndLog("Max debug mode parameter is 4 \n");
1085 if (strlen(Cmd) < 1 || !param_getchar(Cmd, 0) || dbgMode > 4) {
1086 PrintAndLog("Usage: hf mf dbg <debug level>");
1087 PrintAndLog(" 0 - no debug messages");
1088 PrintAndLog(" 1 - error messages");
1089 PrintAndLog(" 2 - plus information messages");
1090 PrintAndLog(" 3 - plus debug messages");
1091 PrintAndLog(" 4 - print even debug messages in timing critical functions");
1092 PrintAndLog(" Note: this option therefore may cause malfunction itself");
1093 return 0;
1096 UsbCommand c = {CMD_MIFARE_SET_DBGMODE, {dbgMode, 0, 0}};
1097 SendCommand(&c);
1099 return 0;
1102 int CmdHF14AMfEGet(const char *Cmd)
1104 uint8_t blockNo = 0;
1105 uint8_t data[16] = {0x00};
1107 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1108 PrintAndLog("Usage: hf mf eget <block number>");
1109 PrintAndLog(" sample: hf mf eget 0 ");
1110 return 0;
1113 blockNo = param_get8(Cmd, 0);
1115 PrintAndLog(" ");
1116 if (!mfEmlGetMem(data, blockNo, 1)) {
1117 PrintAndLog("data[%3d]:%s", blockNo, sprint_hex(data, 16));
1118 } else {
1119 PrintAndLog("Command execute timeout");
1122 return 0;
1125 int CmdHF14AMfEClear(const char *Cmd)
1127 if (param_getchar(Cmd, 0) == 'h') {
1128 PrintAndLog("Usage: hf mf eclr");
1129 PrintAndLog("It set card emulator memory to empty data blocks and key A/B FFFFFFFFFFFF \n");
1130 return 0;
1133 UsbCommand c = {CMD_MIFARE_EML_MEMCLR, {0, 0, 0}};
1134 SendCommand(&c);
1135 return 0;
1139 int CmdHF14AMfESet(const char *Cmd)
1141 uint8_t memBlock[16];
1142 uint8_t blockNo = 0;
1144 memset(memBlock, 0x00, sizeof(memBlock));
1146 if (strlen(Cmd) < 3 || param_getchar(Cmd, 0) == 'h') {
1147 PrintAndLog("Usage: hf mf eset <block number> <block data (32 hex symbols)>");
1148 PrintAndLog(" sample: hf mf eset 1 000102030405060708090a0b0c0d0e0f ");
1149 return 0;
1152 blockNo = param_get8(Cmd, 0);
1154 if (param_gethex(Cmd, 1, memBlock, 32)) {
1155 PrintAndLog("block data must include 32 HEX symbols");
1156 return 1;
1159 // 1 - blocks count
1160 UsbCommand c = {CMD_MIFARE_EML_MEMSET, {blockNo, 1, 0}};
1161 memcpy(c.d.asBytes, memBlock, 16);
1162 SendCommand(&c);
1163 return 0;
1167 int CmdHF14AMfELoad(const char *Cmd)
1169 FILE * f;
1170 char filename[FILE_PATH_SIZE];
1171 char *fnameptr = filename;
1172 char buf[64] = {0x00};
1173 uint8_t buf8[64] = {0x00};
1174 int i, len, blockNum, numBlocks;
1175 int nameParamNo = 1;
1177 char ctmp = param_getchar(Cmd, 0);
1179 if ( ctmp == 'h' || ctmp == 0x00) {
1180 PrintAndLog("It loads emul dump from the file `filename.eml`");
1181 PrintAndLog("Usage: hf mf eload [card memory] <file name w/o `.eml`>");
1182 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
1183 PrintAndLog("");
1184 PrintAndLog(" sample: hf mf eload filename");
1185 PrintAndLog(" hf mf eload 4 filename");
1186 return 0;
1189 switch (ctmp) {
1190 case '0' : numBlocks = 5*4; break;
1191 case '1' :
1192 case '\0': numBlocks = 16*4; break;
1193 case '2' : numBlocks = 32*4; break;
1194 case '4' : numBlocks = 256; break;
1195 default: {
1196 numBlocks = 16*4;
1197 nameParamNo = 0;
1201 len = param_getstr(Cmd,nameParamNo,filename);
1203 if (len > FILE_PATH_SIZE - 4) len = FILE_PATH_SIZE - 4;
1205 fnameptr += len;
1207 sprintf(fnameptr, ".eml");
1209 // open file
1210 f = fopen(filename, "r");
1211 if (f == NULL) {
1212 PrintAndLog("File %s not found or locked", filename);
1213 return 1;
1216 blockNum = 0;
1217 while(!feof(f)){
1218 memset(buf, 0, sizeof(buf));
1220 if (fgets(buf, sizeof(buf), f) == NULL) {
1222 if (blockNum >= numBlocks) break;
1224 PrintAndLog("File reading error.");
1225 fclose(f);
1226 return 2;
1229 if (strlen(buf) < 32){
1230 if(strlen(buf) && feof(f))
1231 break;
1232 PrintAndLog("File content error. Block data must include 32 HEX symbols");
1233 fclose(f);
1234 return 2;
1237 for (i = 0; i < 32; i += 2) {
1238 sscanf(&buf[i], "%02x", (unsigned int *)&buf8[i / 2]);
1241 if (mfEmlSetMem(buf8, blockNum, 1)) {
1242 PrintAndLog("Cant set emul block: %3d", blockNum);
1243 fclose(f);
1244 return 3;
1246 printf(".");
1247 blockNum++;
1249 if (blockNum >= numBlocks) break;
1251 fclose(f);
1252 printf("\n");
1254 if ((blockNum != numBlocks)) {
1255 PrintAndLog("File content error. Got %d must be %d blocks.",blockNum, numBlocks);
1256 return 4;
1258 PrintAndLog("Loaded %d blocks from file: %s", blockNum, filename);
1259 return 0;
1263 int CmdHF14AMfESave(const char *Cmd)
1265 FILE * f;
1266 char filename[FILE_PATH_SIZE];
1267 char * fnameptr = filename;
1268 uint8_t buf[64];
1269 int i, j, len, numBlocks;
1270 int nameParamNo = 1;
1272 memset(filename, 0, sizeof(filename));
1273 memset(buf, 0, sizeof(buf));
1275 char ctmp = param_getchar(Cmd, 0);
1277 if ( ctmp == 'h' || ctmp == 'H') {
1278 PrintAndLog("It saves emul dump into the file `filename.eml` or `cardID.eml`");
1279 PrintAndLog(" Usage: hf mf esave [card memory] [file name w/o `.eml`]");
1280 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
1281 PrintAndLog("");
1282 PrintAndLog(" sample: hf mf esave ");
1283 PrintAndLog(" hf mf esave 4");
1284 PrintAndLog(" hf mf esave 4 filename");
1285 return 0;
1288 switch (ctmp) {
1289 case '0' : numBlocks = 5*4; break;
1290 case '1' :
1291 case '\0': numBlocks = 16*4; break;
1292 case '2' : numBlocks = 32*4; break;
1293 case '4' : numBlocks = 256; break;
1294 default: {
1295 numBlocks = 16*4;
1296 nameParamNo = 0;
1300 len = param_getstr(Cmd,nameParamNo,filename);
1302 if (len > FILE_PATH_SIZE - 4) len = FILE_PATH_SIZE - 4;
1304 // user supplied filename?
1305 if (len < 1) {
1306 // get filename (UID from memory)
1307 if (mfEmlGetMem(buf, 0, 1)) {
1308 PrintAndLog("Can\'t get UID from block: %d", 0);
1309 len = sprintf(fnameptr, "dump");
1310 fnameptr += len;
1312 else {
1313 for (j = 0; j < 7; j++, fnameptr += 2)
1314 sprintf(fnameptr, "%02X", buf[j]);
1316 } else {
1317 fnameptr += len;
1320 // add file extension
1321 sprintf(fnameptr, ".eml");
1323 // open file
1324 f = fopen(filename, "w+");
1326 if ( !f ) {
1327 PrintAndLog("Can't open file %s ", filename);
1328 return 1;
1331 // put hex
1332 for (i = 0; i < numBlocks; i++) {
1333 if (mfEmlGetMem(buf, i, 1)) {
1334 PrintAndLog("Cant get block: %d", i);
1335 break;
1337 for (j = 0; j < 16; j++)
1338 fprintf(f, "%02X", buf[j]);
1339 fprintf(f,"\n");
1341 fclose(f);
1343 PrintAndLog("Saved %d blocks to file: %s", numBlocks, filename);
1345 return 0;
1349 int CmdHF14AMfECFill(const char *Cmd)
1351 uint8_t keyType = 0;
1352 uint8_t numSectors = 16;
1354 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1355 PrintAndLog("Usage: hf mf ecfill <key A/B> [card memory]");
1356 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
1357 PrintAndLog("");
1358 PrintAndLog("samples: hf mf ecfill A");
1359 PrintAndLog(" hf mf ecfill A 4");
1360 PrintAndLog("Read card and transfer its data to emulator memory.");
1361 PrintAndLog("Keys must be laid in the emulator memory. \n");
1362 return 0;
1365 char ctmp = param_getchar(Cmd, 0);
1366 if (ctmp != 'a' && ctmp != 'A' && ctmp != 'b' && ctmp != 'B') {
1367 PrintAndLog("Key type must be A or B");
1368 return 1;
1370 if (ctmp != 'A' && ctmp != 'a') keyType = 1;
1372 ctmp = param_getchar(Cmd, 1);
1373 switch (ctmp) {
1374 case '0' : numSectors = 5; break;
1375 case '1' :
1376 case '\0': numSectors = 16; break;
1377 case '2' : numSectors = 32; break;
1378 case '4' : numSectors = 40; break;
1379 default: numSectors = 16;
1382 printf("--params: numSectors: %d, keyType:%d", numSectors, keyType);
1383 UsbCommand c = {CMD_MIFARE_EML_CARDLOAD, {numSectors, keyType, 0}};
1384 SendCommand(&c);
1385 return 0;
1389 int CmdHF14AMfEKeyPrn(const char *Cmd)
1391 int i;
1392 uint8_t numSectors;
1393 uint8_t data[16];
1394 uint64_t keyA, keyB;
1396 if (param_getchar(Cmd, 0) == 'h') {
1397 PrintAndLog("It prints the keys loaded in the emulator memory");
1398 PrintAndLog("Usage: hf mf ekeyprn [card memory]");
1399 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
1400 PrintAndLog("");
1401 PrintAndLog(" sample: hf mf ekeyprn 1");
1402 return 0;
1405 char cmdp = param_getchar(Cmd, 0);
1407 switch (cmdp) {
1408 case '0' : numSectors = 5; break;
1409 case '1' :
1410 case '\0': numSectors = 16; break;
1411 case '2' : numSectors = 32; break;
1412 case '4' : numSectors = 40; break;
1413 default: numSectors = 16;
1416 PrintAndLog("|---|----------------|----------------|");
1417 PrintAndLog("|sec|key A |key B |");
1418 PrintAndLog("|---|----------------|----------------|");
1419 for (i = 0; i < numSectors; i++) {
1420 if (mfEmlGetMem(data, FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1, 1)) {
1421 PrintAndLog("error get block %d", FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1);
1422 break;
1424 keyA = bytes_to_num(data, 6);
1425 keyB = bytes_to_num(data + 10, 6);
1426 PrintAndLog("|%03d| %012"llx" | %012"llx" |", i, keyA, keyB);
1428 PrintAndLog("|---|----------------|----------------|");
1430 return 0;
1434 int CmdHF14AMfCSetUID(const char *Cmd)
1436 uint8_t wipeCard = 0;
1437 uint8_t uid[8] = {0x00};
1438 uint8_t oldUid[8] = {0x00};
1439 uint8_t atqa[2] = {0x00};
1440 uint8_t sak[1] = {0x00};
1441 uint8_t atqaPresent = 1;
1442 int res;
1443 char ctmp;
1444 int argi=0;
1446 if (strlen(Cmd) < 1 || param_getchar(Cmd, argi) == 'h') {
1447 PrintAndLog("Usage: hf mf csetuid <UID 8 hex symbols> [ATQA 4 hex symbols SAK 2 hex symbols] [w]");
1448 PrintAndLog("sample: hf mf csetuid 01020304");
1449 PrintAndLog("sample: hf mf csetuid 01020304 0004 08 w");
1450 PrintAndLog("Set UID, ATQA, and SAK for magic Chinese card (only works with such cards)");
1451 PrintAndLog("If you also want to wipe the card then add 'w' at the end of the command line.");
1452 return 0;
1455 if (param_getchar(Cmd, argi) && param_gethex(Cmd, argi, uid, 8)) {
1456 PrintAndLog("UID must include 8 HEX symbols");
1457 return 1;
1459 argi++;
1461 ctmp = param_getchar(Cmd, argi);
1462 if (ctmp == 'w' || ctmp == 'W') {
1463 wipeCard = 1;
1464 atqaPresent = 0;
1467 if (atqaPresent) {
1468 if (param_getchar(Cmd, argi)) {
1469 if (param_gethex(Cmd, argi, atqa, 4)) {
1470 PrintAndLog("ATQA must include 4 HEX symbols");
1471 return 1;
1473 argi++;
1474 if (!param_getchar(Cmd, argi) || param_gethex(Cmd, argi, sak, 2)) {
1475 PrintAndLog("SAK must include 2 HEX symbols");
1476 return 1;
1478 argi++;
1479 } else
1480 atqaPresent = 0;
1483 if(!wipeCard) {
1484 ctmp = param_getchar(Cmd, argi);
1485 if (ctmp == 'w' || ctmp == 'W') {
1486 wipeCard = 1;
1490 PrintAndLog("--wipe card:%s uid:%s", (wipeCard)?"YES":"NO", sprint_hex(uid, 4));
1492 res = mfCSetUID(uid, (atqaPresent)?atqa:NULL, (atqaPresent)?sak:NULL, oldUid, wipeCard);
1493 if (res) {
1494 PrintAndLog("Can't set UID. error=%d", res);
1495 return 1;
1498 PrintAndLog("old UID:%s", sprint_hex(oldUid, 4));
1499 PrintAndLog("new UID:%s", sprint_hex(uid, 4));
1500 return 0;
1503 int CmdHF14AMfCSetBlk(const char *Cmd)
1505 uint8_t memBlock[16] = {0x00};
1506 uint8_t blockNo = 0;
1507 bool wipeCard = FALSE;
1508 int res;
1510 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1511 PrintAndLog("Usage: hf mf csetblk <block number> <block data (32 hex symbols)> [w]");
1512 PrintAndLog("sample: hf mf csetblk 1 01020304050607080910111213141516");
1513 PrintAndLog("Set block data for magic Chinese card (only works with such cards)");
1514 PrintAndLog("If you also want wipe the card then add 'w' at the end of the command line");
1515 return 0;
1518 blockNo = param_get8(Cmd, 0);
1520 if (param_gethex(Cmd, 1, memBlock, 32)) {
1521 PrintAndLog("block data must include 32 HEX symbols");
1522 return 1;
1525 char ctmp = param_getchar(Cmd, 2);
1526 wipeCard = (ctmp == 'w' || ctmp == 'W');
1527 PrintAndLog("--block number:%2d data:%s", blockNo, sprint_hex(memBlock, 16));
1529 res = mfCSetBlock(blockNo, memBlock, NULL, wipeCard, CSETBLOCK_SINGLE_OPER);
1530 if (res) {
1531 PrintAndLog("Can't write block. error=%d", res);
1532 return 1;
1534 return 0;
1538 int CmdHF14AMfCLoad(const char *Cmd)
1540 FILE * f;
1541 char filename[FILE_PATH_SIZE] = {0x00};
1542 char * fnameptr = filename;
1543 char buf[64] = {0x00};
1544 uint8_t buf8[64] = {0x00};
1545 uint8_t fillFromEmulator = 0;
1546 int i, len, blockNum, flags=0;
1548 if (param_getchar(Cmd, 0) == 'h' || param_getchar(Cmd, 0)== 0x00) {
1549 PrintAndLog("It loads magic Chinese card from the file `filename.eml`");
1550 PrintAndLog("or from emulator memory (option `e`)");
1551 PrintAndLog("Usage: hf mf cload <file name w/o `.eml`>");
1552 PrintAndLog(" or: hf mf cload e ");
1553 PrintAndLog(" sample: hf mf cload filename");
1554 return 0;
1557 char ctmp = param_getchar(Cmd, 0);
1558 if (ctmp == 'e' || ctmp == 'E') fillFromEmulator = 1;
1560 if (fillFromEmulator) {
1561 for (blockNum = 0; blockNum < 16 * 4; blockNum += 1) {
1562 if (mfEmlGetMem(buf8, blockNum, 1)) {
1563 PrintAndLog("Cant get block: %d", blockNum);
1564 return 2;
1566 if (blockNum == 0) flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC; // switch on field and send magic sequence
1567 if (blockNum == 1) flags = 0; // just write
1568 if (blockNum == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD; // Done. Magic Halt and switch off field.
1570 if (mfCSetBlock(blockNum, buf8, NULL, 0, flags)) {
1571 PrintAndLog("Cant set magic card block: %d", blockNum);
1572 return 3;
1575 return 0;
1576 } else {
1577 len = strlen(Cmd);
1578 if (len > FILE_PATH_SIZE - 4) len = FILE_PATH_SIZE - 4;
1580 memcpy(filename, Cmd, len);
1581 fnameptr += len;
1583 sprintf(fnameptr, ".eml");
1585 // open file
1586 f = fopen(filename, "r");
1587 if (f == NULL) {
1588 PrintAndLog("File not found or locked.");
1589 return 1;
1592 blockNum = 0;
1593 while(!feof(f)){
1595 memset(buf, 0, sizeof(buf));
1597 if (fgets(buf, sizeof(buf), f) == NULL) {
1598 fclose(f);
1599 PrintAndLog("File reading error.");
1600 return 2;
1603 if (strlen(buf) < 32) {
1604 if(strlen(buf) && feof(f))
1605 break;
1606 PrintAndLog("File content error. Block data must include 32 HEX symbols");
1607 fclose(f);
1608 return 2;
1610 for (i = 0; i < 32; i += 2)
1611 sscanf(&buf[i], "%02x", (unsigned int *)&buf8[i / 2]);
1613 if (blockNum == 0) flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC; // switch on field and send magic sequence
1614 if (blockNum == 1) flags = 0; // just write
1615 if (blockNum == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD; // Done. Switch off field.
1617 if (mfCSetBlock(blockNum, buf8, NULL, 0, flags)) {
1618 PrintAndLog("Can't set magic card block: %d", blockNum);
1619 return 3;
1621 blockNum++;
1623 if (blockNum >= 16 * 4) break; // magic card type - mifare 1K
1625 fclose(f);
1627 if (blockNum != 16 * 4 && blockNum != 32 * 4 + 8 * 16){
1628 PrintAndLog("File content error. There must be 64 blocks");
1629 return 4;
1631 PrintAndLog("Loaded from file: %s", filename);
1632 return 0;
1634 return 0;
1637 int CmdHF14AMfCGetBlk(const char *Cmd) {
1638 uint8_t memBlock[16];
1639 uint8_t blockNo = 0;
1640 int res;
1641 memset(memBlock, 0x00, sizeof(memBlock));
1643 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1644 PrintAndLog("Usage: hf mf cgetblk <block number>");
1645 PrintAndLog("sample: hf mf cgetblk 1");
1646 PrintAndLog("Get block data from magic Chinese card (only works with such cards)\n");
1647 return 0;
1650 blockNo = param_get8(Cmd, 0);
1652 PrintAndLog("--block number:%2d ", blockNo);
1654 res = mfCGetBlock(blockNo, memBlock, CSETBLOCK_SINGLE_OPER);
1655 if (res) {
1656 PrintAndLog("Can't read block. error=%d", res);
1657 return 1;
1660 PrintAndLog("block data:%s", sprint_hex(memBlock, 16));
1661 return 0;
1665 int CmdHF14AMfCGetSc(const char *Cmd) {
1666 uint8_t memBlock[16] = {0x00};
1667 uint8_t sectorNo = 0;
1668 int i, res, flags;
1670 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1671 PrintAndLog("Usage: hf mf cgetsc <sector number>");
1672 PrintAndLog("sample: hf mf cgetsc 0");
1673 PrintAndLog("Get sector data from magic Chinese card (only works with such cards)\n");
1674 return 0;
1677 sectorNo = param_get8(Cmd, 0);
1678 if (sectorNo > 15) {
1679 PrintAndLog("Sector number must be in [0..15] as in MIFARE classic.");
1680 return 1;
1683 PrintAndLog("--sector number:%d ", sectorNo);
1685 flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC;
1686 for (i = 0; i < 4; i++) {
1687 if (i == 1) flags = 0;
1688 if (i == 3) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD;
1690 res = mfCGetBlock(sectorNo * 4 + i, memBlock, flags);
1691 if (res) {
1692 PrintAndLog("Can't read block. %d error=%d", sectorNo * 4 + i, res);
1693 return 1;
1696 PrintAndLog("block %3d data:%s", sectorNo * 4 + i, sprint_hex(memBlock, 16));
1698 return 0;
1702 int CmdHF14AMfCSave(const char *Cmd) {
1704 FILE * f;
1705 char filename[FILE_PATH_SIZE] = {0x00};
1706 char * fnameptr = filename;
1707 uint8_t fillFromEmulator = 0;
1708 uint8_t buf[64] = {0x00};
1709 int i, j, len, flags;
1711 // memset(filename, 0, sizeof(filename));
1712 // memset(buf, 0, sizeof(buf));
1714 if (param_getchar(Cmd, 0) == 'h') {
1715 PrintAndLog("It saves `magic Chinese` card dump into the file `filename.eml` or `cardID.eml`");
1716 PrintAndLog("or into emulator memory (option `e`)");
1717 PrintAndLog("Usage: hf mf esave [file name w/o `.eml`][e]");
1718 PrintAndLog(" sample: hf mf esave ");
1719 PrintAndLog(" hf mf esave filename");
1720 PrintAndLog(" hf mf esave e \n");
1721 return 0;
1724 char ctmp = param_getchar(Cmd, 0);
1725 if (ctmp == 'e' || ctmp == 'E') fillFromEmulator = 1;
1727 if (fillFromEmulator) {
1728 // put into emulator
1729 flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC;
1730 for (i = 0; i < 16 * 4; i++) {
1731 if (i == 1) flags = 0;
1732 if (i == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD;
1734 if (mfCGetBlock(i, buf, flags)) {
1735 PrintAndLog("Cant get block: %d", i);
1736 break;
1739 if (mfEmlSetMem(buf, i, 1)) {
1740 PrintAndLog("Cant set emul block: %d", i);
1741 return 3;
1744 return 0;
1745 } else {
1746 len = strlen(Cmd);
1747 if (len > FILE_PATH_SIZE - 4) len = FILE_PATH_SIZE - 4;
1749 if (len < 1) {
1750 // get filename
1751 if (mfCGetBlock(0, buf, CSETBLOCK_SINGLE_OPER)) {
1752 PrintAndLog("Cant get block: %d", 0);
1753 return 1;
1755 for (j = 0; j < 7; j++, fnameptr += 2)
1756 sprintf(fnameptr, "%02x", buf[j]);
1757 } else {
1758 memcpy(filename, Cmd, len);
1759 fnameptr += len;
1762 sprintf(fnameptr, ".eml");
1764 // open file
1765 f = fopen(filename, "w+");
1767 if (f == NULL) {
1768 PrintAndLog("File not found or locked.");
1769 return 1;
1772 // put hex
1773 flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC;
1774 for (i = 0; i < 16 * 4; i++) {
1775 if (i == 1) flags = 0;
1776 if (i == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD;
1778 if (mfCGetBlock(i, buf, flags)) {
1779 PrintAndLog("Cant get block: %d", i);
1780 break;
1782 for (j = 0; j < 16; j++)
1783 fprintf(f, "%02x", buf[j]);
1784 fprintf(f,"\n");
1786 fclose(f);
1788 PrintAndLog("Saved to file: %s", filename);
1790 return 0;
1795 int CmdHF14AMfSniff(const char *Cmd){
1797 bool wantLogToFile = 0;
1798 bool wantDecrypt = 0;
1799 //bool wantSaveToEml = 0; TODO
1800 bool wantSaveToEmlFile = 0;
1802 //var
1803 int res = 0;
1804 int len = 0;
1805 int blockLen = 0;
1806 int pckNum = 0;
1807 int num = 0;
1808 uint8_t uid[7];
1809 uint8_t uid_len;
1810 uint8_t atqa[2] = {0x00};
1811 uint8_t sak;
1812 bool isTag;
1813 uint8_t *buf = NULL;
1814 uint16_t bufsize = 0;
1815 uint8_t *bufPtr = NULL;
1817 char ctmp = param_getchar(Cmd, 0);
1818 if ( ctmp == 'h' || ctmp == 'H' ) {
1819 PrintAndLog("It continuously gets data from the field and saves it to: log, emulator, emulator file.");
1820 PrintAndLog("You can specify:");
1821 PrintAndLog(" l - save encrypted sequence to logfile `uid.log`");
1822 PrintAndLog(" d - decrypt sequence and put it to log file `uid.log`");
1823 PrintAndLog(" n/a e - decrypt sequence, collect read and write commands and save the result of the sequence to emulator memory");
1824 PrintAndLog(" f - decrypt sequence, collect read and write commands and save the result of the sequence to emulator dump file `uid.eml`");
1825 PrintAndLog("Usage: hf mf sniff [l][d][e][f]");
1826 PrintAndLog(" sample: hf mf sniff l d e");
1827 return 0;
1830 for (int i = 0; i < 4; i++) {
1831 ctmp = param_getchar(Cmd, i);
1832 if (ctmp == 'l' || ctmp == 'L') wantLogToFile = true;
1833 if (ctmp == 'd' || ctmp == 'D') wantDecrypt = true;
1834 //if (ctmp == 'e' || ctmp == 'E') wantSaveToEml = true; TODO
1835 if (ctmp == 'f' || ctmp == 'F') wantSaveToEmlFile = true;
1838 printf("-------------------------------------------------------------------------\n");
1839 printf("Executing command. \n");
1840 printf("Press the key on the proxmark3 device to abort both proxmark3 and client.\n");
1841 printf("Press the key on pc keyboard to abort the client.\n");
1842 printf("-------------------------------------------------------------------------\n");
1844 UsbCommand c = {CMD_MIFARE_SNIFFER, {0, 0, 0}};
1845 clearCommandBuffer();
1846 SendCommand(&c);
1848 // wait cycle
1849 while (true) {
1850 printf(".");
1851 fflush(stdout);
1852 if (ukbhit()) {
1853 getchar();
1854 printf("\naborted via keyboard!\n");
1855 break;
1858 UsbCommand resp;
1859 if (WaitForResponseTimeout(CMD_ACK,&resp,2000)) {
1860 res = resp.arg[0] & 0xff;
1861 uint16_t traceLen = resp.arg[1];
1862 len = resp.arg[2];
1864 if (res == 0) return 0; // we are done
1866 if (res == 1) { // there is (more) data to be transferred
1867 if (pckNum == 0) { // first packet, (re)allocate necessary buffer
1868 if (traceLen > bufsize) {
1869 uint8_t *p;
1870 if (buf == NULL) { // not yet allocated
1871 p = malloc(traceLen);
1872 } else { // need more memory
1873 p = realloc(buf, traceLen);
1875 if (p == NULL) {
1876 PrintAndLog("Cannot allocate memory for trace");
1877 free(buf);
1878 return 2;
1880 buf = p;
1882 bufPtr = buf;
1883 bufsize = traceLen;
1884 memset(buf, 0x00, traceLen);
1886 memcpy(bufPtr, resp.d.asBytes, len);
1887 bufPtr += len;
1888 pckNum++;
1891 if (res == 2) { // received all data, start displaying
1892 blockLen = bufPtr - buf;
1893 bufPtr = buf;
1894 printf(">\n");
1895 PrintAndLog("received trace len: %d packages: %d", blockLen, pckNum);
1896 while (bufPtr - buf < blockLen) {
1897 bufPtr += 6; // skip (void) timing information
1898 len = *((uint16_t *)bufPtr);
1899 if(len & 0x8000) {
1900 isTag = true;
1901 len &= 0x7fff;
1902 } else {
1903 isTag = false;
1905 bufPtr += 2;
1906 if ((len == 14) && (bufPtr[0] == 0xff) && (bufPtr[1] == 0xff) && (bufPtr[12] == 0xff) && (bufPtr[13] == 0xff)) {
1907 memcpy(uid, bufPtr + 2, 7);
1908 memcpy(atqa, bufPtr + 2 + 7, 2);
1909 uid_len = (atqa[0] & 0xC0) == 0x40 ? 7 : 4;
1910 sak = bufPtr[11];
1911 PrintAndLog("tag select uid:%s atqa:0x%02x%02x sak:0x%02x",
1912 sprint_hex(uid + (7 - uid_len), uid_len),
1913 atqa[1],
1914 atqa[0],
1915 sak);
1916 if (wantLogToFile || wantDecrypt) {
1917 FillFileNameByUID(logHexFileName, uid + (7 - uid_len), ".log", uid_len);
1918 AddLogCurrentDT(logHexFileName);
1920 if (wantDecrypt)
1921 mfTraceInit(uid, atqa, sak, wantSaveToEmlFile);
1922 } else {
1923 PrintAndLog("%s(%d):%s", isTag ? "TAG":"RDR", num, sprint_hex(bufPtr, len));
1924 if (wantLogToFile)
1925 AddLogHex(logHexFileName, isTag ? "TAG: ":"RDR: ", bufPtr, len);
1926 if (wantDecrypt)
1927 mfTraceDecode(bufPtr, len, wantSaveToEmlFile);
1928 num++;
1930 bufPtr += len;
1931 bufPtr += ((len-1)/8+1); // ignore parity
1933 pckNum = 0;
1935 } // resp not NULL
1936 } // while (true)
1938 free(buf);
1939 return 0;
1943 static command_t CommandTable[] =
1945 {"help", CmdHelp, 1, "This help"},
1946 {"dbg", CmdHF14AMfDbg, 0, "Set default debug mode"},
1947 {"rdbl", CmdHF14AMfRdBl, 0, "Read MIFARE classic block"},
1948 {"rdsc", CmdHF14AMfRdSc, 0, "Read MIFARE classic sector"},
1949 {"dump", CmdHF14AMfDump, 0, "Dump MIFARE classic tag to binary file"},
1950 {"restore", CmdHF14AMfRestore, 0, "Restore MIFARE classic binary file to BLANK tag"},
1951 {"wrbl", CmdHF14AMfWrBl, 0, "Write MIFARE classic block"},
1952 {"chk", CmdHF14AMfChk, 0, "Test block keys"},
1953 {"mifare", CmdHF14AMifare, 0, "Read parity error messages."},
1954 {"nested", CmdHF14AMfNested, 0, "Test nested authentication"},
1955 {"sniff", CmdHF14AMfSniff, 0, "Sniff card-reader communication"},
1956 {"sim", CmdHF14AMf1kSim, 0, "Simulate MIFARE card"},
1957 {"eclr", CmdHF14AMfEClear, 0, "Clear simulator memory block"},
1958 {"eget", CmdHF14AMfEGet, 0, "Get simulator memory block"},
1959 {"eset", CmdHF14AMfESet, 0, "Set simulator memory block"},
1960 {"eload", CmdHF14AMfELoad, 0, "Load from file emul dump"},
1961 {"esave", CmdHF14AMfESave, 0, "Save to file emul dump"},
1962 {"ecfill", CmdHF14AMfECFill, 0, "Fill simulator memory with help of keys from simulator"},
1963 {"ekeyprn", CmdHF14AMfEKeyPrn, 0, "Print keys from simulator memory"},
1964 {"csetuid", CmdHF14AMfCSetUID, 0, "Set UID for magic Chinese card"},
1965 {"csetblk", CmdHF14AMfCSetBlk, 0, "Write block - Magic Chinese card"},
1966 {"cgetblk", CmdHF14AMfCGetBlk, 0, "Read block - Magic Chinese card"},
1967 {"cgetsc", CmdHF14AMfCGetSc, 0, "Read sector - Magic Chinese card"},
1968 {"cload", CmdHF14AMfCLoad, 0, "Load dump into magic Chinese card"},
1969 {"csave", CmdHF14AMfCSave, 0, "Save dump from magic Chinese card into file or emulator"},
1970 {NULL, NULL, 0, NULL}
1973 int CmdHFMF(const char *Cmd)
1975 // flush
1976 WaitForResponseTimeout(CMD_ACK,NULL,100);
1978 CmdsParse(CommandTable, Cmd);
1979 return 0;
1982 int CmdHelp(const char *Cmd)
1984 CmdsHelp(CommandTable);
1985 return 0;