]> cvs.zerfleddert.de Git - proxmark3-svn/blob - client/cmdhfmf.c
CHG: making sure no buffer overflows will occure in ul_send_cmd_raw by adding respon...
[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
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 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;
289 }
290
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;
298 }
299
300 if ((fin = fopen("dumpkeys.bin","rb")) == NULL) {
301 PrintAndLog("Could not find file dumpkeys.bin");
302 return 1;
303 }
304
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;
311 }
312 }
313
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;
320 }
321 }
322
323 fclose(fin);
324
325 PrintAndLog("|-----------------------------------------|");
326 PrintAndLog("|------ Reading sector access bits...-----|");
327 PrintAndLog("|-----------------------------------------|");
328
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);
333
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;
346 }
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;
351 }
352 }
353
354 PrintAndLog("|-----------------------------------------|");
355 PrintAndLog("|----- Dumping all blocks to file... -----|");
356 PrintAndLog("|-----------------------------------------|");
357
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;
362
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);
383 }
384 }
385
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]);
402 }
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;
409 }
410 }
411 else {
412 isOK = false;
413 PrintAndLog("Command execute timeout when trying to read block %2d of sector %2d.", blockNo, sectorNo);
414 break;
415 }
416 }
417 }
418
419 if (isOK) {
420 if ((fout = fopen("dumpdata.bin","wb")) == NULL) {
421 PrintAndLog("Could not create file name dumpdata.bin");
422 return 1;
423 }
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);
428 }
429
430 return 0;
431 }
432
433 int CmdHF14AMfRestore(const char *Cmd)
434 {
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;
442
443 FILE *fdump;
444 FILE *fkeys;
445
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;
454 }
455
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;
463 }
464
465 if ((fkeys = fopen("dumpkeys.bin","rb")) == NULL) {
466 PrintAndLog("Could not find file dumpkeys.bin");
467 return 1;
468 }
469
470 for (sectorNo = 0; sectorNo < numSectors; sectorNo++) {
471 if (fread(keyA[sectorNo], 1, 6, fkeys) == 0) {
472 PrintAndLog("File reading error (dumpkeys.bin).");
473
474 fclose(fkeys);
475 return 2;
476 }
477 }
478
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;
484 }
485 }
486
487 fclose(fkeys);
488
489 if ((fdump = fopen("dumpdata.bin","rb")) == NULL) {
490 PrintAndLog("Could not find file dumpdata.bin");
491 return 1;
492 }
493 PrintAndLog("Restoring dumpdata.bin to card");
494
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);
499
500 if (fread(bldata, 1, 16, fdump) == 0) {
501 PrintAndLog("File reading error (dumpdata.bin).");
502 fclose(fdump);
503 return 2;
504 }
505
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]);
519 }
520
521 PrintAndLog("Writing to block %3d: %s", FirstBlockOfSector(sectorNo) + blockNo, sprint_hex(bldata, 16));
522
523 memcpy(c.d.asBytes + 10, bldata, 16);
524 SendCommand(&c);
525
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");
532 }
533 }
534 }
535
536 fclose(fdump);
537 return 0;
538 }
539
540 int CmdHF14AMfNested(const char *Cmd)
541 {
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[13*6];
551 uint64_t key64 = 0;
552 bool transferToEml = false;
553
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};
558
559 char cmdp, ctmp;
560
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;
575 }
576
577 cmdp = param_getchar(Cmd, 0);
578 blockNo = param_get8(Cmd, 1);
579 ctmp = param_getchar(Cmd, 2);
580
581 if (ctmp != 'a' && ctmp != 'A' && ctmp != 'b' && ctmp != 'B') {
582 PrintAndLog("Key type must be A or B");
583 return 1;
584 }
585
586 if (ctmp != 'A' && ctmp != 'a')
587 keyType = 1;
588
589 if (param_gethex(Cmd, 3, key, 12)) {
590 PrintAndLog("Key must include 12 HEX symbols");
591 return 1;
592 }
593
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;
601 }
602 if (ctmp != 'A' && ctmp != 'a')
603 trgKeyType = 1;
604 } else {
605
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;
612 }
613 }
614
615 ctmp = param_getchar(Cmd, 4);
616 if (ctmp == 't' || ctmp == 'T') transferToEml = true;
617 else if (ctmp == 'd' || ctmp == 'D') createDumpFile = true;
618
619 ctmp = param_getchar(Cmd, 6);
620 transferToEml |= (ctmp == 't' || ctmp == 'T');
621 transferToEml |= (ctmp == 'd' || ctmp == 'D');
622
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;
628 }
629 key64 = bytes_to_num(keyBlock, 6);
630 if (key64) {
631 PrintAndLog("Found valid key:%012"llx, key64);
632
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;
640 }
641 mfEmlGetMem(keyBlock, sectortrailer, 1);
642
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);
648 }
649 } else {
650 PrintAndLog("No valid key found");
651 }
652 }
653 else { // ------------------------------------ multiple sectors working
654 clock_t time1;
655 time1 = clock();
656
657 e_sector = calloc(SectorsCnt, sizeof(sector));
658 if (e_sector == NULL) return 1;
659
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));
675
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;
680
681 res = mfCheckKeys(FirstBlockOfSector(i), j, 6, keyBlock, &key64);
682
683 if (!res) {
684 e_sector[i].Key[j] = key64;
685 e_sector[i].foundKey[j] = 1;
686 }
687 }
688 }
689
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;
705 }
706
707 iterations++;
708
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;
714 }
715 }
716 }
717 }
718
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);
720
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]);
729 }
730 PrintAndLog("|---|----------------|---|----------------|---|");
731
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);
741 }
742 }
743
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;
750 }
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 );
756 }
757 else{
758 fwrite ( &standart, 1, 6, fkeys );
759 }
760 }
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 );
765 }
766 else{
767 fwrite ( &standart, 1, 6, fkeys );
768 }
769 }
770 fclose(fkeys);
771 }
772
773 free(e_sector);
774 }
775 return 0;
776 }
777
778 int CmdHF14AMfChk(const char *Cmd)
779 {
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");
785 PrintAndLog("t - write keys to emulator memory\n");
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;
790 }
791
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;
797
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;
805
806 int transferToEml = 0;
807 int createDumpFile = 0;
808
809 keyBlock = calloc(stKeyBlock, 6);
810 if (keyBlock == NULL) return 1;
811
812 uint64_t defaultKeys[] =
813 {
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
827 };
828 int defaultKeysSize = sizeof(defaultKeys) / sizeof(uint64_t);
829
830 for (int defaultKeyCounter = 0; defaultKeyCounter < defaultKeysSize; defaultKeyCounter++)
831 {
832 num_to_bytes(defaultKeys[defaultKeyCounter], 6, (uint8_t*)(keyBlock + defaultKeyCounter * 6));
833 }
834
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;
843 }
844 }
845 else
846 blockNo = param_get8(Cmd, 0);
847
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;
862 };
863
864 ctmp = param_getchar(Cmd, 2);
865 if (ctmp == 't' || ctmp == 'T') transferToEml = 1;
866 else if (ctmp == 'd' || ctmp == 'D') createDumpFile = 1;
867
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;
876 }
877 keyBlock = p;
878 }
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;
889 }
890
891 if ( (f = fopen( filename , "r")) ) {
892 while( fgets(buf, sizeof(buf), f) ){
893 if (strlen(buf) < 12 || buf[11] == '\n')
894 continue;
895
896 while (fgetc(f) != '\n' && !feof(f)) ; //goto next line
897
898 if( buf[0]=='#' ) continue; //The line start with # is comment, skip
899
900 if (!isxdigit(buf[0])){
901 PrintAndLog("File content error. '%s' must include 12 HEX symbols",buf);
902 continue;
903 }
904
905 buf[12] = 0;
906
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;
913 }
914 keyBlock = p;
915 }
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));
921 }
922 fclose(f);
923 } else {
924 PrintAndLog("File: %s: not found or locked.", filename);
925 free(keyBlock);
926 return 1;
927
928 }
929 }
930 }
931
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);
938 }
939
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;
948 }
949 }
950 }
951
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;
965 }
966 } else {
967 PrintAndLog("Command execute timeout");
968 }
969 }
970 b<127?(b+=4):(b+=16);
971 }
972 }
973
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);
982 }
983 }
984 mfEmlSetMem(block, FirstBlockOfSector(sectorNo) + NumBlocksPerSector(sectorNo) - 1, 1);
985 }
986 }
987 PrintAndLog("Found keys have been transferred to the emulator memory");
988 }
989
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;
996 }
997 for (uint16_t t = 0; t < 2; t++) {
998 fwrite(foundKey[t], 1, 6*SectorsCnt, fkeys);
999 }
1000 fclose(fkeys);
1001 PrintAndLog("Found keys have been dumped to file dumpkeys.bin. 0xffffffffffff has been inserted for unknown keys.");
1002 }
1003
1004 free(keyBlock);
1005 PrintAndLog("");
1006 return 0;
1007 }
1008
1009 int CmdHF14AMf1kSim(const char *Cmd)
1010 {
1011 uint8_t uid[7] = {0, 0, 0, 0, 0, 0, 0};
1012 uint8_t exitAfterNReads = 0;
1013 uint8_t flags = 0;
1014
1015 uint8_t cmdp = param_getchar(Cmd, 0);
1016
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;
1027 }
1028 uint8_t pnr = 0;
1029 if (param_getchar(Cmd, pnr) == 'u') {
1030 if(param_gethex(Cmd, pnr+1, uid, 8) == 0)
1031 {
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;
1038 }
1039 pnr +=2;
1040 }
1041 if (param_getchar(Cmd, pnr) == 'n') {
1042 exitAfterNReads = param_get8(Cmd,pnr+1);
1043 pnr += 2;
1044 }
1045 if (param_getchar(Cmd, pnr) == 'i' ) {
1046 //Using a flag to signal interactiveness, least significant bit
1047 flags |= FLAG_INTERACTIVE;
1048 pnr++;
1049 }
1050
1051 if (param_getchar(Cmd, pnr) == 'x' ) {
1052 //Using a flag to signal interactiveness, least significant bit
1053 flags |= FLAG_NR_AR_ATTACK;
1054 }
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);
1059
1060
1061 UsbCommand c = {CMD_SIMULATE_MIFARE_CARD, {flags, exitAfterNReads,0}};
1062 memcpy(c.d.asBytes, uid, sizeof(uid));
1063 SendCommand(&c);
1064
1065 if(flags & FLAG_INTERACTIVE)
1066 {
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... "
1072 }
1073 }
1074
1075 return 0;
1076 }
1077
1078 int CmdHF14AMfDbg(const char *Cmd)
1079 {
1080 int dbgMode = param_get32ex(Cmd, 0, 0, 10);
1081 if (dbgMode > 4) {
1082 PrintAndLog("Max debug mode parameter is 4 \n");
1083 }
1084
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;
1094 }
1095
1096 UsbCommand c = {CMD_MIFARE_SET_DBGMODE, {dbgMode, 0, 0}};
1097 SendCommand(&c);
1098
1099 return 0;
1100 }
1101
1102 int CmdHF14AMfEGet(const char *Cmd)
1103 {
1104 uint8_t blockNo = 0;
1105 uint8_t data[16] = {0x00};
1106
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;
1111 }
1112
1113 blockNo = param_get8(Cmd, 0);
1114
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");
1120 }
1121
1122 return 0;
1123 }
1124
1125 int CmdHF14AMfEClear(const char *Cmd)
1126 {
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;
1131 }
1132
1133 UsbCommand c = {CMD_MIFARE_EML_MEMCLR, {0, 0, 0}};
1134 SendCommand(&c);
1135 return 0;
1136 }
1137
1138
1139 int CmdHF14AMfESet(const char *Cmd)
1140 {
1141 uint8_t memBlock[16];
1142 uint8_t blockNo = 0;
1143
1144 memset(memBlock, 0x00, sizeof(memBlock));
1145
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;
1150 }
1151
1152 blockNo = param_get8(Cmd, 0);
1153
1154 if (param_gethex(Cmd, 1, memBlock, 32)) {
1155 PrintAndLog("block data must include 32 HEX symbols");
1156 return 1;
1157 }
1158
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;
1164 }
1165
1166
1167 int CmdHF14AMfELoad(const char *Cmd)
1168 {
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;
1176
1177 char ctmp = param_getchar(Cmd, 0);
1178
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;
1187 }
1188
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;
1198 }
1199 }
1200
1201 len = param_getstr(Cmd,nameParamNo,filename);
1202
1203 if (len > FILE_PATH_SIZE) len = FILE_PATH_SIZE;
1204
1205 fnameptr += len;
1206
1207 sprintf(fnameptr, ".eml");
1208
1209 // open file
1210 f = fopen(filename, "r");
1211 if (f == NULL) {
1212 PrintAndLog("File %s not found or locked", filename);
1213 return 1;
1214 }
1215
1216 blockNum = 0;
1217 while(!feof(f)){
1218 memset(buf, 0, sizeof(buf));
1219
1220 if (fgets(buf, sizeof(buf), f) == NULL) {
1221
1222 if (blockNum >= numBlocks) break;
1223
1224 PrintAndLog("File reading error.");
1225 fclose(f);
1226 return 2;
1227 }
1228
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;
1235 }
1236
1237 for (i = 0; i < 32; i += 2) {
1238 sscanf(&buf[i], "%02x", (unsigned int *)&buf8[i / 2]);
1239 }
1240
1241 if (mfEmlSetMem(buf8, blockNum, 1)) {
1242 PrintAndLog("Cant set emul block: %3d", blockNum);
1243 fclose(f);
1244 return 3;
1245 }
1246 printf(".");
1247 blockNum++;
1248
1249 if (blockNum >= numBlocks) break;
1250 }
1251 fclose(f);
1252 printf("\n");
1253
1254 if ((blockNum != numBlocks)) {
1255 PrintAndLog("File content error. Got %d must be %d blocks.",blockNum, numBlocks);
1256 return 4;
1257 }
1258 PrintAndLog("Loaded %d blocks from file: %s", blockNum, filename);
1259 return 0;
1260 }
1261
1262
1263 int CmdHF14AMfESave(const char *Cmd)
1264 {
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;
1271
1272 memset(filename, 0, sizeof(filename));
1273 memset(buf, 0, sizeof(buf));
1274
1275 char ctmp = param_getchar(Cmd, 0);
1276
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;
1286 }
1287
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;
1297 }
1298 }
1299
1300 len = param_getstr(Cmd,nameParamNo,filename);
1301
1302 if (len > FILE_PATH_SIZE) len = FILE_PATH_SIZE;
1303
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 sprintf(filename, "dump.eml");
1310 }
1311 for (j = 0; j < 7; j++, fnameptr += 2)
1312 sprintf(fnameptr, "%02X", buf[j]);
1313 } else {
1314 fnameptr += len;
1315 }
1316
1317 // add file extension
1318 sprintf(fnameptr, ".eml");
1319
1320 // open file
1321 f = fopen(filename, "w+");
1322
1323 if ( !f ) {
1324 PrintAndLog("Can't open file %s ", filename);
1325 return 1;
1326 }
1327
1328 // put hex
1329 for (i = 0; i < numBlocks; i++) {
1330 if (mfEmlGetMem(buf, i, 1)) {
1331 PrintAndLog("Cant get block: %d", i);
1332 break;
1333 }
1334 for (j = 0; j < 16; j++)
1335 fprintf(f, "%02X", buf[j]);
1336 fprintf(f,"\n");
1337 }
1338 fclose(f);
1339
1340 PrintAndLog("Saved %d blocks to file: %s", numBlocks, filename);
1341
1342 return 0;
1343 }
1344
1345
1346 int CmdHF14AMfECFill(const char *Cmd)
1347 {
1348 uint8_t keyType = 0;
1349 uint8_t numSectors = 16;
1350
1351 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1352 PrintAndLog("Usage: hf mf ecfill <key A/B> [card memory]");
1353 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
1354 PrintAndLog("");
1355 PrintAndLog("samples: hf mf ecfill A");
1356 PrintAndLog(" hf mf ecfill A 4");
1357 PrintAndLog("Read card and transfer its data to emulator memory.");
1358 PrintAndLog("Keys must be laid in the emulator memory. \n");
1359 return 0;
1360 }
1361
1362 char ctmp = param_getchar(Cmd, 0);
1363 if (ctmp != 'a' && ctmp != 'A' && ctmp != 'b' && ctmp != 'B') {
1364 PrintAndLog("Key type must be A or B");
1365 return 1;
1366 }
1367 if (ctmp != 'A' && ctmp != 'a') keyType = 1;
1368
1369 ctmp = param_getchar(Cmd, 1);
1370 switch (ctmp) {
1371 case '0' : numSectors = 5; break;
1372 case '1' :
1373 case '\0': numSectors = 16; break;
1374 case '2' : numSectors = 32; break;
1375 case '4' : numSectors = 40; break;
1376 default: numSectors = 16;
1377 }
1378
1379 printf("--params: numSectors: %d, keyType:%d", numSectors, keyType);
1380 UsbCommand c = {CMD_MIFARE_EML_CARDLOAD, {numSectors, keyType, 0}};
1381 SendCommand(&c);
1382 return 0;
1383 }
1384
1385
1386 int CmdHF14AMfEKeyPrn(const char *Cmd)
1387 {
1388 int i;
1389 uint8_t numSectors;
1390 uint8_t data[16];
1391 uint64_t keyA, keyB;
1392
1393 if (param_getchar(Cmd, 0) == 'h') {
1394 PrintAndLog("It prints the keys loaded in the emulator memory");
1395 PrintAndLog("Usage: hf mf ekeyprn [card memory]");
1396 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
1397 PrintAndLog("");
1398 PrintAndLog(" sample: hf mf ekeyprn 1");
1399 return 0;
1400 }
1401
1402 char cmdp = param_getchar(Cmd, 0);
1403
1404 switch (cmdp) {
1405 case '0' : numSectors = 5; break;
1406 case '1' :
1407 case '\0': numSectors = 16; break;
1408 case '2' : numSectors = 32; break;
1409 case '4' : numSectors = 40; break;
1410 default: numSectors = 16;
1411 }
1412
1413 PrintAndLog("|---|----------------|----------------|");
1414 PrintAndLog("|sec|key A |key B |");
1415 PrintAndLog("|---|----------------|----------------|");
1416 for (i = 0; i < numSectors; i++) {
1417 if (mfEmlGetMem(data, FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1, 1)) {
1418 PrintAndLog("error get block %d", FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1);
1419 break;
1420 }
1421 keyA = bytes_to_num(data, 6);
1422 keyB = bytes_to_num(data + 10, 6);
1423 PrintAndLog("|%03d| %012"llx" | %012"llx" |", i, keyA, keyB);
1424 }
1425 PrintAndLog("|---|----------------|----------------|");
1426
1427 return 0;
1428 }
1429
1430
1431 int CmdHF14AMfCSetUID(const char *Cmd)
1432 {
1433 uint8_t wipeCard = 0;
1434 uint8_t uid[8] = {0x00};
1435 uint8_t oldUid[8] = {0x00};
1436 uint8_t atqa[2] = {0x00};
1437 uint8_t sak[1] = {0x00};
1438 uint8_t atqaPresent = 1;
1439 int res;
1440 char ctmp;
1441 int argi=0;
1442
1443 if (strlen(Cmd) < 1 || param_getchar(Cmd, argi) == 'h') {
1444 PrintAndLog("Usage: hf mf csetuid <UID 8 hex symbols> [ATQA 4 hex symbols SAK 2 hex symbols] [w]");
1445 PrintAndLog("sample: hf mf csetuid 01020304");
1446 PrintAndLog("sample: hf mf csetuid 01020304 0004 08 w");
1447 PrintAndLog("Set UID, ATQA, and SAK for magic Chinese card (only works with such cards)");
1448 PrintAndLog("If you also want to wipe the card then add 'w' at the end of the command line.");
1449 return 0;
1450 }
1451
1452 if (param_getchar(Cmd, argi) && param_gethex(Cmd, argi, uid, 8)) {
1453 PrintAndLog("UID must include 8 HEX symbols");
1454 return 1;
1455 }
1456 argi++;
1457
1458 ctmp = param_getchar(Cmd, argi);
1459 if (ctmp == 'w' || ctmp == 'W') {
1460 wipeCard = 1;
1461 atqaPresent = 0;
1462 }
1463
1464 if (atqaPresent) {
1465 if (param_getchar(Cmd, argi)) {
1466 if (param_gethex(Cmd, argi, atqa, 4)) {
1467 PrintAndLog("ATQA must include 4 HEX symbols");
1468 return 1;
1469 }
1470 argi++;
1471 if (!param_getchar(Cmd, argi) || param_gethex(Cmd, argi, sak, 2)) {
1472 PrintAndLog("SAK must include 2 HEX symbols");
1473 return 1;
1474 }
1475 argi++;
1476 } else
1477 atqaPresent = 0;
1478 }
1479
1480 if(!wipeCard) {
1481 ctmp = param_getchar(Cmd, argi);
1482 if (ctmp == 'w' || ctmp == 'W') {
1483 wipeCard = 1;
1484 }
1485 }
1486
1487 PrintAndLog("--wipe card:%s uid:%s", (wipeCard)?"YES":"NO", sprint_hex(uid, 4));
1488
1489 res = mfCSetUID(uid, (atqaPresent)?atqa:NULL, (atqaPresent)?sak:NULL, oldUid, wipeCard);
1490 if (res) {
1491 PrintAndLog("Can't set UID. error=%d", res);
1492 return 1;
1493 }
1494
1495 PrintAndLog("old UID:%s", sprint_hex(oldUid, 4));
1496 PrintAndLog("new UID:%s", sprint_hex(uid, 4));
1497 return 0;
1498 }
1499
1500 int CmdHF14AMfCSetBlk(const char *Cmd)
1501 {
1502 uint8_t memBlock[16] = {0x00};
1503 uint8_t blockNo = 0;
1504 bool wipeCard = FALSE;
1505 int res;
1506
1507 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1508 PrintAndLog("Usage: hf mf csetblk <block number> <block data (32 hex symbols)> [w]");
1509 PrintAndLog("sample: hf mf csetblk 1 01020304050607080910111213141516");
1510 PrintAndLog("Set block data for magic Chinese card (only works with such cards)");
1511 PrintAndLog("If you also want wipe the card then add 'w' at the end of the command line");
1512 return 0;
1513 }
1514
1515 blockNo = param_get8(Cmd, 0);
1516
1517 if (param_gethex(Cmd, 1, memBlock, 32)) {
1518 PrintAndLog("block data must include 32 HEX symbols");
1519 return 1;
1520 }
1521
1522 char ctmp = param_getchar(Cmd, 2);
1523 wipeCard = (ctmp == 'w' || ctmp == 'W');
1524 PrintAndLog("--block number:%2d data:%s", blockNo, sprint_hex(memBlock, 16));
1525
1526 res = mfCSetBlock(blockNo, memBlock, NULL, wipeCard, CSETBLOCK_SINGLE_OPER);
1527 if (res) {
1528 PrintAndLog("Can't write block. error=%d", res);
1529 return 1;
1530 }
1531 return 0;
1532 }
1533
1534
1535 int CmdHF14AMfCLoad(const char *Cmd)
1536 {
1537 FILE * f;
1538 char filename[FILE_PATH_SIZE] = {0x00};
1539 char * fnameptr = filename;
1540 char buf[64] = {0x00};
1541 uint8_t buf8[64] = {0x00};
1542 uint8_t fillFromEmulator = 0;
1543 int i, len, blockNum, flags=0;
1544
1545 if (param_getchar(Cmd, 0) == 'h' || param_getchar(Cmd, 0)== 0x00) {
1546 PrintAndLog("It loads magic Chinese card from the file `filename.eml`");
1547 PrintAndLog("or from emulator memory (option `e`)");
1548 PrintAndLog("Usage: hf mf cload <file name w/o `.eml`>");
1549 PrintAndLog(" or: hf mf cload e ");
1550 PrintAndLog(" sample: hf mf cload filename");
1551 return 0;
1552 }
1553
1554 char ctmp = param_getchar(Cmd, 0);
1555 if (ctmp == 'e' || ctmp == 'E') fillFromEmulator = 1;
1556
1557 if (fillFromEmulator) {
1558 for (blockNum = 0; blockNum < 16 * 4; blockNum += 1) {
1559 if (mfEmlGetMem(buf8, blockNum, 1)) {
1560 PrintAndLog("Cant get block: %d", blockNum);
1561 return 2;
1562 }
1563 if (blockNum == 0) flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC; // switch on field and send magic sequence
1564 if (blockNum == 1) flags = 0; // just write
1565 if (blockNum == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD; // Done. Magic Halt and switch off field.
1566
1567 if (mfCSetBlock(blockNum, buf8, NULL, 0, flags)) {
1568 PrintAndLog("Cant set magic card block: %d", blockNum);
1569 return 3;
1570 }
1571 }
1572 return 0;
1573 } else {
1574 len = strlen(Cmd);
1575 if (len > FILE_PATH_SIZE) len = FILE_PATH_SIZE;
1576
1577 memcpy(filename, Cmd, len);
1578 fnameptr += len;
1579
1580 sprintf(fnameptr, ".eml");
1581
1582 // open file
1583 f = fopen(filename, "r");
1584 if (f == NULL) {
1585 PrintAndLog("File not found or locked.");
1586 return 1;
1587 }
1588
1589 blockNum = 0;
1590 while(!feof(f)){
1591
1592 memset(buf, 0, sizeof(buf));
1593
1594 if (fgets(buf, sizeof(buf), f) == NULL) {
1595 PrintAndLog("File reading error.");
1596 return 2;
1597 }
1598
1599 if (strlen(buf) < 32) {
1600 if(strlen(buf) && feof(f))
1601 break;
1602 PrintAndLog("File content error. Block data must include 32 HEX symbols");
1603 return 2;
1604 }
1605 for (i = 0; i < 32; i += 2)
1606 sscanf(&buf[i], "%02x", (unsigned int *)&buf8[i / 2]);
1607
1608 if (blockNum == 0) flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC; // switch on field and send magic sequence
1609 if (blockNum == 1) flags = 0; // just write
1610 if (blockNum == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD; // Done. Switch off field.
1611
1612 if (mfCSetBlock(blockNum, buf8, NULL, 0, flags)) {
1613 PrintAndLog("Can't set magic card block: %d", blockNum);
1614 return 3;
1615 }
1616 blockNum++;
1617
1618 if (blockNum >= 16 * 4) break; // magic card type - mifare 1K
1619 }
1620 fclose(f);
1621
1622 if (blockNum != 16 * 4 && blockNum != 32 * 4 + 8 * 16){
1623 PrintAndLog("File content error. There must be 64 blocks");
1624 return 4;
1625 }
1626 PrintAndLog("Loaded from file: %s", filename);
1627 return 0;
1628 }
1629 return 0;
1630 }
1631
1632 int CmdHF14AMfCGetBlk(const char *Cmd) {
1633 uint8_t memBlock[16];
1634 uint8_t blockNo = 0;
1635 int res;
1636 memset(memBlock, 0x00, sizeof(memBlock));
1637
1638 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1639 PrintAndLog("Usage: hf mf cgetblk <block number>");
1640 PrintAndLog("sample: hf mf cgetblk 1");
1641 PrintAndLog("Get block data from magic Chinese card (only works with such cards)\n");
1642 return 0;
1643 }
1644
1645 blockNo = param_get8(Cmd, 0);
1646
1647 PrintAndLog("--block number:%2d ", blockNo);
1648
1649 res = mfCGetBlock(blockNo, memBlock, CSETBLOCK_SINGLE_OPER);
1650 if (res) {
1651 PrintAndLog("Can't read block. error=%d", res);
1652 return 1;
1653 }
1654
1655 PrintAndLog("block data:%s", sprint_hex(memBlock, 16));
1656 return 0;
1657 }
1658
1659
1660 int CmdHF14AMfCGetSc(const char *Cmd) {
1661 uint8_t memBlock[16] = {0x00};
1662 uint8_t sectorNo = 0;
1663 int i, res, flags;
1664
1665 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1666 PrintAndLog("Usage: hf mf cgetsc <sector number>");
1667 PrintAndLog("sample: hf mf cgetsc 0");
1668 PrintAndLog("Get sector data from magic Chinese card (only works with such cards)\n");
1669 return 0;
1670 }
1671
1672 sectorNo = param_get8(Cmd, 0);
1673 if (sectorNo > 15) {
1674 PrintAndLog("Sector number must be in [0..15] as in MIFARE classic.");
1675 return 1;
1676 }
1677
1678 PrintAndLog("--sector number:%d ", sectorNo);
1679
1680 flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC;
1681 for (i = 0; i < 4; i++) {
1682 if (i == 1) flags = 0;
1683 if (i == 3) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD;
1684
1685 res = mfCGetBlock(sectorNo * 4 + i, memBlock, flags);
1686 if (res) {
1687 PrintAndLog("Can't read block. %d error=%d", sectorNo * 4 + i, res);
1688 return 1;
1689 }
1690
1691 PrintAndLog("block %3d data:%s", sectorNo * 4 + i, sprint_hex(memBlock, 16));
1692 }
1693 return 0;
1694 }
1695
1696
1697 int CmdHF14AMfCSave(const char *Cmd) {
1698
1699 FILE * f;
1700 char filename[FILE_PATH_SIZE] = {0x00};
1701 char * fnameptr = filename;
1702 uint8_t fillFromEmulator = 0;
1703 uint8_t buf[64] = {0x00};
1704 int i, j, len, flags;
1705
1706 // memset(filename, 0, sizeof(filename));
1707 // memset(buf, 0, sizeof(buf));
1708
1709 if (param_getchar(Cmd, 0) == 'h') {
1710 PrintAndLog("It saves `magic Chinese` card dump into the file `filename.eml` or `cardID.eml`");
1711 PrintAndLog("or into emulator memory (option `e`)");
1712 PrintAndLog("Usage: hf mf esave [file name w/o `.eml`][e]");
1713 PrintAndLog(" sample: hf mf esave ");
1714 PrintAndLog(" hf mf esave filename");
1715 PrintAndLog(" hf mf esave e \n");
1716 return 0;
1717 }
1718
1719 char ctmp = param_getchar(Cmd, 0);
1720 if (ctmp == 'e' || ctmp == 'E') fillFromEmulator = 1;
1721
1722 if (fillFromEmulator) {
1723 // put into emulator
1724 flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC;
1725 for (i = 0; i < 16 * 4; i++) {
1726 if (i == 1) flags = 0;
1727 if (i == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD;
1728
1729 if (mfCGetBlock(i, buf, flags)) {
1730 PrintAndLog("Cant get block: %d", i);
1731 break;
1732 }
1733
1734 if (mfEmlSetMem(buf, i, 1)) {
1735 PrintAndLog("Cant set emul block: %d", i);
1736 return 3;
1737 }
1738 }
1739 return 0;
1740 } else {
1741 len = strlen(Cmd);
1742 if (len > FILE_PATH_SIZE) len = FILE_PATH_SIZE;
1743
1744 if (len < 1) {
1745 // get filename
1746 if (mfCGetBlock(0, buf, CSETBLOCK_SINGLE_OPER)) {
1747 PrintAndLog("Cant get block: %d", 0);
1748 return 1;
1749 }
1750 for (j = 0; j < 7; j++, fnameptr += 2)
1751 sprintf(fnameptr, "%02x", buf[j]);
1752 } else {
1753 memcpy(filename, Cmd, len);
1754 fnameptr += len;
1755 }
1756
1757 sprintf(fnameptr, ".eml");
1758
1759 // open file
1760 f = fopen(filename, "w+");
1761
1762 if (f == NULL) {
1763 PrintAndLog("File not found or locked.");
1764 return 1;
1765 }
1766
1767 // put hex
1768 flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC;
1769 for (i = 0; i < 16 * 4; i++) {
1770 if (i == 1) flags = 0;
1771 if (i == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD;
1772
1773 if (mfCGetBlock(i, buf, flags)) {
1774 PrintAndLog("Cant get block: %d", i);
1775 break;
1776 }
1777 for (j = 0; j < 16; j++)
1778 fprintf(f, "%02x", buf[j]);
1779 fprintf(f,"\n");
1780 }
1781 fclose(f);
1782
1783 PrintAndLog("Saved to file: %s", filename);
1784
1785 return 0;
1786 }
1787 }
1788
1789
1790 int CmdHF14AMfSniff(const char *Cmd){
1791
1792 bool wantLogToFile = 0;
1793 bool wantDecrypt = 0;
1794 //bool wantSaveToEml = 0; TODO
1795 bool wantSaveToEmlFile = 0;
1796
1797 //var
1798 int res = 0;
1799 int len = 0;
1800 int blockLen = 0;
1801 int pckNum = 0;
1802 int num = 0;
1803 uint8_t uid[7];
1804 uint8_t uid_len;
1805 uint8_t atqa[2] = {0x00};
1806 uint8_t sak;
1807 bool isTag;
1808 uint8_t *buf = NULL;
1809 uint16_t bufsize = 0;
1810 uint8_t *bufPtr = NULL;
1811
1812 char ctmp = param_getchar(Cmd, 0);
1813 if ( ctmp == 'h' || ctmp == 'H' ) {
1814 PrintAndLog("It continuously gets data from the field and saves it to: log, emulator, emulator file.");
1815 PrintAndLog("You can specify:");
1816 PrintAndLog(" l - save encrypted sequence to logfile `uid.log`");
1817 PrintAndLog(" d - decrypt sequence and put it to log file `uid.log`");
1818 PrintAndLog(" n/a e - decrypt sequence, collect read and write commands and save the result of the sequence to emulator memory");
1819 PrintAndLog(" f - decrypt sequence, collect read and write commands and save the result of the sequence to emulator dump file `uid.eml`");
1820 PrintAndLog("Usage: hf mf sniff [l][d][e][f]");
1821 PrintAndLog(" sample: hf mf sniff l d e");
1822 return 0;
1823 }
1824
1825 for (int i = 0; i < 4; i++) {
1826 ctmp = param_getchar(Cmd, i);
1827 if (ctmp == 'l' || ctmp == 'L') wantLogToFile = true;
1828 if (ctmp == 'd' || ctmp == 'D') wantDecrypt = true;
1829 //if (ctmp == 'e' || ctmp == 'E') wantSaveToEml = true; TODO
1830 if (ctmp == 'f' || ctmp == 'F') wantSaveToEmlFile = true;
1831 }
1832
1833 printf("-------------------------------------------------------------------------\n");
1834 printf("Executing command. \n");
1835 printf("Press the key on the proxmark3 device to abort both proxmark3 and client.\n");
1836 printf("Press the key on pc keyboard to abort the client.\n");
1837 printf("-------------------------------------------------------------------------\n");
1838
1839 UsbCommand c = {CMD_MIFARE_SNIFFER, {0, 0, 0}};
1840 clearCommandBuffer();
1841 SendCommand(&c);
1842
1843 // wait cycle
1844 while (true) {
1845 printf(".");
1846 fflush(stdout);
1847 if (ukbhit()) {
1848 getchar();
1849 printf("\naborted via keyboard!\n");
1850 break;
1851 }
1852
1853 UsbCommand resp;
1854 if (WaitForResponseTimeout(CMD_ACK,&resp,2000)) {
1855 res = resp.arg[0] & 0xff;
1856 uint16_t traceLen = resp.arg[1];
1857 len = resp.arg[2];
1858
1859 if (res == 0) return 0; // we are done
1860
1861 if (res == 1) { // there is (more) data to be transferred
1862 if (pckNum == 0) { // first packet, (re)allocate necessary buffer
1863 if (traceLen > bufsize) {
1864 uint8_t *p;
1865 if (buf == NULL) { // not yet allocated
1866 p = malloc(traceLen);
1867 } else { // need more memory
1868 p = realloc(buf, traceLen);
1869 }
1870 if (p == NULL) {
1871 PrintAndLog("Cannot allocate memory for trace");
1872 free(buf);
1873 return 2;
1874 }
1875 buf = p;
1876 }
1877 bufPtr = buf;
1878 bufsize = traceLen;
1879 memset(buf, 0x00, traceLen);
1880 }
1881 memcpy(bufPtr, resp.d.asBytes, len);
1882 bufPtr += len;
1883 pckNum++;
1884 }
1885
1886 if (res == 2) { // received all data, start displaying
1887 blockLen = bufPtr - buf;
1888 bufPtr = buf;
1889 printf(">\n");
1890 PrintAndLog("received trace len: %d packages: %d", blockLen, pckNum);
1891 while (bufPtr - buf < blockLen) {
1892 bufPtr += 6; // skip (void) timing information
1893 len = *((uint16_t *)bufPtr);
1894 if(len & 0x8000) {
1895 isTag = true;
1896 len &= 0x7fff;
1897 } else {
1898 isTag = false;
1899 }
1900 bufPtr += 2;
1901 if ((len == 14) && (bufPtr[0] == 0xff) && (bufPtr[1] == 0xff) && (bufPtr[12] == 0xff) && (bufPtr[13] == 0xff)) {
1902 memcpy(uid, bufPtr + 2, 7);
1903 memcpy(atqa, bufPtr + 2 + 7, 2);
1904 uid_len = (atqa[0] & 0xC0) == 0x40 ? 7 : 4;
1905 sak = bufPtr[11];
1906 PrintAndLog("tag select uid:%s atqa:0x%02x%02x sak:0x%02x",
1907 sprint_hex(uid + (7 - uid_len), uid_len),
1908 atqa[1],
1909 atqa[0],
1910 sak);
1911 if (wantLogToFile || wantDecrypt) {
1912 FillFileNameByUID(logHexFileName, uid + (7 - uid_len), ".log", uid_len);
1913 AddLogCurrentDT(logHexFileName);
1914 }
1915 if (wantDecrypt)
1916 mfTraceInit(uid, atqa, sak, wantSaveToEmlFile);
1917 } else {
1918 PrintAndLog("%s(%d):%s", isTag ? "TAG":"RDR", num, sprint_hex(bufPtr, len));
1919 if (wantLogToFile)
1920 AddLogHex(logHexFileName, isTag ? "TAG: ":"RDR: ", bufPtr, len);
1921 if (wantDecrypt)
1922 mfTraceDecode(bufPtr, len, wantSaveToEmlFile);
1923 num++;
1924 }
1925 bufPtr += len;
1926 bufPtr += ((len-1)/8+1); // ignore parity
1927 }
1928 pckNum = 0;
1929 }
1930 } // resp not NULL
1931 } // while (true)
1932
1933 free(buf);
1934 return 0;
1935 }
1936
1937
1938 static command_t CommandTable[] =
1939 {
1940 {"help", CmdHelp, 1, "This help"},
1941 {"dbg", CmdHF14AMfDbg, 0, "Set default debug mode"},
1942 {"rdbl", CmdHF14AMfRdBl, 0, "Read MIFARE classic block"},
1943 {"rdsc", CmdHF14AMfRdSc, 0, "Read MIFARE classic sector"},
1944 {"dump", CmdHF14AMfDump, 0, "Dump MIFARE classic tag to binary file"},
1945 {"restore", CmdHF14AMfRestore, 0, "Restore MIFARE classic binary file to BLANK tag"},
1946 {"wrbl", CmdHF14AMfWrBl, 0, "Write MIFARE classic block"},
1947 {"chk", CmdHF14AMfChk, 0, "Test block keys"},
1948 {"mifare", CmdHF14AMifare, 0, "Read parity error messages."},
1949 {"nested", CmdHF14AMfNested, 0, "Test nested authentication"},
1950 {"sniff", CmdHF14AMfSniff, 0, "Sniff card-reader communication"},
1951 {"sim", CmdHF14AMf1kSim, 0, "Simulate MIFARE card"},
1952 {"eclr", CmdHF14AMfEClear, 0, "Clear simulator memory block"},
1953 {"eget", CmdHF14AMfEGet, 0, "Get simulator memory block"},
1954 {"eset", CmdHF14AMfESet, 0, "Set simulator memory block"},
1955 {"eload", CmdHF14AMfELoad, 0, "Load from file emul dump"},
1956 {"esave", CmdHF14AMfESave, 0, "Save to file emul dump"},
1957 {"ecfill", CmdHF14AMfECFill, 0, "Fill simulator memory with help of keys from simulator"},
1958 {"ekeyprn", CmdHF14AMfEKeyPrn, 0, "Print keys from simulator memory"},
1959 {"csetuid", CmdHF14AMfCSetUID, 0, "Set UID for magic Chinese card"},
1960 {"csetblk", CmdHF14AMfCSetBlk, 0, "Write block - Magic Chinese card"},
1961 {"cgetblk", CmdHF14AMfCGetBlk, 0, "Read block - Magic Chinese card"},
1962 {"cgetsc", CmdHF14AMfCGetSc, 0, "Read sector - Magic Chinese card"},
1963 {"cload", CmdHF14AMfCLoad, 0, "Load dump into magic Chinese card"},
1964 {"csave", CmdHF14AMfCSave, 0, "Save dump from magic Chinese card into file or emulator"},
1965 {NULL, NULL, 0, NULL}
1966 };
1967
1968 int CmdHFMF(const char *Cmd)
1969 {
1970 // flush
1971 WaitForResponseTimeout(CMD_ACK,NULL,100);
1972
1973 CmdsParse(CommandTable, Cmd);
1974 return 0;
1975 }
1976
1977 int CmdHelp(const char *Cmd)
1978 {
1979 CmdsHelp(CommandTable);
1980 return 0;
1981 }
Impressum, Datenschutz