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 //-----------------------------------------------------------------------------
13 #include "proxmark3.h"
17 #include "cmdparser.h"
20 #include "cmdlft55xx.h"
24 #include "cmdhf14a.h" //for getTagInfo
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
32 // Default configuration
33 t55xx_conf_block_t config
= { .modulation
= DEMOD_ASK
, .inverted
= FALSE
, .offset
= 0x00, .block0
= 0x00, .Q5
= FALSE
};
35 t55xx_conf_block_t
Get_t55xx_Config(){
38 void Set_t55xx_Config(t55xx_conf_block_t conf
){
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");
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");
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");
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");
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");
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");
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.");
97 PrintAndLog("Examples:");
98 PrintAndLog(" lf t55xx trace");
99 PrintAndLog(" lf t55xx trace 1");
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.");
108 PrintAndLog("Examples:");
109 PrintAndLog(" lf t55xx info");
110 PrintAndLog(" lf t55xx info 1");
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");
120 PrintAndLog("Examples:");
121 PrintAndLog(" lf t55xx dump");
122 PrintAndLog(" lf t55xx dump feedbeef o");
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)");
132 PrintAndLog("Examples:");
133 PrintAndLog(" lf t55xx detect");
134 PrintAndLog(" lf t55xx detect 1");
135 PrintAndLog(" lf t55xx detect p 11223344");
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)");
146 PrintAndLog("Examples:");
147 PrintAndLog(" lf t55xx wakeup p 11223344 - send wakeup password");
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>");
161 PrintAndLog("Examples:");
162 PrintAndLog(" lf t55xx bruteforce aaaaaaaa bbbbbbbb");
163 PrintAndLog(" lf t55xx bruteforce i default_pwd.dic");
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");
177 PrintAndLog("Examples:");
178 PrintAndLog(" lf t55xx recoverpw");
179 PrintAndLog(" lf t55xx recoverpw 51243648");
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");
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");
194 static int CmdHelp(const char *Cmd
);
196 void printT5xxHeader(uint8_t page
){
197 PrintAndLog("Reading Page %d:", page
);
198 PrintAndLog("blk | hex data | binary | ascii");
199 PrintAndLog("----+----------+---------------------------------+-------");
202 int CmdT55xxSetConfig(const char *Cmd
) {
205 char modulation
[5] = {0x00};
208 uint8_t rates
[9] = {8,16,32,40,50,64,100,128,0};
211 while(param_getchar(Cmd
, cmdp
) != 0x00 && !errors
)
213 tmp
= param_getchar(Cmd
, cmdp
);
218 return usage_t55xx_config();
220 errors
|= param_getdec(Cmd
, cmdp
+1, &bitRate
);
224 if (rates
[i
]==bitRate
) {
229 if (i
==9) errors
= TRUE
;
234 param_getstr(Cmd
, cmdp
+1, modulation
);
237 if ( strcmp(modulation
, "FSK" ) == 0) {
238 config
.modulation
= DEMOD_FSK
;
239 } else if ( strcmp(modulation
, "FSK1" ) == 0) {
240 config
.modulation
= DEMOD_FSK1
;
242 } else if ( strcmp(modulation
, "FSK1a" ) == 0) {
243 config
.modulation
= DEMOD_FSK1a
;
245 } else if ( strcmp(modulation
, "FSK2" ) == 0) {
246 config
.modulation
= DEMOD_FSK2
;
248 } else if ( strcmp(modulation
, "FSK2a" ) == 0) {
249 config
.modulation
= DEMOD_FSK2a
;
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
;
264 } else if ( strcmp(modulation
, "BI" ) == 0) {
265 config
.modulation
= DEMOD_BI
;
268 PrintAndLog("Unknown modulation '%s'", modulation
);
273 config
.inverted
= param_getchar(Cmd
,cmdp
+1) == '1';
277 errors
|= param_getdec(Cmd
, cmdp
+1, &offset
);
279 config
.offset
= offset
;
293 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd
, cmdp
));
300 if (cmdp
== 0) return printConfiguration( config
);
303 if (errors
) return usage_t55xx_config();
306 return printConfiguration ( config
);
309 int T55xxReadBlock(uint8_t block
, bool page1
, bool usepwd
, bool override
, uint32_t password
){
312 // try reading the config block and verify that PWD bit is set before doing this!
315 if ( !AquireData(T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, false, 0 ) ) return 0;
317 if ( !tryDetectModulation() ) {
318 PrintAndLog("Safety Check: Could not detect if PWD bit is set in config block. Exits.");
321 PrintAndLog("Safety Check: PWD bit is NOT set in config block. Reading without password...");
326 PrintAndLog("Safety Check Overriden - proceeding despite risk");
330 if (!AquireData(page1
, block
, usepwd
, password
) ) return 0;
331 if (!DecodeT55xxBlock()) return 0;
334 sprintf(blk
,"%02d", block
);
335 printT55xxBlock(blk
);
339 int CmdT55xxReadBlock(const char *Cmd
) {
340 uint8_t block
= REGULAR_READ_MODE_BLOCK
;
341 uint32_t password
= 0; //default to blank Block 7
343 bool override
= false;
347 while(param_getchar(Cmd
, cmdp
) != 0x00 && !errors
) {
348 switch(param_getchar(Cmd
, cmdp
)) {
351 return usage_t55xx_read();
354 errors
|= param_getdec(Cmd
, cmdp
+1, &block
);
364 password
= param_get32ex(Cmd
, cmdp
+1, 0, 16);
373 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd
, cmdp
));
378 if (errors
) return usage_t55xx_read();
380 if (block
> 7 && block
!= REGULAR_READ_MODE_BLOCK
) {
381 PrintAndLog("Block must be between 0 and 7");
385 printT5xxHeader(page1
);
386 return T55xxReadBlock(block
, page1
, usepwd
, override
, password
);
389 bool DecodeT55xxBlock(){
391 char buf
[30] = {0x00};
395 uint8_t bitRate
[8] = {8,16,32,40,50,64,100,128};
396 DemodBufferLen
= 0x00;
398 switch( config
.modulation
){
400 snprintf(cmdStr
, sizeof(buf
),"%d %d", bitRate
[config
.bitrate
], config
.inverted
);
401 ans
= FSKrawDemod(cmdStr
, FALSE
);
405 snprintf(cmdStr
, sizeof(buf
),"%d %d 8 5", bitRate
[config
.bitrate
], config
.inverted
);
406 ans
= FSKrawDemod(cmdStr
, FALSE
);
410 snprintf(cmdStr
, sizeof(buf
),"%d %d 10 8", bitRate
[config
.bitrate
], config
.inverted
);
411 ans
= FSKrawDemod(cmdStr
, FALSE
);
414 snprintf(cmdStr
, sizeof(buf
),"%d %d 1", bitRate
[config
.bitrate
], config
.inverted
);
415 ans
= ASKDemod_ext(cmdStr
, FALSE
, FALSE
, 1, &ST
);
418 // skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)
421 snprintf(cmdStr
, sizeof(buf
),"%d %d 6", bitRate
[config
.bitrate
], config
.inverted
);
422 ans
= PSKDemod(cmdStr
, FALSE
);
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)
431 snprintf(cmdStr
, sizeof(buf
),"%d 0 6", bitRate
[config
.bitrate
] );
432 ans
= PSKDemod(cmdStr
, FALSE
);
433 psk1TOpsk2(DemodBuffer
, DemodBufferLen
);
438 snprintf(cmdStr
, sizeof(buf
),"%d %d 1", bitRate
[config
.bitrate
], config
.inverted
);
439 ans
= NRZrawDemod(cmdStr
, FALSE
);
443 snprintf(cmdStr
, sizeof(buf
),"0 %d %d 1", bitRate
[config
.bitrate
], config
.inverted
);
444 ans
= ASKbiphaseDemod(cmdStr
, FALSE
);
452 bool DecodeT5555TraceBlock() {
453 DemodBufferLen
= 0x00;
455 // According to datasheet. Always: RF/64, not inverted, Manchester
456 return (bool) ASKDemod("64 0 1", FALSE
, FALSE
, 1);
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");
468 int CmdT55xxDetect(const char *Cmd
){
472 uint32_t password
= 0;
475 while(param_getchar(Cmd
, cmdp
) != 0x00 && !errors
) {
476 switch(param_getchar(Cmd
, cmdp
)) {
479 return usage_t55xx_detect();
482 password
= param_get32ex(Cmd
, cmdp
+1, 0, 16);
487 // use Graphbuffer data
492 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd
, cmdp
));
497 if (errors
) return usage_t55xx_detect();
500 if (!SanityOfflineCheck(useGB
)) return 1;
503 if ( !AquireData(T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, usepwd
, password
) )
507 if ( !tryDetectModulation() )
508 PrintAndLog("Could not detect modulation automatically. Try setting it manually with \'lf t55xx config\'");
513 // detect configuration?
514 bool tryDetectModulation(){
516 t55xx_conf_block_t tests
[15];
518 uint8_t fc1
= 0, fc2
= 0, clk
=0;
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
;
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
;
547 clk
= GetAskClock("", FALSE
, FALSE
);
549 tests
[hits
].ST
= TRUE
;
550 // "0 0 1 " == clock auto, invert false, maxError 1.
551 // false = no verbose
552 // false = no emSearch
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
);
562 tests
[hits
].ST
= TRUE
;
563 // "0 0 1 " == clock auto, invert true, maxError 1.
564 // false = no verbose
565 // false = no emSearch
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
);
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
;
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
;
594 clk
= GetNrzClock("", FALSE
, FALSE
);
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
;
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
;
616 // skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)
619 clk
= GetPskClock("", FALSE
, FALSE
);
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
;
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
;
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
;
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
;
660 } // inverse waves does not affect this demod
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
);
678 PrintAndLog("Found [%d] possible matches for modulation.",hits
);
679 for(int i
=0; i
<hits
; ++i
){
680 PrintAndLog("--[%d]---------------", i
+1);
681 printConfiguration( tests
[i
] );
687 bool testModulation(uint8_t mode
, uint8_t modread
){
690 if (modread
>= DEMOD_FSK1
&& modread
<= DEMOD_FSK2a
) return TRUE
;
693 if (modread
== DEMOD_ASK
) return TRUE
;
696 if (modread
== DEMOD_PSK1
) return TRUE
;
699 if (modread
== DEMOD_PSK2
) return TRUE
;
702 if (modread
== DEMOD_PSK3
) return TRUE
;
705 if (modread
== DEMOD_NRZ
) return TRUE
;
708 if (modread
== DEMOD_BI
) return TRUE
;
711 if (modread
== DEMOD_BIa
) return TRUE
;
719 bool testQ5Modulation(uint8_t mode
, uint8_t modread
){
722 if (modread
>= 4 && modread
<= 5) return TRUE
;
725 if (modread
== 0) return TRUE
;
728 if (modread
== 1) return TRUE
;
731 if (modread
== 2) return TRUE
;
734 if (modread
== 3) return TRUE
;
737 if (modread
== 7) return TRUE
;
740 if (modread
== 6) return TRUE
;
748 int convertQ5bitRate(uint8_t bitRateRead
) {
749 uint8_t expected
[] = {8, 16, 32, 40, 50, 64, 100, 128};
750 for (int i
=0; i
<8; i
++)
751 if (expected
[i
] == bitRateRead
)
757 bool testQ5(uint8_t mode
, uint8_t *offset
, int *fndBitRate
, uint8_t clk
){
759 if ( DemodBufferLen
< 64 ) return FALSE
;
761 for (uint8_t idx
= 28; idx
< 64; idx
++){
763 if ( PackBits(si
, 28, DemodBuffer
) == 0x00 ) continue;
765 uint8_t safer
= PackBits(si
, 4, DemodBuffer
); si
+= 4; //master key
766 uint8_t resv
= PackBits(si
, 8, DemodBuffer
); si
+= 8;
767 // 2nibble must be zeroed.
768 if (safer
!= 0x6 && safer
!= 0x9) continue;
769 if ( resv
> 0x00) continue;
770 //uint8_t pageSel = PackBits(si, 1, DemodBuffer); si += 1;
771 //uint8_t fastWrite = PackBits(si, 1, DemodBuffer); si += 1;
773 int bitRate
= PackBits(si
, 6, DemodBuffer
)*2 + 2; si
+= 6; //bit rate
774 if (bitRate
> 128 || bitRate
< 8) continue;
776 //uint8_t AOR = PackBits(si, 1, DemodBuffer); si += 1;
777 //uint8_t PWD = PackBits(si, 1, DemodBuffer); si += 1;
778 //uint8_t pskcr = PackBits(si, 2, DemodBuffer); si += 2; //could check psk cr
779 //uint8_t inverse = PackBits(si, 1, DemodBuffer); si += 1;
781 uint8_t modread
= PackBits(si
, 3, DemodBuffer
); si
+= 3;
782 uint8_t maxBlk
= PackBits(si
, 3, DemodBuffer
); si
+= 3;
783 //uint8_t ST = PackBits(si, 1, DemodBuffer); si += 1;
784 if (maxBlk
== 0) continue;
786 if (!testQ5Modulation(mode
, modread
)) continue;
787 if (bitRate
!= clk
) continue;
788 *fndBitRate
= convertQ5bitRate(bitRate
);
789 if (*fndBitRate
< 0) continue;
797 bool testBitRate(uint8_t readRate
, uint8_t clk
){
798 uint8_t expected
[] = {8, 16, 32, 40, 50, 64, 100, 128};
799 if (expected
[readRate
] == clk
)
805 bool test(uint8_t mode
, uint8_t *offset
, int *fndBitRate
, uint8_t clk
, bool *Q5
){
807 if ( DemodBufferLen
< 64 ) return FALSE
;
809 for (uint8_t idx
= 28; idx
< 64; idx
++){
811 if ( PackBits(si
, 28, DemodBuffer
) == 0x00 ) continue;
813 uint8_t safer
= PackBits(si
, 4, DemodBuffer
); si
+= 4; //master key
814 uint8_t resv
= PackBits(si
, 4, DemodBuffer
); si
+= 4; //was 7 & +=7+3 //should be only 4 bits if extended mode
815 // 2nibble must be zeroed.
816 // moved test to here, since this gets most faults first.
817 if ( resv
> 0x00) continue;
819 uint8_t xtRate
= PackBits(si
, 3, DemodBuffer
); si
+= 3; //extended mode part of rate
820 int bitRate
= PackBits(si
, 3, DemodBuffer
); si
+= 3; //bit rate
821 if (bitRate
> 7) continue;
822 uint8_t extend
= PackBits(si
, 1, DemodBuffer
); si
+= 1; //bit 15 extended mode
823 uint8_t modread
= PackBits(si
, 5, DemodBuffer
); si
+= 5+2+1;
824 //uint8_t pskcr = PackBits(si, 2, DemodBuffer); si += 2+1; //could check psk cr
825 //uint8_t nml01 = PackBits(si, 1, DemodBuffer); si += 1+5; //bit 24, 30, 31 could be tested for 0 if not extended mode
826 //uint8_t nml02 = PackBits(si, 2, DemodBuffer); si += 2;
829 bool extMode
=( (safer
== 0x6 || safer
== 0x9) && extend
) ? TRUE
: FALSE
;
832 if (xtRate
) continue; //nml01 || nml02 || caused issues on noralys tags
835 if (!testModulation(mode
, modread
)) continue;
836 if (!testBitRate(bitRate
, clk
)) continue;
837 *fndBitRate
= bitRate
;
842 if (testQ5(mode
, offset
, fndBitRate
, clk
)) {
849 void printT55xxBlock(const char *blockNum
){
851 uint8_t i
= config
.offset
;
852 uint8_t endpos
= 32 + i
;
853 uint32_t blockData
= 0;
854 uint8_t bits
[64] = {0x00};
856 if ( !DemodBufferLen
) return;
858 if ( endpos
> DemodBufferLen
){
859 PrintAndLog("The configured offset %d is too big. Possible offset: %d)", i
, DemodBufferLen
-32);
863 for (; i
< endpos
; ++i
)
864 bits
[i
- config
.offset
] = DemodBuffer
[i
];
866 blockData
= PackBits(0, 32, bits
);
867 uint8_t bytes
[4] = {0};
868 num_to_bytes(blockData
, 4, bytes
);
870 PrintAndLog(" %s | %08X | %s | %s", blockNum
, blockData
, sprint_bin(bits
,32), sprint_ascii(bytes
,4));
873 int special(const char *Cmd
) {
874 uint32_t blockData
= 0;
875 uint8_t bits
[32] = {0x00};
877 PrintAndLog("OFFSET | DATA | BINARY | ASCII");
878 PrintAndLog("-------+-------+------------------------------------+------");
882 for (i
= 0; i
< 32; ++i
)
883 bits
[i
]=DemodBuffer
[j
+i
];
885 blockData
= PackBits(0, 32, bits
);
887 PrintAndLog("%02d | 0x%08X | %s",j
, blockData
, sprint_bin(bits
,32));
892 int printConfiguration( t55xx_conf_block_t b
){
893 PrintAndLog("Chip Type : %s", (b
.Q5
) ? "T5555(Q5)" : "T55x7");
894 PrintAndLog("Modulation : %s", GetSelectedModulationStr(b
.modulation
) );
895 PrintAndLog("Bit Rate : %s", GetBitRateStr(b
.bitrate
) );
896 PrintAndLog("Inverted : %s", (b
.inverted
) ? "Yes" : "No" );
897 PrintAndLog("Offset : %d", b
.offset
);
898 PrintAndLog("Seq. Term. : %s", (b
.ST
) ? "Yes" : "No" );
899 PrintAndLog("Block0 : 0x%08X", b
.block0
);
904 int CmdT55xxWakeUp(const char *Cmd
) {
905 uint32_t password
= 0;
908 while(param_getchar(Cmd
, cmdp
) != 0x00 && !errors
) {
909 switch(param_getchar(Cmd
, cmdp
)) {
912 return usage_t55xx_wakup();
915 password
= param_get32ex(Cmd
, cmdp
+1, 0, 16);
920 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd
, cmdp
));
925 if (errors
) return usage_t55xx_wakup();
927 UsbCommand c
= {CMD_T55XX_WAKEUP
, {password
, 0, 0}};
928 clearCommandBuffer();
930 PrintAndLog("Wake up command sent. Try read now");
934 int CmdT55xxWriteBlock(const char *Cmd
) {
935 uint8_t block
= 0xFF; //default to invalid block
936 uint32_t data
= 0; //default to blank Block
937 uint32_t password
= 0; //default to blank Block 7
940 bool gotdata
= false;
943 while(param_getchar(Cmd
, cmdp
) != 0x00 && !errors
) {
944 switch(param_getchar(Cmd
, cmdp
)) {
947 return usage_t55xx_write();
950 errors
|= param_getdec(Cmd
, cmdp
+1, &block
);
955 data
= param_get32ex(Cmd
, cmdp
+1, 0, 16);
961 password
= param_get32ex(Cmd
, cmdp
+1, 0, 16);
970 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd
, cmdp
));
975 if (errors
|| !gotdata
) return usage_t55xx_write();
978 PrintAndLog("Block number must be between 0 and 7");
982 UsbCommand c
= {CMD_T55XX_WRITE_BLOCK
, {data
, block
, 0}};
984 c
.d
.asBytes
[0] = (page1
) ? 0x2 : 0;
986 char pwdStr
[16] = {0};
987 snprintf(pwdStr
, sizeof(pwdStr
), "pwd: 0x%08X", password
);
989 PrintAndLog("Writing page %d block: %02d data: 0x%08X %s", page1
, block
, data
, (usepwd
) ? pwdStr
: "" );
994 c
.d
.asBytes
[0] |= 0x1;
996 clearCommandBuffer();
998 if (!WaitForResponseTimeout(CMD_ACK
, &resp
, 1000)){
999 PrintAndLog("Error occurred, device did not ACK write operation. (May be due to old firmware)");
1005 int CmdT55xxReadTrace(const char *Cmd
) {
1006 char cmdp
= param_getchar(Cmd
, 0);
1007 bool pwdmode
= false;
1008 uint32_t password
= 0;
1009 if (strlen(Cmd
) > 1 || cmdp
== 'h' || cmdp
== 'H') return usage_t55xx_trace();
1011 if (strlen(Cmd
)==0) {
1013 if (!SanityOfflineCheck(FALSE
)) return 1;
1015 if ( !AquireData( T55x7_PAGE1
, REGULAR_READ_MODE_BLOCK
, pwdmode
, password
) )
1020 if (!DecodeT5555TraceBlock()) return 1;
1022 if (!DecodeT55xxBlock()) return 1;
1025 if ( !DemodBufferLen
) return 1;
1027 RepaintGraphWindow();
1028 uint8_t repeat
= (config
.offset
> 5) ? 32 : 0;
1030 uint8_t si
= config
.offset
+ repeat
;
1031 uint32_t bl1
= PackBits(si
, 32, DemodBuffer
);
1032 uint32_t bl2
= PackBits(si
+32, 32, DemodBuffer
);
1035 uint32_t hdr
= PackBits(si
, 9, DemodBuffer
); si
+= 9;
1038 PrintAndLog("Invalid Q5 Trace data header (expected 0x1FF, found %X)", hdr
);
1042 t5555_tracedata_t data
= {.bl1
= bl1
, .bl2
= bl2
, .icr
= 0, .lotidc
= '?', .lotid
= 0, .wafer
= 0, .dw
=0};
1044 data
.icr
= PackBits(si
, 2, DemodBuffer
); si
+= 2;
1045 data
.lotidc
= 'Z' - PackBits(si
, 2, DemodBuffer
); si
+= 3;
1047 data
.lotid
= PackBits(si
, 4, DemodBuffer
); si
+= 5;
1049 data
.lotid
|= PackBits(si
, 4, DemodBuffer
); si
+= 5;
1051 data
.lotid
|= PackBits(si
, 4, DemodBuffer
); si
+= 5;
1053 data
.lotid
|= PackBits(si
, 4, DemodBuffer
); si
+= 5;
1055 data
.lotid
|= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1057 data
.wafer
= PackBits(si
, 3, DemodBuffer
); si
+= 4;
1059 data
.wafer
|= PackBits(si
, 2, DemodBuffer
); si
+= 2;
1061 data
.dw
= PackBits(si
, 2, DemodBuffer
); si
+= 3;
1063 data
.dw
|= PackBits(si
, 4, DemodBuffer
); si
+= 5;
1065 data
.dw
|= PackBits(si
, 4, DemodBuffer
); si
+= 5;
1067 data
.dw
|= PackBits(si
, 4, DemodBuffer
); si
+= 5;
1069 printT5555Trace(data
, repeat
);
1073 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};
1075 data
.acl
= PackBits(si
, 8, DemodBuffer
); si
+= 8;
1076 if ( data
.acl
!= 0xE0 ) {
1077 PrintAndLog("The modulation is most likely wrong since the ACL is not 0xE0. ");
1081 data
.mfc
= PackBits(si
, 8, DemodBuffer
); si
+= 8;
1082 data
.cid
= PackBits(si
, 5, DemodBuffer
); si
+= 5;
1083 data
.icr
= PackBits(si
, 3, DemodBuffer
); si
+= 3;
1084 data
.year
= PackBits(si
, 4, DemodBuffer
); si
+= 4;
1085 data
.quarter
= PackBits(si
, 2, DemodBuffer
); si
+= 2;
1086 data
.lotid
= PackBits(si
, 14, DemodBuffer
); si
+= 14;
1087 data
.wafer
= PackBits(si
, 5, DemodBuffer
); si
+= 5;
1088 data
.dw
= PackBits(si
, 15, DemodBuffer
);
1090 time_t t
= time(NULL
);
1091 struct tm tm
= *localtime(&t
);
1092 if ( data
.year
> tm
.tm_year
-110)
1097 printT55x7Trace(data
, repeat
);
1102 void printT55x7Trace( t55x7_tracedata_t data
, uint8_t repeat
){
1103 PrintAndLog("-- T55x7 Trace Information ----------------------------------");
1104 PrintAndLog("-------------------------------------------------------------");
1105 PrintAndLog(" ACL Allocation class (ISO/IEC 15963-1) : 0x%02X (%d)", data
.acl
, data
.acl
);
1106 PrintAndLog(" MFC Manufacturer ID (ISO/IEC 7816-6) : 0x%02X (%d) - %s", data
.mfc
, data
.mfc
, getTagInfo(data
.mfc
));
1107 PrintAndLog(" CID : 0x%02X (%d) - %s", data
.cid
, data
.cid
, GetModelStrFromCID(data
.cid
));
1108 PrintAndLog(" ICR IC Revision : %d", data
.icr
);
1109 PrintAndLog(" Manufactured");
1110 PrintAndLog(" Year/Quarter : %d/%d", data
.year
, data
.quarter
);
1111 PrintAndLog(" Lot ID : %d", data
.lotid
);
1112 PrintAndLog(" Wafer number : %d", data
.wafer
);
1113 PrintAndLog(" Die Number : %d", data
.dw
);
1114 PrintAndLog("-------------------------------------------------------------");
1115 PrintAndLog(" Raw Data - Page 1");
1116 PrintAndLog(" Block 1 : 0x%08X %s", data
.bl1
, sprint_bin(DemodBuffer
+config
.offset
+repeat
,32) );
1117 PrintAndLog(" Block 2 : 0x%08X %s", data
.bl2
, sprint_bin(DemodBuffer
+config
.offset
+repeat
+32,32) );
1118 PrintAndLog("-------------------------------------------------------------");
1123 1-8 ACL Allocation class (ISO/IEC 15963-1) 0xE0
1124 9-16 MFC Manufacturer ID (ISO/IEC 7816-6) 0x15 Atmel Corporation
1125 17-21 CID 0x1 = Atmel ATA5577M1 0x2 = Atmel ATA5577M2
1126 22-24 ICR IC revision
1127 25-28 YEAR (BCD encoded) 9 (= 2009)
1128 29-30 QUARTER 1,2,3,4
1134 18-32 DW, die number sequential
1138 void printT5555Trace( t5555_tracedata_t data
, uint8_t repeat
){
1139 PrintAndLog("-- T5555 (Q5) Trace Information -----------------------------");
1140 PrintAndLog("-------------------------------------------------------------");
1141 PrintAndLog(" ICR IC Revision : %d", data
.icr
);
1142 PrintAndLog(" Lot : %c%d", data
.lotidc
, data
.lotid
);
1143 PrintAndLog(" Wafer number : %d", data
.wafer
);
1144 PrintAndLog(" Die Number : %d", data
.dw
);
1145 PrintAndLog("-------------------------------------------------------------");
1146 PrintAndLog(" Raw Data - Page 1");
1147 PrintAndLog(" Block 1 : 0x%08X %s", data
.bl1
, sprint_bin(DemodBuffer
+config
.offset
+repeat
,32) );
1148 PrintAndLog(" Block 2 : 0x%08X %s", data
.bl2
, sprint_bin(DemodBuffer
+config
.offset
+repeat
+32,32) );
1152 TRACE - BLOCK O and BLOCK1
1157 15-35 Lot ID (NB parity)
1158 36-41 Wafer number (NB parity)
1159 42-58 DW, die number sequential (NB parity)
1165 //need to add Q5 info...
1166 int CmdT55xxInfo(const char *Cmd
){
1168 Page 0 Block 0 Configuration data.
1172 bool pwdmode
= false;
1173 uint32_t password
= 0;
1174 char cmdp
= param_getchar(Cmd
, 0);
1176 if (strlen(Cmd
) > 1 || cmdp
== 'h' || cmdp
== 'H') return usage_t55xx_info();
1178 if (strlen(Cmd
)==0){
1180 if (!SanityOfflineCheck(FALSE
)) return 1;
1182 if ( !AquireData( T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, pwdmode
, password
) )
1186 if (!DecodeT55xxBlock()) return 1;
1188 // too little space to start with
1189 if ( DemodBufferLen
< 32) return 1;
1192 PrintAndLog("Offset+32 ==%d\n DemodLen == %d", config
.offset
+ 32,DemodBufferLen
);
1194 uint8_t si
= config
.offset
;
1195 uint32_t bl0
= PackBits(si
, 32, DemodBuffer
);
1196 uint32_t safer
= PackBits(si
, 4, DemodBuffer
); si
+= 4;
1197 uint32_t resv
= PackBits(si
, 7, DemodBuffer
); si
+= 7;
1198 uint32_t dbr
= PackBits(si
, 3, DemodBuffer
); si
+= 3;
1199 uint32_t extend
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1200 uint32_t datamod
= PackBits(si
, 5, DemodBuffer
); si
+= 5;
1201 uint32_t pskcf
= PackBits(si
, 2, DemodBuffer
); si
+= 2;
1202 uint32_t aor
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1203 uint32_t otp
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1204 uint32_t maxblk
= PackBits(si
, 3, DemodBuffer
); si
+= 3;
1205 uint32_t pwd
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1206 uint32_t sst
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1207 uint32_t fw
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1208 uint32_t inv
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1209 uint32_t por
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1211 if (config
.Q5
) PrintAndLog("*** Warning *** Config Info read off a Q5 will not display as expected");
1213 PrintAndLog("-- T55x7 Configuration & Tag Information --------------------");
1214 PrintAndLog("-------------------------------------------------------------");
1215 PrintAndLog(" Safer key : %s", GetSaferStr(safer
));
1216 PrintAndLog(" reserved : %d", resv
);
1217 PrintAndLog(" Data bit rate : %s", GetBitRateStr(dbr
));
1218 PrintAndLog(" eXtended mode : %s", (extend
) ? "Yes - Warning":"No");
1219 PrintAndLog(" Modulation : %s", GetModulationStr(datamod
));
1220 PrintAndLog(" PSK clock frequency : %d", pskcf
);
1221 PrintAndLog(" AOR - Answer on Request : %s", (aor
) ? "Yes":"No");
1222 PrintAndLog(" OTP - One Time Pad : %s", (otp
) ? "Yes - Warning":"No" );
1223 PrintAndLog(" Max block : %d", maxblk
);
1224 PrintAndLog(" Password mode : %s", (pwd
) ? "Yes":"No");
1225 PrintAndLog(" Sequence Start Terminator : %s", (sst
) ? "Yes":"No");
1226 PrintAndLog(" Fast Write : %s", (fw
) ? "Yes":"No");
1227 PrintAndLog(" Inverse data : %s", (inv
) ? "Yes":"No");
1228 PrintAndLog(" POR-Delay : %s", (por
) ? "Yes":"No");
1229 PrintAndLog("-------------------------------------------------------------");
1230 PrintAndLog(" Raw Data - Page 0");
1231 PrintAndLog(" Block 0 : 0x%08X %s", bl0
, sprint_bin(DemodBuffer
+config
.offset
,32) );
1232 PrintAndLog("-------------------------------------------------------------");
1237 int CmdT55xxDump(const char *Cmd
){
1239 uint32_t password
= 0;
1240 bool override
= false;
1241 char cmdp
= param_getchar(Cmd
, 0);
1242 if ( cmdp
== 'h' || cmdp
== 'H') return usage_t55xx_dump();
1244 bool usepwd
= ( strlen(Cmd
) > 0);
1246 password
= param_get32ex(Cmd
, 0, 0, 16);
1247 if (param_getchar(Cmd
, 1) =='o' )
1252 for ( uint8_t i
= 0; i
< 8; ++i
)
1253 T55xxReadBlock(i
, 0, usepwd
, override
, password
);
1256 for ( uint8_t i
= 0; i
< 4; i
++)
1257 T55xxReadBlock(i
, 1, usepwd
, override
, password
);
1262 int AquireData( uint8_t page
, uint8_t block
, bool pwdmode
, uint32_t password
){
1265 // bit1 = page to read from
1266 // arg1: which block to read
1268 uint8_t arg0
= (page
<<1) | pwdmode
;
1269 UsbCommand c
= {CMD_T55XX_READ_BLOCK
, {arg0
, block
, password
}};
1270 clearCommandBuffer();
1272 if ( !WaitForResponseTimeout(CMD_ACK
, NULL
, 2500) ) {
1273 PrintAndLog("command execution time out");
1277 //uint8_t got[12288];
1279 GetFromBigBuf(got
, sizeof(got
), 0);
1280 if ( !WaitForResponseTimeout(CMD_ACK
, NULL
, 8000) ) {
1281 PrintAndLog("command execution time out");
1284 setGraphBuf(got
, sizeof(got
));
1288 char * GetBitRateStr(uint32_t id
){
1289 static char buf
[25];
1293 case 0: snprintf(retStr
,sizeof(buf
),"%d - RF/8",id
); break;
1294 case 1: snprintf(retStr
,sizeof(buf
),"%d - RF/16",id
); break;
1295 case 2: snprintf(retStr
,sizeof(buf
),"%d - RF/32",id
); break;
1296 case 3: snprintf(retStr
,sizeof(buf
),"%d - RF/40",id
); break;
1297 case 4: snprintf(retStr
,sizeof(buf
),"%d - RF/50",id
); break;
1298 case 5: snprintf(retStr
,sizeof(buf
),"%d - RF/64",id
); break;
1299 case 6: snprintf(retStr
,sizeof(buf
),"%d - RF/100",id
); break;
1300 case 7: snprintf(retStr
,sizeof(buf
),"%d - RF/128",id
); break;
1301 default: snprintf(retStr
,sizeof(buf
),"%d - (Unknown)",id
); break;
1306 char * GetSaferStr(uint32_t id
){
1307 static char buf
[40];
1310 snprintf(retStr
,sizeof(buf
),"%d",id
);
1312 snprintf(retStr
,sizeof(buf
),"%d - passwd",id
);
1315 snprintf(retStr
,sizeof(buf
),"%d - testmode",id
);
1321 char * GetModulationStr( uint32_t id
){
1322 static char buf
[60];
1326 case 0: snprintf(retStr
,sizeof(buf
),"%d - DIRECT (ASK/NRZ)",id
); break;
1327 case 1: snprintf(retStr
,sizeof(buf
),"%d - PSK 1 phase change when input changes",id
); break;
1328 case 2: snprintf(retStr
,sizeof(buf
),"%d - PSK 2 phase change on bitclk if input high",id
); break;
1329 case 3: snprintf(retStr
,sizeof(buf
),"%d - PSK 3 phase change on rising edge of input",id
); break;
1330 case 4: snprintf(retStr
,sizeof(buf
),"%d - FSK 1 RF/8 RF/5",id
); break;
1331 case 5: snprintf(retStr
,sizeof(buf
),"%d - FSK 2 RF/8 RF/10",id
); break;
1332 case 6: snprintf(retStr
,sizeof(buf
),"%d - FSK 1a RF/5 RF/8",id
); break;
1333 case 7: snprintf(retStr
,sizeof(buf
),"%d - FSK 2a RF/10 RF/8",id
); break;
1334 case 8: snprintf(retStr
,sizeof(buf
),"%d - Manchester",id
); break;
1335 case 16: snprintf(retStr
,sizeof(buf
),"%d - Biphase",id
); break;
1336 case 0x18:snprintf(retStr
,sizeof(buf
),"%d - Biphase a - AKA Conditional Dephase Encoding(CDP)",id
); break;
1337 case 17: snprintf(retStr
,sizeof(buf
),"%d - Reserved",id
); break;
1338 default: snprintf(retStr
,sizeof(buf
),"0x%02X (Unknown)",id
); break;
1343 char * GetModelStrFromCID(uint32_t cid
){
1345 static char buf
[10];
1348 if (cid
== 1) snprintf(retStr
, sizeof(buf
),"ATA5577M1");
1349 if (cid
== 2) snprintf(retStr
, sizeof(buf
),"ATA5577M2");
1353 char * GetSelectedModulationStr( uint8_t id
){
1355 static char buf
[20];
1359 case DEMOD_FSK
: snprintf(retStr
,sizeof(buf
),"FSK"); break;
1360 case DEMOD_FSK1
: snprintf(retStr
,sizeof(buf
),"FSK1"); break;
1361 case DEMOD_FSK1a
: snprintf(retStr
,sizeof(buf
),"FSK1a"); break;
1362 case DEMOD_FSK2
: snprintf(retStr
,sizeof(buf
),"FSK2"); break;
1363 case DEMOD_FSK2a
: snprintf(retStr
,sizeof(buf
),"FSK2a"); break;
1364 case DEMOD_ASK
: snprintf(retStr
,sizeof(buf
),"ASK"); break;
1365 case DEMOD_NRZ
: snprintf(retStr
,sizeof(buf
),"DIRECT/NRZ"); break;
1366 case DEMOD_PSK1
: snprintf(retStr
,sizeof(buf
),"PSK1"); break;
1367 case DEMOD_PSK2
: snprintf(retStr
,sizeof(buf
),"PSK2"); break;
1368 case DEMOD_PSK3
: snprintf(retStr
,sizeof(buf
),"PSK3"); break;
1369 case DEMOD_BI
: snprintf(retStr
,sizeof(buf
),"BIPHASE"); break;
1370 case DEMOD_BIa
: snprintf(retStr
,sizeof(buf
),"BIPHASEa - (CDP)"); break;
1371 default: snprintf(retStr
,sizeof(buf
),"(Unknown)"); break;
1376 void t55x7_create_config_block( int tagtype
){
1379 T55X7_DEFAULT_CONFIG_BLOCK, T55X7_RAW_CONFIG_BLOCK
1380 T55X7_EM_UNIQUE_CONFIG_BLOCK, T55X7_FDXB_CONFIG_BLOCK,
1381 T55X7_FDXB_CONFIG_BLOCK, T55X7_HID_26_CONFIG_BLOCK, T55X7_INDALA_64_CONFIG_BLOCK, T55X7_INDALA_224_CONFIG_BLOCK
1382 T55X7_GUARDPROXII_CONFIG_BLOCK, T55X7_VIKING_CONFIG_BLOCK, T55X7_NORALYS_CONFIG_BLOCK, T55X7_IOPROX_CONFIG_BLOCK
1384 static char buf
[60];
1388 case 0: snprintf(retStr
, sizeof(buf
),"%08X - T55X7 Default", T55X7_DEFAULT_CONFIG_BLOCK
); break;
1389 case 1: snprintf(retStr
, sizeof(buf
),"%08X - T55X7 Raw", T55X7_RAW_CONFIG_BLOCK
); break;
1390 case 2: snprintf(retStr
, sizeof(buf
),"%08X - T5555 Q5 Default", T5555_DEFAULT_CONFIG_BLOCK
); break;
1397 int CmdResetRead(const char *Cmd
) {
1398 UsbCommand c
= {CMD_T55XX_RESET_READ
, {0,0,0}};
1400 clearCommandBuffer();
1402 if ( !WaitForResponseTimeout(CMD_ACK
,NULL
,2500) ) {
1403 PrintAndLog("command execution time out");
1407 uint8_t got
[BIGBUF_SIZE
-1];
1408 GetFromBigBuf(got
,sizeof(got
),0);
1409 WaitForResponse(CMD_ACK
,NULL
);
1410 setGraphBuf(got
, sizeof(got
));
1413 // ADD T5555 (Q5) Default config block
1414 int CmdT55xxWipe(const char *Cmd
) {
1415 char writeData
[20] = {0};
1416 char *ptrData
= writeData
;
1417 char cmdp
= param_getchar(Cmd
, 0);
1418 if ( cmdp
== 'h' || cmdp
== 'H') return usage_t55xx_wipe();
1420 bool Q5
= (cmdp
== 'q' || cmdp
== 'Q');
1422 // Try with the default password to reset block 0
1423 // With a pwd should work even if pwd bit not set
1424 PrintAndLog("\nBeginning Wipe of a T55xx tag (assuming the tag is not password protected)\n");
1427 snprintf(ptrData
,sizeof(writeData
),"b 0 d 6001F004 p 0");
1429 snprintf(ptrData
,sizeof(writeData
),"b 0 d 000880E0 p 0");
1432 if (!CmdT55xxWriteBlock(ptrData
)) PrintAndLog("Error writing blk 0");
1434 for (uint8_t blk
= 1; blk
<8; blk
++) {
1436 snprintf(ptrData
,sizeof(writeData
),"b %d d 0", blk
);
1438 if (!CmdT55xxWriteBlock(ptrData
)) PrintAndLog("Error writing blk %d", blk
);
1440 memset(writeData
,0x00, sizeof(writeData
));
1445 int CmdT55xxBruteForce(const char *Cmd
) {
1447 // load a default pwd file.
1449 char filename
[FILE_PATH_SIZE
]={0};
1452 uint8_t stKeyBlock
= 20;
1453 uint8_t *keyBlock
= NULL
, *p
= NULL
;
1454 uint32_t start_password
= 0x00000000; //start password
1455 uint32_t end_password
= 0xFFFFFFFF; //end password
1458 char cmdp
= param_getchar(Cmd
, 0);
1459 if (cmdp
== 'h' || cmdp
== 'H') return usage_t55xx_bruteforce();
1461 keyBlock
= calloc(stKeyBlock
, 6);
1462 if (keyBlock
== NULL
) return 1;
1464 if (cmdp
== 'i' || cmdp
== 'I') {
1466 int len
= strlen(Cmd
+2);
1467 if (len
> FILE_PATH_SIZE
) len
= FILE_PATH_SIZE
;
1468 memcpy(filename
, Cmd
+2, len
);
1470 FILE * f
= fopen( filename
, "r");
1472 PrintAndLog("File: %s: not found or locked.", filename
);
1477 while( fgets(buf
, sizeof(buf
), f
) ){
1478 if (strlen(buf
) < 8 || buf
[7] == '\n') continue;
1480 while (fgetc(f
) != '\n' && !feof(f
)) ; //goto next line
1482 //The line start with # is comment, skip
1483 if( buf
[0]=='#' ) continue;
1485 if (!isxdigit(buf
[0])){
1486 PrintAndLog("File content error. '%s' must include 8 HEX symbols", buf
);
1492 if ( stKeyBlock
- keycnt
< 2) {
1493 p
= realloc(keyBlock
, 6*(stKeyBlock
+=10));
1495 PrintAndLog("Cannot allocate memory for defaultKeys");
1505 memset(keyBlock
+ 4 * keycnt
, 0, 4);
1506 num_to_bytes(strtoll(buf
, NULL
, 16), 4, keyBlock
+ 4*keycnt
);
1507 PrintAndLog("chk custom pwd[%2d] %08X", keycnt
, bytes_to_num(keyBlock
+ 4*keycnt
, 4));
1509 memset(buf
, 0, sizeof(buf
));
1516 PrintAndLog("No keys found in file");
1520 PrintAndLog("Loaded %d keys", keycnt
);
1523 uint64_t testpwd
= 0x00;
1524 for (uint16_t c
= 0; c
< keycnt
; ++c
) {
1527 printf("Device offline\n");
1535 printf("\naborted via keyboard!\n");
1540 testpwd
= bytes_to_num(keyBlock
+ 4*c
, 4);
1542 PrintAndLog("Testing %08X", testpwd
);
1544 if ( !AquireData(T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, TRUE
, testpwd
)) {
1545 PrintAndLog("Aquireing data from device failed. Quitting");
1550 found
= tryDetectModulation();
1552 PrintAndLog("Found valid password: [%08X]", testpwd
);
1557 PrintAndLog("Password NOT found.");
1562 // Try to read Block 7, first :)
1564 // incremental pwd range search
1565 start_password
= param_get32ex(Cmd
, 0, 0, 16);
1566 end_password
= param_get32ex(Cmd
, 1, 0, 16);
1568 if ( start_password
>= end_password
) {
1570 return usage_t55xx_bruteforce();
1573 PrintAndLog("Search password range [%08X -> %08X]", start_password
, end_password
);
1575 uint32_t i
= start_password
;
1577 while ((!found
) && (i
<= end_password
)){
1584 printf("\naborted via keyboard!\n");
1589 if (!AquireData(T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, TRUE
, i
)) {
1590 PrintAndLog("Aquireing data from device failed. Quitting");
1594 found
= tryDetectModulation();
1603 PrintAndLog("Found valid password: [%08x]", i
);
1605 PrintAndLog("Password NOT found. Last tried: [%08x]", --i
);
1611 int tryOnePassword(uint32_t password
) {
1612 PrintAndLog("Trying password %08x", password
);
1613 if (!AquireData(T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, TRUE
, password
)) {
1614 PrintAndLog("Aquireing data from device failed. Quitting");
1618 if (tryDetectModulation())
1624 int CmdT55xxRecoverPW(const char *Cmd
) {
1626 uint32_t orig_password
= 0x0;
1627 uint32_t curr_password
= 0x0;
1628 uint32_t prev_password
= 0xffffffff;
1629 uint32_t mask
= 0x0;
1632 char cmdp
= param_getchar(Cmd
, 0);
1633 if (cmdp
== 'h' || cmdp
== 'H') return usage_t55xx_recoverpw();
1635 orig_password
= param_get32ex(Cmd
, 0, 0x51243648, 16); //password used by handheld cloners
1637 // first try fliping each bit in the expected password
1638 while ((found
!= 1) && (bit
< 32)) {
1639 curr_password
= orig_password
^ ( 1 << bit
);
1640 found
= tryOnePassword(curr_password
);
1643 else if (found
== -1)
1648 // now try to use partial original password, since block 7 should have been completely
1649 // erased during the write sequence and it is possible that only partial password has been
1651 // not sure from which end the bit bits are written, so try from both ends
1652 // from low bit to high bit
1654 while ((found
!= 1) && (bit
< 32)) {
1655 mask
+= ( 1 << bit
);
1656 curr_password
= orig_password
& mask
;
1657 // if updated mask didn't change the password, don't try it again
1658 if (prev_password
== curr_password
) {
1662 found
= tryOnePassword(curr_password
);
1665 else if (found
== -1)
1668 prev_password
=curr_password
;
1671 // from high bit to low
1674 while ((found
!= 1) && (bit
< 32)) {
1675 mask
-= ( 1 << bit
);
1676 curr_password
= orig_password
& mask
;
1677 // if updated mask didn't change the password, don't try it again
1678 if (prev_password
== curr_password
) {
1682 found
= tryOnePassword(curr_password
);
1685 else if (found
== -1)
1688 prev_password
=curr_password
;
1694 PrintAndLog("Found valid password: [%08x]", curr_password
);
1696 PrintAndLog("Password NOT found.");
1701 static command_t CommandTable
[] = {
1702 {"help", CmdHelp
, 1, "This help"},
1703 {"bruteforce", CmdT55xxBruteForce
,0, "<start password> <end password> [i <*.dic>] Simple bruteforce attack to find password"},
1704 {"config", CmdT55xxSetConfig
, 1, "Set/Get T55XX configuration (modulation, inverted, offset, rate)"},
1705 {"detect", CmdT55xxDetect
, 1, "[1] Try detecting the tag modulation from reading the configuration block."},
1706 {"dump", CmdT55xxDump
, 0, "[password] [o] Dump T55xx card block 0-7. Optional [password], [override]"},
1707 {"info", CmdT55xxInfo
, 1, "[1] Show T55x7 configuration data (page 0/ blk 0)"},
1708 {"read", CmdT55xxReadBlock
, 0, "b <block> p [password] [o] [1] -- Read T55xx block data. Optional [p password], [override], [page1]"},
1709 {"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)"},
1710 {"recoverpw", CmdT55xxRecoverPW
, 0, "[password] Try to recover from bad password write from a cloner. Only use on PW protected chips!"},
1711 {"special", special
, 0, "Show block changes with 64 different offsets"},
1712 {"trace", CmdT55xxReadTrace
, 1, "[1] Show T55x7 traceability data (page 1/ blk 0-1)"},
1713 {"wakeup", CmdT55xxWakeUp
, 0, "Send AOR wakeup command"},
1714 {"wipe", CmdT55xxWipe
, 0, "[q] Wipe a T55xx tag and set defaults (will destroy any data on tag)"},
1715 {"write", CmdT55xxWriteBlock
,0, "b <block> d <data> p [password] [1] -- Write T55xx block data. Optional [p password], [page1]"},
1716 {NULL
, NULL
, 0, NULL
}
1719 int CmdLFT55XX(const char *Cmd
) {
1720 clearCommandBuffer();
1721 CmdsParse(CommandTable
, Cmd
);
1725 int CmdHelp(const char *Cmd
) {
1726 CmdsHelp(CommandTable
);