]> cvs.zerfleddert.de Git - proxmark3-svn/blob - client/cmdhfmf.c
Merge branch 'master' of https://github.com/Proxmark/proxmark3
[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};
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\n");
785 PrintAndLog("t - write keys to emulator memory");
786 PrintAndLog(" sample: hf mf chk 0 A 1234567890ab keys.dic");
787 PrintAndLog(" hf mf chk *1 ? t");
788 PrintAndLog(" hf mf chk *1 ? d");
789 return 0;
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 PrintAndLog(" : hf mf sim u 0a0a0a0a i x");
1027 return 0;
1028 }
1029 uint8_t pnr = 0;
1030 if (param_getchar(Cmd, pnr) == 'u') {
1031 if(param_gethex(Cmd, pnr+1, uid, 8) == 0)
1032 {
1033 flags |= FLAG_4B_UID_IN_DATA; // UID from packet
1034 } else if(param_gethex(Cmd,pnr+1,uid,14) == 0) {
1035 flags |= FLAG_7B_UID_IN_DATA;// UID from packet
1036 } else {
1037 PrintAndLog("UID, if specified, must include 8 or 14 HEX symbols");
1038 return 1;
1039 }
1040 pnr +=2;
1041 }
1042 if (param_getchar(Cmd, pnr) == 'n') {
1043 exitAfterNReads = param_get8(Cmd,pnr+1);
1044 pnr += 2;
1045 }
1046 if (param_getchar(Cmd, pnr) == 'i' ) {
1047 //Using a flag to signal interactiveness, least significant bit
1048 flags |= FLAG_INTERACTIVE;
1049 pnr++;
1050 }
1051
1052 if (param_getchar(Cmd, pnr) == 'x' ) {
1053 //Using a flag to signal interactiveness, least significant bit
1054 flags |= FLAG_NR_AR_ATTACK;
1055 }
1056 PrintAndLog(" uid:%s, numreads:%d, flags:%d (0x%02x) ",
1057 flags & FLAG_4B_UID_IN_DATA ? sprint_hex(uid,4):
1058 flags & FLAG_7B_UID_IN_DATA ? sprint_hex(uid,7): "N/A"
1059 , exitAfterNReads, flags,flags);
1060
1061
1062 UsbCommand c = {CMD_SIMULATE_MIFARE_CARD, {flags, exitAfterNReads,0}};
1063 memcpy(c.d.asBytes, uid, sizeof(uid));
1064 SendCommand(&c);
1065
1066 if(flags & FLAG_INTERACTIVE)
1067 {
1068 UsbCommand resp;
1069 PrintAndLog("Press pm3-button to abort simulation");
1070 while(! WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
1071 //We're waiting only 1.5 s at a time, otherwise we get the
1072 // annoying message about "Waiting for a response... "
1073 }
1074 }
1075
1076 return 0;
1077 }
1078
1079 int CmdHF14AMfDbg(const char *Cmd)
1080 {
1081 int dbgMode = param_get32ex(Cmd, 0, 0, 10);
1082 if (dbgMode > 4) {
1083 PrintAndLog("Max debug mode parameter is 4 \n");
1084 }
1085
1086 if (strlen(Cmd) < 1 || !param_getchar(Cmd, 0) || dbgMode > 4) {
1087 PrintAndLog("Usage: hf mf dbg <debug level>");
1088 PrintAndLog(" 0 - no debug messages");
1089 PrintAndLog(" 1 - error messages");
1090 PrintAndLog(" 2 - plus information messages");
1091 PrintAndLog(" 3 - plus debug messages");
1092 PrintAndLog(" 4 - print even debug messages in timing critical functions");
1093 PrintAndLog(" Note: this option therefore may cause malfunction itself");
1094 return 0;
1095 }
1096
1097 UsbCommand c = {CMD_MIFARE_SET_DBGMODE, {dbgMode, 0, 0}};
1098 SendCommand(&c);
1099
1100 return 0;
1101 }
1102
1103 int CmdHF14AMfEGet(const char *Cmd)
1104 {
1105 uint8_t blockNo = 0;
1106 uint8_t data[16] = {0x00};
1107
1108 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1109 PrintAndLog("Usage: hf mf eget <block number>");
1110 PrintAndLog(" sample: hf mf eget 0 ");
1111 return 0;
1112 }
1113
1114 blockNo = param_get8(Cmd, 0);
1115
1116 PrintAndLog(" ");
1117 if (!mfEmlGetMem(data, blockNo, 1)) {
1118 PrintAndLog("data[%3d]:%s", blockNo, sprint_hex(data, 16));
1119 } else {
1120 PrintAndLog("Command execute timeout");
1121 }
1122
1123 return 0;
1124 }
1125
1126 int CmdHF14AMfEClear(const char *Cmd)
1127 {
1128 if (param_getchar(Cmd, 0) == 'h') {
1129 PrintAndLog("Usage: hf mf eclr");
1130 PrintAndLog("It set card emulator memory to empty data blocks and key A/B FFFFFFFFFFFF \n");
1131 return 0;
1132 }
1133
1134 UsbCommand c = {CMD_MIFARE_EML_MEMCLR, {0, 0, 0}};
1135 SendCommand(&c);
1136 return 0;
1137 }
1138
1139
1140 int CmdHF14AMfESet(const char *Cmd)
1141 {
1142 uint8_t memBlock[16];
1143 uint8_t blockNo = 0;
1144
1145 memset(memBlock, 0x00, sizeof(memBlock));
1146
1147 if (strlen(Cmd) < 3 || param_getchar(Cmd, 0) == 'h') {
1148 PrintAndLog("Usage: hf mf eset <block number> <block data (32 hex symbols)>");
1149 PrintAndLog(" sample: hf mf eset 1 000102030405060708090a0b0c0d0e0f ");
1150 return 0;
1151 }
1152
1153 blockNo = param_get8(Cmd, 0);
1154
1155 if (param_gethex(Cmd, 1, memBlock, 32)) {
1156 PrintAndLog("block data must include 32 HEX symbols");
1157 return 1;
1158 }
1159
1160 // 1 - blocks count
1161 UsbCommand c = {CMD_MIFARE_EML_MEMSET, {blockNo, 1, 0}};
1162 memcpy(c.d.asBytes, memBlock, 16);
1163 SendCommand(&c);
1164 return 0;
1165 }
1166
1167
1168 int CmdHF14AMfELoad(const char *Cmd)
1169 {
1170 FILE * f;
1171 char filename[FILE_PATH_SIZE];
1172 char *fnameptr = filename;
1173 char buf[64] = {0x00};
1174 uint8_t buf8[64] = {0x00};
1175 int i, len, blockNum, numBlocks;
1176 int nameParamNo = 1;
1177
1178 char ctmp = param_getchar(Cmd, 0);
1179
1180 if ( ctmp == 'h' || ctmp == 0x00) {
1181 PrintAndLog("It loads emul dump from the file `filename.eml`");
1182 PrintAndLog("Usage: hf mf eload [card memory] <file name w/o `.eml`>");
1183 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
1184 PrintAndLog("");
1185 PrintAndLog(" sample: hf mf eload filename");
1186 PrintAndLog(" hf mf eload 4 filename");
1187 return 0;
1188 }
1189
1190 switch (ctmp) {
1191 case '0' : numBlocks = 5*4; break;
1192 case '1' :
1193 case '\0': numBlocks = 16*4; break;
1194 case '2' : numBlocks = 32*4; break;
1195 case '4' : numBlocks = 256; break;
1196 default: {
1197 numBlocks = 16*4;
1198 nameParamNo = 0;
1199 }
1200 }
1201
1202 len = param_getstr(Cmd,nameParamNo,filename);
1203
1204 if (len > FILE_PATH_SIZE) len = FILE_PATH_SIZE;
1205
1206 fnameptr += len;
1207
1208 sprintf(fnameptr, ".eml");
1209
1210 // open file
1211 f = fopen(filename, "r");
1212 if (f == NULL) {
1213 PrintAndLog("File %s not found or locked", filename);
1214 return 1;
1215 }
1216
1217 blockNum = 0;
1218 while(!feof(f)){
1219 memset(buf, 0, sizeof(buf));
1220
1221 if (fgets(buf, sizeof(buf), f) == NULL) {
1222
1223 if (blockNum >= numBlocks) break;
1224
1225 PrintAndLog("File reading error.");
1226 fclose(f);
1227 return 2;
1228 }
1229
1230 if (strlen(buf) < 32){
1231 if(strlen(buf) && feof(f))
1232 break;
1233 PrintAndLog("File content error. Block data must include 32 HEX symbols");
1234 fclose(f);
1235 return 2;
1236 }
1237
1238 for (i = 0; i < 32; i += 2) {
1239 sscanf(&buf[i], "%02x", (unsigned int *)&buf8[i / 2]);
1240 }
1241
1242 if (mfEmlSetMem(buf8, blockNum, 1)) {
1243 PrintAndLog("Cant set emul block: %3d", blockNum);
1244 fclose(f);
1245 return 3;
1246 }
1247 printf(".");
1248 blockNum++;
1249
1250 if (blockNum >= numBlocks) break;
1251 }
1252 fclose(f);
1253 printf("\n");
1254
1255 if ((blockNum != numBlocks)) {
1256 PrintAndLog("File content error. Got %d must be %d blocks.",blockNum, numBlocks);
1257 return 4;
1258 }
1259 PrintAndLog("Loaded %d blocks from file: %s", blockNum, filename);
1260 return 0;
1261 }
1262
1263
1264 int CmdHF14AMfESave(const char *Cmd)
1265 {
1266 FILE * f;
1267 char filename[FILE_PATH_SIZE];
1268 char * fnameptr = filename;
1269 uint8_t buf[64];
1270 int i, j, len, numBlocks;
1271 int nameParamNo = 1;
1272
1273 memset(filename, 0, sizeof(filename));
1274 memset(buf, 0, sizeof(buf));
1275
1276 char ctmp = param_getchar(Cmd, 0);
1277
1278 if ( ctmp == 'h' || ctmp == 'H') {
1279 PrintAndLog("It saves emul dump into the file `filename.eml` or `cardID.eml`");
1280 PrintAndLog(" Usage: hf mf esave [card memory] [file name w/o `.eml`]");
1281 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
1282 PrintAndLog("");
1283 PrintAndLog(" sample: hf mf esave ");
1284 PrintAndLog(" hf mf esave 4");
1285 PrintAndLog(" hf mf esave 4 filename");
1286 return 0;
1287 }
1288
1289 switch (ctmp) {
1290 case '0' : numBlocks = 5*4; break;
1291 case '1' :
1292 case '\0': numBlocks = 16*4; break;
1293 case '2' : numBlocks = 32*4; break;
1294 case '4' : numBlocks = 256; break;
1295 default: {
1296 numBlocks = 16*4;
1297 nameParamNo = 0;
1298 }
1299 }
1300
1301 len = param_getstr(Cmd,nameParamNo,filename);
1302
1303 if (len > FILE_PATH_SIZE) len = FILE_PATH_SIZE;
1304
1305 // user supplied filename?
1306 if (len < 1) {
1307 // get filename (UID from memory)
1308 if (mfEmlGetMem(buf, 0, 1)) {
1309 PrintAndLog("Can\'t get UID from block: %d", 0);
1310 sprintf(filename, "dump.eml");
1311 }
1312 for (j = 0; j < 7; j++, fnameptr += 2)
1313 sprintf(fnameptr, "%02X", buf[j]);
1314 } else {
1315 fnameptr += len;
1316 }
1317
1318 // add file extension
1319 sprintf(fnameptr, ".eml");
1320
1321 // open file
1322 f = fopen(filename, "w+");
1323
1324 if ( !f ) {
1325 PrintAndLog("Can't open file %s ", filename);
1326 return 1;
1327 }
1328
1329 // put hex
1330 for (i = 0; i < numBlocks; i++) {
1331 if (mfEmlGetMem(buf, i, 1)) {
1332 PrintAndLog("Cant get block: %d", i);
1333 break;
1334 }
1335 for (j = 0; j < 16; j++)
1336 fprintf(f, "%02X", buf[j]);
1337 fprintf(f,"\n");
1338 }
1339 fclose(f);
1340
1341 PrintAndLog("Saved %d blocks to file: %s", numBlocks, filename);
1342
1343 return 0;
1344 }
1345
1346
1347 int CmdHF14AMfECFill(const char *Cmd)
1348 {
1349 uint8_t keyType = 0;
1350 uint8_t numSectors = 16;
1351
1352 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1353 PrintAndLog("Usage: hf mf ecfill <key A/B> [card memory]");
1354 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
1355 PrintAndLog("");
1356 PrintAndLog("samples: hf mf ecfill A");
1357 PrintAndLog(" hf mf ecfill A 4");
1358 PrintAndLog("Read card and transfer its data to emulator memory.");
1359 PrintAndLog("Keys must be laid in the emulator memory. \n");
1360 return 0;
1361 }
1362
1363 char ctmp = param_getchar(Cmd, 0);
1364 if (ctmp != 'a' && ctmp != 'A' && ctmp != 'b' && ctmp != 'B') {
1365 PrintAndLog("Key type must be A or B");
1366 return 1;
1367 }
1368 if (ctmp != 'A' && ctmp != 'a') keyType = 1;
1369
1370 ctmp = param_getchar(Cmd, 1);
1371 switch (ctmp) {
1372 case '0' : numSectors = 5; break;
1373 case '1' :
1374 case '\0': numSectors = 16; break;
1375 case '2' : numSectors = 32; break;
1376 case '4' : numSectors = 40; break;
1377 default: numSectors = 16;
1378 }
1379
1380 printf("--params: numSectors: %d, keyType:%d", numSectors, keyType);
1381 UsbCommand c = {CMD_MIFARE_EML_CARDLOAD, {numSectors, keyType, 0}};
1382 SendCommand(&c);
1383 return 0;
1384 }
1385
1386
1387 int CmdHF14AMfEKeyPrn(const char *Cmd)
1388 {
1389 int i;
1390 uint8_t numSectors;
1391 uint8_t data[16];
1392 uint64_t keyA, keyB;
1393
1394 if (param_getchar(Cmd, 0) == 'h') {
1395 PrintAndLog("It prints the keys loaded in the emulator memory");
1396 PrintAndLog("Usage: hf mf ekeyprn [card memory]");
1397 PrintAndLog(" [card memory]: 0 = 320 bytes (Mifare Mini), 1 = 1K (default), 2 = 2K, 4 = 4K");
1398 PrintAndLog("");
1399 PrintAndLog(" sample: hf mf ekeyprn 1");
1400 return 0;
1401 }
1402
1403 char cmdp = param_getchar(Cmd, 0);
1404
1405 switch (cmdp) {
1406 case '0' : numSectors = 5; break;
1407 case '1' :
1408 case '\0': numSectors = 16; break;
1409 case '2' : numSectors = 32; break;
1410 case '4' : numSectors = 40; break;
1411 default: numSectors = 16;
1412 }
1413
1414 PrintAndLog("|---|----------------|----------------|");
1415 PrintAndLog("|sec|key A |key B |");
1416 PrintAndLog("|---|----------------|----------------|");
1417 for (i = 0; i < numSectors; i++) {
1418 if (mfEmlGetMem(data, FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1, 1)) {
1419 PrintAndLog("error get block %d", FirstBlockOfSector(i) + NumBlocksPerSector(i) - 1);
1420 break;
1421 }
1422 keyA = bytes_to_num(data, 6);
1423 keyB = bytes_to_num(data + 10, 6);
1424 PrintAndLog("|%03d| %012"llx" | %012"llx" |", i, keyA, keyB);
1425 }
1426 PrintAndLog("|---|----------------|----------------|");
1427
1428 return 0;
1429 }
1430
1431
1432 int CmdHF14AMfCSetUID(const char *Cmd)
1433 {
1434 uint8_t wipeCard = 0;
1435 uint8_t uid[8] = {0x00};
1436 uint8_t oldUid[8] = {0x00};
1437 uint8_t atqa[2] = {0x00};
1438 uint8_t sak[1] = {0x00};
1439 uint8_t atqaPresent = 1;
1440 int res;
1441 char ctmp;
1442 int argi=0;
1443
1444 if (strlen(Cmd) < 1 || param_getchar(Cmd, argi) == 'h') {
1445 PrintAndLog("Usage: hf mf csetuid <UID 8 hex symbols> [ATQA 4 hex symbols SAK 2 hex symbols] [w]");
1446 PrintAndLog("sample: hf mf csetuid 01020304");
1447 PrintAndLog("sample: hf mf csetuid 01020304 0004 08 w");
1448 PrintAndLog("Set UID, ATQA, and SAK for magic Chinese card (only works with such cards)");
1449 PrintAndLog("If you also want to wipe the card then add 'w' at the end of the command line.");
1450 return 0;
1451 }
1452
1453 if (param_getchar(Cmd, argi) && param_gethex(Cmd, argi, uid, 8)) {
1454 PrintAndLog("UID must include 8 HEX symbols");
1455 return 1;
1456 }
1457 argi++;
1458
1459 ctmp = param_getchar(Cmd, argi);
1460 if (ctmp == 'w' || ctmp == 'W') {
1461 wipeCard = 1;
1462 atqaPresent = 0;
1463 }
1464
1465 if (atqaPresent) {
1466 if (param_getchar(Cmd, argi)) {
1467 if (param_gethex(Cmd, argi, atqa, 4)) {
1468 PrintAndLog("ATQA must include 4 HEX symbols");
1469 return 1;
1470 }
1471 argi++;
1472 if (!param_getchar(Cmd, argi) || param_gethex(Cmd, argi, sak, 2)) {
1473 PrintAndLog("SAK must include 2 HEX symbols");
1474 return 1;
1475 }
1476 argi++;
1477 } else
1478 atqaPresent = 0;
1479 }
1480
1481 if(!wipeCard) {
1482 ctmp = param_getchar(Cmd, argi);
1483 if (ctmp == 'w' || ctmp == 'W') {
1484 wipeCard = 1;
1485 }
1486 }
1487
1488 PrintAndLog("--wipe card:%s uid:%s", (wipeCard)?"YES":"NO", sprint_hex(uid, 4));
1489
1490 res = mfCSetUID(uid, (atqaPresent)?atqa:NULL, (atqaPresent)?sak:NULL, oldUid, wipeCard);
1491 if (res) {
1492 PrintAndLog("Can't set UID. error=%d", res);
1493 return 1;
1494 }
1495
1496 PrintAndLog("old UID:%s", sprint_hex(oldUid, 4));
1497 PrintAndLog("new UID:%s", sprint_hex(uid, 4));
1498 return 0;
1499 }
1500
1501 int CmdHF14AMfCSetBlk(const char *Cmd)
1502 {
1503 //uint8_t uid[8] = {0x00};
1504 uint8_t memBlock[16] = {0x00};
1505 uint8_t blockNo = 0;
1506 int res;
1507
1508 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1509 PrintAndLog("Usage: hf mf csetblk <block number> <block data (32 hex symbols)>");
1510 PrintAndLog("sample: hf mf csetblk 1 01020304050607080910111213141516");
1511 PrintAndLog("Set block data for magic Chinese card (only works with!!!)");
1512 PrintAndLog("If you want wipe card then add 'w' into command line. \n");
1513 return 0;
1514 }
1515
1516 blockNo = param_get8(Cmd, 0);
1517
1518 if (param_gethex(Cmd, 1, memBlock, 32)) {
1519 PrintAndLog("block data must include 32 HEX symbols");
1520 return 1;
1521 }
1522
1523 PrintAndLog("--block number:%2d data:%s", blockNo, sprint_hex(memBlock, 16));
1524
1525 //res = mfCSetBlock(blockNo, memBlock, uid, 0, CSETBLOCK_SINGLE_OPER);
1526 res = mfCSetBlock(blockNo, memBlock, NULL, 0, CSETBLOCK_SINGLE_OPER);
1527 if (res) {
1528 PrintAndLog("Can't write block. error=%d", res);
1529 return 1;
1530 }
1531
1532 return 0;
1533 }
1534
1535
1536 int CmdHF14AMfCLoad(const char *Cmd)
1537 {
1538 FILE * f;
1539 char filename[FILE_PATH_SIZE] = {0x00};
1540 char * fnameptr = filename;
1541 char buf[64] = {0x00};
1542 uint8_t buf8[64] = {0x00};
1543 uint8_t fillFromEmulator = 0;
1544 int i, len, blockNum, flags=0;
1545
1546 if (param_getchar(Cmd, 0) == 'h' || param_getchar(Cmd, 0)== 0x00) {
1547 PrintAndLog("It loads magic Chinese card from the file `filename.eml`");
1548 PrintAndLog("or from emulator memory (option `e`)");
1549 PrintAndLog("Usage: hf mf cload <file name w/o `.eml`>");
1550 PrintAndLog(" or: hf mf cload e ");
1551 PrintAndLog(" sample: hf mf cload filename");
1552 return 0;
1553 }
1554
1555 char ctmp = param_getchar(Cmd, 0);
1556 if (ctmp == 'e' || ctmp == 'E') fillFromEmulator = 1;
1557
1558 if (fillFromEmulator) {
1559 for (blockNum = 0; blockNum < 16 * 4; blockNum += 1) {
1560 if (mfEmlGetMem(buf8, blockNum, 1)) {
1561 PrintAndLog("Cant get block: %d", blockNum);
1562 return 2;
1563 }
1564 if (blockNum == 0) flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC; // switch on field and send magic sequence
1565 if (blockNum == 1) flags = 0; // just write
1566 if (blockNum == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD; // Done. Magic Halt and switch off field.
1567
1568 if (mfCSetBlock(blockNum, buf8, NULL, 0, flags)) {
1569 PrintAndLog("Cant set magic card block: %d", blockNum);
1570 return 3;
1571 }
1572 }
1573 return 0;
1574 } else {
1575 len = strlen(Cmd);
1576 if (len > FILE_PATH_SIZE) len = FILE_PATH_SIZE;
1577
1578 memcpy(filename, Cmd, len);
1579 fnameptr += len;
1580
1581 sprintf(fnameptr, ".eml");
1582
1583 // open file
1584 f = fopen(filename, "r");
1585 if (f == NULL) {
1586 PrintAndLog("File not found or locked.");
1587 return 1;
1588 }
1589
1590 blockNum = 0;
1591 while(!feof(f)){
1592
1593 memset(buf, 0, sizeof(buf));
1594
1595 if (fgets(buf, sizeof(buf), f) == NULL) {
1596 PrintAndLog("File reading error.");
1597 return 2;
1598 }
1599
1600 if (strlen(buf) < 32) {
1601 if(strlen(buf) && feof(f))
1602 break;
1603 PrintAndLog("File content error. Block data must include 32 HEX symbols");
1604 return 2;
1605 }
1606 for (i = 0; i < 32; i += 2)
1607 sscanf(&buf[i], "%02x", (unsigned int *)&buf8[i / 2]);
1608
1609 if (blockNum == 0) flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC; // switch on field and send magic sequence
1610 if (blockNum == 1) flags = 0; // just write
1611 if (blockNum == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD; // Done. Switch off field.
1612
1613 if (mfCSetBlock(blockNum, buf8, NULL, 0, flags)) {
1614 PrintAndLog("Can't set magic card block: %d", blockNum);
1615 return 3;
1616 }
1617 blockNum++;
1618
1619 if (blockNum >= 16 * 4) break; // magic card type - mifare 1K
1620 }
1621 fclose(f);
1622
1623 if (blockNum != 16 * 4 && blockNum != 32 * 4 + 8 * 16){
1624 PrintAndLog("File content error. There must be 64 blocks");
1625 return 4;
1626 }
1627 PrintAndLog("Loaded from file: %s", filename);
1628 return 0;
1629 }
1630 return 0;
1631 }
1632
1633 int CmdHF14AMfCGetBlk(const char *Cmd) {
1634 uint8_t memBlock[16];
1635 uint8_t blockNo = 0;
1636 int res;
1637 memset(memBlock, 0x00, sizeof(memBlock));
1638
1639 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1640 PrintAndLog("Usage: hf mf cgetblk <block number>");
1641 PrintAndLog("sample: hf mf cgetblk 1");
1642 PrintAndLog("Get block data from magic Chinese card (only works with!!!)\n");
1643 return 0;
1644 }
1645
1646 blockNo = param_get8(Cmd, 0);
1647
1648 PrintAndLog("--block number:%2d ", blockNo);
1649
1650 res = mfCGetBlock(blockNo, memBlock, CSETBLOCK_SINGLE_OPER);
1651 if (res) {
1652 PrintAndLog("Can't read block. error=%d", res);
1653 return 1;
1654 }
1655
1656 PrintAndLog("block data:%s", sprint_hex(memBlock, 16));
1657 return 0;
1658 }
1659
1660
1661 int CmdHF14AMfCGetSc(const char *Cmd) {
1662 uint8_t memBlock[16] = {0x00};
1663 uint8_t sectorNo = 0;
1664 int i, res, flags;
1665
1666 if (strlen(Cmd) < 1 || param_getchar(Cmd, 0) == 'h') {
1667 PrintAndLog("Usage: hf mf cgetsc <sector number>");
1668 PrintAndLog("sample: hf mf cgetsc 0");
1669 PrintAndLog("Get sector data from magic Chinese card (only works with!!!)\n");
1670 return 0;
1671 }
1672
1673 sectorNo = param_get8(Cmd, 0);
1674 if (sectorNo > 15) {
1675 PrintAndLog("Sector number must be in [0..15] as in MIFARE classic.");
1676 return 1;
1677 }
1678
1679 PrintAndLog("--sector number:%d ", sectorNo);
1680
1681 flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC;
1682 for (i = 0; i < 4; i++) {
1683 if (i == 1) flags = 0;
1684 if (i == 3) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD;
1685
1686 res = mfCGetBlock(sectorNo * 4 + i, memBlock, flags);
1687 if (res) {
1688 PrintAndLog("Can't read block. %d error=%d", sectorNo * 4 + i, res);
1689 return 1;
1690 }
1691
1692 PrintAndLog("block %3d data:%s", sectorNo * 4 + i, sprint_hex(memBlock, 16));
1693 }
1694 return 0;
1695 }
1696
1697
1698 int CmdHF14AMfCSave(const char *Cmd) {
1699
1700 FILE * f;
1701 char filename[FILE_PATH_SIZE] = {0x00};
1702 char * fnameptr = filename;
1703 uint8_t fillFromEmulator = 0;
1704 uint8_t buf[64] = {0x00};
1705 int i, j, len, flags;
1706
1707 // memset(filename, 0, sizeof(filename));
1708 // memset(buf, 0, sizeof(buf));
1709
1710 if (param_getchar(Cmd, 0) == 'h') {
1711 PrintAndLog("It saves `magic Chinese` card dump into the file `filename.eml` or `cardID.eml`");
1712 PrintAndLog("or into emulator memory (option `e`)");
1713 PrintAndLog("Usage: hf mf esave [file name w/o `.eml`][e]");
1714 PrintAndLog(" sample: hf mf esave ");
1715 PrintAndLog(" hf mf esave filename");
1716 PrintAndLog(" hf mf esave e \n");
1717 return 0;
1718 }
1719
1720 char ctmp = param_getchar(Cmd, 0);
1721 if (ctmp == 'e' || ctmp == 'E') fillFromEmulator = 1;
1722
1723 if (fillFromEmulator) {
1724 // put into emulator
1725 flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC;
1726 for (i = 0; i < 16 * 4; i++) {
1727 if (i == 1) flags = 0;
1728 if (i == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD;
1729
1730 if (mfCGetBlock(i, buf, flags)) {
1731 PrintAndLog("Cant get block: %d", i);
1732 break;
1733 }
1734
1735 if (mfEmlSetMem(buf, i, 1)) {
1736 PrintAndLog("Cant set emul block: %d", i);
1737 return 3;
1738 }
1739 }
1740 return 0;
1741 } else {
1742 len = strlen(Cmd);
1743 if (len > FILE_PATH_SIZE) len = FILE_PATH_SIZE;
1744
1745 if (len < 1) {
1746 // get filename
1747 if (mfCGetBlock(0, buf, CSETBLOCK_SINGLE_OPER)) {
1748 PrintAndLog("Cant get block: %d", 0);
1749 return 1;
1750 }
1751 for (j = 0; j < 7; j++, fnameptr += 2)
1752 sprintf(fnameptr, "%02x", buf[j]);
1753 } else {
1754 memcpy(filename, Cmd, len);
1755 fnameptr += len;
1756 }
1757
1758 sprintf(fnameptr, ".eml");
1759
1760 // open file
1761 f = fopen(filename, "w+");
1762
1763 if (f == NULL) {
1764 PrintAndLog("File not found or locked.");
1765 return 1;
1766 }
1767
1768 // put hex
1769 flags = CSETBLOCK_INIT_FIELD + CSETBLOCK_WUPC;
1770 for (i = 0; i < 16 * 4; i++) {
1771 if (i == 1) flags = 0;
1772 if (i == 16 * 4 - 1) flags = CSETBLOCK_HALT + CSETBLOCK_RESET_FIELD;
1773
1774 if (mfCGetBlock(i, buf, flags)) {
1775 PrintAndLog("Cant get block: %d", i);
1776 break;
1777 }
1778 for (j = 0; j < 16; j++)
1779 fprintf(f, "%02x", buf[j]);
1780 fprintf(f,"\n");
1781 }
1782 fclose(f);
1783
1784 PrintAndLog("Saved to file: %s", filename);
1785
1786 return 0;
1787 }
1788 }
1789
1790
1791 int CmdHF14AMfSniff(const char *Cmd){
1792
1793 bool wantLogToFile = 0;
1794 bool wantDecrypt = 0;
1795 //bool wantSaveToEml = 0; TODO
1796 bool wantSaveToEmlFile = 0;
1797
1798 //var
1799 int res = 0;
1800 int len = 0;
1801 int blockLen = 0;
1802 int pckNum = 0;
1803 int num = 0;
1804 uint8_t uid[7];
1805 uint8_t uid_len;
1806 uint8_t atqa[2] = {0x00};
1807 uint8_t sak;
1808 bool isTag;
1809 uint8_t *buf = NULL;
1810 uint16_t bufsize = 0;
1811 uint8_t *bufPtr = NULL;
1812
1813 char ctmp = param_getchar(Cmd, 0);
1814 if ( ctmp == 'h' || ctmp == 'H' ) {
1815 PrintAndLog("It continuously gets data from the field and saves it to: log, emulator, emulator file.");
1816 PrintAndLog("You can specify:");
1817 PrintAndLog(" l - save encrypted sequence to logfile `uid.log`");
1818 PrintAndLog(" d - decrypt sequence and put it to log file `uid.log`");
1819 PrintAndLog(" n/a e - decrypt sequence, collect read and write commands and save the result of the sequence to emulator memory");
1820 PrintAndLog(" f - decrypt sequence, collect read and write commands and save the result of the sequence to emulator dump file `uid.eml`");
1821 PrintAndLog("Usage: hf mf sniff [l][d][e][f]");
1822 PrintAndLog(" sample: hf mf sniff l d e");
1823 return 0;
1824 }
1825
1826 for (int i = 0; i < 4; i++) {
1827 ctmp = param_getchar(Cmd, i);
1828 if (ctmp == 'l' || ctmp == 'L') wantLogToFile = true;
1829 if (ctmp == 'd' || ctmp == 'D') wantDecrypt = true;
1830 //if (ctmp == 'e' || ctmp == 'E') wantSaveToEml = true; TODO
1831 if (ctmp == 'f' || ctmp == 'F') wantSaveToEmlFile = true;
1832 }
1833
1834 printf("-------------------------------------------------------------------------\n");
1835 printf("Executing command. \n");
1836 printf("Press the key on the proxmark3 device to abort both proxmark3 and client.\n");
1837 printf("Press the key on pc keyboard to abort the client.\n");
1838 printf("-------------------------------------------------------------------------\n");
1839
1840 UsbCommand c = {CMD_MIFARE_SNIFFER, {0, 0, 0}};
1841 clearCommandBuffer();
1842 SendCommand(&c);
1843
1844 // wait cycle
1845 while (true) {
1846 printf(".");
1847 fflush(stdout);
1848 if (ukbhit()) {
1849 getchar();
1850 printf("\naborted via keyboard!\n");
1851 break;
1852 }
1853
1854 UsbCommand resp;
1855 if (WaitForResponseTimeout(CMD_ACK,&resp,2000)) {
1856 res = resp.arg[0] & 0xff;
1857 uint16_t traceLen = resp.arg[1];
1858 len = resp.arg[2];
1859
1860 if (res == 0) return 0; // we are done
1861
1862 if (res == 1) { // there is (more) data to be transferred
1863 if (pckNum == 0) { // first packet, (re)allocate necessary buffer
1864 if (traceLen > bufsize) {
1865 uint8_t *p;
1866 if (buf == NULL) { // not yet allocated
1867 p = malloc(traceLen);
1868 } else { // need more memory
1869 p = realloc(buf, traceLen);
1870 }
1871 if (p == NULL) {
1872 PrintAndLog("Cannot allocate memory for trace");
1873 free(buf);
1874 return 2;
1875 }
1876 buf = p;
1877 }
1878 bufPtr = buf;
1879 bufsize = traceLen;
1880 memset(buf, 0x00, traceLen);
1881 }
1882 memcpy(bufPtr, resp.d.asBytes, len);
1883 bufPtr += len;
1884 pckNum++;
1885 }
1886
1887 if (res == 2) { // received all data, start displaying
1888 blockLen = bufPtr - buf;
1889 bufPtr = buf;
1890 printf(">\n");
1891 PrintAndLog("received trace len: %d packages: %d", blockLen, pckNum);
1892 while (bufPtr - buf < blockLen) {
1893 bufPtr += 6; // skip (void) timing information
1894 len = *((uint16_t *)bufPtr);
1895 if(len & 0x8000) {
1896 isTag = true;
1897 len &= 0x7fff;
1898 } else {
1899 isTag = false;
1900 }
1901 bufPtr += 2;
1902 if ((len == 14) && (bufPtr[0] == 0xff) && (bufPtr[1] == 0xff) && (bufPtr[12] == 0xff) && (bufPtr[13] == 0xff)) {
1903 memcpy(uid, bufPtr + 2, 7);
1904 memcpy(atqa, bufPtr + 2 + 7, 2);
1905 uid_len = (atqa[0] & 0xC0) == 0x40 ? 7 : 4;
1906 sak = bufPtr[11];
1907 PrintAndLog("tag select uid:%s atqa:0x%02x%02x sak:0x%02x",
1908 sprint_hex(uid + (7 - uid_len), uid_len),
1909 atqa[1],
1910 atqa[0],
1911 sak);
1912 if (wantLogToFile || wantDecrypt) {
1913 FillFileNameByUID(logHexFileName, uid + (7 - uid_len), ".log", uid_len);
1914 AddLogCurrentDT(logHexFileName);
1915 }
1916 if (wantDecrypt)
1917 mfTraceInit(uid, atqa, sak, wantSaveToEmlFile);
1918 } else {
1919 PrintAndLog("%s(%d):%s", isTag ? "TAG":"RDR", num, sprint_hex(bufPtr, len));
1920 if (wantLogToFile)
1921 AddLogHex(logHexFileName, isTag ? "TAG: ":"RDR: ", bufPtr, len);
1922 if (wantDecrypt)
1923 mfTraceDecode(bufPtr, len, wantSaveToEmlFile);
1924 num++;
1925 }
1926 bufPtr += len;
1927 bufPtr += ((len-1)/8+1); // ignore parity
1928 }
1929 pckNum = 0;
1930 }
1931 } // resp not NULL
1932 } // while (true)
1933
1934 free(buf);
1935 return 0;
1936 }
1937
1938
1939 static command_t CommandTable[] =
1940 {
1941 {"help", CmdHelp, 1, "This help"},
1942 {"dbg", CmdHF14AMfDbg, 0, "Set default debug mode"},
1943 {"rdbl", CmdHF14AMfRdBl, 0, "Read MIFARE classic block"},
1944 {"rdsc", CmdHF14AMfRdSc, 0, "Read MIFARE classic sector"},
1945 {"dump", CmdHF14AMfDump, 0, "Dump MIFARE classic tag to binary file"},
1946 {"restore", CmdHF14AMfRestore, 0, "Restore MIFARE classic binary file to BLANK tag"},
1947 {"wrbl", CmdHF14AMfWrBl, 0, "Write MIFARE classic block"},
1948 {"chk", CmdHF14AMfChk, 0, "Test block keys"},
1949 {"mifare", CmdHF14AMifare, 0, "Read parity error messages."},
1950 {"nested", CmdHF14AMfNested, 0, "Test nested authentication"},
1951 {"sniff", CmdHF14AMfSniff, 0, "Sniff card-reader communication"},
1952 {"sim", CmdHF14AMf1kSim, 0, "Simulate MIFARE card"},
1953 {"eclr", CmdHF14AMfEClear, 0, "Clear simulator memory block"},
1954 {"eget", CmdHF14AMfEGet, 0, "Get simulator memory block"},
1955 {"eset", CmdHF14AMfESet, 0, "Set simulator memory block"},
1956 {"eload", CmdHF14AMfELoad, 0, "Load from file emul dump"},
1957 {"esave", CmdHF14AMfESave, 0, "Save to file emul dump"},
1958 {"ecfill", CmdHF14AMfECFill, 0, "Fill simulator memory with help of keys from simulator"},
1959 {"ekeyprn", CmdHF14AMfEKeyPrn, 0, "Print keys from simulator memory"},
1960 {"csetuid", CmdHF14AMfCSetUID, 0, "Set UID for magic Chinese card"},
1961 {"csetblk", CmdHF14AMfCSetBlk, 0, "Write block - Magic Chinese card"},
1962 {"cgetblk", CmdHF14AMfCGetBlk, 0, "Read block - Magic Chinese card"},
1963 {"cgetsc", CmdHF14AMfCGetSc, 0, "Read sector - Magic Chinese card"},
1964 {"cload", CmdHF14AMfCLoad, 0, "Load dump into magic Chinese card"},
1965 {"csave", CmdHF14AMfCSave, 0, "Save dump from magic Chinese card into file or emulator"},
1966 {NULL, NULL, 0, NULL}
1967 };
1968
1969 int CmdHFMF(const char *Cmd)
1970 {
1971 // flush
1972 WaitForResponseTimeout(CMD_ACK,NULL,100);
1973
1974 CmdsParse(CommandTable, Cmd);
1975 return 0;
1976 }
1977
1978 int CmdHelp(const char *Cmd)
1979 {
1980 CmdsHelp(CommandTable);
1981 return 0;
1982 }
Impressum, Datenschutz