1 //-----------------------------------------------------------------------------
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
6 //-----------------------------------------------------------------------------
7 // Low frequency T55xx commands
8 //-----------------------------------------------------------------------------
15 #include "proxmark3.h"
19 #include "cmdparser.h"
22 #include "cmdlft55xx.h"
25 #include "cmdhf14a.h" //for getTagInfo
26 #include "protocols.h"
28 #define T55x7_CONFIGURATION_BLOCK 0x00
29 #define T55x7_PAGE0 0x00
30 #define T55x7_PAGE1 0x01
31 //#define T55x7_PWD 0x00000010
32 #define REGULAR_READ_MODE_BLOCK 0xFF
34 // Default configuration
35 t55xx_conf_block_t config
= { .modulation
= DEMOD_ASK
, .inverted
= false, .offset
= 0x00, .block0
= 0x00, .Q5
= false };
37 t55xx_conf_block_t
Get_t55xx_Config(){
40 void Set_t55xx_Config(t55xx_conf_block_t conf
){
44 int usage_t55xx_config(){
45 PrintAndLog("Usage: lf t55xx config [d <demodulation>] [i 1] [o <offset>] [Q5]");
46 PrintAndLog("Options:");
47 PrintAndLog(" h This help");
48 PrintAndLog(" b <8|16|32|40|50|64|100|128> Set bitrate");
49 PrintAndLog(" d <FSK|FSK1|FSK1a|FSK2|FSK2a|ASK|PSK1|PSK2|NRZ|BI|BIa> Set demodulation FSK / ASK / PSK / NRZ / Biphase / Biphase A");
50 PrintAndLog(" i [1] Invert data signal, defaults to normal");
51 PrintAndLog(" o [offset] Set offset, where data should start decode in bitstream");
52 PrintAndLog(" Q5 Set as Q5(T5555) chip instead of T55x7");
53 PrintAndLog(" ST Set Sequence Terminator on");
55 PrintAndLog("Examples:");
56 PrintAndLog(" lf t55xx config d FSK - FSK demodulation");
57 PrintAndLog(" lf t55xx config d FSK i 1 - FSK demodulation, inverse data");
58 PrintAndLog(" lf t55xx config d FSK i 1 o 3 - FSK demodulation, inverse data, offset=3,start from position 3 to decode data");
62 int usage_t55xx_read(){
63 PrintAndLog("Usage: lf t55xx read [b <block>] [p <password>] <override_safety> <page1>");
64 PrintAndLog("Options:");
65 PrintAndLog(" b <block> - block number to read. Between 0-7");
66 PrintAndLog(" p <password> - OPTIONAL password (8 hex characters)");
67 PrintAndLog(" o - OPTIONAL override safety check");
68 PrintAndLog(" 1 - OPTIONAL read Page 1 instead of Page 0");
69 PrintAndLog(" ****WARNING****");
70 PrintAndLog(" Use of read with password on a tag not configured for a pwd");
71 PrintAndLog(" can damage the tag");
73 PrintAndLog("Examples:");
74 PrintAndLog(" lf t55xx read b 0 - read data from block 0");
75 PrintAndLog(" lf t55xx read b 0 p feedbeef - read data from block 0 password feedbeef");
76 PrintAndLog(" lf t55xx read b 0 p feedbeef o - read data from block 0 password feedbeef safety check");
80 int usage_t55xx_write(){
81 PrintAndLog("Usage: lf t55xx write [b <block>] [d <data>] [p <password>] [1] [t]");
82 PrintAndLog("Options:");
83 PrintAndLog(" b <block> - block number to write. Between 0-7");
84 PrintAndLog(" d <data> - 4 bytes of data to write (8 hex characters)");
85 PrintAndLog(" p <password> - OPTIONAL password 4bytes (8 hex characters)");
86 PrintAndLog(" 1 - OPTIONAL write Page 1 instead of Page 0");
87 PrintAndLog(" t - OPTIONAL test mode write - ****DANGER****");
89 PrintAndLog("Examples:");
90 PrintAndLog(" lf t55xx write b 3 d 11223344 - write 11223344 to block 3");
91 PrintAndLog(" lf t55xx write b 3 d 11223344 p feedbeef - write 11223344 to block 3 password feedbeef");
95 int usage_t55xx_trace() {
96 PrintAndLog("Usage: lf t55xx trace [1]");
97 PrintAndLog("Options:");
98 PrintAndLog(" [graph buffer data] - if set, use Graphbuffer otherwise read data from tag.");
100 PrintAndLog("Examples:");
101 PrintAndLog(" lf t55xx trace");
102 PrintAndLog(" lf t55xx trace 1");
106 int usage_t55xx_info() {
107 PrintAndLog("Usage: lf t55xx info [1]");
108 PrintAndLog("Options:");
109 PrintAndLog(" [graph buffer data] - if set, use Graphbuffer otherwise read data from tag.");
111 PrintAndLog("Examples:");
112 PrintAndLog(" lf t55xx info");
113 PrintAndLog(" lf t55xx info 1");
117 int usage_t55xx_dump(){
118 PrintAndLog("Usage: lf t55xx dump <password> [o]");
119 PrintAndLog("Options:");
120 PrintAndLog(" <password> - OPTIONAL password 4bytes (8 hex symbols)");
121 PrintAndLog(" o - OPTIONAL override, force pwd read despite danger to card");
123 PrintAndLog("Examples:");
124 PrintAndLog(" lf t55xx dump");
125 PrintAndLog(" lf t55xx dump feedbeef o");
129 int usage_t55xx_detect(){
130 PrintAndLog("Usage: lf t55xx detect [1] [p <password>]");
131 PrintAndLog("Options:");
132 PrintAndLog(" 1 - if set, use Graphbuffer otherwise read data from tag.");
133 PrintAndLog(" p <password> - OPTIONAL password (8 hex characters)");
135 PrintAndLog("Examples:");
136 PrintAndLog(" lf t55xx detect");
137 PrintAndLog(" lf t55xx detect 1");
138 PrintAndLog(" lf t55xx detect p 11223344");
142 int usage_t55xx_detectP1(){
143 PrintAndLog("Command: Detect Page 1 of a t55xx chip");
144 PrintAndLog("Usage: lf t55xx p1detect [1] [p <password>]");
145 PrintAndLog("Options:");
146 PrintAndLog(" 1 - if set, use Graphbuffer otherwise read data from tag.");
147 PrintAndLog(" p <password> - OPTIONAL password (8 hex characters)");
149 PrintAndLog("Examples:");
150 PrintAndLog(" lf t55xx p1detect");
151 PrintAndLog(" lf t55xx p1detect 1");
152 PrintAndLog(" lf t55xx p1detect p 11223344");
156 int usage_t55xx_wakup(){
157 PrintAndLog("Usage: lf t55xx wakeup [h] <password>");
158 PrintAndLog("This commands send the Answer-On-Request command and leaves the readerfield ON afterwards.");
159 PrintAndLog("Options:");
160 PrintAndLog(" h - this help");
161 PrintAndLog(" <password> - [required] password 4bytes (8 hex symbols)");
163 PrintAndLog("Examples:");
164 PrintAndLog(" lf t55xx wakeup 11223344 - send wakeup password");
167 int usage_t55xx_bruteforce(){
168 PrintAndLog("This command uses A) bruteforce to scan a number range");
169 PrintAndLog(" B) a dictionary attack");
170 PrintAndLog("Usage: lf t55xx bruteforce <start password> <end password> [i <*.dic>]");
171 PrintAndLog(" password must be 4 bytes (8 hex symbols)");
172 PrintAndLog("Options:");
173 PrintAndLog(" h - this help");
174 PrintAndLog(" <start_pwd> - 4 byte hex value to start pwd search at");
175 PrintAndLog(" <end_pwd> - 4 byte hex value to end pwd search at");
176 PrintAndLog(" i <*.dic> - loads a default keys dictionary file <*.dic>");
178 PrintAndLog("Examples:");
179 PrintAndLog(" lf t55xx bruteforce aaaaaaaa bbbbbbbb");
180 PrintAndLog(" lf t55xx bruteforce i default_pwd.dic");
184 int usage_t55xx_wipe(){
185 PrintAndLog("Usage: lf t55xx wipe [h] [Q5]");
186 PrintAndLog("This commands wipes a tag, fills blocks 1-7 with zeros and a default configuration block");
187 PrintAndLog("Options:");
188 PrintAndLog(" h - this help");
189 PrintAndLog(" Q5 - indicates to use the T5555 (Q5) default configuration block");
191 PrintAndLog("Examples:");
192 PrintAndLog(" lf t55xx wipe - wipes a t55x7 tag, config block 0x000880E0");
193 PrintAndLog(" lf t55xx wipe Q5 - wipes a t5555 Q5 tag, config block 0x6001F004");
198 static int CmdHelp(const char *Cmd
);
200 void printT5xxHeader(uint8_t page
){
201 PrintAndLog("Reading Page %d:", page
);
202 PrintAndLog("blk | hex data | binary");
203 PrintAndLog("----+----------+---------------------------------");
206 int CmdT55xxSetConfig(const char *Cmd
) {
209 char modulation
[5] = {0x00};
212 uint8_t rates
[9] = {8,16,32,40,50,64,100,128,0};
215 while(param_getchar(Cmd
, cmdp
) != 0x00 && !errors
)
217 tmp
= param_getchar(Cmd
, cmdp
);
222 return usage_t55xx_config();
224 errors
|= param_getdec(Cmd
, cmdp
+1, &bitRate
);
228 if (rates
[i
]==bitRate
) {
233 if (i
==9) errors
= true;
238 param_getstr(Cmd
, cmdp
+1, modulation
, sizeof(modulation
));
241 if ( strcmp(modulation
, "FSK" ) == 0) {
242 config
.modulation
= DEMOD_FSK
;
243 } else if ( strcmp(modulation
, "FSK1" ) == 0) {
244 config
.modulation
= DEMOD_FSK1
;
246 } else if ( strcmp(modulation
, "FSK1a" ) == 0) {
247 config
.modulation
= DEMOD_FSK1a
;
249 } else if ( strcmp(modulation
, "FSK2" ) == 0) {
250 config
.modulation
= DEMOD_FSK2
;
252 } else if ( strcmp(modulation
, "FSK2a" ) == 0) {
253 config
.modulation
= DEMOD_FSK2a
;
255 } else if ( strcmp(modulation
, "ASK" ) == 0) {
256 config
.modulation
= DEMOD_ASK
;
257 } else if ( strcmp(modulation
, "NRZ" ) == 0) {
258 config
.modulation
= DEMOD_NRZ
;
259 } else if ( strcmp(modulation
, "PSK1" ) == 0) {
260 config
.modulation
= DEMOD_PSK1
;
261 } else if ( strcmp(modulation
, "PSK2" ) == 0) {
262 config
.modulation
= DEMOD_PSK2
;
263 } else if ( strcmp(modulation
, "PSK3" ) == 0) {
264 config
.modulation
= DEMOD_PSK3
;
265 } else if ( strcmp(modulation
, "BIa" ) == 0) {
266 config
.modulation
= DEMOD_BIa
;
268 } else if ( strcmp(modulation
, "BI" ) == 0) {
269 config
.modulation
= DEMOD_BI
;
272 PrintAndLog("Unknown modulation '%s'", modulation
);
277 config
.inverted
= param_getchar(Cmd
,cmdp
+1) == '1';
281 errors
|= param_getdec(Cmd
, cmdp
+1, &offset
);
283 config
.offset
= offset
;
297 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd
, cmdp
));
304 if (cmdp
== 0) return printConfiguration( config
);
307 if (errors
) return usage_t55xx_config();
310 return printConfiguration ( config
);
313 int T55xxReadBlock(uint8_t block
, bool page1
, bool usepwd
, bool override
, uint32_t password
){
316 // try reading the config block and verify that PWD bit is set before doing this!
318 if ( !AquireData(T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, false, 0 ) ) return 0;
319 if ( !tryDetectModulation() ) {
320 PrintAndLog("Safety Check: Could not detect if PWD bit is set in config block. Exits.");
323 PrintAndLog("Safety Check: PWD bit is NOT set in config block. Reading without password...");
328 PrintAndLog("Safety Check Overriden - proceeding despite risk");
332 if (!AquireData(page1
, block
, usepwd
, password
) ) return 0;
333 if (!DecodeT55xxBlock()) return 0;
336 sprintf(blk
,"%d", block
);
337 printT55xxBlock(blk
);
341 int CmdT55xxReadBlock(const char *Cmd
) {
342 uint8_t block
= REGULAR_READ_MODE_BLOCK
;
343 uint32_t password
= 0; //default to blank Block 7
345 bool override
= false;
349 while(param_getchar(Cmd
, cmdp
) != 0x00 && !errors
) {
350 switch(param_getchar(Cmd
, cmdp
)) {
353 return usage_t55xx_read();
356 errors
|= param_getdec(Cmd
, cmdp
+1, &block
);
366 password
= param_get32ex(Cmd
, cmdp
+1, 0, 16);
375 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd
, cmdp
));
380 if (errors
) return usage_t55xx_read();
382 if (block
> 7 && block
!= REGULAR_READ_MODE_BLOCK
) {
383 PrintAndLog("Block must be between 0 and 7");
387 printT5xxHeader(page1
);
388 return T55xxReadBlock(block
, page1
, usepwd
, override
, password
);
391 bool DecodeT55xxBlock(){
393 char buf
[30] = {0x00};
397 uint8_t bitRate
[8] = {8,16,32,40,50,64,100,128};
398 DemodBufferLen
= 0x00;
400 switch( config
.modulation
){
402 snprintf(cmdStr
, sizeof(buf
),"%d %d", bitRate
[config
.bitrate
], config
.inverted
);
403 ans
= FSKrawDemod(cmdStr
, false);
407 snprintf(cmdStr
, sizeof(buf
),"%d %d 8 5", bitRate
[config
.bitrate
], config
.inverted
);
408 ans
= FSKrawDemod(cmdStr
, false);
412 snprintf(cmdStr
, sizeof(buf
),"%d %d 10 8", bitRate
[config
.bitrate
], config
.inverted
);
413 ans
= FSKrawDemod(cmdStr
, false);
416 snprintf(cmdStr
, sizeof(buf
),"%d %d 1", bitRate
[config
.bitrate
], config
.inverted
);
417 ans
= ASKDemod_ext(cmdStr
, false, false, 1, &ST
);
420 // skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)
421 save_restoreGB(GRAPH_SAVE
);
423 snprintf(cmdStr
, sizeof(buf
),"%d %d 6", bitRate
[config
.bitrate
], config
.inverted
);
424 ans
= PSKDemod(cmdStr
, false);
426 save_restoreGB(GRAPH_RESTORE
);
428 case DEMOD_PSK2
: //inverted won't affect this
429 case DEMOD_PSK3
: //not fully implemented
430 // skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)
431 save_restoreGB(GRAPH_SAVE
);
433 snprintf(cmdStr
, sizeof(buf
),"%d 0 6", bitRate
[config
.bitrate
] );
434 ans
= PSKDemod(cmdStr
, false);
435 psk1TOpsk2(DemodBuffer
, DemodBufferLen
);
437 save_restoreGB(GRAPH_RESTORE
);
440 snprintf(cmdStr
, sizeof(buf
),"%d %d 1", bitRate
[config
.bitrate
], config
.inverted
);
441 ans
= NRZrawDemod(cmdStr
, false);
445 snprintf(cmdStr
, sizeof(buf
),"0 %d %d 1", bitRate
[config
.bitrate
], config
.inverted
);
446 ans
= ASKbiphaseDemod(cmdStr
, false);
454 bool DecodeT5555TraceBlock() {
455 DemodBufferLen
= 0x00;
457 // According to datasheet. Always: RF/64, not inverted, Manchester
458 return (bool) ASKDemod("64 0 1", false, false, 1);
461 int CmdT55xxDetect(const char *Cmd
){
465 uint32_t password
= 0;
468 while(param_getchar(Cmd
, cmdp
) != 0x00 && !errors
) {
469 switch(param_getchar(Cmd
, cmdp
)) {
472 return usage_t55xx_detect();
475 password
= param_get32ex(Cmd
, cmdp
+1, 0, 16);
480 // use Graphbuffer data
485 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd
, cmdp
));
490 if (errors
) return usage_t55xx_detect();
493 if ( !AquireData(T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, usepwd
, password
) )
497 if ( !tryDetectModulation() )
498 PrintAndLog("Could not detect modulation automatically. Try setting it manually with \'lf t55xx config\'");
503 // detect configuration?
504 bool tryDetectModulation(){
506 t55xx_conf_block_t tests
[15];
508 uint8_t fc1
= 0, fc2
= 0, ans
= 0;
509 int clk
= 0, firstClockEdge
= 0;
510 ans
= fskClocks(&fc1
, &fc2
, (uint8_t *)&clk
, false, &firstClockEdge
);
511 if (ans
&& ((fc1
==10 && fc2
==8) || (fc1
==8 && fc2
==5))) {
512 if ( FSKrawDemod("0 0", false) && test(DEMOD_FSK
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)) {
513 tests
[hits
].modulation
= DEMOD_FSK
;
514 if (fc1
==8 && fc2
== 5)
515 tests
[hits
].modulation
= DEMOD_FSK1a
;
516 else if (fc1
==10 && fc2
== 8)
517 tests
[hits
].modulation
= DEMOD_FSK2
;
518 tests
[hits
].bitrate
= bitRate
;
519 tests
[hits
].inverted
= false;
520 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
521 tests
[hits
].ST
= false;
524 if ( FSKrawDemod("0 1", false) && test(DEMOD_FSK
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)) {
525 tests
[hits
].modulation
= DEMOD_FSK
;
526 if (fc1
== 8 && fc2
== 5)
527 tests
[hits
].modulation
= DEMOD_FSK1
;
528 else if (fc1
== 10 && fc2
== 8)
529 tests
[hits
].modulation
= DEMOD_FSK2a
;
530 tests
[hits
].bitrate
= bitRate
;
531 tests
[hits
].inverted
= true;
532 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
533 tests
[hits
].ST
= false;
537 clk
= GetAskClock("", false, false);
539 tests
[hits
].ST
= true;
540 if ( ASKDemod_ext("0 0 1", false, false, 1, &tests
[hits
].ST
) && test(DEMOD_ASK
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)) {
541 tests
[hits
].modulation
= DEMOD_ASK
;
542 tests
[hits
].bitrate
= bitRate
;
543 tests
[hits
].inverted
= false;
544 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
547 tests
[hits
].ST
= true;
548 if ( ASKDemod_ext("0 1 1", false, false, 1, &tests
[hits
].ST
) && test(DEMOD_ASK
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)) {
549 tests
[hits
].modulation
= DEMOD_ASK
;
550 tests
[hits
].bitrate
= bitRate
;
551 tests
[hits
].inverted
= true;
552 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
555 if ( ASKbiphaseDemod("0 0 0 2", false) && test(DEMOD_BI
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
) ) {
556 tests
[hits
].modulation
= DEMOD_BI
;
557 tests
[hits
].bitrate
= bitRate
;
558 tests
[hits
].inverted
= false;
559 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
560 tests
[hits
].ST
= false;
563 if ( ASKbiphaseDemod("0 0 1 2", false) && test(DEMOD_BIa
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
) ) {
564 tests
[hits
].modulation
= DEMOD_BIa
;
565 tests
[hits
].bitrate
= bitRate
;
566 tests
[hits
].inverted
= true;
567 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
568 tests
[hits
].ST
= false;
572 clk
= GetNrzClock("", false, false);
573 if (clk
>8) { //clock of rf/8 is likely a false positive, so don't use it.
574 if ( NRZrawDemod("0 0 1", false) && test(DEMOD_NRZ
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)) {
575 tests
[hits
].modulation
= DEMOD_NRZ
;
576 tests
[hits
].bitrate
= bitRate
;
577 tests
[hits
].inverted
= false;
578 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
579 tests
[hits
].ST
= false;
583 if ( NRZrawDemod("0 1 1", false) && test(DEMOD_NRZ
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)) {
584 tests
[hits
].modulation
= DEMOD_NRZ
;
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;
593 clk
= GetPskClock("", false, false);
596 save_restoreGB(GRAPH_SAVE
);
597 // skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)
599 if ( PSKDemod("0 0 6", false) && test(DEMOD_PSK1
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)) {
600 tests
[hits
].modulation
= DEMOD_PSK1
;
601 tests
[hits
].bitrate
= bitRate
;
602 tests
[hits
].inverted
= false;
603 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
604 tests
[hits
].ST
= false;
607 if ( PSKDemod("0 1 6", false) && test(DEMOD_PSK1
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)) {
608 tests
[hits
].modulation
= DEMOD_PSK1
;
609 tests
[hits
].bitrate
= bitRate
;
610 tests
[hits
].inverted
= true;
611 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
612 tests
[hits
].ST
= false;
615 // PSK2 - needs a call to psk1TOpsk2.
616 if ( PSKDemod("0 0 6", false)) {
617 psk1TOpsk2(DemodBuffer
, DemodBufferLen
);
618 if (test(DEMOD_PSK2
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)){
619 tests
[hits
].modulation
= DEMOD_PSK2
;
620 tests
[hits
].bitrate
= bitRate
;
621 tests
[hits
].inverted
= false;
622 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
623 tests
[hits
].ST
= false;
626 } // inverse waves does not affect this demod
627 // PSK3 - needs a call to psk1TOpsk2.
628 if ( PSKDemod("0 0 6", false)) {
629 psk1TOpsk2(DemodBuffer
, DemodBufferLen
);
630 if (test(DEMOD_PSK3
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)){
631 tests
[hits
].modulation
= DEMOD_PSK3
;
632 tests
[hits
].bitrate
= bitRate
;
633 tests
[hits
].inverted
= false;
634 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
635 tests
[hits
].ST
= false;
638 } // inverse waves does not affect this demod
640 save_restoreGB(GRAPH_RESTORE
);
644 config
.modulation
= tests
[0].modulation
;
645 config
.bitrate
= tests
[0].bitrate
;
646 config
.inverted
= tests
[0].inverted
;
647 config
.offset
= tests
[0].offset
;
648 config
.block0
= tests
[0].block0
;
649 config
.Q5
= tests
[0].Q5
;
650 config
.ST
= tests
[0].ST
;
651 printConfiguration( config
);
656 PrintAndLog("Found [%d] possible matches for modulation.",hits
);
657 for(int i
=0; i
<hits
; ++i
){
658 PrintAndLog("--[%d]---------------", i
+1);
659 printConfiguration( tests
[i
] );
665 bool testModulation(uint8_t mode
, uint8_t modread
){
668 if (modread
>= DEMOD_FSK1
&& modread
<= DEMOD_FSK2a
) return true;
671 if (modread
== DEMOD_ASK
) return true;
674 if (modread
== DEMOD_PSK1
) return true;
677 if (modread
== DEMOD_PSK2
) return true;
680 if (modread
== DEMOD_PSK3
) return true;
683 if (modread
== DEMOD_NRZ
) return true;
686 if (modread
== DEMOD_BI
) return true;
689 if (modread
== DEMOD_BIa
) return true;
697 bool testQ5Modulation(uint8_t mode
, uint8_t modread
){
700 if (modread
>= 4 && modread
<= 5) return true;
703 if (modread
== 0) return true;
706 if (modread
== 1) return true;
709 if (modread
== 2) return true;
712 if (modread
== 3) return true;
715 if (modread
== 7) return true;
718 if (modread
== 6) return true;
726 int convertQ5bitRate(uint8_t bitRateRead
) {
727 uint8_t expected
[] = {8, 16, 32, 40, 50, 64, 100, 128};
728 for (int i
=0; i
<8; i
++)
729 if (expected
[i
] == bitRateRead
)
735 bool testQ5(uint8_t mode
, uint8_t *offset
, int *fndBitRate
, uint8_t clk
){
737 if ( DemodBufferLen
< 64 ) return false;
739 for (uint8_t idx
= 28; idx
< 64; idx
++){
741 if ( PackBits(si
, 28, DemodBuffer
) == 0x00 ) continue;
743 uint8_t safer
= PackBits(si
, 4, DemodBuffer
); si
+= 4; //master key
744 uint8_t resv
= PackBits(si
, 8, DemodBuffer
); si
+= 8;
745 // 2nibble must be zeroed.
746 if (safer
!= 0x6 && safer
!= 0x9) continue;
747 if ( resv
> 0x00) continue;
748 //uint8_t pageSel = PackBits(si, 1, DemodBuffer); si += 1;
749 //uint8_t fastWrite = PackBits(si, 1, DemodBuffer); si += 1;
751 int bitRate
= PackBits(si
, 6, DemodBuffer
)*2 + 2; si
+= 6; //bit rate
752 if (bitRate
> 128 || bitRate
< 8) continue;
754 //uint8_t AOR = PackBits(si, 1, DemodBuffer); si += 1;
755 //uint8_t PWD = PackBits(si, 1, DemodBuffer); si += 1;
756 //uint8_t pskcr = PackBits(si, 2, DemodBuffer); si += 2; //could check psk cr
757 //uint8_t inverse = PackBits(si, 1, DemodBuffer); si += 1;
759 uint8_t modread
= PackBits(si
, 3, DemodBuffer
); si
+= 3;
760 uint8_t maxBlk
= PackBits(si
, 3, DemodBuffer
); si
+= 3;
761 //uint8_t ST = PackBits(si, 1, DemodBuffer); si += 1;
762 if (maxBlk
== 0) continue;
764 if (!testQ5Modulation(mode
, modread
)) continue;
765 if (bitRate
!= clk
) continue;
766 *fndBitRate
= convertQ5bitRate(bitRate
);
767 if (*fndBitRate
< 0) continue;
775 bool testBitRate(uint8_t readRate
, uint8_t clk
){
776 uint8_t expected
[] = {8, 16, 32, 40, 50, 64, 100, 128};
777 if (expected
[readRate
] == clk
)
783 bool test(uint8_t mode
, uint8_t *offset
, int *fndBitRate
, uint8_t clk
, bool *Q5
){
785 if ( DemodBufferLen
< 64 ) return false;
787 for (uint8_t idx
= 28; idx
< 64; idx
++){
789 if ( PackBits(si
, 28, DemodBuffer
) == 0x00 ) continue;
791 uint8_t safer
= PackBits(si
, 4, DemodBuffer
); si
+= 4; //master key
792 uint8_t resv
= PackBits(si
, 4, DemodBuffer
); si
+= 4; //was 7 & +=7+3 //should be only 4 bits if extended mode
793 // 2nibble must be zeroed.
794 // moved test to here, since this gets most faults first.
795 if ( resv
> 0x00) continue;
797 int bitRate
= PackBits(si
, 6, DemodBuffer
); si
+= 6; //bit rate (includes extended mode part of rate)
798 uint8_t extend
= PackBits(si
, 1, DemodBuffer
); si
+= 1; //bit 15 extended mode
799 uint8_t modread
= PackBits(si
, 5, DemodBuffer
); si
+= 5+2+1;
800 //uint8_t pskcr = PackBits(si, 2, DemodBuffer); si += 2+1; //could check psk cr
801 //uint8_t nml01 = PackBits(si, 1, DemodBuffer); si += 1+5; //bit 24, 30, 31 could be tested for 0 if not extended mode
802 //uint8_t nml02 = PackBits(si, 2, DemodBuffer); si += 2;
805 bool extMode
=( (safer
== 0x6 || safer
== 0x9) && extend
) ? true : false;
808 if (bitRate
> 7) continue;
809 if (!testBitRate(bitRate
, clk
)) continue;
810 } else { //extended mode bitrate = same function to calc bitrate as em4x05
811 if (EM4x05_GET_BITRATE(bitRate
) != clk
) continue;
815 if (!testModulation(mode
, modread
)) continue;
816 *fndBitRate
= bitRate
;
821 if (testQ5(mode
, offset
, fndBitRate
, clk
)) {
828 void printT55xxBlock(const char *blockNum
){
830 uint8_t i
= config
.offset
;
831 uint8_t endpos
= 32 + i
;
832 uint32_t blockData
= 0;
833 uint8_t bits
[64] = {0x00};
835 if ( !DemodBufferLen
) return;
837 if ( endpos
> DemodBufferLen
){
838 PrintAndLog("The configured offset %d is too big. Possible offset: %d)", i
, DemodBufferLen
-32);
842 for (; i
< endpos
; ++i
)
843 bits
[i
- config
.offset
]=DemodBuffer
[i
];
845 blockData
= PackBits(0, 32, bits
);
847 PrintAndLog(" %s | %08X | %s", blockNum
, blockData
, sprint_bin(bits
,32));
850 int special(const char *Cmd
) {
851 uint32_t blockData
= 0;
852 uint8_t bits
[32] = {0x00};
854 PrintAndLog("OFFSET | DATA | BINARY");
855 PrintAndLog("----------------------------------------------------");
859 for (i
= 0; i
< 32; ++i
)
860 bits
[i
]=DemodBuffer
[j
+i
];
862 blockData
= PackBits(0, 32, bits
);
864 PrintAndLog(" %02d | 0x%08X | %s",j
, blockData
, sprint_bin(bits
,32));
869 int printConfiguration( t55xx_conf_block_t b
){
870 PrintAndLog("Chip Type : %s", (b
.Q5
) ? "T5555(Q5)" : "T55x7");
871 PrintAndLog("Modulation : %s", GetSelectedModulationStr(b
.modulation
) );
872 PrintAndLog("Bit Rate : %s", GetBitRateStr(b
.bitrate
, (b
.block0
& T55x7_X_MODE
&& (b
.block0
>>28==6 || b
.block0
>>28==9))) );
873 PrintAndLog("Inverted : %s", (b
.inverted
) ? "Yes" : "No" );
874 PrintAndLog("Offset : %d", b
.offset
);
875 PrintAndLog("Seq. Term. : %s", (b
.ST
) ? "Yes" : "No" );
876 PrintAndLog("Block0 : 0x%08X", b
.block0
);
881 int CmdT55xxWakeUp(const char *Cmd
) {
882 uint32_t password
= 0;
883 if ( strlen(Cmd
) <= 0 ) return usage_t55xx_wakup();
884 char cmdp
= param_getchar(Cmd
, 0);
885 if ( cmdp
== 'h' || cmdp
== 'H') return usage_t55xx_wakup();
887 password
= param_get32ex(Cmd
, 0, 0, 16);
889 UsbCommand c
= {CMD_T55XX_WAKEUP
, {password
, 0, 0}};
890 clearCommandBuffer();
892 PrintAndLog("Wake up command sent. Try read now");
896 int CmdT55xxWriteBlock(const char *Cmd
) {
897 uint8_t block
= 0xFF; //default to invalid block
898 uint32_t data
= 0; //default to blank Block
899 uint32_t password
= 0; //default to blank Block 7
902 bool gotdata
= false;
903 bool testMode
= false;
906 while(param_getchar(Cmd
, cmdp
) != 0x00 && !errors
) {
907 switch(param_getchar(Cmd
, cmdp
)) {
910 return usage_t55xx_write();
913 errors
|= param_getdec(Cmd
, cmdp
+1, &block
);
918 data
= param_get32ex(Cmd
, cmdp
+1, 0, 16);
924 password
= param_get32ex(Cmd
, cmdp
+1, 0, 16);
938 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd
, cmdp
));
943 if (errors
|| !gotdata
) return usage_t55xx_write();
946 PrintAndLog("Block number must be between 0 and 7");
950 UsbCommand c
= {CMD_T55XX_WRITE_BLOCK
, {data
, block
, 0}};
952 c
.d
.asBytes
[0] = (page1
) ? 0x2 : 0;
953 c
.d
.asBytes
[0] |= (testMode
) ? 0x4 : 0;
955 char pwdStr
[16] = {0};
956 snprintf(pwdStr
, sizeof(pwdStr
), "pwd: 0x%08X", password
);
958 PrintAndLog("Writing page %d block: %02d data: 0x%08X %s", page1
, block
, data
, (usepwd
) ? pwdStr
: "" );
963 c
.d
.asBytes
[0] |= 0x1;
965 clearCommandBuffer();
967 if (!WaitForResponseTimeout(CMD_ACK
, &resp
, 1000)){
968 PrintAndLog("Error occurred, device did not ACK write operation. (May be due to old firmware)");
974 int CmdT55xxReadTrace(const char *Cmd
) {
975 char cmdp
= param_getchar(Cmd
, 0);
976 bool pwdmode
= false;
977 uint32_t password
= 0;
978 if (strlen(Cmd
) > 1 || cmdp
== 'h' || cmdp
== 'H')
979 return usage_t55xx_trace();
982 if ( !AquireData( T55x7_PAGE1
, REGULAR_READ_MODE_BLOCK
, pwdmode
, password
) )
986 if (!DecodeT5555TraceBlock()) return 0;
988 if (!DecodeT55xxBlock()) return 0;
991 if ( !DemodBufferLen
) return 0;
993 RepaintGraphWindow();
994 uint8_t repeat
= (config
.offset
> 5) ? 32 : 0;
996 uint8_t si
= config
.offset
+repeat
;
997 uint32_t bl1
= PackBits(si
, 32, DemodBuffer
);
998 uint32_t bl2
= PackBits(si
+32, 32, DemodBuffer
);
1001 uint32_t hdr
= PackBits(si
, 9, DemodBuffer
); si
+= 9;
1004 PrintAndLog("Invalid Q5 Trace data header (expected 0x1FF, found %X)", hdr
);
1008 t5555_tracedata_t data
= {.bl1
= bl1
, .bl2
= bl2
, .icr
= 0, .lotidc
= '?', .lotid
= 0, .wafer
= 0, .dw
=0};
1010 data
.icr
= PackBits(si
, 2, DemodBuffer
); si
+= 2;
1011 data
.lotidc
= 'Z' - PackBits(si
, 2, DemodBuffer
); si
+= 3;
1013 data
.lotid
= PackBits(si
, 4, DemodBuffer
); si
+= 5;
1015 data
.lotid
|= PackBits(si
, 4, DemodBuffer
); si
+= 5;
1017 data
.lotid
|= PackBits(si
, 4, DemodBuffer
); si
+= 5;
1019 data
.lotid
|= PackBits(si
, 4, DemodBuffer
); si
+= 5;
1021 data
.lotid
|= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1023 data
.wafer
= PackBits(si
, 3, DemodBuffer
); si
+= 4;
1025 data
.wafer
|= PackBits(si
, 2, DemodBuffer
); si
+= 2;
1027 data
.dw
= PackBits(si
, 2, DemodBuffer
); si
+= 3;
1029 data
.dw
|= PackBits(si
, 4, DemodBuffer
); si
+= 5;
1031 data
.dw
|= PackBits(si
, 4, DemodBuffer
); si
+= 5;
1033 data
.dw
|= PackBits(si
, 4, DemodBuffer
); si
+= 5;
1035 printT5555Trace(data
, repeat
);
1039 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};
1041 data
.acl
= PackBits(si
, 8, DemodBuffer
); si
+= 8;
1042 if ( data
.acl
!= 0xE0 ) {
1043 PrintAndLog("The modulation is most likely wrong since the ACL is not 0xE0. ");
1047 data
.mfc
= PackBits(si
, 8, DemodBuffer
); si
+= 8;
1048 data
.cid
= PackBits(si
, 5, DemodBuffer
); si
+= 5;
1049 data
.icr
= PackBits(si
, 3, DemodBuffer
); si
+= 3;
1050 data
.year
= PackBits(si
, 4, DemodBuffer
); si
+= 4;
1051 data
.quarter
= PackBits(si
, 2, DemodBuffer
); si
+= 2;
1052 data
.lotid
= PackBits(si
, 14, DemodBuffer
); si
+= 14;
1053 data
.wafer
= PackBits(si
, 5, DemodBuffer
); si
+= 5;
1054 data
.dw
= PackBits(si
, 15, DemodBuffer
);
1056 time_t t
= time(NULL
);
1057 struct tm tm
= *localtime(&t
);
1058 if ( data
.year
> tm
.tm_year
-110)
1063 printT55x7Trace(data
, repeat
);
1068 void printT55x7Trace( t55x7_tracedata_t data
, uint8_t repeat
){
1069 PrintAndLog("-- T55x7 Trace Information ----------------------------------");
1070 PrintAndLog("-------------------------------------------------------------");
1071 PrintAndLog(" ACL Allocation class (ISO/IEC 15963-1) : 0x%02X (%d)", data
.acl
, data
.acl
);
1072 PrintAndLog(" MFC Manufacturer ID (ISO/IEC 7816-6) : 0x%02X (%d) - %s", data
.mfc
, data
.mfc
, getTagInfo(data
.mfc
));
1073 PrintAndLog(" CID : 0x%02X (%d) - %s", data
.cid
, data
.cid
, GetModelStrFromCID(data
.cid
));
1074 PrintAndLog(" ICR IC Revision : %d", data
.icr
);
1075 PrintAndLog(" Manufactured");
1076 PrintAndLog(" Year/Quarter : %d/%d", data
.year
, data
.quarter
);
1077 PrintAndLog(" Lot ID : %d", data
.lotid
);
1078 PrintAndLog(" Wafer number : %d", data
.wafer
);
1079 PrintAndLog(" Die Number : %d", data
.dw
);
1080 PrintAndLog("-------------------------------------------------------------");
1081 PrintAndLog(" Raw Data - Page 1");
1082 PrintAndLog(" Block 1 : 0x%08X %s", data
.bl1
, sprint_bin(DemodBuffer
+config
.offset
+repeat
,32) );
1083 PrintAndLog(" Block 2 : 0x%08X %s", data
.bl2
, sprint_bin(DemodBuffer
+config
.offset
+repeat
+32,32) );
1084 PrintAndLog("-------------------------------------------------------------");
1089 1-8 ACL Allocation class (ISO/IEC 15963-1) 0xE0
1090 9-16 MFC Manufacturer ID (ISO/IEC 7816-6) 0x15 Atmel Corporation
1091 17-21 CID 0x1 = Atmel ATA5577M1 0x2 = Atmel ATA5577M2
1092 22-24 ICR IC revision
1093 25-28 YEAR (BCD encoded) 9 (= 2009)
1094 29-30 QUARTER 1,2,3,4
1100 18-32 DW, die number sequential
1104 void printT5555Trace( t5555_tracedata_t data
, uint8_t repeat
){
1105 PrintAndLog("-- T5555 (Q5) Trace Information -----------------------------");
1106 PrintAndLog("-------------------------------------------------------------");
1107 PrintAndLog(" ICR IC Revision : %d", data
.icr
);
1108 PrintAndLog(" Lot : %c%d", data
.lotidc
, data
.lotid
);
1109 PrintAndLog(" Wafer number : %d", data
.wafer
);
1110 PrintAndLog(" Die Number : %d", data
.dw
);
1111 PrintAndLog("-------------------------------------------------------------");
1112 PrintAndLog(" Raw Data - Page 1");
1113 PrintAndLog(" Block 1 : 0x%08X %s", data
.bl1
, sprint_bin(DemodBuffer
+config
.offset
+repeat
,32) );
1114 PrintAndLog(" Block 2 : 0x%08X %s", data
.bl2
, sprint_bin(DemodBuffer
+config
.offset
+repeat
+32,32) );
1118 TRACE - BLOCK O and BLOCK1
1123 15-35 Lot ID (NB parity)
1124 36-41 Wafer number (NB parity)
1125 42-58 DW, die number sequential (NB parity)
1131 //need to add Q5 info...
1132 int CmdT55xxInfo(const char *Cmd
){
1134 Page 0 Block 0 Configuration data.
1138 bool pwdmode
= false;
1139 uint32_t password
= 0;
1140 char cmdp
= param_getchar(Cmd
, 0);
1142 if (strlen(Cmd
) > 1 || cmdp
== 'h' || cmdp
== 'H')
1143 return usage_t55xx_info();
1146 if ( !AquireData( T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, pwdmode
, password
) )
1149 if (!DecodeT55xxBlock()) return 1;
1151 // too little space to start with
1152 if ( DemodBufferLen
< 32) return 1;
1154 uint8_t si
= config
.offset
;
1155 uint32_t bl0
= PackBits(si
, 32, DemodBuffer
);
1157 uint32_t safer
= PackBits(si
, 4, DemodBuffer
); si
+= 4;
1158 uint32_t resv
= PackBits(si
, 7, DemodBuffer
); si
+= 7;
1159 uint32_t dbr
= PackBits(si
, 3, DemodBuffer
); si
+= 3;
1160 uint32_t extend
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1161 uint32_t datamod
= PackBits(si
, 5, DemodBuffer
); si
+= 5;
1162 uint32_t pskcf
= PackBits(si
, 2, DemodBuffer
); si
+= 2;
1163 uint32_t aor
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1164 uint32_t otp
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1165 uint32_t maxblk
= PackBits(si
, 3, DemodBuffer
); si
+= 3;
1166 uint32_t pwd
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1167 uint32_t sst
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1168 uint32_t fw
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1169 uint32_t inv
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1170 uint32_t por
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1172 if (config
.Q5
) PrintAndLog("*** Warning *** Config Info read off a Q5 will not display as expected");
1174 PrintAndLog("-- T55x7 Configuration & Tag Information --------------------");
1175 PrintAndLog("-------------------------------------------------------------");
1176 PrintAndLog(" Safer key : %s", GetSaferStr(safer
));
1177 PrintAndLog(" reserved : %d", resv
);
1178 PrintAndLog(" Data bit rate : %s", GetBitRateStr(dbr
, extend
));
1179 PrintAndLog(" eXtended mode : %s", (extend
) ? "Yes - Warning":"No");
1180 PrintAndLog(" Modulation : %s", GetModulationStr(datamod
));
1181 PrintAndLog(" PSK clock frequency : %d", pskcf
);
1182 PrintAndLog(" AOR - Answer on Request : %s", (aor
) ? "Yes":"No");
1183 PrintAndLog(" OTP - One Time Pad : %s", (otp
) ? "Yes - Warning":"No" );
1184 PrintAndLog(" Max block : %d", maxblk
);
1185 PrintAndLog(" Password mode : %s", (pwd
) ? "Yes":"No");
1186 PrintAndLog(" Sequence Start Terminator : %s", (sst
) ? "Yes":"No");
1187 PrintAndLog(" Fast Write : %s", (fw
) ? "Yes":"No");
1188 PrintAndLog(" Inverse data : %s", (inv
) ? "Yes":"No");
1189 PrintAndLog(" POR-Delay : %s", (por
) ? "Yes":"No");
1190 PrintAndLog("-------------------------------------------------------------");
1191 PrintAndLog(" Raw Data - Page 0");
1192 PrintAndLog(" Block 0 : 0x%08X %s", bl0
, sprint_bin(DemodBuffer
+config
.offset
,32) );
1193 PrintAndLog("-------------------------------------------------------------");
1198 int CmdT55xxDump(const char *Cmd
){
1200 uint32_t password
= 0;
1201 char cmdp
= param_getchar(Cmd
, 0);
1202 bool override
= false;
1203 if ( cmdp
== 'h' || cmdp
== 'H') return usage_t55xx_dump();
1205 bool usepwd
= ( strlen(Cmd
) > 0);
1207 password
= param_get32ex(Cmd
, 0, 0, 16);
1208 if (param_getchar(Cmd
, 1) =='o' )
1213 for ( uint8_t i
= 0; i
<8; ++i
)
1214 T55xxReadBlock(i
, 0, usepwd
, override
, password
);
1217 for ( uint8_t i
= 0; i
<4; i
++)
1218 T55xxReadBlock(i
, 1, usepwd
, override
, password
);
1223 int AquireData( uint8_t page
, uint8_t block
, bool pwdmode
, uint32_t password
){
1226 // bit1 = page to read from
1227 uint8_t arg0
= (page
<<1) | pwdmode
;
1228 UsbCommand c
= {CMD_T55XX_READ_BLOCK
, {arg0
, block
, password
}};
1230 clearCommandBuffer();
1232 if ( !WaitForResponseTimeout(CMD_ACK
,NULL
,2500) ) {
1233 PrintAndLog("command execution time out");
1236 getSamples(12000,true);
1240 char * GetBitRateStr(uint32_t id
, bool xmode
) {
1241 static char buf
[25];
1244 if (xmode
) { //xmode bitrate calc is same as em4x05 calc
1245 snprintf(retStr
,sizeof(buf
),"%d - RF/%d", id
, EM4x05_GET_BITRATE(id
));
1248 case 0: snprintf(retStr
,sizeof(buf
),"%d - RF/8",id
); break;
1249 case 1: snprintf(retStr
,sizeof(buf
),"%d - RF/16",id
); break;
1250 case 2: snprintf(retStr
,sizeof(buf
),"%d - RF/32",id
); break;
1251 case 3: snprintf(retStr
,sizeof(buf
),"%d - RF/40",id
); break;
1252 case 4: snprintf(retStr
,sizeof(buf
),"%d - RF/50",id
); break;
1253 case 5: snprintf(retStr
,sizeof(buf
),"%d - RF/64",id
); break;
1254 case 6: snprintf(retStr
,sizeof(buf
),"%d - RF/100",id
); break;
1255 case 7: snprintf(retStr
,sizeof(buf
),"%d - RF/128",id
); break;
1256 default: snprintf(retStr
,sizeof(buf
),"%d - (Unknown)",id
); break;
1262 char * GetSaferStr(uint32_t id
) {
1263 static char buf
[40];
1266 snprintf(retStr
,sizeof(buf
),"%d",id
);
1268 snprintf(retStr
,sizeof(buf
),"%d - passwd",id
);
1271 snprintf(retStr
,sizeof(buf
),"%d - testmode",id
);
1277 char * GetModulationStr( uint32_t id
){
1278 static char buf
[60];
1282 case 0: snprintf(retStr
,sizeof(buf
),"%d - DIRECT (ASK/NRZ)",id
); break;
1283 case 1: snprintf(retStr
,sizeof(buf
),"%d - PSK 1 phase change when input changes",id
); break;
1284 case 2: snprintf(retStr
,sizeof(buf
),"%d - PSK 2 phase change on bitclk if input high",id
); break;
1285 case 3: snprintf(retStr
,sizeof(buf
),"%d - PSK 3 phase change on rising edge of input",id
); break;
1286 case 4: snprintf(retStr
,sizeof(buf
),"%d - FSK 1 RF/8 RF/5",id
); break;
1287 case 5: snprintf(retStr
,sizeof(buf
),"%d - FSK 2 RF/8 RF/10",id
); break;
1288 case 6: snprintf(retStr
,sizeof(buf
),"%d - FSK 1a RF/5 RF/8",id
); break;
1289 case 7: snprintf(retStr
,sizeof(buf
),"%d - FSK 2a RF/10 RF/8",id
); break;
1290 case 8: snprintf(retStr
,sizeof(buf
),"%d - Manchester",id
); break;
1291 case 16: snprintf(retStr
,sizeof(buf
),"%d - Biphase",id
); break;
1292 case 0x18: snprintf(retStr
,sizeof(buf
),"%d - Biphase a - AKA Conditional Dephase Encoding(CDP)",id
); break;
1293 case 17: snprintf(retStr
,sizeof(buf
),"%d - Reserved",id
); break;
1294 default: snprintf(retStr
,sizeof(buf
),"0x%02X (Unknown)",id
); break;
1299 char * GetModelStrFromCID(uint32_t cid
){
1301 static char buf
[10];
1304 if (cid
== 1) snprintf(retStr
, sizeof(buf
),"ATA5577M1");
1305 if (cid
== 2) snprintf(retStr
, sizeof(buf
),"ATA5577M2");
1309 char * GetSelectedModulationStr( uint8_t id
){
1311 static char buf
[20];
1315 case DEMOD_FSK
: snprintf(retStr
,sizeof(buf
),"FSK"); break;
1316 case DEMOD_FSK1
: snprintf(retStr
,sizeof(buf
),"FSK1"); break;
1317 case DEMOD_FSK1a
: snprintf(retStr
,sizeof(buf
),"FSK1a"); break;
1318 case DEMOD_FSK2
: snprintf(retStr
,sizeof(buf
),"FSK2"); break;
1319 case DEMOD_FSK2a
: snprintf(retStr
,sizeof(buf
),"FSK2a"); break;
1320 case DEMOD_ASK
: snprintf(retStr
,sizeof(buf
),"ASK"); break;
1321 case DEMOD_NRZ
: snprintf(retStr
,sizeof(buf
),"DIRECT/NRZ"); break;
1322 case DEMOD_PSK1
: snprintf(retStr
,sizeof(buf
),"PSK1"); break;
1323 case DEMOD_PSK2
: snprintf(retStr
,sizeof(buf
),"PSK2"); break;
1324 case DEMOD_PSK3
: snprintf(retStr
,sizeof(buf
),"PSK3"); break;
1325 case DEMOD_BI
: snprintf(retStr
,sizeof(buf
),"BIPHASE"); break;
1326 case DEMOD_BIa
: snprintf(retStr
,sizeof(buf
),"BIPHASEa - (CDP)"); break;
1327 default: snprintf(retStr
,sizeof(buf
),"(Unknown)"); break;
1332 uint32_t PackBits(uint8_t start
, uint8_t len
, uint8_t* bits
){
1337 if (len
> 32) return 0;
1340 for (; j
>= 0; --j
, ++i
)
1341 tmp
|= bits
[i
] << j
;
1346 int CmdResetRead(const char *Cmd
) {
1347 UsbCommand c
= {CMD_T55XX_RESET_READ
, {0,0,0}};
1349 clearCommandBuffer();
1351 if ( !WaitForResponseTimeout(CMD_ACK
,NULL
,2500) ) {
1352 PrintAndLog("command execution time out");
1356 uint8_t got
[BIGBUF_SIZE
-1];
1357 GetFromBigBuf(got
, sizeof(got
), 0, NULL
, -1 , 0);
1358 setGraphBuf(got
, sizeof(got
));
1362 int CmdT55xxWipe(const char *Cmd
) {
1363 char writeData
[20] = {0};
1364 char *ptrData
= writeData
;
1366 char cmdp
= param_getchar(Cmd
, 0);
1367 if ( cmdp
== 'h' || cmdp
== 'H') return usage_t55xx_wipe();
1369 bool Q5
= (cmdp
== 'q' || cmdp
== 'Q');
1371 // Try with the default password to reset block 0
1372 // With a pwd should work even if pwd bit not set
1373 PrintAndLog("\nBeginning Wipe of a T55xx tag (assuming the tag is not password protected)\n");
1376 snprintf(ptrData
,sizeof(writeData
),"b 0 d 6001F004 p 0");
1378 snprintf(ptrData
,sizeof(writeData
),"b 0 d 00088040 p 0");
1381 if (!CmdT55xxWriteBlock(ptrData
)) PrintAndLog("Error writing blk 0");
1383 for (uint8_t blk
= 1; blk
<8; blk
++) {
1384 snprintf(ptrData
,sizeof(writeData
),"b %d d 0", blk
);
1385 if (!CmdT55xxWriteBlock(ptrData
))
1386 PrintAndLog("Error writing blk %d", blk
);
1388 memset(writeData
, 0x00, sizeof(writeData
));
1393 int CmdT55xxBruteForce(const char *Cmd
) {
1395 // load a default pwd file.
1397 char filename
[FILE_PATH_SIZE
]={0};
1400 uint8_t stKeyBlock
= 20;
1401 uint8_t *keyBlock
= NULL
, *p
= NULL
;
1402 uint32_t start_password
= 0x00000000; //start password
1403 uint32_t end_password
= 0xFFFFFFFF; //end password
1406 char cmdp
= param_getchar(Cmd
, 0);
1407 if (cmdp
== 'h' || cmdp
== 'H') return usage_t55xx_bruteforce();
1409 keyBlock
= calloc(stKeyBlock
, 6);
1410 if (keyBlock
== NULL
) return 1;
1412 if (cmdp
== 'i' || cmdp
== 'I') {
1414 int len
= strlen(Cmd
+2);
1415 if (len
> FILE_PATH_SIZE
) len
= FILE_PATH_SIZE
;
1416 memcpy(filename
, Cmd
+2, len
);
1418 FILE * f
= fopen( filename
, "r");
1421 PrintAndLog("File: %s: not found or locked.", filename
);
1426 while( fgets(buf
, sizeof(buf
), f
) ) {
1427 if (strlen(buf
) < 8 || buf
[7] == '\n') continue;
1429 while (fgetc(f
) != '\n' && !feof(f
)) ; //goto next line
1431 //The line start with # is comment, skip
1432 if( buf
[0]=='#' ) continue;
1434 if (!isxdigit((unsigned char)buf
[0])) {
1435 PrintAndLog("File content error. '%s' must include 8 HEX symbols", buf
);
1441 if ( stKeyBlock
- keycnt
< 2) {
1442 p
= realloc(keyBlock
, 6*(stKeyBlock
+=10));
1444 PrintAndLog("Cannot allocate memory for defaultKeys");
1451 memset(keyBlock
+ 4 * keycnt
, 0, 4);
1452 num_to_bytes(strtoll(buf
, NULL
, 16), 4, keyBlock
+ 4*keycnt
);
1453 PrintAndLog("chk custom pwd[%2d] %08X", keycnt
, bytes_to_num(keyBlock
+ 4*keycnt
, 4));
1455 memset(buf
, 0, sizeof(buf
));
1460 PrintAndLog("No keys found in file");
1464 PrintAndLog("Loaded %d keys", keycnt
);
1467 uint64_t testpwd
= 0x00;
1468 for (uint16_t c
= 0; c
< keycnt
; ++c
) {
1473 printf("\naborted via keyboard!\n");
1478 testpwd
= bytes_to_num(keyBlock
+ 4*c
, 4);
1480 PrintAndLog("Testing %08X", testpwd
);
1482 if ( !AquireData(T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, true, testpwd
)) {
1483 PrintAndLog("Aquireing data from device failed. Quitting");
1488 found
= tryDetectModulation();
1491 PrintAndLog("Found valid password: [%08X]", testpwd
);
1496 PrintAndLog("Password NOT found.");
1501 // Try to read Block 7, first :)
1503 // incremental pwd range search
1504 start_password
= param_get32ex(Cmd
, 0, 0, 16);
1505 end_password
= param_get32ex(Cmd
, 1, 0, 16);
1507 if ( start_password
>= end_password
) {
1509 return usage_t55xx_bruteforce();
1511 PrintAndLog("Search password range [%08X -> %08X]", start_password
, end_password
);
1513 uint32_t i
= start_password
;
1515 while ((!found
) && (i
<= end_password
)) {
1522 printf("\naborted via keyboard!\n");
1527 if (!AquireData(T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, true, i
)) {
1528 PrintAndLog("Aquireing data from device failed. Quitting");
1532 found
= tryDetectModulation();
1541 PrintAndLog("Found valid password: [%08x]", i
);
1543 PrintAndLog("Password NOT found. Last tried: [%08x]", --i
);
1549 // note length of data returned is different for different chips.
1550 // some return all page 1 (64 bits) and others return just that block (32 bits)
1551 // unfortunately the 64 bits makes this more likely to get a false positive...
1552 bool tryDetectP1(bool getData
) {
1553 uint8_t preamble
[] = {1,1,1,0,0,0,0,0,0,0,0,1,0,1,0,1};
1554 size_t startIdx
= 0;
1555 uint8_t fc1
= 0, fc2
= 0, ans
= 0;
1556 int clk
= 0, firstClockEdge
= 0;
1560 if ( !AquireData(T55x7_PAGE1
, 1, false, 0) )
1564 // try fsk clock detect. if successful it cannot be any other type of modulation... (in theory...)
1565 ans
= fskClocks(&fc1
, &fc2
, (uint8_t *)&clk
, false, &firstClockEdge
);
1566 if (ans
&& ((fc1
==10 && fc2
==8) || (fc1
==8 && fc2
==5))) {
1567 if ( FSKrawDemod("0 0", false) &&
1568 preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&
1569 (DemodBufferLen
== 32 || DemodBufferLen
== 64) ) {
1572 if ( FSKrawDemod("0 1", false) &&
1573 preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&
1574 (DemodBufferLen
== 32 || DemodBufferLen
== 64) ) {
1580 // try psk clock detect. if successful it cannot be any other type of modulation... (in theory...)
1581 clk
= GetPskClock("", false, false);
1584 // save_restoreGB(1);
1585 // skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)
1587 if ( PSKDemod("0 0 6", false) &&
1588 preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&
1589 (DemodBufferLen
== 32 || DemodBufferLen
== 64) ) {
1590 //save_restoreGB(0);
1593 if ( PSKDemod("0 1 6", false) &&
1594 preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&
1595 (DemodBufferLen
== 32 || DemodBufferLen
== 64) ) {
1596 //save_restoreGB(0);
1599 // PSK2 - needs a call to psk1TOpsk2.
1600 if ( PSKDemod("0 0 6", false)) {
1601 psk1TOpsk2(DemodBuffer
, DemodBufferLen
);
1602 if (preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&
1603 (DemodBufferLen
== 32 || DemodBufferLen
== 64) ) {
1604 //save_restoreGB(0);
1607 } // inverse waves does not affect PSK2 demod
1609 //save_restoreGB(0);
1610 // no other modulation clocks = 2 or 4 so quit searching
1611 if (fc1
!= 8) return false;
1614 // try ask clock detect. it could be another type even if successful.
1615 clk
= GetAskClock("", false, false);
1617 if ( ASKDemod_ext("0 0 1", false, false, 1, &st
) &&
1618 preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&
1619 (DemodBufferLen
== 32 || DemodBufferLen
== 64) ) {
1623 if ( ASKDemod_ext("0 1 1", false, false, 1, &st
) &&
1624 preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&
1625 (DemodBufferLen
== 32 || DemodBufferLen
== 64) ) {
1628 if ( ASKbiphaseDemod("0 0 0 2", false) &&
1629 preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&
1630 (DemodBufferLen
== 32 || DemodBufferLen
== 64) ) {
1633 if ( ASKbiphaseDemod("0 0 1 2", false) &&
1634 preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&
1635 (DemodBufferLen
== 32 || DemodBufferLen
== 64) ) {
1640 // try NRZ clock detect. it could be another type even if successful.
1641 clk
= GetNrzClock("", false, false); //has the most false positives :(
1643 if ( NRZrawDemod("0 0 1", false) &&
1644 preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&
1645 (DemodBufferLen
== 32 || DemodBufferLen
== 64) ) {
1648 if ( NRZrawDemod("0 1 1", false) &&
1649 preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&
1650 (DemodBufferLen
== 32 || DemodBufferLen
== 64) ) {
1656 // does this need to be a callable command?
1657 int CmdT55xxDetectPage1(const char *Cmd
){
1658 bool errors
= false;
1660 bool usepwd
= false;
1661 uint32_t password
= 0;
1664 while(param_getchar(Cmd
, cmdp
) != 0x00 && !errors
) {
1665 switch(param_getchar(Cmd
, cmdp
)) {
1668 return usage_t55xx_detectP1();
1671 password
= param_get32ex(Cmd
, cmdp
+1, 0, 16);
1676 // use Graphbuffer data
1681 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd
, cmdp
));
1686 if (errors
) return usage_t55xx_detectP1();
1689 if ( !AquireData(T55x7_PAGE1
, 1, usepwd
, password
) )
1692 bool success
= tryDetectP1(false);
1693 if (success
) PrintAndLog("T55xx chip found!");
1697 static command_t CommandTable
[] = {
1698 {"help", CmdHelp
, 1, "This help"},
1699 {"bruteforce",CmdT55xxBruteForce
,0, "<start password> <end password> [i <*.dic>] Simple bruteforce attack to find password"},
1700 {"config", CmdT55xxSetConfig
, 1, "Set/Get T55XX configuration (modulation, inverted, offset, rate)"},
1701 {"detect", CmdT55xxDetect
, 1, "[1] Try detecting the tag modulation from reading the configuration block."},
1702 {"p1detect", CmdT55xxDetectPage1
,1, "[1] Try detecting if this is a t55xx tag by reading page 1"},
1703 {"read", CmdT55xxReadBlock
, 0, "b <block> p [password] [o] [1] -- Read T55xx block data. Optional [p password], [override], [page1]"},
1704 {"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)"},
1705 {"write", CmdT55xxWriteBlock
,0, "b <block> d <data> p [password] [1] -- Write T55xx block data. Optional [p password], [page1]"},
1706 {"trace", CmdT55xxReadTrace
, 1, "[1] Show T55x7 traceability data (page 1/ blk 0-1)"},
1707 {"info", CmdT55xxInfo
, 1, "[1] Show T55x7 configuration data (page 0/ blk 0)"},
1708 {"dump", CmdT55xxDump
, 0, "[password] [o] Dump T55xx card block 0-7. Optional [password], [override]"},
1709 {"special", special
, 0, "Show block changes with 64 different offsets"},
1710 {"wakeup", CmdT55xxWakeUp
, 0, "Send AOR wakeup command"},
1711 {"wipe", CmdT55xxWipe
, 0, "[q] Wipe a T55xx tag and set defaults (will destroy any data on tag)"},
1712 {NULL
, NULL
, 0, NULL
}
1715 int CmdLFT55XX(const char *Cmd
) {
1716 CmdsParse(CommandTable
, Cmd
);
1720 int CmdHelp(const char *Cmd
) {
1721 CmdsHelp(CommandTable
);