]> git.zerfleddert.de Git - proxmark3-svn/blob - client/cmdlft55xx.c
projects / proxmark3-svn / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
FIX: sprint_bin_break didn't print the last digit in array.
[proxmark3-svn] / client / cmdlft55xx.c
1 //-----------------------------------------------------------------------------
2 //
3 // This code is licensed to you under the terms of the GNU GPL, version 2 or,
4 // at your option, any later version. See the LICENSE.txt file for the text of
5 // the license.
6 //-----------------------------------------------------------------------------
7 // Low frequency T55xx commands
8 //-----------------------------------------------------------------------------
9
10 #include <stdio.h>
11 #include <string.h>
12 #include <inttypes.h>
13 #include "proxmark3.h"
14 #include "ui.h"
15 #include "graph.h"
16 #include "cmdmain.h"
17 #include "cmdparser.h"
18 #include "cmddata.h"
19 #include "cmdlf.h"
20 #include "cmdlft55xx.h"
21 #include "util.h"
22 #include "data.h"
23 #include "lfdemod.h"
24 #include "cmdhf14a.h" //for getTagInfo
25
26 #define T55x7_CONFIGURATION_BLOCK 0x00
27 #define T55x7_PAGE0 0x00
28 #define T55x7_PAGE1 0x01
29 #define T55x7_PWD 0x00000010
30 #define REGULAR_READ_MODE_BLOCK 0xFF
31
32 // Default configuration
33 t55xx_conf_block_t config = { .modulation = DEMOD_ASK, .inverted = FALSE, .offset = 0x00, .block0 = 0x00, .Q5 = FALSE };
34
35 t55xx_conf_block_t Get_t55xx_Config(){
36 return config;
37 }
38 void Set_t55xx_Config(t55xx_conf_block_t conf){
39 config = conf;
40 }
41
42 int usage_t55xx_config(){
43 PrintAndLog("Usage: lf t55xx config [d <demodulation>] [i 1] [o <offset>] [Q5]");
44 PrintAndLog("Options:");
45 PrintAndLog(" h - This help");
46 PrintAndLog(" b <8|16|32|40|50|64|100|128> - Set bitrate");
47 PrintAndLog(" d <FSK|FSK1|FSK1a|FSK2|FSK2a|ASK|PSK1|PSK2|NRZ|BI|BIa> - Set demodulation FSK / ASK / PSK / NRZ / Biphase / Biphase A");
48 PrintAndLog(" i [1] - Invert data signal, defaults to normal");
49 PrintAndLog(" o [offset] - Set offset, where data should start decode in bitstream");
50 PrintAndLog(" Q5 - Set as Q5(T5555) chip instead of T55x7");
51 PrintAndLog(" ST - Set Sequence Terminator on");
52 PrintAndLog("");
53 PrintAndLog("Examples:");
54 PrintAndLog(" lf t55xx config d FSK - FSK demodulation");
55 PrintAndLog(" lf t55xx config d FSK i 1 - FSK demodulation, inverse data");
56 PrintAndLog(" lf t55xx config d FSK i 1 o 3 - FSK demodulation, inverse data, offset=3,start from position 3 to decode data");
57 PrintAndLog("");
58 return 0;
59 }
60 int usage_t55xx_read(){
61 PrintAndLog("Usage: lf t55xx read [b <block>] [p <password>] <override_safety> <page1>");
62 PrintAndLog("Options:");
63 PrintAndLog(" b <block> - block number to read. Between 0-7");
64 PrintAndLog(" p <password> - OPTIONAL password (8 hex characters)");
65 PrintAndLog(" o - OPTIONAL override safety check");
66 PrintAndLog(" 1 - OPTIONAL read Page 1 instead of Page 0");
67 PrintAndLog(" ****WARNING****");
68 PrintAndLog(" Use of read with password on a tag not configured for a pwd");
69 PrintAndLog(" can damage the tag");
70 PrintAndLog("");
71 PrintAndLog("Examples:");
72 PrintAndLog(" lf t55xx read b 0 - read data from block 0");
73 PrintAndLog(" lf t55xx read b 0 p feedbeef - read data from block 0 password feedbeef");
74 PrintAndLog(" lf t55xx read b 0 p feedbeef o - read data from block 0 password feedbeef safety check");
75 PrintAndLog("");
76 return 0;
77 }
78 int usage_t55xx_write(){
79 PrintAndLog("Usage: lf t55xx wr [b <block>] [d <data>] [p <password>] [1]");
80 PrintAndLog("Options:");
81 PrintAndLog(" b <block> - block number to write. Between 0-7");
82 PrintAndLog(" d <data> - 4 bytes of data to write (8 hex characters)");
83 PrintAndLog(" p <password> - OPTIONAL password 4bytes (8 hex characters)");
84 PrintAndLog(" 1 - OPTIONAL write Page 1 instead of Page 0");
85 PrintAndLog("");
86 PrintAndLog("Examples:");
87 PrintAndLog(" lf t55xx write b 3 d 11223344 - write 11223344 to block 3");
88 PrintAndLog(" lf t55xx write b 3 d 11223344 p feedbeef - write 11223344 to block 3 password feedbeef");
89 PrintAndLog("");
90 return 0;
91 }
92 int usage_t55xx_trace() {
93 PrintAndLog("Usage: lf t55xx trace [1]");
94 PrintAndLog("Options:");
95 PrintAndLog(" 1 - if set, use Graphbuffer otherwise read data from tag.");
96 PrintAndLog("");
97 PrintAndLog("Examples:");
98 PrintAndLog(" lf t55xx trace");
99 PrintAndLog(" lf t55xx trace 1");
100 PrintAndLog("");
101 return 0;
102 }
103 int usage_t55xx_info() {
104 PrintAndLog("Usage: lf t55xx info [1]");
105 PrintAndLog("Options:");
106 PrintAndLog(" 1 - if set, use Graphbuffer otherwise read data from tag.");
107 PrintAndLog("");
108 PrintAndLog("Examples:");
109 PrintAndLog(" lf t55xx info");
110 PrintAndLog(" lf t55xx info 1");
111 PrintAndLog("");
112 return 0;
113 }
114 int usage_t55xx_dump(){
115 PrintAndLog("Usage: lf t55xx dump <password> [o]");
116 PrintAndLog("Options:");
117 PrintAndLog(" <password> - OPTIONAL password 4bytes (8 hex symbols)");
118 PrintAndLog(" o - OPTIONAL override, force pwd read despite danger to card");
119 PrintAndLog("");
120 PrintAndLog("Examples:");
121 PrintAndLog(" lf t55xx dump");
122 PrintAndLog(" lf t55xx dump feedbeef o");
123 PrintAndLog("");
124 return 0;
125 }
126 int usage_t55xx_detect(){
127 PrintAndLog("Usage: lf t55xx detect [1] [p <password>]");
128 PrintAndLog("Options:");
129 PrintAndLog(" 1 - if set, use Graphbuffer otherwise read data from tag.");
130 PrintAndLog(" p <password> - OPTIONAL password (8 hex characters)");
131 PrintAndLog("");
132 PrintAndLog("Examples:");
133 PrintAndLog(" lf t55xx detect");
134 PrintAndLog(" lf t55xx detect 1");
135 PrintAndLog(" lf t55xx detect p 11223344");
136 PrintAndLog("");
137 return 0;
138 }
139 int usage_t55xx_wakup(){
140 PrintAndLog("Usage: lf t55xx wakeup [h] p <password>");
141 PrintAndLog("This commands send the Answer-On-Request command and leaves the readerfield ON afterwards.");
142 PrintAndLog("Options:");
143 PrintAndLog(" h - this help");
144 PrintAndLog(" p <password> - password 4bytes (8 hex symbols)");
145 PrintAndLog("");
146 PrintAndLog("Examples:");
147 PrintAndLog(" lf t55xx wakeup p 11223344 - send wakeup password");
148 return 0;
149 }
150 int usage_t55xx_bruteforce(){
151 PrintAndLog("This command uses A) bruteforce to scan a number range");
152 PrintAndLog(" B) a dictionary attack");
153 PrintAndLog("Usage: lf t55xx bruteforce [h] <start password> <end password> [i <*.dic>]");
154 PrintAndLog(" password must be 4 bytes (8 hex symbols)");
155 PrintAndLog("Options:");
156 PrintAndLog(" h - this help");
157 PrintAndLog(" <start_pwd> - 4 byte hex value to start pwd search at");
158 PrintAndLog(" <end_pwd> - 4 byte hex value to end pwd search at");
159 PrintAndLog(" i <*.dic> - loads a default keys dictionary file <*.dic>");
160 PrintAndLog("");
161 PrintAndLog("Examples:");
162 PrintAndLog(" lf t55xx bruteforce aaaaaaaa bbbbbbbb");
163 PrintAndLog(" lf t55xx bruteforce i default_pwd.dic");
164 PrintAndLog("");
165 return 0;
166 }
167 int usage_t55xx_recoverpw(){
168 PrintAndLog("This command uses a few tricks to try to recover mangled password");
169 PrintAndLog("WARNING: this may brick non-password protected chips!");
170 PrintAndLog("Usage: lf t55xx recoverpw [password]");
171 PrintAndLog(" password must be 4 bytes (8 hex symbols)");
172 PrintAndLog(" default password is 51243648, used by many cloners");
173 PrintAndLog("Options:");
174 PrintAndLog(" h - this help");
175 PrintAndLog(" [password] - 4 byte hex value of password written by cloner");
176 PrintAndLog("");
177 PrintAndLog("Examples:");
178 PrintAndLog(" lf t55xx recoverpw");
179 PrintAndLog(" lf t55xx recoverpw 51243648");
180 PrintAndLog("");
181 return 0;
182 }int usage_t55xx_wipe(){
183 PrintAndLog("Usage: lf t55xx wipe [h] [Q5]");
184 PrintAndLog("This commands wipes a tag, fills blocks 1-7 with zeros and a default configuration block");
185 PrintAndLog("Options:");
186 PrintAndLog(" h - this help");
187 PrintAndLog(" Q5 - indicates to use the T5555 (Q5) default configuration block");
188 PrintAndLog("");
189 PrintAndLog("Examples:");
190 PrintAndLog(" lf t55xx wipe - wipes a t55x7 tag, config block 0x000880E0");
191 PrintAndLog(" lf t55xx wipe Q5 - wipes a t5555 Q5 tag, config block 0x6001F004");
192 return 0;
193 }
194 static int CmdHelp(const char *Cmd);
195
196 void printT5xxHeader(uint8_t page){
197 PrintAndLog("Reading Page %d:", page);
198 PrintAndLog("blk | hex data | binary | ascii");
199 PrintAndLog("----+----------+----------------------------------+-------");
200 }
201
202 int CmdT55xxSetConfig(const char *Cmd) {
203
204 uint8_t offset = 0;
205 char modulation[5] = {0x00};
206 char tmp = 0x00;
207 uint8_t bitRate = 0;
208 uint8_t rates[9] = {8,16,32,40,50,64,100,128,0};
209 uint8_t cmdp = 0;
210 bool errors = FALSE;
211 while(param_getchar(Cmd, cmdp) != 0x00 && !errors)
212 {
213 tmp = param_getchar(Cmd, cmdp);
214 switch(tmp)
215 {
216 case 'h':
217 case 'H':
218 return usage_t55xx_config();
219 case 'b':
220 errors |= param_getdec(Cmd, cmdp+1, &bitRate);
221 if ( !errors){
222 uint8_t i = 0;
223 for (; i < 9; i++){
224 if (rates[i]==bitRate) {
225 config.bitrate = i;
226 break;
227 }
228 }
229 if (i==9) errors = TRUE;
230 }
231 cmdp+=2;
232 break;
233 case 'd':
234 param_getstr(Cmd, cmdp+1, modulation);
235 cmdp += 2;
236
237 if ( strcmp(modulation, "FSK" ) == 0) {
238 config.modulation = DEMOD_FSK;
239 } else if ( strcmp(modulation, "FSK1" ) == 0) {
240 config.modulation = DEMOD_FSK1;
241 config.inverted=1;
242 } else if ( strcmp(modulation, "FSK1a" ) == 0) {
243 config.modulation = DEMOD_FSK1a;
244 config.inverted=0;
245 } else if ( strcmp(modulation, "FSK2" ) == 0) {
246 config.modulation = DEMOD_FSK2;
247 config.inverted=0;
248 } else if ( strcmp(modulation, "FSK2a" ) == 0) {
249 config.modulation = DEMOD_FSK2a;
250 config.inverted=1;
251 } else if ( strcmp(modulation, "ASK" ) == 0) {
252 config.modulation = DEMOD_ASK;
253 } else if ( strcmp(modulation, "NRZ" ) == 0) {
254 config.modulation = DEMOD_NRZ;
255 } else if ( strcmp(modulation, "PSK1" ) == 0) {
256 config.modulation = DEMOD_PSK1;
257 } else if ( strcmp(modulation, "PSK2" ) == 0) {
258 config.modulation = DEMOD_PSK2;
259 } else if ( strcmp(modulation, "PSK3" ) == 0) {
260 config.modulation = DEMOD_PSK3;
261 } else if ( strcmp(modulation, "BIa" ) == 0) {
262 config.modulation = DEMOD_BIa;
263 config.inverted=1;
264 } else if ( strcmp(modulation, "BI" ) == 0) {
265 config.modulation = DEMOD_BI;
266 config.inverted=0;
267 } else {
268 PrintAndLog("Unknown modulation '%s'", modulation);
269 errors = TRUE;
270 }
271 break;
272 case 'i':
273 config.inverted = param_getchar(Cmd,cmdp+1) == '1';
274 cmdp+=2;
275 break;
276 case 'o':
277 errors |= param_getdec(Cmd, cmdp+1, &offset);
278 if ( !errors )
279 config.offset = offset;
280 cmdp+=2;
281 break;
282 case 'Q':
283 case 'q':
284 config.Q5 = TRUE;
285 cmdp++;
286 break;
287 case 'S':
288 case 's':
289 config.ST = TRUE;
290 cmdp++;
291 break;
292 default:
293 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp));
294 errors = TRUE;
295 break;
296 }
297 }
298
299 // No args
300 if (cmdp == 0) return printConfiguration( config );
301
302 //Validations
303 if (errors) return usage_t55xx_config();
304
305 config.block0 = 0;
306 return printConfiguration ( config );
307 }
308
309 int T55xxReadBlock(uint8_t block, bool page1, bool usepwd, bool override, uint32_t password){
310 //Password mode
311 if ( usepwd ) {
312 // try reading the config block and verify that PWD bit is set before doing this!
313 if ( !override ) {
314
315 if ( !AquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, false, 0 ) ) return 0;
316
317 if ( !tryDetectModulation() ) {
318 PrintAndLog("Safety Check: Could not detect if PWD bit is set in config block. Exits.");
319 return 0;
320 } else {
321 PrintAndLog("Safety Check: PWD bit is NOT set in config block. Reading without password...");
322 usepwd = false;
323 page1 = false;
324 }
325 } else {
326 PrintAndLog("Safety Check Overriden - proceeding despite risk");
327 }
328 }
329
330 if (!AquireData(page1, block, usepwd, password) ) return 0;
331 if (!DecodeT55xxBlock()) return 0;
332
333 char blk[10]={0};
334 sprintf(blk,"%02d", block);
335 printT55xxBlock(blk);
336 return 1;
337 }
338
339 int CmdT55xxReadBlock(const char *Cmd) {
340 uint8_t block = REGULAR_READ_MODE_BLOCK;
341 uint32_t password = 0; //default to blank Block 7
342 bool usepwd = false;
343 bool override = false;
344 bool page1 = false;
345 bool errors = false;
346 uint8_t cmdp = 0;
347 while(param_getchar(Cmd, cmdp) != 0x00 && !errors) {
348 switch(param_getchar(Cmd, cmdp)) {
349 case 'h':
350 case 'H':
351 return usage_t55xx_read();
352 case 'b':
353 case 'B':
354 errors |= param_getdec(Cmd, cmdp+1, &block);
355 cmdp += 2;
356 break;
357 case 'o':
358 case 'O':
359 override = TRUE;
360 cmdp++;
361 break;
362 case 'p':
363 case 'P':
364 password = param_get32ex(Cmd, cmdp+1, 0, 16);
365 usepwd = true;
366 cmdp += 2;
367 break;
368 case '1':
369 page1 = true;
370 cmdp++;
371 break;
372 default:
373 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp));
374 errors = true;
375 break;
376 }
377 }
378 if (errors) return usage_t55xx_read();
379
380 if (block > 7 && block != REGULAR_READ_MODE_BLOCK ) {
381 PrintAndLog("Block must be between 0 and 7");
382 return 0;
383 }
384
385 printT5xxHeader(page1);
386 return T55xxReadBlock(block, page1, usepwd, override, password);
387 }
388
389 bool DecodeT55xxBlock(){
390
391 char buf[30] = {0x00};
392 char *cmdStr = buf;
393 int ans = 0;
394 bool ST = config.ST;
395 uint8_t bitRate[8] = {8,16,32,40,50,64,100,128};
396 DemodBufferLen = 0x00;
397
398 switch( config.modulation ){
399 case DEMOD_FSK:
400 snprintf(cmdStr, sizeof(buf),"%d %d", bitRate[config.bitrate], config.inverted );
401 ans = FSKrawDemod(cmdStr, FALSE);
402 break;
403 case DEMOD_FSK1:
404 case DEMOD_FSK1a:
405 snprintf(cmdStr, sizeof(buf),"%d %d 8 5", bitRate[config.bitrate], config.inverted );
406 ans = FSKrawDemod(cmdStr, FALSE);
407 break;
408 case DEMOD_FSK2:
409 case DEMOD_FSK2a:
410 snprintf(cmdStr, sizeof(buf),"%d %d 10 8", bitRate[config.bitrate], config.inverted );
411 ans = FSKrawDemod(cmdStr, FALSE);
412 break;
413 case DEMOD_ASK:
414 snprintf(cmdStr, sizeof(buf),"%d %d 1", bitRate[config.bitrate], config.inverted );
415 ans = ASKDemod_ext(cmdStr, FALSE, FALSE, 1, &ST);
416 break;
417 case DEMOD_PSK1:
418 // skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)
419 save_restoreGB(1);
420 CmdLtrim("160");
421 snprintf(cmdStr, sizeof(buf),"%d %d 6", bitRate[config.bitrate], config.inverted );
422 ans = PSKDemod(cmdStr, FALSE);
423 //undo trim samples
424 save_restoreGB(0);
425 break;
426 case DEMOD_PSK2: //inverted won't affect this
427 case DEMOD_PSK3: //not fully implemented
428 // skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)
429 save_restoreGB(1);
430 CmdLtrim("160");
431 snprintf(cmdStr, sizeof(buf),"%d 0 6", bitRate[config.bitrate] );
432 ans = PSKDemod(cmdStr, FALSE);
433 psk1TOpsk2(DemodBuffer, DemodBufferLen);
434 //undo trim samples
435 save_restoreGB(0);
436 break;
437 case DEMOD_NRZ:
438 snprintf(cmdStr, sizeof(buf),"%d %d 1", bitRate[config.bitrate], config.inverted );
439 ans = NRZrawDemod(cmdStr, FALSE);
440 break;
441 case DEMOD_BI:
442 case DEMOD_BIa:
443 snprintf(cmdStr, sizeof(buf),"0 %d %d 1", bitRate[config.bitrate], config.inverted );
444 ans = ASKbiphaseDemod(cmdStr, FALSE);
445 break;
446 default:
447 return FALSE;
448 }
449 return (bool) ans;
450 }
451
452 bool DecodeT5555TraceBlock() {
453 DemodBufferLen = 0x00;
454
455 // According to datasheet. Always: RF/64, not inverted, Manchester
456 return (bool) ASKDemod("64 0 1", FALSE, FALSE, 1);
457 }
458
459 // sanity check. Don't use proxmark if it is offline and you didn't specify useGraphbuf
460 static int SanityOfflineCheck( bool useGraphBuffer ){
461 if ( !useGraphBuffer && offline) {
462 PrintAndLog("Your proxmark3 device is offline. Specify [1] to use graphbuffer data instead");
463 return 0;
464 }
465 return 1;
466 }
467
468 int CmdT55xxDetect(const char *Cmd){
469 bool errors = FALSE;
470 bool useGB = FALSE;
471 bool usepwd = FALSE;
472 uint32_t password = 0;
473 uint8_t cmdp = 0;
474
475 while(param_getchar(Cmd, cmdp) != 0x00 && !errors) {
476 switch(param_getchar(Cmd, cmdp)) {
477 case 'h':
478 case 'H':
479 return usage_t55xx_detect();
480 case 'p':
481 case 'P':
482 password = param_get32ex(Cmd, cmdp+1, 0, 16);
483 usepwd = TRUE;
484 cmdp += 2;
485 break;
486 case '1':
487 // use Graphbuffer data
488 useGB = TRUE;
489 cmdp++;
490 break;
491 default:
492 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp));
493 errors = true;
494 break;
495 }
496 }
497 if (errors) return usage_t55xx_detect();
498
499 // sanity check.
500 if (!SanityOfflineCheck(useGB)) return 1;
501
502 if ( !useGB) {
503 if ( !AquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, usepwd, password) )
504 return 1;
505 }
506
507 if ( !tryDetectModulation() )
508 PrintAndLog("Could not detect modulation automatically. Try setting it manually with \'lf t55xx config\'");
509
510 return 0;
511 }
512
513 // detect configuration?
514 bool tryDetectModulation(){
515 uint8_t hits = 0;
516 t55xx_conf_block_t tests[15];
517 int bitRate=0;
518 uint8_t fc1 = 0, fc2 = 0, clk=0;
519
520 if (GetFskClock("", FALSE, FALSE)){
521 fskClocks(&fc1, &fc2, &clk, FALSE);
522 if ( FSKrawDemod("0 0", FALSE) && test(DEMOD_FSK, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)){
523 tests[hits].modulation = DEMOD_FSK;
524 if (fc1==8 && fc2 == 5)
525 tests[hits].modulation = DEMOD_FSK1a;
526 else if (fc1==10 && fc2 == 8)
527 tests[hits].modulation = DEMOD_FSK2;
528 tests[hits].bitrate = bitRate;
529 tests[hits].inverted = FALSE;
530 tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
531 tests[hits].ST = FALSE;
532 ++hits;
533 }
534 if ( FSKrawDemod("0 1", FALSE) && test(DEMOD_FSK, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
535 tests[hits].modulation = DEMOD_FSK;
536 if (fc1 == 8 && fc2 == 5)
537 tests[hits].modulation = DEMOD_FSK1;
538 else if (fc1 == 10 && fc2 == 8)
539 tests[hits].modulation = DEMOD_FSK2a;
540 tests[hits].bitrate = bitRate;
541 tests[hits].inverted = TRUE;
542 tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
543 tests[hits].ST = FALSE;
544 ++hits;
545 }
546 } else {
547 clk = GetAskClock("", FALSE, FALSE);
548 if (clk>0) {
549 tests[hits].ST = TRUE;
550 // "0 0 1 " == clock auto, invert false, maxError 1.
551 // false = no verbose
552 // false = no emSearch
553 // 1 = Ask/Man
554 // st = true
555 if ( ASKDemod_ext("0 0 1", FALSE, FALSE, 1, &tests[hits].ST) && test(DEMOD_ASK, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
556 tests[hits].modulation = DEMOD_ASK;
557 tests[hits].bitrate = bitRate;
558 tests[hits].inverted = FALSE;
559 tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
560 ++hits;
561 }
562 tests[hits].ST = TRUE;
563 // "0 0 1 " == clock auto, invert true, maxError 1.
564 // false = no verbose
565 // false = no emSearch
566 // 1 = Ask/Man
567 // st = true
568 if ( ASKDemod_ext("0 1 1", FALSE, FALSE, 1, &tests[hits].ST) && test(DEMOD_ASK, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
569 tests[hits].modulation = DEMOD_ASK;
570 tests[hits].bitrate = bitRate;
571 tests[hits].inverted = TRUE;
572 tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
573 ++hits;
574 }
575 if ( ASKbiphaseDemod("0 0 0 2", FALSE) && test(DEMOD_BI, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5) ) {
576 tests[hits].modulation = DEMOD_BI;
577 tests[hits].bitrate = bitRate;
578 tests[hits].inverted = FALSE;
579 tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
580 tests[hits].ST = FALSE;
581 ++hits;
582 }
583 if ( ASKbiphaseDemod("0 0 1 2", FALSE) && test(DEMOD_BIa, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5) ) {
584 tests[hits].modulation = DEMOD_BIa;
585 tests[hits].bitrate = bitRate;
586 tests[hits].inverted = TRUE;
587 tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
588 tests[hits].ST = FALSE;
589 ++hits;
590 }
591 }
592 //undo trim from ask
593 //save_restoreGB(0);
594 clk = GetNrzClock("", FALSE, FALSE);
595 if (clk>0) {
596 if ( NRZrawDemod("0 0 1", FALSE) && test(DEMOD_NRZ, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
597 tests[hits].modulation = DEMOD_NRZ;
598 tests[hits].bitrate = bitRate;
599 tests[hits].inverted = FALSE;
600 tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
601 tests[hits].ST = FALSE;
602 ++hits;
603 }
604
605 if ( NRZrawDemod("0 1 1", FALSE) && test(DEMOD_NRZ, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
606 tests[hits].modulation = DEMOD_NRZ;
607 tests[hits].bitrate = bitRate;
608 tests[hits].inverted = TRUE;
609 tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
610 tests[hits].ST = FALSE;
611 ++hits;
612 }
613 }
614
615 // allow undo
616 // skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)
617 save_restoreGB(1);
618 CmdLtrim("160");
619 clk = GetPskClock("", FALSE, FALSE);
620 if (clk>0) {
621 if ( PSKDemod("0 0 6", FALSE) && test(DEMOD_PSK1, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
622 tests[hits].modulation = DEMOD_PSK1;
623 tests[hits].bitrate = bitRate;
624 tests[hits].inverted = FALSE;
625 tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
626 tests[hits].ST = FALSE;
627 ++hits;
628 }
629 if ( PSKDemod("0 1 6", FALSE) && test(DEMOD_PSK1, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
630 tests[hits].modulation = DEMOD_PSK1;
631 tests[hits].bitrate = bitRate;
632 tests[hits].inverted = TRUE;
633 tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
634 tests[hits].ST = FALSE;
635 ++hits;
636 }
637 // PSK2 - needs a call to psk1TOpsk2.
638 if ( PSKDemod("0 0 6", FALSE)) {
639 psk1TOpsk2(DemodBuffer, DemodBufferLen);
640 if (test(DEMOD_PSK2, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)){
641 tests[hits].modulation = DEMOD_PSK2;
642 tests[hits].bitrate = bitRate;
643 tests[hits].inverted = FALSE;
644 tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
645 tests[hits].ST = FALSE;
646 ++hits;
647 }
648 } // inverse waves does not affect this demod
649 // PSK3 - needs a call to psk1TOpsk2.
650 if ( PSKDemod("0 0 6", FALSE)) {
651 psk1TOpsk2(DemodBuffer, DemodBufferLen);
652 if (test(DEMOD_PSK3, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)){
653 tests[hits].modulation = DEMOD_PSK3;
654 tests[hits].bitrate = bitRate;
655 tests[hits].inverted = FALSE;
656 tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
657 tests[hits].ST = FALSE;
658 ++hits;
659 }
660 } // inverse waves does not affect this demod
661 }
662 //undo trim samples
663 save_restoreGB(0);
664 }
665 if ( hits == 1) {
666 config.modulation = tests[0].modulation;
667 config.bitrate = tests[0].bitrate;
668 config.inverted = tests[0].inverted;
669 config.offset = tests[0].offset;
670 config.block0 = tests[0].block0;
671 config.Q5 = tests[0].Q5;
672 config.ST = tests[0].ST;
673 printConfiguration( config );
674 return TRUE;
675 }
676
677 bool retval = FALSE;
678 if ( hits > 1) {
679 PrintAndLog("Found [%d] possible matches for modulation.",hits);
680 for(int i=0; i<hits; ++i){
681 retval = testKnownConfigBlock(tests[i].block0);
682 if ( retval ) {
683 PrintAndLog("--[%d]--------------- << selected this", i+1);
684 config.modulation = tests[i].modulation;
685 config.bitrate = tests[i].bitrate;
686 config.inverted = tests[i].inverted;
687 config.offset = tests[i].offset;
688 config.block0 = tests[i].block0;
689 config.Q5 = tests[i].Q5;
690 config.ST = tests[i].ST;
691 } else {
692 PrintAndLog("--[%d]---------------", i+1);
693 }
694 printConfiguration( tests[i] );
695 }
696 }
697 return retval;
698 }
699
700 bool testKnownConfigBlock(uint32_t block0) {
701 switch(block0){
702 case T55X7_DEFAULT_CONFIG_BLOCK:
703 case T55X7_RAW_CONFIG_BLOCK:
704 case T55X7_EM_UNIQUE_CONFIG_BLOCK:
705 case T55X7_FDXB_CONFIG_BLOCK:
706 case T55X7_HID_26_CONFIG_BLOCK:
707 case T55X7_PYRAMID_CONFIG_BLOCK:
708 case T55X7_INDALA_64_CONFIG_BLOCK:
709 case T55X7_INDALA_224_CONFIG_BLOCK:
710 case T55X7_GUARDPROXII_CONFIG_BLOCK:
711 case T55X7_VIKING_CONFIG_BLOCK:
712 case T55X7_NORALYS_CONFIG_BLOCK:
713 case T55X7_IOPROX_CONFIG_BLOCK:
714 case T55X7_PRESCO_CONFIG_BLOCK:
715 return TRUE;
716 }
717 return FALSE;
718 }
719
720 bool testModulation(uint8_t mode, uint8_t modread){
721 switch( mode ){
722 case DEMOD_FSK:
723 if (modread >= DEMOD_FSK1 && modread <= DEMOD_FSK2a) return TRUE;
724 break;
725 case DEMOD_ASK:
726 if (modread == DEMOD_ASK) return TRUE;
727 break;
728 case DEMOD_PSK1:
729 if (modread == DEMOD_PSK1) return TRUE;
730 break;
731 case DEMOD_PSK2:
732 if (modread == DEMOD_PSK2) return TRUE;
733 break;
734 case DEMOD_PSK3:
735 if (modread == DEMOD_PSK3) return TRUE;
736 break;
737 case DEMOD_NRZ:
738 if (modread == DEMOD_NRZ) return TRUE;
739 break;
740 case DEMOD_BI:
741 if (modread == DEMOD_BI) return TRUE;
742 break;
743 case DEMOD_BIa:
744 if (modread == DEMOD_BIa) return TRUE;
745 break;
746 default:
747 return FALSE;
748 }
749 return FALSE;
750 }
751
752 bool testQ5Modulation(uint8_t mode, uint8_t modread){
753 switch( mode ){
754 case DEMOD_FSK:
755 if (modread >= 4 && modread <= 5) return TRUE;
756 break;
757 case DEMOD_ASK:
758 if (modread == 0) return TRUE;
759 break;
760 case DEMOD_PSK1:
761 if (modread == 1) return TRUE;
762 break;
763 case DEMOD_PSK2:
764 if (modread == 2) return TRUE;
765 break;
766 case DEMOD_PSK3:
767 if (modread == 3) return TRUE;
768 break;
769 case DEMOD_NRZ:
770 if (modread == 7) return TRUE;
771 break;
772 case DEMOD_BI:
773 if (modread == 6) return TRUE;
774 break;
775 default:
776 return FALSE;
777 }
778 return FALSE;
779 }
780
781 int convertQ5bitRate(uint8_t bitRateRead) {
782 uint8_t expected[] = {8, 16, 32, 40, 50, 64, 100, 128};
783 for (int i=0; i<8; i++)
784 if (expected[i] == bitRateRead)
785 return i;
786
787 return -1;
788 }
789
790 bool testQ5(uint8_t mode, uint8_t *offset, int *fndBitRate, uint8_t clk){
791
792 if ( DemodBufferLen < 64 ) return FALSE;
793 uint8_t si = 0;
794 for (uint8_t idx = 28; idx < 64; idx++){
795 si = idx;
796 if ( PackBits(si, 28, DemodBuffer) == 0x00 ) continue;
797
798 uint8_t safer = PackBits(si, 4, DemodBuffer); si += 4; //master key
799 uint8_t resv = PackBits(si, 8, DemodBuffer); si += 8;
800 // 2nibble must be zeroed.
801 if (safer != 0x6 && safer != 0x9) continue;
802 if ( resv > 0x00) continue;
803 //uint8_t pageSel = PackBits(si, 1, DemodBuffer); si += 1;
804 //uint8_t fastWrite = PackBits(si, 1, DemodBuffer); si += 1;
805 si += 1+1;
806 int bitRate = PackBits(si, 6, DemodBuffer)*2 + 2; si += 6; //bit rate
807 if (bitRate > 128 || bitRate < 8) continue;
808
809 //uint8_t AOR = PackBits(si, 1, DemodBuffer); si += 1;
810 //uint8_t PWD = PackBits(si, 1, DemodBuffer); si += 1;
811 //uint8_t pskcr = PackBits(si, 2, DemodBuffer); si += 2; //could check psk cr
812 //uint8_t inverse = PackBits(si, 1, DemodBuffer); si += 1;
813 si += 1+1+2+1;
814 uint8_t modread = PackBits(si, 3, DemodBuffer); si += 3;
815 uint8_t maxBlk = PackBits(si, 3, DemodBuffer); si += 3;
816 //uint8_t ST = PackBits(si, 1, DemodBuffer); si += 1;
817 if (maxBlk == 0) continue;
818 //test modulation
819 if (!testQ5Modulation(mode, modread)) continue;
820 if (bitRate != clk) continue;
821 *fndBitRate = convertQ5bitRate(bitRate);
822 if (*fndBitRate < 0) continue;
823 *offset = idx;
824
825 return TRUE;
826 }
827 return FALSE;
828 }
829
830 bool testBitRate(uint8_t readRate, uint8_t clk){
831 uint8_t expected[] = {8, 16, 32, 40, 50, 64, 100, 128};
832 if (expected[readRate] == clk)
833 return true;
834
835 return false;
836 }
837
838 bool test(uint8_t mode, uint8_t *offset, int *fndBitRate, uint8_t clk, bool *Q5){
839
840 if ( DemodBufferLen < 64 ) return FALSE;
841 uint8_t si = 0;
842 for (uint8_t idx = 28; idx < 64; idx++){
843 si = idx;
844 if ( PackBits(si, 28, DemodBuffer) == 0x00 ) continue;
845
846 uint8_t safer = PackBits(si, 4, DemodBuffer); si += 4; //master key
847 uint8_t resv = PackBits(si, 4, DemodBuffer); si += 4; //was 7 & +=7+3 //should be only 4 bits if extended mode
848 // 2nibble must be zeroed.
849 // moved test to here, since this gets most faults first.
850 if ( resv > 0x00) continue;
851
852 uint8_t xtRate = PackBits(si, 3, DemodBuffer); si += 3; //extended mode part of rate
853 int bitRate = PackBits(si, 3, DemodBuffer); si += 3; //bit rate
854 if (bitRate > 7) continue;
855 uint8_t extend = PackBits(si, 1, DemodBuffer); si += 1; //bit 15 extended mode
856 uint8_t modread = PackBits(si, 5, DemodBuffer); si += 5+2+1;
857 //uint8_t pskcr = PackBits(si, 2, DemodBuffer); si += 2+1; //could check psk cr
858 //uint8_t nml01 = PackBits(si, 1, DemodBuffer); si += 1+5; //bit 24, 30, 31 could be tested for 0 if not extended mode
859 //uint8_t nml02 = PackBits(si, 2, DemodBuffer); si += 2;
860
861 //if extended mode
862 bool extMode =( (safer == 0x6 || safer == 0x9) && extend) ? TRUE : FALSE;
863
864 if (!extMode){
865 if (xtRate) continue; //nml01 || nml02 || caused issues on noralys tags
866 }
867 //test modulation
868 if (!testModulation(mode, modread)) continue;
869 if (!testBitRate(bitRate, clk)) continue;
870 *fndBitRate = bitRate;
871 *offset = idx;
872 *Q5 = FALSE;
873 return TRUE;
874 }
875 if (testQ5(mode, offset, fndBitRate, clk)) {
876 *Q5 = TRUE;
877 return TRUE;
878 }
879 return FALSE;
880 }
881
882 void printT55xxBlock(const char *blockNum){
883
884 uint8_t i = config.offset;
885 uint8_t endpos = 32 + i;
886 uint32_t blockData = 0;
887 uint8_t bits[64] = {0x00};
888
889 if ( !DemodBufferLen) return;
890
891 if ( endpos > DemodBufferLen){
892 PrintAndLog("The configured offset %d is too big. Possible offset: %d)", i, DemodBufferLen-32);
893 return;
894 }
895
896 for (; i < endpos; ++i)
897 bits[i - config.offset] = DemodBuffer[i];
898
899 blockData = PackBits(0, 32, bits);
900 uint8_t bytes[4] = {0};
901 num_to_bytes(blockData, 4, bytes);
902
903 PrintAndLog(" %s | %08X | %s | %s", blockNum, blockData, sprint_bin(bits,32), sprint_ascii(bytes,4));
904 }
905
906 int special(const char *Cmd) {
907 uint32_t blockData = 0;
908 uint8_t bits[32] = {0x00};
909
910 PrintAndLog("OFFSET | DATA | BINARY | ASCII");
911 PrintAndLog("-------+-------+-------------------------------------+------");
912 int i,j = 0;
913 for (; j < 64; ++j){
914
915 for (i = 0; i < 32; ++i)
916 bits[i]=DemodBuffer[j+i];
917
918 blockData = PackBits(0, 32, bits);
919
920 PrintAndLog("%02d | 0x%08X | %s",j , blockData, sprint_bin(bits,32));
921 }
922 return 0;
923 }
924
925 int printConfiguration( t55xx_conf_block_t b){
926 PrintAndLog("Chip Type : %s", (b.Q5) ? "T5555(Q5)" : "T55x7");
927 PrintAndLog("Modulation : %s", GetSelectedModulationStr(b.modulation) );
928 PrintAndLog("Bit Rate : %s", GetBitRateStr(b.bitrate) );
929 PrintAndLog("Inverted : %s", (b.inverted) ? "Yes" : "No" );
930 PrintAndLog("Offset : %d", b.offset);
931 PrintAndLog("Seq. Term. : %s", (b.ST) ? "Yes" : "No" );
932 PrintAndLog("Block0 : 0x%08X", b.block0);
933 PrintAndLog("");
934 return 0;
935 }
936
937 int CmdT55xxWakeUp(const char *Cmd) {
938 uint32_t password = 0;
939 uint8_t cmdp = 0;
940 bool errors = false;
941 while(param_getchar(Cmd, cmdp) != 0x00 && !errors) {
942 switch(param_getchar(Cmd, cmdp)) {
943 case 'h':
944 case 'H':
945 return usage_t55xx_wakup();
946 case 'p':
947 case 'P':
948 password = param_get32ex(Cmd, cmdp+1, 0, 16);
949 cmdp += 2;
950 errors = false;
951 break;
952 default:
953 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp));
954 errors = true;
955 break;
956 }
957 }
958 if (errors) return usage_t55xx_wakup();
959
960 UsbCommand c = {CMD_T55XX_WAKEUP, {password, 0, 0}};
961 clearCommandBuffer();
962 SendCommand(&c);
963 PrintAndLog("Wake up command sent. Try read now");
964 return 0;
965 }
966
967 int CmdT55xxWriteBlock(const char *Cmd) {
968 uint8_t block = 0xFF; //default to invalid block
969 uint32_t data = 0; //default to blank Block
970 uint32_t password = 0; //default to blank Block 7
971 bool usepwd = false;
972 bool page1 = false;
973 bool gotdata = false;
974 bool errors = false;
975 uint8_t cmdp = 0;
976 while(param_getchar(Cmd, cmdp) != 0x00 && !errors) {
977 switch(param_getchar(Cmd, cmdp)) {
978 case 'h':
979 case 'H':
980 return usage_t55xx_write();
981 case 'b':
982 case 'B':
983 errors |= param_getdec(Cmd, cmdp+1, &block);
984 cmdp += 2;
985 break;
986 case 'd':
987 case 'D':
988 data = param_get32ex(Cmd, cmdp+1, 0, 16);
989 gotdata = true;
990 cmdp += 2;
991 break;
992 case 'p':
993 case 'P':
994 password = param_get32ex(Cmd, cmdp+1, 0, 16);
995 usepwd = true;
996 cmdp += 2;
997 break;
998 case '1':
999 page1 = true;
1000 cmdp++;
1001 break;
1002 default:
1003 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp));
1004 errors = true;
1005 break;
1006 }
1007 }
1008 if (errors || !gotdata) return usage_t55xx_write();
1009
1010 if (block > 7) {
1011 PrintAndLog("Block number must be between 0 and 7");
1012 return 0;
1013 }
1014
1015 UsbCommand c = {CMD_T55XX_WRITE_BLOCK, {data, block, 0}};
1016 UsbCommand resp;
1017 c.d.asBytes[0] = (page1) ? 0x2 : 0;
1018
1019 char pwdStr[16] = {0};
1020 snprintf(pwdStr, sizeof(pwdStr), "pwd: 0x%08X", password);
1021
1022 PrintAndLog("Writing page %d block: %02d data: 0x%08X %s", page1, block, data, (usepwd) ? pwdStr : "" );
1023
1024 //Password mode
1025 if (usepwd) {
1026 c.arg[2] = password;
1027 c.d.asBytes[0] |= 0x1;
1028 }
1029 clearCommandBuffer();
1030 SendCommand(&c);
1031 if (!WaitForResponseTimeout(CMD_ACK, &resp, 1500)){
1032 PrintAndLog("Error occurred, device did not ACK write operation. (May be due to old firmware)");
1033 return 0;
1034 }
1035 return 1;
1036 }
1037
1038 int CmdT55xxReadTrace(const char *Cmd) {
1039 char cmdp = param_getchar(Cmd, 0);
1040 bool pwdmode = false;
1041 uint32_t password = 0;
1042 if (strlen(Cmd) > 1 || cmdp == 'h' || cmdp == 'H') return usage_t55xx_trace();
1043
1044 if (strlen(Cmd)==0) {
1045 // sanity check.
1046 if (!SanityOfflineCheck(FALSE)) return 1;
1047
1048 if ( !AquireData( T55x7_PAGE1, REGULAR_READ_MODE_BLOCK, pwdmode, password ) )
1049 return 1;
1050 }
1051
1052 if ( config.Q5 ){
1053 if (!DecodeT5555TraceBlock()) return 1;
1054 } else {
1055 if (!DecodeT55xxBlock()) return 1;
1056 }
1057
1058 if ( !DemodBufferLen ) return 1;
1059
1060 RepaintGraphWindow();
1061 uint8_t repeat = (config.offset > 5) ? 32 : 0;
1062
1063 uint8_t si = config.offset + repeat;
1064 uint32_t bl1 = PackBits(si, 32, DemodBuffer);
1065 uint32_t bl2 = PackBits(si+32, 32, DemodBuffer);
1066
1067 if (config.Q5) {
1068 uint32_t hdr = PackBits(si, 9, DemodBuffer); si += 9;
1069
1070 if (hdr != 0x1FF) {
1071 PrintAndLog("Invalid Q5 Trace data header (expected 0x1FF, found %X)", hdr);
1072 return 1;
1073 }
1074
1075 t5555_tracedata_t data = {.bl1 = bl1, .bl2 = bl2, .icr = 0, .lotidc = '?', .lotid = 0, .wafer = 0, .dw =0};
1076
1077 data.icr = PackBits(si, 2, DemodBuffer); si += 2;
1078 data.lotidc = 'Z' - PackBits(si, 2, DemodBuffer); si += 3;
1079
1080 data.lotid = PackBits(si, 4, DemodBuffer); si += 5;
1081 data.lotid <<= 4;
1082 data.lotid |= PackBits(si, 4, DemodBuffer); si += 5;
1083 data.lotid <<= 4;
1084 data.lotid |= PackBits(si, 4, DemodBuffer); si += 5;
1085 data.lotid <<= 4;
1086 data.lotid |= PackBits(si, 4, DemodBuffer); si += 5;
1087 data.lotid <<= 1;
1088 data.lotid |= PackBits(si, 1, DemodBuffer); si += 1;
1089
1090 data.wafer = PackBits(si, 3, DemodBuffer); si += 4;
1091 data.wafer <<= 2;
1092 data.wafer |= PackBits(si, 2, DemodBuffer); si += 2;
1093
1094 data.dw = PackBits(si, 2, DemodBuffer); si += 3;
1095 data.dw <<= 4;
1096 data.dw |= PackBits(si, 4, DemodBuffer); si += 5;
1097 data.dw <<= 4;
1098 data.dw |= PackBits(si, 4, DemodBuffer); si += 5;
1099 data.dw <<= 4;
1100 data.dw |= PackBits(si, 4, DemodBuffer); si += 5;
1101
1102 printT5555Trace(data, repeat);
1103
1104 } else {
1105
1106 t55x7_tracedata_t data = {.bl1 = bl1, .bl2 = bl2, .acl = 0, .mfc = 0, .cid = 0, .year = 0, .quarter = 0, .icr = 0, .lotid = 0, .wafer = 0, .dw = 0};
1107
1108 data.acl = PackBits(si, 8, DemodBuffer); si += 8;
1109 if ( data.acl != 0xE0 ) {
1110 PrintAndLog("The modulation is most likely wrong since the ACL is not 0xE0. ");
1111 return 1;
1112 }
1113
1114 data.mfc = PackBits(si, 8, DemodBuffer); si += 8;
1115 data.cid = PackBits(si, 5, DemodBuffer); si += 5;
1116 data.icr = PackBits(si, 3, DemodBuffer); si += 3;
1117 data.year = PackBits(si, 4, DemodBuffer); si += 4;
1118 data.quarter = PackBits(si, 2, DemodBuffer); si += 2;
1119 data.lotid = PackBits(si, 14, DemodBuffer); si += 14;
1120 data.wafer = PackBits(si, 5, DemodBuffer); si += 5;
1121 data.dw = PackBits(si, 15, DemodBuffer);
1122
1123 time_t t = time(NULL);
1124 struct tm tm = *localtime(&t);
1125 if ( data.year > tm.tm_year-110)
1126 data.year += 2000;
1127 else
1128 data.year += 2010;
1129
1130 printT55x7Trace(data, repeat);
1131 }
1132 return 0;
1133 }
1134
1135 void printT55x7Trace( t55x7_tracedata_t data, uint8_t repeat ){
1136 PrintAndLog("-- T55x7 Trace Information ----------------------------------");
1137 PrintAndLog("-------------------------------------------------------------");
1138 PrintAndLog(" ACL Allocation class (ISO/IEC 15963-1) : 0x%02X (%d)", data.acl, data.acl);
1139 PrintAndLog(" MFC Manufacturer ID (ISO/IEC 7816-6) : 0x%02X (%d) - %s", data.mfc, data.mfc, getTagInfo(data.mfc));
1140 PrintAndLog(" CID : 0x%02X (%d) - %s", data.cid, data.cid, GetModelStrFromCID(data.cid));
1141 PrintAndLog(" ICR IC Revision : %d", data.icr );
1142 PrintAndLog(" Manufactured");
1143 PrintAndLog(" Year/Quarter : %d/%d", data.year, data.quarter);
1144 PrintAndLog(" Lot ID : %d", data.lotid );
1145 PrintAndLog(" Wafer number : %d", data.wafer);
1146 PrintAndLog(" Die Number : %d", data.dw);
1147 PrintAndLog("-------------------------------------------------------------");
1148 PrintAndLog(" Raw Data - Page 1");
1149 PrintAndLog(" Block 1 : 0x%08X %s", data.bl1, sprint_bin(DemodBuffer+config.offset+repeat,32) );
1150 PrintAndLog(" Block 2 : 0x%08X %s", data.bl2, sprint_bin(DemodBuffer+config.offset+repeat+32,32) );
1151 PrintAndLog("-------------------------------------------------------------");
1152
1153 /*
1154 TRACE - BLOCK O
1155 Bits Definition HEX
1156 1-8 ACL Allocation class (ISO/IEC 15963-1) 0xE0
1157 9-16 MFC Manufacturer ID (ISO/IEC 7816-6) 0x15 Atmel Corporation
1158 17-21 CID 0x1 = Atmel ATA5577M1 0x2 = Atmel ATA5577M2
1159 22-24 ICR IC revision
1160 25-28 YEAR (BCD encoded) 9 (= 2009)
1161 29-30 QUARTER 1,2,3,4
1162 31-32 LOT ID
1163
1164 TRACE - BLOCK 1
1165 1-12 LOT ID
1166 13-17 Wafer number
1167 18-32 DW, die number sequential
1168 */
1169 }
1170
1171 void printT5555Trace( t5555_tracedata_t data, uint8_t repeat ){
1172 PrintAndLog("-- T5555 (Q5) Trace Information -----------------------------");
1173 PrintAndLog("-------------------------------------------------------------");
1174 PrintAndLog(" ICR IC Revision : %d", data.icr );
1175 PrintAndLog(" Lot : %c%d", data.lotidc, data.lotid);
1176 PrintAndLog(" Wafer number : %d", data.wafer);
1177 PrintAndLog(" Die Number : %d", data.dw);
1178 PrintAndLog("-------------------------------------------------------------");
1179 PrintAndLog(" Raw Data - Page 1");
1180 PrintAndLog(" Block 1 : 0x%08X %s", data.bl1, sprint_bin(DemodBuffer+config.offset+repeat,32) );
1181 PrintAndLog(" Block 2 : 0x%08X %s", data.bl2, sprint_bin(DemodBuffer+config.offset+repeat+32,32) );
1182
1183 /*
1184 ** Q5 **
1185 TRACE - BLOCK O and BLOCK1
1186 Bits Definition HEX
1187 1-9 Header 0x1FF
1188 10-11 IC Revision
1189 12-13 Lot ID char
1190 15-35 Lot ID (NB parity)
1191 36-41 Wafer number (NB parity)
1192 42-58 DW, die number sequential (NB parity)
1193 60-63 Parity bits
1194 64 Always zero
1195 */
1196 }
1197
1198 //need to add Q5 info...
1199 int CmdT55xxInfo(const char *Cmd){
1200 /*
1201 Page 0 Block 0 Configuration data.
1202 Normal mode
1203 Extended mode
1204 */
1205 bool pwdmode = false;
1206 uint32_t password = 0;
1207 char cmdp = param_getchar(Cmd, 0);
1208
1209 if (strlen(Cmd) > 1 || cmdp == 'h' || cmdp == 'H') return usage_t55xx_info();
1210
1211 if (strlen(Cmd)==0){
1212 // sanity check.
1213 if (!SanityOfflineCheck(FALSE)) return 1;
1214
1215 if ( !AquireData( T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, pwdmode, password ) )
1216 return 1;
1217 }
1218
1219 if (!DecodeT55xxBlock()) return 1;
1220
1221 // too little space to start with
1222 if ( DemodBufferLen < 32) return 1;
1223
1224 //
1225 PrintAndLog("Offset+32 ==%d\n DemodLen == %d", config.offset + 32,DemodBufferLen );
1226
1227 uint8_t si = config.offset;
1228 uint32_t bl0 = PackBits(si, 32, DemodBuffer);
1229 uint32_t safer = PackBits(si, 4, DemodBuffer); si += 4;
1230 uint32_t resv = PackBits(si, 7, DemodBuffer); si += 7;
1231 uint32_t dbr = PackBits(si, 3, DemodBuffer); si += 3;
1232 uint32_t extend = PackBits(si, 1, DemodBuffer); si += 1;
1233 uint32_t datamod = PackBits(si, 5, DemodBuffer); si += 5;
1234 uint32_t pskcf = PackBits(si, 2, DemodBuffer); si += 2;
1235 uint32_t aor = PackBits(si, 1, DemodBuffer); si += 1;
1236 uint32_t otp = PackBits(si, 1, DemodBuffer); si += 1;
1237 uint32_t maxblk = PackBits(si, 3, DemodBuffer); si += 3;
1238 uint32_t pwd = PackBits(si, 1, DemodBuffer); si += 1;
1239 uint32_t sst = PackBits(si, 1, DemodBuffer); si += 1;
1240 uint32_t fw = PackBits(si, 1, DemodBuffer); si += 1;
1241 uint32_t inv = PackBits(si, 1, DemodBuffer); si += 1;
1242 uint32_t por = PackBits(si, 1, DemodBuffer); si += 1;
1243
1244 if (config.Q5) PrintAndLog("*** Warning *** Config Info read off a Q5 will not display as expected");
1245 PrintAndLog("");
1246 PrintAndLog("-- T55x7 Configuration & Tag Information --------------------");
1247 PrintAndLog("-------------------------------------------------------------");
1248 PrintAndLog(" Safer key : %s", GetSaferStr(safer));
1249 PrintAndLog(" reserved : %d", resv);
1250 PrintAndLog(" Data bit rate : %s", GetBitRateStr(dbr));
1251 PrintAndLog(" eXtended mode : %s", (extend) ? "Yes - Warning":"No");
1252 PrintAndLog(" Modulation : %s", GetModulationStr(datamod));
1253 PrintAndLog(" PSK clock frequency : %d", pskcf);
1254 PrintAndLog(" AOR - Answer on Request : %s", (aor) ? "Yes":"No");
1255 PrintAndLog(" OTP - One Time Pad : %s", (otp) ? "Yes - Warning":"No" );
1256 PrintAndLog(" Max block : %d", maxblk);
1257 PrintAndLog(" Password mode : %s", (pwd) ? "Yes":"No");
1258 PrintAndLog(" Sequence Start Terminator : %s", (sst) ? "Yes":"No");
1259 PrintAndLog(" Fast Write : %s", (fw) ? "Yes":"No");
1260 PrintAndLog(" Inverse data : %s", (inv) ? "Yes":"No");
1261 PrintAndLog(" POR-Delay : %s", (por) ? "Yes":"No");
1262 PrintAndLog("-------------------------------------------------------------");
1263 PrintAndLog(" Raw Data - Page 0");
1264 PrintAndLog(" Block 0 : 0x%08X %s", bl0, sprint_bin(DemodBuffer+config.offset,32) );
1265 PrintAndLog("-------------------------------------------------------------");
1266
1267 return 0;
1268 }
1269
1270 int CmdT55xxDump(const char *Cmd){
1271
1272 uint32_t password = 0;
1273 bool override = false;
1274 char cmdp = param_getchar(Cmd, 0);
1275 if ( cmdp == 'h' || cmdp == 'H') return usage_t55xx_dump();
1276
1277 bool usepwd = ( strlen(Cmd) > 0);
1278 if ( usepwd ){
1279 password = param_get32ex(Cmd, 0, 0, 16);
1280 if (param_getchar(Cmd, 1) =='o' )
1281 override = true;
1282 }
1283
1284 printT5xxHeader(0);
1285 for ( uint8_t i = 0; i < 8; ++i)
1286 T55xxReadBlock(i, 0, usepwd, override, password);
1287
1288 printT5xxHeader(1);
1289 for ( uint8_t i = 0; i < 4; i++)
1290 T55xxReadBlock(i, 1, usepwd, override, password);
1291
1292 return 1;
1293 }
1294
1295 int AquireData( uint8_t page, uint8_t block, bool pwdmode, uint32_t password ){
1296 // arg0 bitmodes:
1297 // bit0 = pwdmode
1298 // bit1 = page to read from
1299 // arg1: which block to read
1300 // arg2: password
1301 uint8_t arg0 = (page<<1) | pwdmode;
1302 UsbCommand c = {CMD_T55XX_READ_BLOCK, {arg0, block, password}};
1303 clearCommandBuffer();
1304 SendCommand(&c);
1305 if ( !WaitForResponseTimeout(CMD_ACK, NULL, 2500) ) {
1306 PrintAndLog("command execution time out");
1307 return 0;
1308 }
1309
1310 //uint8_t got[12288];
1311 uint8_t got[7679];
1312 GetFromBigBuf(got, sizeof(got), 0);
1313 if ( !WaitForResponseTimeout(CMD_ACK, NULL, 8000) ) {
1314 PrintAndLog("command execution time out");
1315 return 0;
1316 }
1317 setGraphBuf(got, sizeof(got));
1318 return 1;
1319 }
1320
1321 char * GetBitRateStr(uint32_t id){
1322 static char buf[25];
1323
1324 char *retStr = buf;
1325 switch (id){
1326 case 0: snprintf(retStr,sizeof(buf),"%d - RF/8",id); break;
1327 case 1: snprintf(retStr,sizeof(buf),"%d - RF/16",id); break;
1328 case 2: snprintf(retStr,sizeof(buf),"%d - RF/32",id); break;
1329 case 3: snprintf(retStr,sizeof(buf),"%d - RF/40",id); break;
1330 case 4: snprintf(retStr,sizeof(buf),"%d - RF/50",id); break;
1331 case 5: snprintf(retStr,sizeof(buf),"%d - RF/64",id); break;
1332 case 6: snprintf(retStr,sizeof(buf),"%d - RF/100",id); break;
1333 case 7: snprintf(retStr,sizeof(buf),"%d - RF/128",id); break;
1334 default: snprintf(retStr,sizeof(buf),"%d - (Unknown)",id); break;
1335 }
1336 return buf;
1337 }
1338
1339 char * GetSaferStr(uint32_t id){
1340 static char buf[40];
1341 char *retStr = buf;
1342
1343 snprintf(retStr,sizeof(buf),"%d",id);
1344 if (id == 6) {
1345 snprintf(retStr,sizeof(buf),"%d - passwd",id);
1346 }
1347 if (id == 9 ){
1348 snprintf(retStr,sizeof(buf),"%d - testmode",id);
1349 }
1350
1351 return buf;
1352 }
1353
1354 char * GetModulationStr( uint32_t id){
1355 static char buf[60];
1356 char *retStr = buf;
1357
1358 switch (id){
1359 case 0: snprintf(retStr,sizeof(buf),"%d - DIRECT (ASK/NRZ)",id); break;
1360 case 1: snprintf(retStr,sizeof(buf),"%d - PSK 1 phase change when input changes",id); break;
1361 case 2: snprintf(retStr,sizeof(buf),"%d - PSK 2 phase change on bitclk if input high",id); break;
1362 case 3: snprintf(retStr,sizeof(buf),"%d - PSK 3 phase change on rising edge of input",id); break;
1363 case 4: snprintf(retStr,sizeof(buf),"%d - FSK 1 RF/8 RF/5",id); break;
1364 case 5: snprintf(retStr,sizeof(buf),"%d - FSK 2 RF/8 RF/10",id); break;
1365 case 6: snprintf(retStr,sizeof(buf),"%d - FSK 1a RF/5 RF/8",id); break;
1366 case 7: snprintf(retStr,sizeof(buf),"%d - FSK 2a RF/10 RF/8",id); break;
1367 case 8: snprintf(retStr,sizeof(buf),"%d - Manchester",id); break;
1368 case 16: snprintf(retStr,sizeof(buf),"%d - Biphase",id); break;
1369 case 0x18:snprintf(retStr,sizeof(buf),"%d - Biphase a - AKA Conditional Dephase Encoding(CDP)",id); break;
1370 case 17: snprintf(retStr,sizeof(buf),"%d - Reserved",id); break;
1371 default: snprintf(retStr,sizeof(buf),"0x%02X (Unknown)",id); break;
1372 }
1373 return buf;
1374 }
1375
1376 char * GetModelStrFromCID(uint32_t cid){
1377
1378 static char buf[10];
1379 char *retStr = buf;
1380
1381 if (cid == 1) snprintf(retStr, sizeof(buf),"ATA5577M1");
1382 if (cid == 2) snprintf(retStr, sizeof(buf),"ATA5577M2");
1383 return buf;
1384 }
1385
1386 char * GetSelectedModulationStr( uint8_t id){
1387
1388 static char buf[20];
1389 char *retStr = buf;
1390
1391 switch (id){
1392 case DEMOD_FSK: snprintf(retStr,sizeof(buf),"FSK"); break;
1393 case DEMOD_FSK1: snprintf(retStr,sizeof(buf),"FSK1"); break;
1394 case DEMOD_FSK1a: snprintf(retStr,sizeof(buf),"FSK1a"); break;
1395 case DEMOD_FSK2: snprintf(retStr,sizeof(buf),"FSK2"); break;
1396 case DEMOD_FSK2a: snprintf(retStr,sizeof(buf),"FSK2a"); break;
1397 case DEMOD_ASK: snprintf(retStr,sizeof(buf),"ASK"); break;
1398 case DEMOD_NRZ: snprintf(retStr,sizeof(buf),"DIRECT/NRZ"); break;
1399 case DEMOD_PSK1: snprintf(retStr,sizeof(buf),"PSK1"); break;
1400 case DEMOD_PSK2: snprintf(retStr,sizeof(buf),"PSK2"); break;
1401 case DEMOD_PSK3: snprintf(retStr,sizeof(buf),"PSK3"); break;
1402 case DEMOD_BI: snprintf(retStr,sizeof(buf),"BIPHASE"); break;
1403 case DEMOD_BIa: snprintf(retStr,sizeof(buf),"BIPHASEa - (CDP)"); break;
1404 default: snprintf(retStr,sizeof(buf),"(Unknown)"); break;
1405 }
1406 return buf;
1407 }
1408
1409 void t55x7_create_config_block( int tagtype ){
1410
1411 /*
1412 T55X7_DEFAULT_CONFIG_BLOCK, T55X7_RAW_CONFIG_BLOCK
1413 T55X7_EM_UNIQUE_CONFIG_BLOCK, T55X7_FDXB_CONFIG_BLOCK,
1414 T55X7_FDXB_CONFIG_BLOCK, T55X7_HID_26_CONFIG_BLOCK, T55X7_INDALA_64_CONFIG_BLOCK, T55X7_INDALA_224_CONFIG_BLOCK
1415 T55X7_GUARDPROXII_CONFIG_BLOCK, T55X7_VIKING_CONFIG_BLOCK, T55X7_NORALYS_CONFIG_BLOCK, T55X7_IOPROX_CONFIG_BLOCK
1416 */
1417 static char buf[60];
1418 char *retStr = buf;
1419
1420 switch (tagtype){
1421 case 0: snprintf(retStr, sizeof(buf),"%08X - T55X7 Default", T55X7_DEFAULT_CONFIG_BLOCK); break;
1422 case 1: snprintf(retStr, sizeof(buf),"%08X - T55X7 Raw", T55X7_RAW_CONFIG_BLOCK); break;
1423 case 2: snprintf(retStr, sizeof(buf),"%08X - T5555 Q5 Default", T5555_DEFAULT_CONFIG_BLOCK); break;
1424 default:
1425 break;
1426 }
1427 PrintAndLog(buf);
1428 }
1429
1430 int CmdResetRead(const char *Cmd) {
1431 UsbCommand c = {CMD_T55XX_RESET_READ, {0,0,0}};
1432
1433 clearCommandBuffer();
1434 SendCommand(&c);
1435 if ( !WaitForResponseTimeout(CMD_ACK,NULL,2500) ) {
1436 PrintAndLog("command execution time out");
1437 return 0;
1438 }
1439
1440 uint8_t got[BIGBUF_SIZE-1];
1441 GetFromBigBuf(got,sizeof(got),0);
1442 WaitForResponse(CMD_ACK,NULL);
1443 setGraphBuf(got, sizeof(got));
1444 return 1;
1445 }
1446 // ADD T5555 (Q5) Default config block
1447 int CmdT55xxWipe(const char *Cmd) {
1448 char writeData[20] = {0};
1449 char *ptrData = writeData;
1450 char cmdp = param_getchar(Cmd, 0);
1451 if ( cmdp == 'h' || cmdp == 'H') return usage_t55xx_wipe();
1452
1453 bool Q5 = (cmdp == 'q' || cmdp == 'Q');
1454
1455 // Try with the default password to reset block 0
1456 // With a pwd should work even if pwd bit not set
1457 PrintAndLog("\nBeginning Wipe of a T55xx tag (assuming the tag is not password protected)\n");
1458
1459 if ( Q5 )
1460 snprintf(ptrData,sizeof(writeData),"b 0 d 6001F004 p 0");
1461 else
1462 snprintf(ptrData,sizeof(writeData),"b 0 d 000880E0 p 0");
1463
1464 if (!CmdT55xxWriteBlock(ptrData)) PrintAndLog("Error writing blk 0");
1465
1466 for (uint8_t blk = 1; blk<8; blk++) {
1467
1468 snprintf(ptrData,sizeof(writeData),"b %d d 0", blk);
1469
1470 if (!CmdT55xxWriteBlock(ptrData)) PrintAndLog("Error writing blk %d", blk);
1471
1472 memset(writeData,0x00, sizeof(writeData));
1473 }
1474 return 0;
1475 }
1476
1477 int CmdT55xxBruteForce(const char *Cmd) {
1478
1479 // load a default pwd file.
1480 char buf[9];
1481 char filename[FILE_PATH_SIZE]={0};
1482 int keycnt = 0;
1483 int ch;
1484 uint8_t stKeyBlock = 20;
1485 uint8_t *keyBlock = NULL, *p = NULL;
1486 uint32_t start_password = 0x00000000; //start password
1487 uint32_t end_password = 0xFFFFFFFF; //end password
1488 bool found = false;
1489
1490 char cmdp = param_getchar(Cmd, 0);
1491 if (cmdp == 'h' || cmdp == 'H') return usage_t55xx_bruteforce();
1492
1493 keyBlock = calloc(stKeyBlock, 6);
1494 if (keyBlock == NULL) return 1;
1495
1496 if (cmdp == 'i' || cmdp == 'I') {
1497
1498 int len = strlen(Cmd+2);
1499 if (len > FILE_PATH_SIZE) len = FILE_PATH_SIZE;
1500 memcpy(filename, Cmd+2, len);
1501
1502 FILE * f = fopen( filename , "r");
1503 if ( !f ) {
1504 PrintAndLog("File: %s: not found or locked.", filename);
1505 free(keyBlock);
1506 return 1;
1507 }
1508
1509 while( fgets(buf, sizeof(buf), f) ){
1510 if (strlen(buf) < 8 || buf[7] == '\n') continue;
1511
1512 while (fgetc(f) != '\n' && !feof(f)) ; //goto next line
1513
1514 //The line start with # is comment, skip
1515 if( buf[0]=='#' ) continue;
1516
1517 if (!isxdigit(buf[0])){
1518 PrintAndLog("File content error. '%s' must include 8 HEX symbols", buf);
1519 continue;
1520 }
1521
1522 buf[8] = 0;
1523
1524 if ( stKeyBlock - keycnt < 2) {
1525 p = realloc(keyBlock, 6*(stKeyBlock+=10));
1526 if (!p) {
1527 PrintAndLog("Cannot allocate memory for defaultKeys");
1528 free(keyBlock);
1529 if (f) {
1530 fclose(f);
1531 f = NULL;
1532 }
1533 return 2;
1534 }
1535 keyBlock = p;
1536 }
1537 memset(keyBlock + 4 * keycnt, 0, 4);
1538 num_to_bytes(strtoll(buf, NULL, 16), 4, keyBlock + 4*keycnt);
1539 PrintAndLog("chk custom pwd[%2d] %08X", keycnt, bytes_to_num(keyBlock + 4*keycnt, 4));
1540 keycnt++;
1541 memset(buf, 0, sizeof(buf));
1542 }
1543 if (f) {
1544 fclose(f);
1545 f = NULL;
1546 }
1547 if (keycnt == 0) {
1548 PrintAndLog("No keys found in file");
1549 free(keyBlock);
1550 return 1;
1551 }
1552 PrintAndLog("Loaded %d keys", keycnt);
1553
1554 // loop
1555 uint64_t testpwd = 0x00;
1556 for (uint16_t c = 0; c < keycnt; ++c ) {
1557
1558 if ( offline ) {
1559 printf("Device offline\n");
1560 free(keyBlock);
1561 return 2;
1562 }
1563
1564 if (ukbhit()) {
1565 ch = getchar();
1566 (void)ch;
1567 printf("\naborted via keyboard!\n");
1568 free(keyBlock);
1569 return 0;
1570 }
1571
1572 testpwd = bytes_to_num(keyBlock + 4*c, 4);
1573
1574 PrintAndLog("Testing %08X", testpwd);
1575
1576 if ( !AquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, TRUE, testpwd)) {
1577 PrintAndLog("Aquireing data from device failed. Quitting");
1578 free(keyBlock);
1579 return 0;
1580 }
1581
1582 found = tryDetectModulation();
1583 if ( found ) {
1584 PrintAndLog("Found valid password: [%08X]", testpwd);
1585 free(keyBlock);
1586 return 0;
1587 }
1588 }
1589 PrintAndLog("Password NOT found.");
1590 free(keyBlock);
1591 return 0;
1592 }
1593
1594 // Try to read Block 7, first :)
1595
1596 // incremental pwd range search
1597 start_password = param_get32ex(Cmd, 0, 0, 16);
1598 end_password = param_get32ex(Cmd, 1, 0, 16);
1599
1600 if ( start_password >= end_password ) {
1601 free(keyBlock);
1602 return usage_t55xx_bruteforce();
1603 }
1604
1605 PrintAndLog("Search password range [%08X -> %08X]", start_password, end_password);
1606
1607 uint32_t i = start_password;
1608
1609 while ((!found) && (i <= end_password)){
1610
1611 printf(".");
1612 fflush(stdout);
1613 if (ukbhit()) {
1614 ch = getchar();
1615 (void)ch;
1616 printf("\naborted via keyboard!\n");
1617 free(keyBlock);
1618 return 0;
1619 }
1620
1621 if (!AquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, TRUE, i)) {
1622 PrintAndLog("Aquireing data from device failed. Quitting");
1623 free(keyBlock);
1624 return 0;
1625 }
1626 found = tryDetectModulation();
1627
1628 if (found) break;
1629 i++;
1630 }
1631
1632 PrintAndLog("");
1633
1634 if (found)
1635 PrintAndLog("Found valid password: [%08x]", i);
1636 else
1637 PrintAndLog("Password NOT found. Last tried: [%08x]", --i);
1638
1639 free(keyBlock);
1640 return 0;
1641 }
1642
1643 int tryOnePassword(uint32_t password) {
1644 PrintAndLog("Trying password %08x", password);
1645 if (!AquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, TRUE, password)) {
1646 PrintAndLog("Aquireing data from device failed. Quitting");
1647 return -1;
1648 }
1649
1650 if (tryDetectModulation())
1651 return 1;
1652 else
1653 return 0;
1654 }
1655
1656 int CmdT55xxRecoverPW(const char *Cmd) {
1657 int bit = 0;
1658 uint32_t orig_password = 0x0;
1659 uint32_t curr_password = 0x0;
1660 uint32_t prev_password = 0xffffffff;
1661 uint32_t mask = 0x0;
1662 int found = 0;
1663
1664 char cmdp = param_getchar(Cmd, 0);
1665 if (cmdp == 'h' || cmdp == 'H') return usage_t55xx_recoverpw();
1666
1667 orig_password = param_get32ex(Cmd, 0, 0x51243648, 16); //password used by handheld cloners
1668
1669 // first try fliping each bit in the expected password
1670 while ((found != 1) && (bit < 32)) {
1671 curr_password = orig_password ^ ( 1 << bit );
1672 found = tryOnePassword(curr_password);
1673 if (found == 1)
1674 goto done;
1675 else if (found == -1)
1676 return 0;
1677 bit++;
1678 }
1679
1680 // now try to use partial original password, since block 7 should have been completely
1681 // erased during the write sequence and it is possible that only partial password has been
1682 // written
1683 // not sure from which end the bit bits are written, so try from both ends
1684 // from low bit to high bit
1685 bit = 0;
1686 while ((found != 1) && (bit < 32)) {
1687 mask += ( 1 << bit );
1688 curr_password = orig_password & mask;
1689 // if updated mask didn't change the password, don't try it again
1690 if (prev_password == curr_password) {
1691 bit++;
1692 continue;
1693 }
1694 found = tryOnePassword(curr_password);
1695 if (found == 1)
1696 goto done;
1697 else if (found == -1)
1698 return 0;
1699 bit++;
1700 prev_password=curr_password;
1701 }
1702
1703 // from high bit to low
1704 bit = 0;
1705 mask = 0xffffffff;
1706 while ((found != 1) && (bit < 32)) {
1707 mask -= ( 1 << bit );
1708 curr_password = orig_password & mask;
1709 // if updated mask didn't change the password, don't try it again
1710 if (prev_password == curr_password) {
1711 bit++;
1712 continue;
1713 }
1714 found = tryOnePassword(curr_password);
1715 if (found == 1)
1716 goto done;
1717 else if (found == -1)
1718 return 0;
1719 bit++;
1720 prev_password=curr_password;
1721 }
1722 done:
1723 PrintAndLog("");
1724
1725 if (found == 1)
1726 PrintAndLog("Found valid password: [%08x]", curr_password);
1727 else
1728 PrintAndLog("Password NOT found.");
1729
1730 return 0;
1731 }
1732
1733 static command_t CommandTable[] = {
1734 {"help", CmdHelp, 1, "This help"},
1735 {"bruteforce", CmdT55xxBruteForce,0, "<start password> <end password> [i <*.dic>] Simple bruteforce attack to find password"},
1736 {"config", CmdT55xxSetConfig, 1, "Set/Get T55XX configuration (modulation, inverted, offset, rate)"},
1737 {"detect", CmdT55xxDetect, 1, "[1] Try detecting the tag modulation from reading the configuration block."},
1738 {"dump", CmdT55xxDump, 0, "[password] [o] Dump T55xx card block 0-7. Optional [password], [override]"},
1739 {"info", CmdT55xxInfo, 1, "[1] Show T55x7 configuration data (page 0/ blk 0)"},
1740 {"read", CmdT55xxReadBlock, 0, "b <block> p [password] [o] [1] -- Read T55xx block data. Optional [p password], [override], [page1]"},
1741 {"resetread", CmdResetRead, 0, "Send Reset Cmd then lf read the stream to attempt to identify the start of it (needs a demod and/or plot after)"},
1742 {"recoverpw", CmdT55xxRecoverPW, 0, "[password] Try to recover from bad password write from a cloner. Only use on PW protected chips!"},
1743 {"special", special, 0, "Show block changes with 64 different offsets"},
1744 {"trace", CmdT55xxReadTrace, 1, "[1] Show T55x7 traceability data (page 1/ blk 0-1)"},
1745 {"wakeup", CmdT55xxWakeUp, 0, "Send AOR wakeup command"},
1746 {"wipe", CmdT55xxWipe, 0, "[q] Wipe a T55xx tag and set defaults (will destroy any data on tag)"},
1747 {"write", CmdT55xxWriteBlock,0, "b <block> d <data> p [password] [1] -- Write T55xx block data. Optional [p password], [page1]"},
1748 {NULL, NULL, 0, NULL}
1749 };
1750
1751 int CmdLFT55XX(const char *Cmd) {
1752 clearCommandBuffer();
1753 CmdsParse(CommandTable, Cmd);
1754 return 0;
1755 }
1756
1757 int CmdHelp(const char *Cmd) {
1758 CmdsHelp(CommandTable);
1759 return 0;
1760 }
Proxmark3 GIT tracking
Impressum, Datenschutz