]> cvs.zerfleddert.de Git - proxmark3-svn/blob - client/cmdhfmf.c
CHG: The input handling for "hf 14b write" is now correct. Thanks Asper for spotting...
[proxmark3-svn] / client / cmdhfmf.c
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 //-----------------------------------------------------------------------------
10 #include "../include/mifare.h"
11 #include "cmdhfmf.h"
12
13 static int CmdHelp(const char *Cmd);
14
15 int CmdHF14AMifare(const char *Cmd)
16 {
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};
22
23 UsbCommand c = {CMD_READER_MIFARE, {true, 0, 0}};
24
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");
30
31
32 start:
33 clearCommandBuffer();
34 SendCommand(&c);
35
36 //flush queue
37 while (ukbhit()) getchar();
38
39 // wait cycle
40 while (true) {
41 printf(".");
42 fflush(stdout);
43 if (ukbhit()) {
44 getchar();
45 printf("\naborted via keyboard!\n");
46 break;
47 }
48
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;
60 }
61 }
62
63 printf("\n");
64
65 // error
66 if (isOK != 1) return 1;
67
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);
75
76 num_to_bytes(r_key, 6, keyBlock);
77 isOK = mfCheckKeys(0, 0, 1, keyBlock, &r_key);
78 }
79
80 if (!isOK)
81 PrintAndLog("Found valid key :%012"llx, r_key);
82 else
83 {
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;
88 }
89
90 PrintAndLog("");
91 return 0;
92 }
93
94 int CmdHF14AMfWrBl(const char *Cmd)
95 {
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};
100
101 char cmdp = 0x00;
102
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;
107 }
108
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;
114 }
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;
119 }
120 if (param_gethex(Cmd, 3, bldata, 32)) {
121 PrintAndLog("Block data must include 32 HEX symbols");
122 return 1;
123 }
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));
126
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);
131
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");
138 }
139
140 return 0;
141 }
142
143 int CmdHF14AMfRdBl(const char *Cmd)
144 {
145 uint8_t blockNo = 0;
146 uint8_t keyType = 0;
147 uint8_t key[6] = {0, 0, 0, 0, 0, 0};
148
149 char cmdp = 0x00;
150
151
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;
156 }
157
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;
163 }
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;
168 }
169 PrintAndLog("--block no:%d, key type:%c, key:%s ", blockNo, keyType?'B':'A', sprint_hex(key, 6));
170
171 UsbCommand c = {CMD_MIFARE_READBL, {blockNo, keyType, 0}};
172 memcpy(c.d.asBytes, key, 6);
173 SendCommand(&c);
174
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;
179
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");
186 }
187
188 return 0;
189 }
190
191 int CmdHF14AMfRdSc(const char *Cmd)
192 {
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;
200
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;
205 }
206
207 sectorNo = param_get8(Cmd, 0);
208 if (sectorNo > 39) {
209 PrintAndLog("Sector number must be less than 40");
210 return 1;
211 }
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;
216 }
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;
221 }
222 PrintAndLog("--sector no:%d key type:%c key:%s ", sectorNo, keyType?'B':'A', sprint_hex(key, 6));
223
224 UsbCommand c = {CMD_MIFARE_READSC, {sectorNo, keyType, 0}};
225 memcpy(c.d.asBytes, key, 6);
226 SendCommand(&c);
227 PrintAndLog(" ");
228
229 UsbCommand resp;
230 if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
231 isOK = resp.arg[0] & 0xff;
232 data = resp.d.asBytes;
233
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));
238 }
239 PrintAndLog("trailer: %s", sprint_hex(data + (sectorNo<32?3:15) * 16, 16));
240 }
241 } else {
242 PrintAndLog("Command execute timeout");
243 }
244
245 return 0;
246 }
247
248 uint8_t FirstBlockOfSector(uint8_t sectorNo)
249 {
250 if (sectorNo < 32) {
251 return sectorNo * 4;
252 } else {
253 return 32 * 4 + (sectorNo - 32) * 16;
254 }
255 }
256
257 uint8_t NumBlocksPerSector(uint8_t sectorNo)
258 {
259 if (sectorNo < 32) {
260 return 4;
261 } else {
262 return 16;
263 }
264 }
265
266 int CmdHF14AMfDump(const char *Cmd)
267 {
268 uint8_t sectorNo, blockNo;
269
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;
275
276 FILE *fin;
277 FILE *fout;
278
279 UsbCommand resp;
280
281 int size = GetCardSize();
282 char cmdp = param_getchar(Cmd, 0);
283
284 if ( size > -1)
285 cmdp = (char)(48+size);
286
287 PrintAndLog("Got %d",cmdp);
288
289 switch (cmdp) {
290 case '0' : numSectors = 5; break;
291 case '1' :
292 case '\0': numSectors = 16; break;
293 case '2' : numSectors = 32; break;
294 case '4' : numSectors = 40; break;
295 default: numSectors = 16;
296 }
297
298 if (strlen(Cmd) > 1 || cmdp == 'h' || cmdp == 'H') {
299 PrintAndLog("Usage: hf mf dump [card memory]");
300 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
301 PrintAndLog("");
302 PrintAndLog("Samples: hf mf dump");
303 PrintAndLog(" hf mf dump 4");
304 return 0;
305 }
306
307 if ((fin = fopen("dumpkeys.bin","rb")) == NULL) {
308 PrintAndLog("Could not find file dumpkeys.bin");
309 return 1;
310 }
311
312 // Read keys A from file
313 for (sectorNo=0; sectorNo<numSectors; sectorNo++) {
314 if (fread( keyA[sectorNo], 1, 6, fin ) == 0) {
315 PrintAndLog("File reading error.");
316 fclose(fin);
317 return 2;
318 }
319 }
320
321 // Read keys B from file
322 for (sectorNo=0; sectorNo<numSectors; sectorNo++) {
323 if (fread( keyB[sectorNo], 1, 6, fin ) == 0) {
324 PrintAndLog("File reading error.");
325 fclose(fin);
326 return 2;
327 }
328 }
329
330 fclose(fin);
331
332 PrintAndLog("|-----------------------------------------|");
333 PrintAndLog("|------ Reading sector access bits...-----|");
334 PrintAndLog("|-----------------------------------------|");
335
336 for (sectorNo = 0; sectorNo < numSectors; sectorNo++) {
337 UsbCommand c = {CMD_MIFARE_READBL, {FirstBlockOfSector(sectorNo) + NumBlocksPerSector(sectorNo) - 1, 0, 0}};
338 memcpy(c.d.asBytes, keyA[sectorNo], 6);
339 SendCommand(&c);
340
341 if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
342 uint8_t isOK = resp.arg[0] & 0xff;
343 uint8_t *data = resp.d.asBytes;
344 if (isOK){
345 rights[sectorNo][0] = ((data[7] & 0x10)>>2) | ((data[8] & 0x1)<<1) | ((data[8] & 0x10)>>4); // C1C2C3 for data area 0
346 rights[sectorNo][1] = ((data[7] & 0x20)>>3) | ((data[8] & 0x2)<<0) | ((data[8] & 0x20)>>5); // C1C2C3 for data area 1
347 rights[sectorNo][2] = ((data[7] & 0x40)>>4) | ((data[8] & 0x4)>>1) | ((data[8] & 0x40)>>6); // C1C2C3 for data area 2
348 rights[sectorNo][3] = ((data[7] & 0x80)>>5) | ((data[8] & 0x8)>>2) | ((data[8] & 0x80)>>7); // C1C2C3 for sector trailer
349 } else {
350 PrintAndLog("Could not get access rights for sector %2d. Trying with defaults...", sectorNo);
351 rights[sectorNo][0] = rights[sectorNo][1] = rights[sectorNo][2] = 0x00;
352 rights[sectorNo][3] = 0x01;
353 }
354 } else {
355 PrintAndLog("Command execute timeout when trying to read access rights for sector %2d. Trying with defaults...", sectorNo);
356 rights[sectorNo][0] = rights[sectorNo][1] = rights[sectorNo][2] = 0x00;
357 rights[sectorNo][3] = 0x01;
358 }
359 }
360
361 PrintAndLog("|-----------------------------------------|");
362 PrintAndLog("|----- Dumping all blocks to file... -----|");
363 PrintAndLog("|-----------------------------------------|");
364
365 bool isOK = true;
366 for (sectorNo = 0; isOK && sectorNo < numSectors; sectorNo++) {
367 for (blockNo = 0; isOK && blockNo < NumBlocksPerSector(sectorNo); blockNo++) {
368 bool received = false;
369
370 if (blockNo == NumBlocksPerSector(sectorNo) - 1) { // sector trailer. At least the Access Conditions can always be read with key A.
371 UsbCommand c = {CMD_MIFARE_READBL, {FirstBlockOfSector(sectorNo) + blockNo, 0, 0}};
372 memcpy(c.d.asBytes, keyA[sectorNo], 6);
373 SendCommand(&c);
374 received = WaitForResponseTimeout(CMD_ACK,&resp,1500);
375 } else { // data block. Check if it can be read with key A or key B
376 uint8_t data_area = sectorNo<32?blockNo:blockNo/5;
377 if ((rights[sectorNo][data_area] == 0x03) || (rights[sectorNo][data_area] == 0x05)) { // only key B would work
378 UsbCommand c = {CMD_MIFARE_READBL, {FirstBlockOfSector(sectorNo) + blockNo, 1, 0}};
379 memcpy(c.d.asBytes, keyB[sectorNo], 6);
380 SendCommand(&c);
381 received = WaitForResponseTimeout(CMD_ACK,&resp,1500);
382 } else if (rights[sectorNo][data_area] == 0x07) { // no key would work
383 isOK = false;
384 PrintAndLog("Access rights do not allow reading of sector %2d block %3d", sectorNo, blockNo);
385 } else { // key A would work
386 UsbCommand c = {CMD_MIFARE_READBL, {FirstBlockOfSector(sectorNo) + blockNo, 0, 0}};
387 memcpy(c.d.asBytes, keyA[sectorNo], 6);
388 SendCommand(&c);
389 received = WaitForResponseTimeout(CMD_ACK,&resp,1500);
390 }
391 }
392
393 if (received) {
394 isOK = resp.arg[0] & 0xff;
395 uint8_t *data = resp.d.asBytes;
396 if (blockNo == NumBlocksPerSector(sectorNo) - 1) { // sector trailer. Fill in the keys.
397 data[0] = (keyA[sectorNo][0]);
398 data[1] = (keyA[sectorNo][1]);
399 data[2] = (keyA[sectorNo][2]);
400 data[3] = (keyA[sectorNo][3]);
401 data[4] = (keyA[sectorNo][4]);
402 data[5] = (keyA[sectorNo][5]);
403 data[10] = (keyB[sectorNo][0]);
404 data[11] = (keyB[sectorNo][1]);
405 data[12] = (keyB[sectorNo][2]);
406 data[13] = (keyB[sectorNo][3]);
407 data[14] = (keyB[sectorNo][4]);
408 data[15] = (keyB[sectorNo][5]);
409 }
410 if (isOK) {
411 memcpy(carddata[FirstBlockOfSector(sectorNo) + blockNo], data, 16);
412 PrintAndLog("Successfully read block %2d of sector %2d.", blockNo, sectorNo);
413 } else {
414 PrintAndLog("Could not read block %2d of sector %2d", blockNo, sectorNo);
415 break;
416 }
417 }
418 else {
419 isOK = false;
420 PrintAndLog("Command execute timeout when trying to read block %2d of sector %2d.", blockNo, sectorNo);
421 break;
422 }
423 }
424 }
425
426 if (isOK) {
427 if ((fout = fopen("dumpdata.bin","wb")) == NULL) {
428 PrintAndLog("Could not create file name dumpdata.bin");
429 return 1;
430 }
431 uint16_t numblocks = FirstBlockOfSector(numSectors - 1) + NumBlocksPerSector(numSectors - 1);
432 fwrite(carddata, 1, 16*numblocks, fout);
433 fclose(fout);
434 PrintAndLog("Dumped %d blocks (%d bytes) to file dumpdata.bin", numblocks, 16*numblocks);
435 }
436
437 return 0;
438 }
439
440 int CmdHF14AMfRestore(const char *Cmd)
441 {
442 uint8_t sectorNo,blockNo;
443 uint8_t keyType = 0;
444 uint8_t key[6] = {0xFF};
445 uint8_t bldata[16] = {0x00};
446 uint8_t keyA[40][6];
447 uint8_t keyB[40][6];
448 uint8_t numSectors;
449
450 FILE *fdump;
451 FILE *fkeys;
452
453 char cmdp = param_getchar(Cmd, 0);
454 switch (cmdp) {
455 case '0' : numSectors = 5; break;
456 case '1' :
457 case '\0': numSectors = 16; break;
458 case '2' : numSectors = 32; break;
459 case '4' : numSectors = 40; break;
460 default: numSectors = 16;
461 }
462
463 if (strlen(Cmd) > 1 || cmdp == 'h' || cmdp == 'H') {
464 PrintAndLog("Usage: hf mf restore [card memory]");
465 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
466 PrintAndLog("");
467 PrintAndLog("Samples: hf mf restore");
468 PrintAndLog(" hf mf restore 4");
469 return 0;
470 }
471
472 if ((fkeys = fopen("dumpkeys.bin","rb")) == NULL) {
473 PrintAndLog("Could not find file dumpkeys.bin");
474 return 1;
475 }
476
477 for (sectorNo = 0; sectorNo < numSectors; sectorNo++) {
478 if (fread(keyA[sectorNo], 1, 6, fkeys) == 0) {
479 PrintAndLog("File reading error (dumpkeys.bin).");
480 return 2;
481 }
482 }
483
484 for (sectorNo = 0; sectorNo < numSectors; sectorNo++) {
485 if (fread(keyB[sectorNo], 1, 6, fkeys) == 0) {
486 PrintAndLog("File reading error (dumpkeys.bin).");
487 return 2;
488 }
489 }
490
491 fclose(fkeys);
492
493 if ((fdump = fopen("dumpdata.bin","rb")) == NULL) {
494 PrintAndLog("Could not find file dumpdata.bin");
495 return 1;
496 }
497 PrintAndLog("Restoring dumpdata.bin to card");
498
499 for (sectorNo = 0; sectorNo < numSectors; sectorNo++) {
500 for(blockNo = 0; blockNo < NumBlocksPerSector(sectorNo); blockNo++) {
501 UsbCommand c = {CMD_MIFARE_WRITEBL, {FirstBlockOfSector(sectorNo) + blockNo, keyType, 0}};
502 memcpy(c.d.asBytes, key, 6);
503
504 if (fread(bldata, 1, 16, fdump) == 0) {
505 PrintAndLog("File reading error (dumpdata.bin).");
506 fclose(fdump);
507 return 2;
508 }
509
510 if (blockNo == NumBlocksPerSector(sectorNo) - 1) { // sector trailer
511 bldata[0] = (keyA[sectorNo][0]);
512 bldata[1] = (keyA[sectorNo][1]);
513 bldata[2] = (keyA[sectorNo][2]);
514 bldata[3] = (keyA[sectorNo][3]);
515 bldata[4] = (keyA[sectorNo][4]);
516 bldata[5] = (keyA[sectorNo][5]);
517 bldata[10] = (keyB[sectorNo][0]);
518 bldata[11] = (keyB[sectorNo][1]);
519 bldata[12] = (keyB[sectorNo][2]);
520 bldata[13] = (keyB[sectorNo][3]);
521 bldata[14] = (keyB[sectorNo][4]);
522 bldata[15] = (keyB[sectorNo][5]);
523 }
524
525 PrintAndLog("Writing to block %3d: %s", FirstBlockOfSector(sectorNo) + blockNo, sprint_hex(bldata, 16));
526
527 memcpy(c.d.asBytes + 10, bldata, 16);
528 SendCommand(&c);
529
530 UsbCommand resp;
531 if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
532 uint8_t isOK = resp.arg[0] & 0xff;
533 PrintAndLog("isOk:%02x", isOK);
534 } else {
535 PrintAndLog("Command execute timeout");
536 }
537 }
538 }
539
540 fclose(fdump);
541 return 0;
542 }
543
544 int CmdHF14AMfNested(const char *Cmd)
545 {
546 int i, j, res, iterations;
547 sector *e_sector = NULL;
548 uint8_t blockNo = 0;
549 uint8_t keyType = 0;
550 uint8_t trgBlockNo = 0;
551 uint8_t trgKeyType = 0;
552 uint8_t SectorsCnt = 0;
553 uint8_t key[6] = {0, 0, 0, 0, 0, 0};
554 uint8_t keyBlock[13*6];
555 uint64_t key64 = 0;
556 bool transferToEml = false;
557
558 bool createDumpFile = false;
559 FILE *fkeys;
560 uint8_t standart[6] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
561 uint8_t tempkey[6] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
562
563 char cmdp, ctmp;
564
565 if (strlen(Cmd)<3) {
566 PrintAndLog("Usage:");
567 PrintAndLog(" all sectors: hf mf nested <card memory> <block number> <key A/B> <key (12 hex symbols)> [t,d]");
568 PrintAndLog(" one sector: hf mf nested o <block number> <key A/B> <key (12 hex symbols)>");
569 PrintAndLog(" <target block number> <target key A/B> [t]");
570 PrintAndLog("card memory - 0 - MINI(320 bytes), 1 - 1K, 2 - 2K, 4 - 4K, <other> - 1K");
571 PrintAndLog("t - transfer keys into emulator memory");
572 PrintAndLog("d - write keys to binary file");
573 PrintAndLog(" ");
574 PrintAndLog(" sample1: hf mf nested 1 0 A FFFFFFFFFFFF ");
575 PrintAndLog(" sample2: hf mf nested 1 0 A FFFFFFFFFFFF t ");
576 PrintAndLog(" sample3: hf mf nested 1 0 A FFFFFFFFFFFF d ");
577 PrintAndLog(" sample4: hf mf nested o 0 A FFFFFFFFFFFF 4 A");
578 return 0;
579 }
580
581 cmdp = param_getchar(Cmd, 0);
582 blockNo = param_get8(Cmd, 1);
583 ctmp = param_getchar(Cmd, 2);
584
585 if (ctmp != 'a' && ctmp != 'A' && ctmp != 'b' && ctmp != 'B') {
586 PrintAndLog("Key type must be A or B");
587 return 1;
588 }
589
590 if (ctmp != 'A' && ctmp != 'a')
591 keyType = 1;
592
593 if (param_gethex(Cmd, 3, key, 12)) {
594 PrintAndLog("Key must include 12 HEX symbols");
595 return 1;
596 }
597
598 if (cmdp == 'o' || cmdp == 'O') {
599 cmdp = 'o';
600 trgBlockNo = param_get8(Cmd, 4);
601 ctmp = param_getchar(Cmd, 5);
602 if (ctmp != 'a' && ctmp != 'A' && ctmp != 'b' && ctmp != 'B') {
603 PrintAndLog("Target key type must be A or B");
604 return 1;
605 }
606 if (ctmp != 'A' && ctmp != 'a')
607 trgKeyType = 1;
608 } else {
609
610 switch (cmdp) {
611 case '0': SectorsCnt = 05; break;
612 case '1': SectorsCnt = 16; break;
613 case '2': SectorsCnt = 32; break;
614 case '4': SectorsCnt = 40; break;
615 default: SectorsCnt = 16;
616 }
617 }
618
619 ctmp = param_getchar(Cmd, 4);
620 if (ctmp == 't' || ctmp == 'T') transferToEml = true;
621 else if (ctmp == 'd' || ctmp == 'D') createDumpFile = true;
622
623 ctmp = param_getchar(Cmd, 6);
624 transferToEml |= (ctmp == 't' || ctmp == 'T');
625 transferToEml |= (ctmp == 'd' || ctmp == 'D');
626
627 if (cmdp == 'o') {
628 PrintAndLog("--target block no:%3d, target key type:%c ", trgBlockNo, trgKeyType?'B':'A');
629 if (mfnested(blockNo, keyType, key, trgBlockNo, trgKeyType, keyBlock, true)) {
630 PrintAndLog("Nested error.");
631 return 2;
632 }
633 key64 = bytes_to_num(keyBlock, 6);
634 if (key64) {
635 PrintAndLog("Found valid key:%012"llx, key64);
636
637 // transfer key to the emulator
638 if (transferToEml) {
639 uint8_t sectortrailer;
640 if (trgBlockNo < 32*4) { // 4 block sector
641 sectortrailer = (trgBlockNo & 0x03) + 3;
642 } else { // 16 block sector
643 sectortrailer = (trgBlockNo & 0x0f) + 15;
644 }
645 mfEmlGetMem(keyBlock, sectortrailer, 1);
646
647 if (!trgKeyType)
648 num_to_bytes(key64, 6, keyBlock);
649 else
650 num_to_bytes(key64, 6, &keyBlock[10]);
651 mfEmlSetMem(keyBlock, sectortrailer, 1);
652 }
653 } else {
654 PrintAndLog("No valid key found");
655 }
656 }
657 else { // ------------------------------------ multiple sectors working
658 clock_t time1;
659 time1 = clock();
660
661 e_sector = calloc(SectorsCnt, sizeof(sector));
662 if (e_sector == NULL) return 1;
663
664 //test current key and additional standard keys first
665 memcpy(keyBlock, key, 6);
666 num_to_bytes(0xffffffffffff, 6, (uint8_t*)(keyBlock + 1 * 6));
667 num_to_bytes(0x000000000000, 6, (uint8_t*)(keyBlock + 2 * 6));
668 num_to_bytes(0xa0a1a2a3a4a5, 6, (uint8_t*)(keyBlock + 3 * 6));
669 num_to_bytes(0xb0b1b2b3b4b5, 6, (uint8_t*)(keyBlock + 4 * 6));
670 num_to_bytes(0xaabbccddeeff, 6, (uint8_t*)(keyBlock + 5 * 6));
671 num_to_bytes(0x4d3a99c351dd, 6, (uint8_t*)(keyBlock + 6 * 6));
672 num_to_bytes(0x1a982c7e459a, 6, (uint8_t*)(keyBlock + 7 * 6));
673 num_to_bytes(0xd3f7d3f7d3f7, 6, (uint8_t*)(keyBlock + 8 * 6));
674 num_to_bytes(0x714c5c886e97, 6, (uint8_t*)(keyBlock + 9 * 6));
675 num_to_bytes(0x587ee5f9350f, 6, (uint8_t*)(keyBlock + 10 * 6));
676 num_to_bytes(0xa0478cc39091, 6, (uint8_t*)(keyBlock + 11 * 6));
677 num_to_bytes(0x533cb6c723f6, 6, (uint8_t*)(keyBlock + 12 * 6));
678 num_to_bytes(0x8fd0a4f256e9, 6, (uint8_t*)(keyBlock + 13 * 6));
679
680 PrintAndLog("Testing known keys. Sector count=%d", SectorsCnt);
681 for (i = 0; i < SectorsCnt; i++) {
682 for (j = 0; j < 2; j++) {
683 if (e_sector[i].foundKey[j]) continue;
684
685 res = mfCheckKeys(FirstBlockOfSector(i), j, 6, keyBlock, &key64);
686
687 if (!res) {
688 e_sector[i].Key[j] = key64;
689 e_sector[i].foundKey[j] = 1;
690 }
691 }
692 }
693
694 // nested sectors
695 iterations = 0;
696 PrintAndLog("nested...");
697 bool calibrate = true;
698 for (i = 0; i < NESTED_SECTOR_RETRY; i++) {
699 for (uint8_t sectorNo = 0; sectorNo < SectorsCnt; sectorNo++) {
700
701 if (ukbhit()) {
702 printf("\naborted via keyboard!\n");
703 free(e_sector);
704 return 2;
705 }
706
707 for (trgKeyType = 0; trgKeyType < 2; trgKeyType++) {
708 if (e_sector[sectorNo].foundKey[trgKeyType]) continue;
709 PrintAndLog("-----------------------------------------------");
710 if(mfnested(blockNo, keyType, key, FirstBlockOfSector(sectorNo), trgKeyType, keyBlock, calibrate)) {
711 PrintAndLog("Nested error.\n");
712 free(e_sector);
713 return 2; }
714 else {
715 calibrate = false;
716 }
717
718 iterations++;
719
720 key64 = bytes_to_num(keyBlock, 6);
721 if (key64) {
722 PrintAndLog("Found valid key:%012"llx, key64);
723 e_sector[sectorNo].foundKey[trgKeyType] = 1;
724 e_sector[sectorNo].Key[trgKeyType] = key64;
725 }
726 }
727 }
728 }
729
730 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);
731
732 PrintAndLog("-----------------------------------------------\nIterations count: %d\n\n", iterations);
733 //print them
734 PrintAndLog("|---|----------------|---|----------------|---|");
735 PrintAndLog("|sec|key A |res|key B |res|");
736 PrintAndLog("|---|----------------|---|----------------|---|");
737 for (i = 0; i < SectorsCnt; i++) {
738 PrintAndLog("|%03d| %012"llx" | %d | %012"llx" | %d |", i,
739 e_sector[i].Key[0], e_sector[i].foundKey[0], e_sector[i].Key[1], e_sector[i].foundKey[1]);
740 }
741 PrintAndLog("|---|----------------|---|----------------|---|");
742
743 // transfer them to the emulator
744 if (transferToEml) {
745 for (i = 0; i < SectorsCnt; i++) {
746 mfEmlGetMem(keyBlock, FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1, 1);
747 if (e_sector[i].foundKey[0])
748 num_to_bytes(e_sector[i].Key[0], 6, keyBlock);
749 if (e_sector[i].foundKey[1])
750 num_to_bytes(e_sector[i].Key[1], 6, &keyBlock[10]);
751 mfEmlSetMem(keyBlock, FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1, 1);
752 }
753 }
754
755 // Create dump file
756 if (createDumpFile) {
757 if ((fkeys = fopen("dumpkeys.bin","wb")) == NULL) {
758 PrintAndLog("Could not create file dumpkeys.bin");
759 free(e_sector);
760 return 1;
761 }
762 PrintAndLog("Printing keys to binary file dumpkeys.bin...");
763 for(i=0; i<SectorsCnt; i++) {
764 if (e_sector[i].foundKey[0]){
765 num_to_bytes(e_sector[i].Key[0], 6, tempkey);
766 fwrite ( tempkey, 1, 6, fkeys );
767 }
768 else{
769 fwrite ( &standart, 1, 6, fkeys );
770 }
771 }
772 for(i=0; i<SectorsCnt; i++) {
773 if (e_sector[i].foundKey[1]){
774 num_to_bytes(e_sector[i].Key[1], 6, tempkey);
775 fwrite ( tempkey, 1, 6, fkeys );
776 }
777 else{
778 fwrite ( &standart, 1, 6, fkeys );
779 }
780 }
781 fclose(fkeys);
782 }
783
784 free(e_sector);
785 }
786 return 0;
787 }
788
789 int CmdHF14AMfChk(const char *Cmd)
790 {
791 if (strlen(Cmd)<3) {
792 PrintAndLog("Usage: hf mf chk <block number>|<*card memory> <key type (A/B/?)> [t|d] [<key (12 hex symbols)>] [<dic (*.dic)>]");
793 PrintAndLog(" * - all sectors");
794 PrintAndLog("card memory - 0 - MINI(320 bytes), 1 - 1K, 2 - 2K, 4 - 4K, <other> - 1K");
795 PrintAndLog("d - write keys to binary file\n");
796 PrintAndLog("t - write keys to emulator memory");
797 PrintAndLog(" sample: hf mf chk 0 A 1234567890ab keys.dic");
798 PrintAndLog(" hf mf chk *1 ? t");
799 PrintAndLog(" hf mf chk *1 ? d");
800 return 0;
801 }
802
803 FILE * f;
804 char filename[FILE_PATH_SIZE]={0};
805 char buf[13];
806 uint8_t *keyBlock = NULL, *p;
807 uint8_t stKeyBlock = 20;
808
809 int i, res;
810 int keycnt = 0;
811 char ctmp = 0x00;
812 uint8_t blockNo = 0;
813 uint8_t SectorsCnt = 1;
814 uint8_t keyType = 0;
815 uint64_t key64 = 0;
816
817 int transferToEml = 0;
818 int createDumpFile = 0;
819
820 keyBlock = calloc(stKeyBlock, 6);
821 if (keyBlock == NULL) return 1;
822
823 uint64_t defaultKeys[] =
824 {
825 0xffffffffffff, // Default key (first key used by program if no user defined key)
826 0x000000000000, // Blank key
827 0xa0a1a2a3a4a5, // NFCForum MAD key
828 0xb0b1b2b3b4b5,
829 0xaabbccddeeff,
830 0x4d3a99c351dd,
831 0x1a982c7e459a,
832 0xd3f7d3f7d3f7,
833 0x714c5c886e97,
834 0x587ee5f9350f,
835 0xa0478cc39091,
836 0x533cb6c723f6,
837 0x8fd0a4f256e9
838 };
839 int defaultKeysSize = sizeof(defaultKeys) / sizeof(uint64_t);
840
841 for (int defaultKeyCounter = 0; defaultKeyCounter < defaultKeysSize; defaultKeyCounter++)
842 {
843 num_to_bytes(defaultKeys[defaultKeyCounter], 6, (uint8_t*)(keyBlock + defaultKeyCounter * 6));
844 }
845
846 if (param_getchar(Cmd, 0)=='*') {
847 blockNo = 3;
848 switch(param_getchar(Cmd+1, 0)) {
849 case '0': SectorsCnt = 5; break;
850 case '1': SectorsCnt = 16; break;
851 case '2': SectorsCnt = 32; break;
852 case '4': SectorsCnt = 40; break;
853 default: SectorsCnt = 16;
854 }
855 }
856 else
857 blockNo = param_get8(Cmd, 0);
858
859 ctmp = param_getchar(Cmd, 1);
860 switch (ctmp) {
861 case 'a': case 'A':
862 keyType = !0;
863 break;
864 case 'b': case 'B':
865 keyType = !1;
866 break;
867 case '?':
868 keyType = 2;
869 break;
870 default:
871 PrintAndLog("Key type must be A , B or ?");
872 return 1;
873 };
874
875 ctmp = param_getchar(Cmd, 2);
876 if (ctmp == 't' || ctmp == 'T') transferToEml = 1;
877 else if (ctmp == 'd' || ctmp == 'D') createDumpFile = 1;
878
879 for (i = transferToEml || createDumpFile; param_getchar(Cmd, 2 + i); i++) {
880 if (!param_gethex(Cmd, 2 + i, keyBlock + 6 * keycnt, 12)) {
881 if ( stKeyBlock - keycnt < 2) {
882 p = realloc(keyBlock, 6*(stKeyBlock+=10));
883 if (!p) {
884 PrintAndLog("Cannot allocate memory for Keys");
885 free(keyBlock);
886 return 2;
887 }
888 keyBlock = p;
889 }
890 PrintAndLog("chk key[%2d] %02x%02x%02x%02x%02x%02x", keycnt,
891 (keyBlock + 6*keycnt)[0],(keyBlock + 6*keycnt)[1], (keyBlock + 6*keycnt)[2],
892 (keyBlock + 6*keycnt)[3], (keyBlock + 6*keycnt)[4], (keyBlock + 6*keycnt)[5], 6);
893 keycnt++;
894 } else {
895 // May be a dic file
896 if ( param_getstr(Cmd, 2 + i,filename) >= FILE_PATH_SIZE ) {
897 PrintAndLog("File name too long");
898 free(keyBlock);
899 return 2;
900 }
901
902 if ( (f = fopen( filename , "r")) ) {
903 while( fgets(buf, sizeof(buf), f) ){
904 if (strlen(buf) < 12 || buf[11] == '\n')
905 continue;
906
907 while (fgetc(f) != '\n' && !feof(f)) ; //goto next line
908
909 if( buf[0]=='#' ) continue; //The line start with # is comment, skip
910
911 if (!isxdigit(buf[0])){
912 PrintAndLog("File content error. '%s' must include 12 HEX symbols",buf);
913 continue;
914 }
915
916 buf[12] = 0;
917
918 if ( stKeyBlock - keycnt < 2) {
919 p = realloc(keyBlock, 6*(stKeyBlock+=10));
920 if (!p) {
921 PrintAndLog("Cannot allocate memory for defKeys");
922 free(keyBlock);
923 return 2;
924 }
925 keyBlock = p;
926 }
927 memset(keyBlock + 6 * keycnt, 0, 6);
928 num_to_bytes(strtoll(buf, NULL, 16), 6, keyBlock + 6*keycnt);
929 PrintAndLog("chk custom key[%2d] %012"llx, keycnt, bytes_to_num(keyBlock + 6*keycnt, 6));
930 keycnt++;
931 memset(buf, 0, sizeof(buf));
932 }
933 fclose(f);
934 } else {
935 PrintAndLog("File: %s: not found or locked.", filename);
936 free(keyBlock);
937 return 1;
938
939 }
940 }
941 }
942
943 if (keycnt == 0) {
944 PrintAndLog("No key specified, trying default keys");
945 for (;keycnt < defaultKeysSize; keycnt++)
946 PrintAndLog("chk default key[%2d] %02x%02x%02x%02x%02x%02x", keycnt,
947 (keyBlock + 6*keycnt)[0],(keyBlock + 6*keycnt)[1], (keyBlock + 6*keycnt)[2],
948 (keyBlock + 6*keycnt)[3], (keyBlock + 6*keycnt)[4], (keyBlock + 6*keycnt)[5], 6);
949 }
950
951 // initialize storage for found keys
952 bool validKey[2][40];
953 uint8_t foundKey[2][40][6];
954 for (uint16_t t = 0; t < 2; t++) {
955 for (uint16_t sectorNo = 0; sectorNo < SectorsCnt; sectorNo++) {
956 validKey[t][sectorNo] = false;
957 for (uint16_t i = 0; i < 6; i++) {
958 foundKey[t][sectorNo][i] = 0xff;
959 }
960 }
961 }
962
963 for ( int t = !keyType; t < 2; keyType==2?(t++):(t=2) ) {
964 int b=blockNo;
965 for (int i = 0; i < SectorsCnt; ++i) {
966 PrintAndLog("--sector:%2d, block:%3d, key type:%C, key count:%2d ", i, b, t?'B':'A', keycnt);
967 uint32_t max_keys = keycnt>USB_CMD_DATA_SIZE/6?USB_CMD_DATA_SIZE/6:keycnt;
968 for (uint32_t c = 0; c < keycnt; c+=max_keys) {
969 uint32_t size = keycnt-c>max_keys?max_keys:keycnt-c;
970 res = mfCheckKeys(b, t, size, &keyBlock[6*c], &key64);
971 if (res != 1) {
972 if (!res) {
973 PrintAndLog("Found valid key:[%012"llx"]",key64);
974 num_to_bytes(key64, 6, foundKey[t][i]);
975 validKey[t][i] = true;
976 }
977 } else {
978 PrintAndLog("Command execute timeout");
979 }
980 }
981 b<127?(b+=4):(b+=16);
982 }
983 }
984
985 if (transferToEml) {
986 uint8_t block[16];
987 for (uint16_t sectorNo = 0; sectorNo < SectorsCnt; sectorNo++) {
988 if (validKey[0][sectorNo] || validKey[1][sectorNo]) {
989 mfEmlGetMem(block, FirstBlockOfSector(sectorNo) + NumBlocksPerSector(sectorNo) - 1, 1);
990 for (uint16_t t = 0; t < 2; t++) {
991 if (validKey[t][sectorNo]) {
992 memcpy(block + t*10, foundKey[t][sectorNo], 6);
993 }
994 }
995 mfEmlSetMem(block, FirstBlockOfSector(sectorNo) + NumBlocksPerSector(sectorNo) - 1, 1);
996 }
997 }
998 PrintAndLog("Found keys have been transferred to the emulator memory");
999 }
1000
1001 if (createDumpFile) {
1002 FILE *fkeys = fopen("dumpkeys.bin","wb");
1003 if (fkeys == NULL) {
1004 PrintAndLog("Could not create file dumpkeys.bin");
1005 free(keyBlock);
1006 return 1;
1007 }
1008 for (uint16_t t = 0; t < 2; t++) {
1009 fwrite(foundKey[t], 1, 6*SectorsCnt, fkeys);
1010 }
1011 fclose(fkeys);
1012 PrintAndLog("Found keys have been dumped to file dumpkeys.bin. 0xffffffffffff has been inserted for unknown keys.");
1013 }
1014
1015 free(keyBlock);
1016 PrintAndLog("");
1017 return 0;
1018 }
1019
1020 int CmdHF14AMf1kSim(const char *Cmd)
1021 {
1022 uint8_t uid[7] = {0, 0, 0, 0, 0, 0, 0};
1023 uint8_t exitAfterNReads = 0;
1024 uint8_t flags = 0;
1025
1026 if (param_getchar(Cmd, 0) == 'h') {
1027 PrintAndLog("Usage: hf mf sim u <uid (8 hex symbols)> n <numreads> i x");
1028 PrintAndLog(" u (Optional) UID. If not specified, the UID from emulator memory will be used");
1029 PrintAndLog(" n (Optional) Automatically exit simulation after <numreads> blocks have been read by reader. 0 = infinite");
1030 PrintAndLog(" i (Optional) Interactive, means that console will not be returned until simulation finishes or is aborted");
1031 PrintAndLog(" x (Optional) Crack, performs the 'reader attack', nr/ar attack against a legitimate reader, fishes out the key(s)");
1032 PrintAndLog(" sample: hf mf sim u 0a0a0a0a ");
1033 return 0;
1034 }
1035 uint8_t pnr = 0;
1036 if (param_getchar(Cmd, pnr) == 'u') {
1037 if(param_gethex(Cmd, pnr+1, uid, 8) == 0)
1038 {
1039 flags |= FLAG_4B_UID_IN_DATA; // UID from packet
1040 } else if(param_gethex(Cmd,pnr+1,uid,14) == 0) {
1041 flags |= FLAG_7B_UID_IN_DATA;// UID from packet
1042 } else {
1043 PrintAndLog("UID, if specified, must include 8 or 14 HEX symbols");
1044 return 1;
1045 }
1046 pnr +=2;
1047 }
1048 if (param_getchar(Cmd, pnr) == 'n') {
1049 exitAfterNReads = param_get8(Cmd,pnr+1);
1050 pnr += 2;
1051 }
1052 if (param_getchar(Cmd, pnr) == 'i' ) {
1053 //Using a flag to signal interactiveness, least significant bit
1054 flags |= FLAG_INTERACTIVE;
1055 pnr++;
1056 }
1057
1058 if (param_getchar(Cmd, pnr) == 'x' ) {
1059 //Using a flag to signal interactiveness, least significant bit
1060 flags |= FLAG_NR_AR_ATTACK;
1061 }
1062 PrintAndLog(" uid:%s, numreads:%d, flags:%d (0x%02x) ",
1063 flags & FLAG_4B_UID_IN_DATA ? sprint_hex(uid,4):
1064 flags & FLAG_7B_UID_IN_DATA ? sprint_hex(uid,7): "N/A"
1065 , exitAfterNReads, flags,flags);
1066
1067
1068 UsbCommand c = {CMD_SIMULATE_MIFARE_CARD, {flags, exitAfterNReads,0}};
1069 memcpy(c.d.asBytes, uid, sizeof(uid));
1070 SendCommand(&c);
1071
1072 if(flags & FLAG_INTERACTIVE)
1073 {
1074 UsbCommand resp;
1075 PrintAndLog("Press pm3-button to abort simulation");
1076 while(! WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
1077 //We're waiting only 1.5 s at a time, otherwise we get the
1078 // annoying message about "Waiting for a response... "
1079 }
1080 }
1081
1082 return 0;
1083 }
1084
1085 int CmdHF14AMfDbg(const char *Cmd)
1086 {
1087 int dbgMode = param_get32ex(Cmd, 0, 0, 10);
1088 if (dbgMode > 4) {
1089 PrintAndLog("Max debug mode parameter is 4 \n");
1090 }
1091
1092 if (strlen(Cmd) < 1 || !param_getchar(Cmd, 0) || dbgMode > 4) {
1093 PrintAndLog("Usage: hf mf dbg <debug level>");
1094 PrintAndLog(" 0 - no debug messages");
1095 PrintAndLog(" 1 - error messages");
1096 PrintAndLog(" 2 - plus information messages");
1097 PrintAndLog(" 3 - plus debug messages");
1098 PrintAndLog(" 4 - print even debug messages in timing critical functions");
1099 PrintAndLog(" Note: this option therefore may cause malfunction itself");
1100 return 0;
1101 }
1102
1103 UsbCommand c = {CMD_MIFARE_SET_DBGMODE, {dbgMode, 0, 0}};
1104 SendCommand(&c);
1105
1106 return 0;
1107 }
1108
1109 int CmdHF14AMfEGet(const char *Cmd)
1110 {
1111 uint8_t blockNo = 0;
1112 uint8_t data[16];
1113
1114 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1115 PrintAndLog("Usage: hf mf eget <block number>");
1116 PrintAndLog(" sample: hf mf eget 0 ");
1117 return 0;
1118 }
1119
1120 blockNo = param_get8(Cmd, 0);
1121
1122 PrintAndLog(" ");
1123 if (!mfEmlGetMem(data, blockNo, 1)) {
1124 PrintAndLog("data[%3d]:%s", blockNo, sprint_hex(data, 16));
1125 } else {
1126 PrintAndLog("Command execute timeout");
1127 }
1128
1129 return 0;
1130 }
1131
1132 int CmdHF14AMfEClear(const char *Cmd)
1133 {
1134 if (param_getchar(Cmd, 0) == 'h') {
1135 PrintAndLog("Usage: hf mf eclr");
1136 PrintAndLog("It set card emulator memory to empty data blocks and key A/B FFFFFFFFFFFF \n");
1137 return 0;
1138 }
1139
1140 UsbCommand c = {CMD_MIFARE_EML_MEMCLR, {0, 0, 0}};
1141 SendCommand(&c);
1142 return 0;
1143 }
1144
1145
1146 int CmdHF14AMfESet(const char *Cmd)
1147 {
1148 uint8_t memBlock[16];
1149 uint8_t blockNo = 0;
1150
1151 memset(memBlock, 0x00, sizeof(memBlock));
1152
1153 if (strlen(Cmd) < 3 || param_getchar(Cmd, 0) == 'h') {
1154 PrintAndLog("Usage: hf mf eset <block number> <block data (32 hex symbols)>");
1155 PrintAndLog(" sample: hf mf eset 1 000102030405060708090a0b0c0d0e0f ");
1156 return 0;
1157 }
1158
1159 blockNo = param_get8(Cmd, 0);
1160
1161 if (param_gethex(Cmd, 1, memBlock, 32)) {
1162 PrintAndLog("block data must include 32 HEX symbols");
1163 return 1;
1164 }
1165
1166 // 1 - blocks count
1167 UsbCommand c = {CMD_MIFARE_EML_MEMSET, {blockNo, 1, 0}};
1168 memcpy(c.d.asBytes, memBlock, 16);
1169 SendCommand(&c);
1170 return 0;
1171 }
1172
1173
1174 int CmdHF14AMfELoad(const char *Cmd)
1175 {
1176 FILE * f;
1177 char filename[FILE_PATH_SIZE];
1178 char *fnameptr = filename;
1179 char buf[64];
1180 uint8_t buf8[64];
1181 int i, len, blockNum, numBlocks;
1182 int nameParamNo = 1;
1183
1184 memset(filename, 0, sizeof(filename));
1185 memset(buf, 0, sizeof(buf));
1186
1187 char ctmp = param_getchar(Cmd, 0);
1188
1189 if ( ctmp == 'h' || ctmp == 0x00) {
1190 PrintAndLog("It loads emul dump from the file `filename.eml`");
1191 PrintAndLog("Usage: hf mf eload [card memory] <file name w/o `.eml`>");
1192 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
1193 PrintAndLog("");
1194 PrintAndLog(" sample: hf mf eload filename");
1195 PrintAndLog(" hf mf eload 4 filename");
1196 return 0;
1197 }
1198
1199 switch (ctmp) {
1200 case '0' : numBlocks = 5*4; break;
1201 case '1' :
1202 case '\0': numBlocks = 16*4; break;
1203 case '2' : numBlocks = 32*4; break;
1204 case '4' : numBlocks = 256; break;
1205 default: {
1206 numBlocks = 16*4;
1207 nameParamNo = 0;
1208 }
1209 }
1210
1211 len = param_getstr(Cmd,nameParamNo,filename);
1212
1213 if (len > FILE_PATH_SIZE) len = FILE_PATH_SIZE;
1214
1215 fnameptr += len;
1216
1217 sprintf(fnameptr, ".eml");
1218
1219 // open file
1220 f = fopen(filename, "r");
1221 if (f == NULL) {
1222 PrintAndLog("File %s not found or locked", filename);
1223 return 1;
1224 }
1225
1226 blockNum = 0;
1227 while(!feof(f)){
1228 memset(buf, 0, sizeof(buf));
1229
1230 if (fgets(buf, sizeof(buf), f) == NULL) {
1231
1232 if (blockNum >= numBlocks) break;
1233
1234 PrintAndLog("File reading error.");
1235 fclose(f);
1236 return 2;
1237 }
1238
1239 if (strlen(buf) < 32){
1240 if(strlen(buf) && feof(f))
1241 break;
1242 PrintAndLog("File content error. Block data must include 32 HEX symbols");
1243 fclose(f);
1244 return 2;
1245 }
1246
1247 for (i = 0; i < 32; i += 2) {
1248 sscanf(&buf[i], "%02x", (unsigned int *)&buf8[i / 2]);
1249 }
1250
1251 if (mfEmlSetMem(buf8, blockNum, 1)) {
1252 PrintAndLog("Cant set emul block: %3d", blockNum);
1253 fclose(f);
1254 return 3;
1255 }
1256 blockNum++;
1257
1258 if (blockNum >= numBlocks) break;
1259 }
1260 fclose(f);
1261
1262 if ((blockNum != numBlocks)) {
1263 PrintAndLog("File content error. Got %d must be %d blocks.",blockNum, numBlocks);
1264 return 4;
1265 }
1266 PrintAndLog("Loaded %d blocks from file: %s", blockNum, filename);
1267 return 0;
1268 }
1269
1270
1271 int CmdHF14AMfESave(const char *Cmd)
1272 {
1273 FILE * f;
1274 char filename[FILE_PATH_SIZE];
1275 char * fnameptr = filename;
1276 uint8_t buf[64];
1277 int i, j, len, numBlocks;
1278 int nameParamNo = 1;
1279
1280 memset(filename, 0, sizeof(filename));
1281 memset(buf, 0, sizeof(buf));
1282
1283 char ctmp = param_getchar(Cmd, 0);
1284
1285 if ( ctmp == 'h' || ctmp == 'H') {
1286 PrintAndLog("It saves emul dump into the file `filename.eml` or `cardID.eml`");
1287 PrintAndLog(" Usage: hf mf esave [card memory] [file name w/o `.eml`]");
1288 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
1289 PrintAndLog("");
1290 PrintAndLog(" sample: hf mf esave ");
1291 PrintAndLog(" hf mf esave 4");
1292 PrintAndLog(" hf mf esave 4 filename");
1293 return 0;
1294 }
1295
1296 switch (ctmp) {
1297 case '0' : numBlocks = 5*4; break;
1298 case '1' :
1299 case '\0': numBlocks = 16*4; break;
1300 case '2' : numBlocks = 32*4; break;
1301 case '4' : numBlocks = 256; break;
1302 default: {
1303 numBlocks = 16*4;
1304 nameParamNo = 0;
1305 }
1306 }
1307
1308 len = param_getstr(Cmd,nameParamNo,filename);
1309
1310 if (len > FILE_PATH_SIZE) len = FILE_PATH_SIZE;
1311
1312 // user supplied filename?
1313 if (len < 1) {
1314 // get filename (UID from memory)
1315 if (mfEmlGetMem(buf, 0, 1)) {
1316 PrintAndLog("Can\'t get UID from block: %d", 0);
1317 sprintf(filename, "dump.eml");
1318 }
1319 for (j = 0; j < 7; j++, fnameptr += 2)
1320 sprintf(fnameptr, "%02X", buf[j]);
1321 } else {
1322 fnameptr += len;
1323 }
1324
1325 // add file extension
1326 sprintf(fnameptr, ".eml");
1327
1328 // open file
1329 f = fopen(filename, "w+");
1330
1331 if ( !f ) {
1332 PrintAndLog("Can't open file %s ", filename);
1333 return 1;
1334 }
1335
1336 // put hex
1337 for (i = 0; i < numBlocks; i++) {
1338 if (mfEmlGetMem(buf, i, 1)) {
1339 PrintAndLog("Cant get block: %d", i);
1340 break;
1341 }
1342 for (j = 0; j < 16; j++)
1343 fprintf(f, "%02X", buf[j]);
1344 fprintf(f,"\n");
1345 }
1346 fclose(f);
1347
1348 PrintAndLog("Saved %d blocks to file: %s", numBlocks, filename);
1349
1350 return 0;
1351 }
1352
1353
1354 int CmdHF14AMfECFill(const char *Cmd)
1355 {
1356 uint8_t keyType = 0;
1357 uint8_t numSectors = 16;
1358
1359 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1360 PrintAndLog("Usage: hf mf ecfill <key A/B> [card memory]");
1361 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
1362 PrintAndLog("");
1363 PrintAndLog("samples: hf mf ecfill A");
1364 PrintAndLog(" hf mf ecfill A 4");
1365 PrintAndLog("Read card and transfer its data to emulator memory.");
1366 PrintAndLog("Keys must be laid in the emulator memory. \n");
1367 return 0;
1368 }
1369
1370 char ctmp = param_getchar(Cmd, 0);
1371 if (ctmp != 'a' && ctmp != 'A' && ctmp != 'b' && ctmp != 'B') {
1372 PrintAndLog("Key type must be A or B");
1373 return 1;
1374 }
1375 if (ctmp != 'A' && ctmp != 'a') keyType = 1;
1376
1377 ctmp = param_getchar(Cmd, 1);
1378 switch (ctmp) {
1379 case '0' : numSectors = 5; break;
1380 case '1' :
1381 case '\0': numSectors = 16; break;
1382 case '2' : numSectors = 32; break;
1383 case '4' : numSectors = 40; break;
1384 default: numSectors = 16;
1385 }
1386
1387 printf("--params: numSectors: %d, keyType:%d", numSectors, keyType);
1388 UsbCommand c = {CMD_MIFARE_EML_CARDLOAD, {numSectors, keyType, 0}};
1389 SendCommand(&c);
1390 return 0;
1391 }
1392
1393
1394 int CmdHF14AMfEKeyPrn(const char *Cmd)
1395 {
1396 int i;
1397 uint8_t numSectors;
1398 uint8_t data[16];
1399 uint64_t keyA, keyB;
1400
1401 if (param_getchar(Cmd, 0) == 'h') {
1402 PrintAndLog("It prints the keys loaded in the emulator memory");
1403 PrintAndLog("Usage: hf mf ekeyprn [card memory]");
1404 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
1405 PrintAndLog("");
1406 PrintAndLog(" sample: hf mf ekeyprn 1");
1407 return 0;
1408 }
1409
1410 char cmdp = param_getchar(Cmd, 0);
1411
1412 switch (cmdp) {
1413 case '0' : numSectors = 5; break;
1414 case '1' :
1415 case '\0': numSectors = 16; break;
1416 case '2' : numSectors = 32; break;
1417 case '4' : numSectors = 40; break;
1418 default: numSectors = 16;
1419 }
1420
1421 PrintAndLog("|---|----------------|----------------|");
1422 PrintAndLog("|sec|key A |key B |");
1423 PrintAndLog("|---|----------------|----------------|");
1424 for (i = 0; i < numSectors; i++) {
1425 if (mfEmlGetMem(data, FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1, 1)) {
1426 PrintAndLog("error get block %d", FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1);
1427 break;
1428 }
1429 keyA = bytes_to_num(data, 6);
1430 keyB = bytes_to_num(data + 10, 6);
1431 PrintAndLog("|%03d| %012"llx" | %012"llx" |", i, keyA, keyB);
1432 }
1433 PrintAndLog("|---|----------------|----------------|");
1434
1435 return 0;
1436 }
1437
1438
1439 int CmdHF14AMfCSetUID(const char *Cmd)
1440 {
1441 uint8_t wipeCard = 0;
1442 uint8_t uid[8] = {0x00};
1443 uint8_t oldUid[8] = {0x00};
1444 int res;
1445
1446 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1447 PrintAndLog("Usage: hf mf csetuid <UID 8 hex symbols> <w>");
1448 PrintAndLog("sample: hf mf csetuid 01020304 w");
1449 PrintAndLog("Set UID for magic Chinese card (only works with!!!)");
1450 PrintAndLog("If you want wipe card then add 'w' into command line. \n");
1451 return 0;
1452 }
1453
1454 if (param_getchar(Cmd, 0) && param_gethex(Cmd, 0, uid, 8)) {
1455 PrintAndLog("UID must include 8 HEX symbols");
1456 return 1;
1457 }
1458
1459 char ctmp = param_getchar(Cmd, 1);
1460 if (ctmp == 'w' || ctmp == 'W') wipeCard = 1;
1461
1462 PrintAndLog("--wipe card:%02x uid:%s", wipeCard, sprint_hex(uid, 4));
1463
1464 res = mfCSetUID(uid, oldUid, wipeCard);
1465 if (res) {
1466 PrintAndLog("Can't set UID. error=%d", res);
1467 return 1;
1468 }
1469
1470 PrintAndLog("old UID:%s", sprint_hex(oldUid, 4));
1471 PrintAndLog("new UID:%s", sprint_hex(uid, 4));
1472 return 0;
1473 }
1474
1475 int CmdHF14AMfCSetBlk(const char *Cmd)
1476 {
1477 uint8_t uid[8];
1478 uint8_t memBlock[16];
1479 uint8_t blockNo = 0;
1480 int res;
1481 memset(memBlock, 0x00, sizeof(memBlock));
1482
1483 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1484 PrintAndLog("Usage: hf mf csetblk <block number> <block data (32 hex symbols)>");
1485 PrintAndLog("sample: hf mf csetblk 1 01020304050607080910111213141516");
1486 PrintAndLog("Set block data for magic Chinese card (only works with!!!)");
1487 PrintAndLog("If you want wipe card then add 'w' into command line. \n");
1488 return 0;
1489 }
1490
1491 blockNo = param_get8(Cmd, 0);
1492
1493 if (param_gethex(Cmd, 1, memBlock, 32)) {
1494 PrintAndLog("block data must include 32 HEX symbols");
1495 return 1;
1496 }
1497
1498 PrintAndLog("--block number:%2d data:%s", blockNo, sprint_hex(memBlock, 16));
1499
1500 res = mfCSetBlock(blockNo, memBlock, uid, 0, CSETBLOCK_SINGLE_OPER);
1501 if (res) {
1502 PrintAndLog("Can't write block. error=%d", res);
1503 return 1;
1504 }
1505
1506 PrintAndLog("UID:%s", sprint_hex(uid, 4));
1507 return 0;
1508 }
1509
1510
1511 int CmdHF14AMfCLoad(const char *Cmd)
1512 {
1513 FILE * f;
1514 char filename[FILE_PATH_SIZE] = {0x00};
1515 char * fnameptr = filename;
1516 char buf[64] = {0x00};
1517 uint8_t buf8[64] = {0x00};
1518 uint8_t fillFromEmulator = 0;
1519 int i, len, blockNum, flags;
1520
1521 // memset(filename, 0, sizeof(filename));
1522 // memset(buf, 0, sizeof(buf));
1523
1524 if (param_getchar(Cmd, 0) == 'h' || param_getchar(Cmd, 0)== 0x00) {
1525 PrintAndLog("It loads magic Chinese card (only works with!!!) from the file `filename.eml`");
1526 PrintAndLog("or from emulator memory (option `e`)");
1527 PrintAndLog("Usage: hf mf cload <file name w/o `.eml`>");
1528 PrintAndLog(" or: hf mf cload e ");
1529 PrintAndLog(" sample: hf mf cload filename");
1530 return 0;
1531 }
1532
1533 char ctmp = param_getchar(Cmd, 0);
1534 if (ctmp == 'e' || ctmp == 'E') fillFromEmulator = 1;
1535
1536 if (fillFromEmulator) {
1537 flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC;
1538 for (blockNum = 0; blockNum < 16 * 4; blockNum += 1) {
1539 if (mfEmlGetMem(buf8, blockNum, 1)) {
1540 PrintAndLog("Cant get block: %d", blockNum);
1541 return 2;
1542 }
1543
1544 if (blockNum == 2) flags = 0;
1545 if (blockNum == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD;
1546
1547 if (mfCSetBlock(blockNum, buf8, NULL, 0, flags)) {
1548 PrintAndLog("Cant set magic card block: %d", blockNum);
1549 return 3;
1550 }
1551 }
1552 return 0;
1553 } else {
1554 len = strlen(Cmd);
1555 if (len > FILE_PATH_SIZE) len = FILE_PATH_SIZE;
1556
1557 memcpy(filename, Cmd, len);
1558 fnameptr += len;
1559
1560 sprintf(fnameptr, ".eml");
1561
1562 // open file
1563 f = fopen(filename, "r");
1564 if (f == NULL) {
1565 PrintAndLog("File not found or locked.");
1566 return 1;
1567 }
1568
1569 blockNum = 0;
1570 flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC;
1571 while(!feof(f)){
1572 memset(buf, 0, sizeof(buf));
1573 if (fgets(buf, sizeof(buf), f) == NULL) {
1574 PrintAndLog("File reading error.");
1575 return 2;
1576 }
1577
1578 if (strlen(buf) < 32){
1579 if(strlen(buf) && feof(f))
1580 break;
1581 PrintAndLog("File content error. Block data must include 32 HEX symbols");
1582 return 2;
1583 }
1584 for (i = 0; i < 32; i += 2)
1585 sscanf(&buf[i], "%02x", (unsigned int *)&buf8[i / 2]);
1586
1587 if (blockNum == 2) flags = 0;
1588 if (blockNum == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD;
1589
1590 if (mfCSetBlock(blockNum, buf8, NULL, 0, flags)) {
1591 PrintAndLog("Can't set magic card block: %d", blockNum);
1592 return 3;
1593 }
1594 blockNum++;
1595
1596 if (blockNum >= 16 * 4) break; // magic card type - mifare 1K
1597 }
1598 fclose(f);
1599
1600 if (blockNum != 16 * 4 && blockNum != 32 * 4 + 8 * 16){
1601 PrintAndLog("File content error. There must be 64 blocks");
1602 return 4;
1603 }
1604 PrintAndLog("Loaded from file: %s", filename);
1605 return 0;
1606 }
1607 }
1608
1609 int CmdHF14AMfCGetBlk(const char *Cmd) {
1610 uint8_t memBlock[16];
1611 uint8_t blockNo = 0;
1612 int res;
1613 memset(memBlock, 0x00, sizeof(memBlock));
1614
1615 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1616 PrintAndLog("Usage: hf mf cgetblk <block number>");
1617 PrintAndLog("sample: hf mf cgetblk 1");
1618 PrintAndLog("Get block data from magic Chinese card (only works with!!!)\n");
1619 return 0;
1620 }
1621
1622 blockNo = param_get8(Cmd, 0);
1623
1624 PrintAndLog("--block number:%2d ", blockNo);
1625
1626 res = mfCGetBlock(blockNo, memBlock, CSETBLOCK_SINGLE_OPER);
1627 if (res) {
1628 PrintAndLog("Can't read block. error=%d", res);
1629 return 1;
1630 }
1631
1632 PrintAndLog("block data:%s", sprint_hex(memBlock, 16));
1633 return 0;
1634 }
1635
1636
1637 int CmdHF14AMfCGetSc(const char *Cmd) {
1638 uint8_t memBlock[16];
1639 uint8_t sectorNo = 0;
1640 int i, res, flags;
1641 memset(memBlock, 0x00, sizeof(memBlock));
1642
1643 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1644 PrintAndLog("Usage: hf mf cgetsc <sector number>");
1645 PrintAndLog("sample: hf mf cgetsc 0");
1646 PrintAndLog("Get sector data from magic Chinese card (only works with!!!)\n");
1647 return 0;
1648 }
1649
1650 sectorNo = param_get8(Cmd, 0);
1651 if (sectorNo > 15) {
1652 PrintAndLog("Sector number must be in [0..15] as in MIFARE classic.");
1653 return 1;
1654 }
1655
1656 PrintAndLog("--sector number:%d ", sectorNo);
1657
1658 flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC;
1659 for (i = 0; i < 4; i++) {
1660 if (i == 1) flags = 0;
1661 if (i == 3) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD;
1662
1663 res = mfCGetBlock(sectorNo * 4 + i, memBlock, flags);
1664 if (res) {
1665 PrintAndLog("Can't read block. %d error=%d", sectorNo * 4 + i, res);
1666 return 1;
1667 }
1668
1669 PrintAndLog("block %3d data:%s", sectorNo * 4 + i, sprint_hex(memBlock, 16));
1670 }
1671 return 0;
1672 }
1673
1674
1675 int CmdHF14AMfCSave(const char *Cmd) {
1676
1677 FILE * f;
1678 char filename[FILE_PATH_SIZE] = {0x00};
1679 char * fnameptr = filename;
1680 uint8_t fillFromEmulator = 0;
1681 uint8_t buf[64] = {0x00};
1682 int i, j, len, flags;
1683
1684 // memset(filename, 0, sizeof(filename));
1685 // memset(buf, 0, sizeof(buf));
1686
1687 if (param_getchar(Cmd, 0) == 'h') {
1688 PrintAndLog("It saves `magic Chinese` card dump into the file `filename.eml` or `cardID.eml`");
1689 PrintAndLog("or into emulator memory (option `e`)");
1690 PrintAndLog("Usage: hf mf esave [file name w/o `.eml`][e]");
1691 PrintAndLog(" sample: hf mf esave ");
1692 PrintAndLog(" hf mf esave filename");
1693 PrintAndLog(" hf mf esave e \n");
1694 return 0;
1695 }
1696
1697 char ctmp = param_getchar(Cmd, 0);
1698 if (ctmp == 'e' || ctmp == 'E') fillFromEmulator = 1;
1699
1700 if (fillFromEmulator) {
1701 // put into emulator
1702 flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC;
1703 for (i = 0; i < 16 * 4; i++) {
1704 if (i == 1) flags = 0;
1705 if (i == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD;
1706
1707 if (mfCGetBlock(i, buf, flags)) {
1708 PrintAndLog("Cant get block: %d", i);
1709 break;
1710 }
1711
1712 if (mfEmlSetMem(buf, i, 1)) {
1713 PrintAndLog("Cant set emul block: %d", i);
1714 return 3;
1715 }
1716 }
1717 return 0;
1718 } else {
1719 len = strlen(Cmd);
1720 if (len > FILE_PATH_SIZE) len = FILE_PATH_SIZE;
1721
1722 if (len < 1) {
1723 // get filename
1724 if (mfCGetBlock(0, buf, CSETBLOCK_SINGLE_OPER)) {
1725 PrintAndLog("Cant get block: %d", 0);
1726 return 1;
1727 }
1728 for (j = 0; j < 7; j++, fnameptr += 2)
1729 sprintf(fnameptr, "%02x", buf[j]);
1730 } else {
1731 memcpy(filename, Cmd, len);
1732 fnameptr += len;
1733 }
1734
1735 sprintf(fnameptr, ".eml");
1736
1737 // open file
1738 f = fopen(filename, "w+");
1739
1740 if (f == NULL) {
1741 PrintAndLog("File not found or locked.");
1742 return 1;
1743 }
1744
1745 // put hex
1746 flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC;
1747 for (i = 0; i < 16 * 4; i++) {
1748 if (i == 1) flags = 0;
1749 if (i == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD;
1750
1751 if (mfCGetBlock(i, buf, flags)) {
1752 PrintAndLog("Cant get block: %d", i);
1753 break;
1754 }
1755 for (j = 0; j < 16; j++)
1756 fprintf(f, "%02x", buf[j]);
1757 fprintf(f,"\n");
1758 }
1759 fclose(f);
1760
1761 PrintAndLog("Saved to file: %s", filename);
1762
1763 return 0;
1764 }
1765 }
1766
1767
1768 int CmdHF14AMfSniff(const char *Cmd){
1769
1770 bool wantLogToFile = 0;
1771 bool wantDecrypt = 0;
1772 //bool wantSaveToEml = 0; TODO
1773 bool wantSaveToEmlFile = 0;
1774
1775 //var
1776 int res = 0;
1777 int len = 0;
1778 int blockLen = 0;
1779 int num = 0;
1780 int pckNum = 0;
1781 uint8_t uid[7];
1782 uint8_t uid_len;
1783 uint8_t atqa[2];
1784 uint8_t sak;
1785 bool isTag;
1786 uint8_t buf[3000];
1787 uint8_t * bufPtr = buf;
1788 memset(buf, 0x00, 3000);
1789
1790 if (param_getchar(Cmd, 0) == 'h') {
1791 PrintAndLog("It continuously gets data from the field and saves it to: log, emulator, emulator file.");
1792 PrintAndLog("You can specify:");
1793 PrintAndLog(" l - save encrypted sequence to logfile `uid.log`");
1794 PrintAndLog(" d - decrypt sequence and put it to log file `uid.log`");
1795 PrintAndLog(" n/a e - decrypt sequence, collect read and write commands and save the result of the sequence to emulator memory");
1796 PrintAndLog(" f - decrypt sequence, collect read and write commands and save the result of the sequence to emulator dump file `uid.eml`");
1797 PrintAndLog("Usage: hf mf sniff [l][d][e][f]");
1798 PrintAndLog(" sample: hf mf sniff l d e");
1799 return 0;
1800 }
1801
1802 for (int i = 0; i < 4; i++) {
1803 char ctmp = param_getchar(Cmd, i);
1804 if (ctmp == 'l' || ctmp == 'L') wantLogToFile = true;
1805 if (ctmp == 'd' || ctmp == 'D') wantDecrypt = true;
1806 //if (ctmp == 'e' || ctmp == 'E') wantSaveToEml = true; TODO
1807 if (ctmp == 'f' || ctmp == 'F') wantSaveToEmlFile = true;
1808 }
1809
1810 printf("-------------------------------------------------------------------------\n");
1811 printf("Executing command. \n");
1812 printf("Press the key on the proxmark3 device to abort both proxmark3 and client.\n");
1813 printf("Press the key on pc keyboard to abort the client.\n");
1814 printf("-------------------------------------------------------------------------\n");
1815
1816 UsbCommand c = {CMD_MIFARE_SNIFFER, {0, 0, 0}};
1817 clearCommandBuffer();
1818 SendCommand(&c);
1819
1820 // wait cycle
1821 while (true) {
1822 printf(".");
1823 fflush(stdout);
1824 if (ukbhit()) {
1825 getchar();
1826 printf("\naborted via keyboard!\n");
1827 break;
1828 }
1829
1830 UsbCommand resp;
1831 if (WaitForResponseTimeout(CMD_ACK,&resp,2000)) {
1832 res = resp.arg[0] & 0xff;
1833 len = resp.arg[1];
1834 num = resp.arg[2];
1835
1836 if (res == 0) return 0;
1837 if (res == 1) {
1838 if (num ==0) {
1839 bufPtr = buf;
1840 memset(buf, 0x00, 3000);
1841 }
1842 memcpy(bufPtr, resp.d.asBytes, len);
1843 bufPtr += len;
1844 pckNum++;
1845 }
1846 if (res == 2) {
1847 blockLen = bufPtr - buf;
1848 bufPtr = buf;
1849 printf(">\n");
1850 PrintAndLog("received trace len: %d packages: %d", blockLen, pckNum);
1851 num = 0;
1852 while (bufPtr - buf < blockLen) {
1853 bufPtr += 6;
1854 len = *((uint16_t *)bufPtr);
1855
1856 if(len & 0x8000) {
1857 isTag = true;
1858 len &= 0x7fff;
1859 } else {
1860 isTag = false;
1861 }
1862 bufPtr += 2;
1863 if ((len == 14) && (bufPtr[0] == 0xff) && (bufPtr[1] == 0xff) && (bufPtr[12] == 0xff) && (bufPtr[13] == 0xff)) {
1864
1865 memcpy(uid, bufPtr + 2, 7);
1866 memcpy(atqa, bufPtr + 2 + 7, 2);
1867 uid_len = (atqa[0] & 0xC0) == 0x40 ? 7 : 4;
1868 sak = bufPtr[11];
1869
1870 PrintAndLog("tag select uid:%s atqa:0x%02x%02x sak:0x%02x",
1871 sprint_hex(uid + (7 - uid_len), uid_len),
1872 atqa[1],
1873 atqa[0],
1874 sak);
1875 if (wantLogToFile || wantDecrypt) {
1876 FillFileNameByUID(logHexFileName, uid + (7 - uid_len), ".log", uid_len);
1877 AddLogCurrentDT(logHexFileName);
1878 }
1879 if (wantDecrypt)
1880 mfTraceInit(uid, atqa, sak, wantSaveToEmlFile);
1881 } else {
1882 PrintAndLog("%s(%d):%s", isTag ? "TAG":"RDR", num, sprint_hex(bufPtr, len));
1883 if (wantLogToFile)
1884 AddLogHex(logHexFileName, isTag ? "TAG: ":"RDR: ", bufPtr, len);
1885 if (wantDecrypt)
1886 mfTraceDecode(bufPtr, len, wantSaveToEmlFile);
1887 }
1888 bufPtr += len;
1889 bufPtr += ((len-1)/8+1); // ignore parity
1890 num++;
1891 }
1892 }
1893 } // resp not NULL
1894 } // while (true)
1895
1896 return 0;
1897 }
1898
1899 // Tries to identify cardsize.
1900 // Returns <num> where num is:
1901 // -1 unidentified
1902 // 0 - MINI (320bytes)
1903 // 1 - 1K
1904 // 2 - 2K
1905 // 4 - 4K
1906 int GetCardSize()
1907 {
1908 UsbCommand c = {CMD_READER_ISO_14443a, {ISO14A_CONNECT, 0, 0}};
1909 SendCommand(&c);
1910
1911 UsbCommand resp;
1912 WaitForResponse(CMD_ACK,&resp);
1913
1914 if(resp.arg[0] == 0) {
1915 PrintAndLog("iso14443a card select failed");
1916 return -1;
1917 }
1918
1919 iso14a_card_select_t *card = (iso14a_card_select_t *)resp.d.asBytes;
1920
1921 PrintAndLog("Trying to detect card size.");
1922
1923 uint16_t atqa = 0;
1924 uint8_t sak = 0;
1925 atqa = (card->atqa[1] & 0xff) << 8;
1926 atqa += card->atqa[0] & 0xff;
1927 sak = card->sak;
1928
1929 // https://code.google.com/p/libnfc/source/browse/libnfc/target-subr.c
1930
1931 PrintAndLog("found ATAQ: %04X SAK: %02X", atqa, sak);
1932
1933
1934 // NXP MIFARE Mini 0.3k
1935 if ( ( (atqa & 0xff0f) == 0x0004) && (sak == 0x09) ) return 0;
1936
1937 // MIFARE Classic 1K
1938 if ( ((atqa & 0xff0f) == 0x0004) && (sak == 0x08) ) return 1;
1939
1940 // MIFARE Classik 4K
1941 if ( ((atqa & 0xff0f) == 0x0002) && (sak == 0x18) ) return 4;
1942
1943 // SmartMX with MIFARE 1K emulation
1944 if ( ((atqa & 0xf0ff) == 0x0004) ) return 1;
1945
1946 // SmartMX with MIFARE 4K emulation
1947 if ( ((atqa & 0xf0ff) == 0x0002) ) return 4;
1948
1949 // Infineon MIFARE CLASSIC 1K
1950 if ( ((atqa & 0xffff) == 0x0004) && (sak == 0x88) ) return 1;
1951
1952 // MFC 4K emulated by Nokia 6212 Classic
1953 if ( ((atqa & 0xffff) == 0x0002) && (sak == 0x38) ) return 4;
1954
1955 // MFC 4K emulated by Nokia 6131 NFC
1956 if ( ((atqa & 0xffff) == 0x0008) && (sak == 0x38) ) return 4;
1957
1958
1959 //PrintAndLog("BEFOOO 1K %02X", (atqa & 0xff0f));
1960
1961 // MIFARE Plus (4 Byte UID or 4 Byte RID)
1962 // MIFARE Plus (7 Byte UID)
1963 if (
1964 ((atqa & 0xffff) == 0x0002) |
1965 ((atqa & 0xffff) == 0x0004) |
1966 ((atqa & 0xffff) == 0x0042) |
1967 ((atqa & 0xffff) == 0x0044)
1968 )
1969 {
1970 switch(sak){
1971 case 0x08:
1972 case 0x10: {
1973 //case 0x20:
1974 PrintAndLog("2");
1975 return 2;
1976 break;
1977 }
1978 case 0x11:
1979 case 0x18:{
1980 //case 0x20:
1981 PrintAndLog("4");
1982 return 4;
1983 break;
1984 }
1985 }
1986 }
1987
1988 return -1;
1989 }
1990
1991 static command_t CommandTable[] =
1992 {
1993 {"help", CmdHelp, 1, "This help"},
1994 {"dbg", CmdHF14AMfDbg, 0, "Set default debug mode"},
1995 {"rdbl", CmdHF14AMfRdBl, 0, "Read MIFARE classic block"},
1996 {"rdsc", CmdHF14AMfRdSc, 0, "Read MIFARE classic sector"},
1997 {"dump", CmdHF14AMfDump, 0, "Dump MIFARE classic tag to binary file"},
1998 {"restore", CmdHF14AMfRestore, 0, "Restore MIFARE classic binary file to BLANK tag"},
1999 {"wrbl", CmdHF14AMfWrBl, 0, "Write MIFARE classic block"},
2000 {"chk", CmdHF14AMfChk, 0, "Test block keys"},
2001 {"mifare", CmdHF14AMifare, 0, "Read parity error messages."},
2002 {"nested", CmdHF14AMfNested, 0, "Test nested authentication"},
2003 {"sniff", CmdHF14AMfSniff, 0, "Sniff card-reader communication"},
2004 {"sim", CmdHF14AMf1kSim, 0, "Simulate MIFARE card"},
2005 {"eclr", CmdHF14AMfEClear, 0, "Clear simulator memory block"},
2006 {"eget", CmdHF14AMfEGet, 0, "Get simulator memory block"},
2007 {"eset", CmdHF14AMfESet, 0, "Set simulator memory block"},
2008 {"eload", CmdHF14AMfELoad, 0, "Load from file emul dump"},
2009 {"esave", CmdHF14AMfESave, 0, "Save to file emul dump"},
2010 {"ecfill", CmdHF14AMfECFill, 0, "Fill simulator memory with help of keys from simulator"},
2011 {"ekeyprn", CmdHF14AMfEKeyPrn, 0, "Print keys from simulator memory"},
2012 {"csetuid", CmdHF14AMfCSetUID, 0, "Set UID for magic Chinese card"},
2013 {"csetblk", CmdHF14AMfCSetBlk, 0, "Write block - Magic Chinese card"},
2014 {"cgetblk", CmdHF14AMfCGetBlk, 0, "Read block - Magic Chinese card"},
2015 {"cgetsc", CmdHF14AMfCGetSc, 0, "Read sector - Magic Chinese card"},
2016 {"cload", CmdHF14AMfCLoad, 0, "Load dump into magic Chinese card"},
2017 {"csave", CmdHF14AMfCSave, 0, "Save dump from magic Chinese card into file or emulator"},
2018 {NULL, NULL, 0, NULL}
2019 };
2020
2021 int CmdHFMF(const char *Cmd)
2022 {
2023 // flush
2024 WaitForResponseTimeout(CMD_ACK,NULL,100);
2025
2026 CmdsParse(CommandTable, Cmd);
2027 return 0;
2028 }
2029
2030 int CmdHelp(const char *Cmd)
2031 {
2032 CmdsHelp(CommandTable);
2033 return 0;
2034 }
Impressum, Datenschutz