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 //-----------------------------------------------------------------------------
14 #include "proxmark3.h"
18 #include "cmdparser.h"
21 #include "cmdlft55xx.h"
25 #include "../common/crc.h"
26 #include "../common/iso14443crc.h"
29 #define T55x7_CONFIGURATION_BLOCK 0x00
30 #define T55x7_PAGE0 0x00
31 #define T55x7_PAGE1 0x01
32 #define T55x7_PWD 0x00000010
33 #define REGULAR_READ_MODE_BLOCK 0xFF
35 // Default configuration
36 t55xx_conf_block_t config
= { .modulation
= DEMOD_ASK
, .inverted
= FALSE
, .offset
= 0x00, .block0
= 0x00, .Q5
= FALSE
};
38 t55xx_conf_block_t
Get_t55xx_Config(){
41 void Set_t55xx_Config(t55xx_conf_block_t conf
){
45 int usage_t55xx_config(){
46 PrintAndLog("Usage: lf t55xx config [d <demodulation>] [i 1] [o <offset>] [Q5]");
47 PrintAndLog("Options:");
48 PrintAndLog(" h This help");
49 PrintAndLog(" b <8|16|32|40|50|64|100|128> Set bitrate");
50 PrintAndLog(" d <FSK|FSK1|FSK1a|FSK2|FSK2a|ASK|PSK1|PSK2|NRZ|BI|BIa> Set demodulation FSK / ASK / PSK / NRZ / Biphase / Biphase A");
51 PrintAndLog(" i [1] Invert data signal, defaults to normal");
52 PrintAndLog(" o [offset] Set offset, where data should start decode in bitstream");
53 PrintAndLog(" Q5 Set as Q5(T5555) chip instead of T55x7");
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 wr [b <block>] [d <data>] [p <password>] [1]");
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");
88 PrintAndLog("Examples:");
89 PrintAndLog(" lf t55xx write b 3 d 11223344 - write 11223344 to block 3");
90 PrintAndLog(" lf t55xx write b 3 d 11223344 p feedbeef - write 11223344 to block 3 password feedbeef");
94 int usage_t55xx_trace() {
95 PrintAndLog("Usage: lf t55xx trace [1]");
96 PrintAndLog("Options:");
97 PrintAndLog(" [graph buffer data] - if set, use Graphbuffer otherwise read data from tag.");
99 PrintAndLog("Examples:");
100 PrintAndLog(" lf t55xx trace");
101 PrintAndLog(" lf t55xx trace 1");
105 int usage_t55xx_info() {
106 PrintAndLog("Usage: lf t55xx info [1]");
107 PrintAndLog("Options:");
108 PrintAndLog(" [graph buffer data] - if set, use Graphbuffer otherwise read data from tag.");
110 PrintAndLog("Examples:");
111 PrintAndLog(" lf t55xx info");
112 PrintAndLog(" lf t55xx info 1");
116 int usage_t55xx_dump(){
117 PrintAndLog("Usage: lf t55xx dump <password> [o]");
118 PrintAndLog("Options:");
119 PrintAndLog(" <password> - OPTIONAL password 4bytes (8 hex symbols)");
120 PrintAndLog(" o - OPTIONAL override, force pwd read despite danger to card");
122 PrintAndLog("Examples:");
123 PrintAndLog(" lf t55xx dump");
124 PrintAndLog(" lf t55xx dump feedbeef o");
128 int usage_t55xx_detect(){
129 PrintAndLog("Usage: lf t55xx detect [1]");
130 PrintAndLog("Options:");
131 PrintAndLog(" [graph buffer data] - if set, use Graphbuffer otherwise read data from tag.");
133 PrintAndLog("Examples:");
134 PrintAndLog(" lf t55xx detect");
135 PrintAndLog(" lf t55xx detect 1");
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");
151 static int CmdHelp(const char *Cmd
);
153 void printT5xxHeader(uint8_t page
){
154 PrintAndLog("Reading Page %d:", page
);
155 PrintAndLog("blk | hex data | binary");
156 PrintAndLog("----+----------+---------------------------------");
159 int CmdT55xxSetConfig(const char *Cmd
) {
162 char modulation
[5] = {0x00};
165 uint8_t rates
[9] = {8,16,32,40,50,64,100,128,0};
169 while(param_getchar(Cmd
, cmdp
) != 0x00 && !errors
)
171 tmp
= param_getchar(Cmd
, cmdp
);
176 return usage_t55xx_config();
178 errors
|= param_getdec(Cmd
, cmdp
+1, &bitRate
);
182 if (rates
[i
]==bitRate
) {
187 if (i
==9) errors
= TRUE
;
192 param_getstr(Cmd
, cmdp
+1, modulation
);
195 if ( strcmp(modulation
, "FSK" ) == 0) {
196 config
.modulation
= DEMOD_FSK
;
197 } else if ( strcmp(modulation
, "FSK1" ) == 0) {
198 config
.modulation
= DEMOD_FSK1
;
200 } else if ( strcmp(modulation
, "FSK1a" ) == 0) {
201 config
.modulation
= DEMOD_FSK1a
;
203 } else if ( strcmp(modulation
, "FSK2" ) == 0) {
204 config
.modulation
= DEMOD_FSK2
;
206 } else if ( strcmp(modulation
, "FSK2a" ) == 0) {
207 config
.modulation
= DEMOD_FSK2a
;
209 } else if ( strcmp(modulation
, "ASK" ) == 0) {
210 config
.modulation
= DEMOD_ASK
;
211 } else if ( strcmp(modulation
, "NRZ" ) == 0) {
212 config
.modulation
= DEMOD_NRZ
;
213 } else if ( strcmp(modulation
, "PSK1" ) == 0) {
214 config
.modulation
= DEMOD_PSK1
;
215 } else if ( strcmp(modulation
, "PSK2" ) == 0) {
216 config
.modulation
= DEMOD_PSK2
;
217 } else if ( strcmp(modulation
, "PSK3" ) == 0) {
218 config
.modulation
= DEMOD_PSK3
;
219 } else if ( strcmp(modulation
, "BIa" ) == 0) {
220 config
.modulation
= DEMOD_BIa
;
222 } else if ( strcmp(modulation
, "BI" ) == 0) {
223 config
.modulation
= DEMOD_BI
;
226 PrintAndLog("Unknown modulation '%s'", modulation
);
231 config
.inverted
= param_getchar(Cmd
,cmdp
+1) == '1';
235 errors
|= param_getdec(Cmd
, cmdp
+1, &offset
);
237 config
.offset
= offset
;
246 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd
, cmdp
));
253 if (cmdp
== 0) return printConfiguration( config
);
256 if (errors
) return usage_t55xx_config();
259 return printConfiguration ( config
);
262 int T55xxReadBlock(uint8_t block
, bool page1
, bool usepwd
, bool override
, uint32_t password
){
265 // try reading the config block and verify that PWD bit is set before doing this!
268 if ( !AquireData(T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, false, 0 ) ) return 0;
270 if ( !tryDetectModulation() ) {
271 PrintAndLog("Safety Check: Could not detect if PWD bit is set in config block. Exits.");
274 PrintAndLog("Safety Check: PWD bit is NOT set in config block. Reading without password...");
279 PrintAndLog("Safety Check Overriden - proceeding despite risk");
283 if (!AquireData(page1
, block
, usepwd
, password
) ) return 0;
284 if (!DecodeT55xxBlock()) return 0;
287 sprintf(blk
,"%02d", block
);
288 printT55xxBlock(blk
);
292 int CmdT55xxReadBlock(const char *Cmd
) {
293 uint8_t block
= REGULAR_READ_MODE_BLOCK
;
294 uint32_t password
= 0; //default to blank Block 7
296 bool override
= false;
300 while(param_getchar(Cmd
, cmdp
) != 0x00 && !errors
) {
301 switch(param_getchar(Cmd
, cmdp
)) {
304 return usage_t55xx_read();
307 errors
|= param_getdec(Cmd
, cmdp
+1, &block
);
317 password
= param_get32ex(Cmd
, cmdp
+1, 0, 16);
326 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd
, cmdp
));
331 if (errors
) return usage_t55xx_read();
333 if (block
> 7 && block
!= REGULAR_READ_MODE_BLOCK
) {
334 PrintAndLog("Block must be between 0 and 7");
338 printT5xxHeader(page1
);
339 return T55xxReadBlock(block
, page1
, usepwd
, override
, password
);
342 bool DecodeT55xxBlock(){
344 char buf
[30] = {0x00};
347 uint8_t bitRate
[8] = {8,16,32,40,50,64,100,128};
348 DemodBufferLen
= 0x00;
350 switch( config
.modulation
){
352 snprintf(cmdStr
, sizeof(buf
),"%d %d", bitRate
[config
.bitrate
], config
.inverted
);
353 ans
= FSKrawDemod(cmdStr
, FALSE
);
357 snprintf(cmdStr
, sizeof(buf
),"%d %d 8 5", bitRate
[config
.bitrate
], config
.inverted
);
358 ans
= FSKrawDemod(cmdStr
, FALSE
);
362 snprintf(cmdStr
, sizeof(buf
),"%d %d 10 8", bitRate
[config
.bitrate
], config
.inverted
);
363 ans
= FSKrawDemod(cmdStr
, FALSE
);
366 snprintf(cmdStr
, sizeof(buf
),"%d %d 1", bitRate
[config
.bitrate
], config
.inverted
);
367 ans
= ASKDemod(cmdStr
, FALSE
, FALSE
, 1);
370 // skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)
372 snprintf(cmdStr
, sizeof(buf
),"%d %d 6", bitRate
[config
.bitrate
], config
.inverted
);
373 ans
= PSKDemod(cmdStr
, FALSE
);
375 case DEMOD_PSK2
: //inverted won't affect this
376 case DEMOD_PSK3
: //not fully implemented
377 // skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)
379 snprintf(cmdStr
, sizeof(buf
),"%d 0 6", bitRate
[config
.bitrate
] );
380 ans
= PSKDemod(cmdStr
, FALSE
);
381 psk1TOpsk2(DemodBuffer
, DemodBufferLen
);
384 snprintf(cmdStr
, sizeof(buf
),"%d %d 1", bitRate
[config
.bitrate
], config
.inverted
);
385 ans
= NRZrawDemod(cmdStr
, FALSE
);
389 snprintf(cmdStr
, sizeof(buf
),"0 %d %d 1", bitRate
[config
.bitrate
], config
.inverted
);
390 ans
= ASKbiphaseDemod(cmdStr
, FALSE
);
398 int CmdT55xxDetect(const char *Cmd
){
400 //bool override = false;
401 //bool pwdmode = false;
403 uint32_t password
= 0; //default to blank Block 7
404 bool usepwd
= ( strlen(Cmd
) > 0);
406 password
= param_get32ex(Cmd
, 0, 0, 16);
407 // if (param_getchar(Cmd, 1) =='o' )
411 char cmdp
= param_getchar(Cmd
, 0);
412 if (strlen(Cmd
) > 1 || cmdp
== 'h' || cmdp
== 'H') return usage_t55xx_detect();
414 if (strlen(Cmd
)==0) {
415 password
= param_get32ex(Cmd
, 0, 0, 16);
416 //if (param_getchar(Cmd, 1) =='o' ) override = true;
419 if ( !AquireData(T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, usepwd
, password
) )
422 if ( !tryDetectModulation() )
423 PrintAndLog("Could not detect modulation automatically. Try setting it manually with \'lf t55xx config\'");
428 // detect configuration?
429 bool tryDetectModulation(){
431 t55xx_conf_block_t tests
[15];
433 uint8_t fc1
= 0, fc2
= 0, clk
=0;
436 if (GetFskClock("", FALSE
, FALSE
)){
437 fskClocks(&fc1
, &fc2
, &clk
, FALSE
);
438 if ( FSKrawDemod("0 0", FALSE
) && test(DEMOD_FSK
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)){
439 tests
[hits
].modulation
= DEMOD_FSK
;
440 if (fc1
==8 && fc2
== 5)
441 tests
[hits
].modulation
= DEMOD_FSK1a
;
442 else if (fc1
==10 && fc2
== 8)
443 tests
[hits
].modulation
= DEMOD_FSK2
;
444 tests
[hits
].bitrate
= bitRate
;
445 tests
[hits
].inverted
= FALSE
;
446 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
449 if ( FSKrawDemod("0 1", FALSE
) && test(DEMOD_FSK
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)) {
450 tests
[hits
].modulation
= DEMOD_FSK
;
451 if (fc1
== 8 && fc2
== 5)
452 tests
[hits
].modulation
= DEMOD_FSK1
;
453 else if (fc1
== 10 && fc2
== 8)
454 tests
[hits
].modulation
= DEMOD_FSK2a
;
456 tests
[hits
].bitrate
= bitRate
;
457 tests
[hits
].inverted
= TRUE
;
458 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
462 clk
= GetAskClock("", FALSE
, FALSE
);
464 if ( ASKDemod("0 0 1", FALSE
, FALSE
, 1) && test(DEMOD_ASK
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)) {
465 tests
[hits
].modulation
= DEMOD_ASK
;
466 tests
[hits
].bitrate
= bitRate
;
467 tests
[hits
].inverted
= FALSE
;
468 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
471 if ( ASKDemod("0 1 1", FALSE
, FALSE
, 1) && test(DEMOD_ASK
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)) {
472 tests
[hits
].modulation
= DEMOD_ASK
;
473 tests
[hits
].bitrate
= bitRate
;
474 tests
[hits
].inverted
= TRUE
;
475 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
478 if ( ASKbiphaseDemod("0 0 0 2", FALSE
) && test(DEMOD_BI
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
) ) {
479 tests
[hits
].modulation
= DEMOD_BI
;
480 tests
[hits
].bitrate
= bitRate
;
481 tests
[hits
].inverted
= FALSE
;
482 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
485 if ( ASKbiphaseDemod("0 0 1 2", FALSE
) && test(DEMOD_BIa
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
) ) {
486 tests
[hits
].modulation
= DEMOD_BIa
;
487 tests
[hits
].bitrate
= bitRate
;
488 tests
[hits
].inverted
= TRUE
;
489 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
495 clk
= GetNrzClock("", FALSE
, FALSE
);
497 if ( NRZrawDemod("0 0 1", FALSE
) && test(DEMOD_NRZ
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)) {
498 tests
[hits
].modulation
= DEMOD_NRZ
;
499 tests
[hits
].bitrate
= bitRate
;
500 tests
[hits
].inverted
= FALSE
;
501 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
505 if ( NRZrawDemod("0 1 1", FALSE
) && test(DEMOD_NRZ
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)) {
506 tests
[hits
].modulation
= DEMOD_NRZ
;
507 tests
[hits
].bitrate
= bitRate
;
508 tests
[hits
].inverted
= TRUE
;
509 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
516 // skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)
518 clk
= GetPskClock("", FALSE
, FALSE
);
520 if ( PSKDemod("0 0 6", FALSE
) && test(DEMOD_PSK1
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)) {
521 tests
[hits
].modulation
= DEMOD_PSK1
;
522 tests
[hits
].bitrate
= bitRate
;
523 tests
[hits
].inverted
= FALSE
;
524 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
527 if ( PSKDemod("0 1 6", FALSE
) && test(DEMOD_PSK1
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)) {
528 tests
[hits
].modulation
= DEMOD_PSK1
;
529 tests
[hits
].bitrate
= bitRate
;
530 tests
[hits
].inverted
= TRUE
;
531 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
534 // PSK2 - needs a call to psk1TOpsk2.
535 if ( PSKDemod("0 0 6", FALSE
)) {
536 psk1TOpsk2(DemodBuffer
, DemodBufferLen
);
537 if (test(DEMOD_PSK2
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)){
538 tests
[hits
].modulation
= DEMOD_PSK2
;
539 tests
[hits
].bitrate
= bitRate
;
540 tests
[hits
].inverted
= FALSE
;
541 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
544 } // inverse waves does not affect this demod
545 // PSK3 - needs a call to psk1TOpsk2.
546 if ( PSKDemod("0 0 6", FALSE
)) {
547 psk1TOpsk2(DemodBuffer
, DemodBufferLen
);
548 if (test(DEMOD_PSK3
, &tests
[hits
].offset
, &bitRate
, clk
, &tests
[hits
].Q5
)){
549 tests
[hits
].modulation
= DEMOD_PSK3
;
550 tests
[hits
].bitrate
= bitRate
;
551 tests
[hits
].inverted
= FALSE
;
552 tests
[hits
].block0
= PackBits(tests
[hits
].offset
, 32, DemodBuffer
);
555 } // inverse waves does not affect this demod
560 config
.modulation
= tests
[0].modulation
;
561 config
.bitrate
= tests
[0].bitrate
;
562 config
.inverted
= tests
[0].inverted
;
563 config
.offset
= tests
[0].offset
;
564 config
.block0
= tests
[0].block0
;
565 printConfiguration( config
);
570 PrintAndLog("Found [%d] possible matches for modulation.",hits
);
571 for(int i
=0; i
<hits
; ++i
){
572 PrintAndLog("--[%d]---------------", i
+1);
573 printConfiguration( tests
[i
] );
579 bool testModulation(uint8_t mode
, uint8_t modread
){
582 if (modread
>= DEMOD_FSK1
&& modread
<= DEMOD_FSK2a
) return TRUE
;
585 if (modread
== DEMOD_ASK
) return TRUE
;
588 if (modread
== DEMOD_PSK1
) return TRUE
;
591 if (modread
== DEMOD_PSK2
) return TRUE
;
594 if (modread
== DEMOD_PSK3
) return TRUE
;
597 if (modread
== DEMOD_NRZ
) return TRUE
;
600 if (modread
== DEMOD_BI
) return TRUE
;
603 if (modread
== DEMOD_BIa
) return TRUE
;
611 bool testQ5Modulation(uint8_t mode
, uint8_t modread
){
614 if (modread
>= 4 && modread
<= 5) return TRUE
;
617 if (modread
== 0) return TRUE
;
620 if (modread
== 1) return TRUE
;
623 if (modread
== 2) return TRUE
;
626 if (modread
== 3) return TRUE
;
629 if (modread
== 7) return TRUE
;
632 if (modread
== 6) return TRUE
;
640 bool testQ5(uint8_t mode
, uint8_t *offset
, int *fndBitRate
, uint8_t clk
){
642 if ( DemodBufferLen
< 64 ) return FALSE
;
644 for (uint8_t idx
= 28; idx
< 64; idx
++){
646 if ( PackBits(si
, 28, DemodBuffer
) == 0x00 ) continue;
648 uint8_t safer
= PackBits(si
, 4, DemodBuffer
); si
+= 4; //master key
649 uint8_t resv
= PackBits(si
, 8, DemodBuffer
); si
+= 8;
650 // 2nibble must be zeroed.
651 if (safer
!= 0x6) continue;
652 if ( resv
> 0x00) continue;
653 //uint8_t pageSel = PackBits(si, 1, DemodBuffer); si += 1;
654 //uint8_t fastWrite = PackBits(si, 1, DemodBuffer); si += 1;
656 int bitRate
= PackBits(si
, 5, DemodBuffer
)*2 + 2; si
+= 5; //bit rate
657 if (bitRate
> 128 || bitRate
< 8) continue;
659 //uint8_t AOR = PackBits(si, 1, DemodBuffer); si += 1;
660 //uint8_t PWD = PackBits(si, 1, DemodBuffer); si += 1;
661 //uint8_t pskcr = PackBits(si, 2, DemodBuffer); si += 2; //could check psk cr
662 //uint8_t inverse = PackBits(si, 1, DemodBuffer); si += 1;
664 uint8_t modread
= PackBits(si
, 3, DemodBuffer
); si
+= 3;
665 uint8_t maxBlk
= PackBits(si
, 3, DemodBuffer
); si
+= 3;
666 //uint8_t ST = PackBits(si, 1, DemodBuffer); si += 1;
667 if (maxBlk
== 0) continue;
669 if (!testQ5Modulation(mode
, modread
)) continue;
670 if (bitRate
!= clk
) continue;
671 *fndBitRate
= bitRate
;
679 bool testBitRate(uint8_t readRate
, uint8_t clk
){
680 uint8_t expected
[] = {8, 16, 32, 40, 50, 64, 100, 128};
681 if (expected
[readRate
] == clk
)
687 bool test(uint8_t mode
, uint8_t *offset
, int *fndBitRate
, uint8_t clk
, bool *Q5
){
689 if ( DemodBufferLen
< 64 ) return FALSE
;
691 for (uint8_t idx
= 28; idx
< 64; idx
++){
693 if ( PackBits(si
, 28, DemodBuffer
) == 0x00 ) continue;
695 uint8_t safer
= PackBits(si
, 4, DemodBuffer
); si
+= 4; //master key
696 uint8_t resv
= PackBits(si
, 4, DemodBuffer
); si
+= 4; //was 7 & +=7+3 //should be only 4 bits if extended mode
697 // 2nibble must be zeroed.
698 // moved test to here, since this gets most faults first.
699 if ( resv
> 0x00) continue;
701 uint8_t xtRate
= PackBits(si
, 3, DemodBuffer
); si
+= 3; //extended mode part of rate
702 int bitRate
= PackBits(si
, 3, DemodBuffer
); si
+= 3; //bit rate
703 if (bitRate
> 7) continue;
704 uint8_t extend
= PackBits(si
, 1, DemodBuffer
); si
+= 1; //bit 15 extended mode
705 uint8_t modread
= PackBits(si
, 5, DemodBuffer
); si
+= 5+2+1;
706 //uint8_t pskcr = PackBits(si, 2, DemodBuffer); si += 2+1; //could check psk cr
707 uint8_t nml01
= PackBits(si
, 1, DemodBuffer
); si
+= 1+5; //bit 24, 30, 31 could be tested for 0 if not extended mode
708 uint8_t nml02
= PackBits(si
, 2, DemodBuffer
); si
+= 2;
711 bool extMode
=( (safer
== 0x6 || safer
== 0x9) && extend
) ? TRUE
: FALSE
;
714 if (nml01
|| nml02
|| xtRate
) continue;
717 if (!testModulation(mode
, modread
)) continue;
718 if (!testBitRate(bitRate
, clk
)) continue;
719 *fndBitRate
= bitRate
;
724 if (testQ5(mode
, offset
, fndBitRate
, clk
)) {
731 void printT55xxBlock(const char *blockNum
){
733 uint8_t i
= config
.offset
;
734 uint8_t endpos
= 32 + i
;
735 uint32_t blockData
= 0;
736 uint8_t bits
[64] = {0x00};
738 if ( !DemodBufferLen
) return;
740 if ( endpos
> DemodBufferLen
){
741 PrintAndLog("The configured offset %d is too big. Possible offset: %d)", i
, DemodBufferLen
-32);
745 for (; i
< endpos
; ++i
)
746 bits
[i
- config
.offset
] = DemodBuffer
[i
];
748 blockData
= PackBits(0, 32, bits
);
750 PrintAndLog(" %s | %08X | %s", blockNum
, blockData
, sprint_bin(bits
,32));
753 int special(const char *Cmd
) {
754 uint32_t blockData
= 0;
755 uint8_t bits
[32] = {0x00};
757 PrintAndLog("OFFSET | DATA | BINARY");
758 PrintAndLog("----------------------------------------------------");
762 for (i
= 0; i
< 32; ++i
)
763 bits
[i
]=DemodBuffer
[j
+i
];
765 blockData
= PackBits(0, 32, bits
);
767 PrintAndLog("%02d | 0x%08X | %s",j
, blockData
, sprint_bin(bits
,32));
772 int printConfiguration( t55xx_conf_block_t b
){
773 PrintAndLog("Chip Type : %s", (b
.Q5
) ? "T5555(Q5)" : "T55x7");
774 PrintAndLog("Modulation : %s", GetSelectedModulationStr(b
.modulation
) );
775 PrintAndLog("Bit Rate : %s", GetBitRateStr(b
.bitrate
) );
776 PrintAndLog("Inverted : %s", (b
.inverted
) ? "Yes" : "No" );
777 PrintAndLog("Offset : %d", b
.offset
);
778 PrintAndLog("Block0 : 0x%08X", b
.block0
);
783 int CmdT55xxWakeUp(const char *Cmd
) {
784 uint32_t password
= 0;
787 while(param_getchar(Cmd
, cmdp
) != 0x00 && !errors
) {
788 switch(param_getchar(Cmd
, cmdp
)) {
791 return usage_t55xx_wakup();
794 password
= param_get32ex(Cmd
, cmdp
+1, 0, 16);
799 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd
, cmdp
));
804 if (errors
) return usage_t55xx_wakup();
806 UsbCommand c
= {CMD_T55XX_WAKEUP
, {password
, 0, 0}};
807 clearCommandBuffer();
809 PrintAndLog("Wake up command sent. Try read now");
813 int CmdT55xxWriteBlock(const char *Cmd
) {
814 uint8_t block
= 0xFF; //default to invalid block
815 uint32_t data
= 0; //default to blank Block
816 uint32_t password
= 0; //default to blank Block 7
819 bool gotdata
= false;
822 while(param_getchar(Cmd
, cmdp
) != 0x00 && !errors
) {
823 switch(param_getchar(Cmd
, cmdp
)) {
826 return usage_t55xx_write();
829 errors
|= param_getdec(Cmd
, cmdp
+1, &block
);
834 data
= param_get32ex(Cmd
, cmdp
+1, 0, 16);
840 password
= param_get32ex(Cmd
, cmdp
+1, 0, 16);
849 PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd
, cmdp
));
854 if (errors
|| !gotdata
) return usage_t55xx_write();
857 PrintAndLog("Block number must be between 0 and 7");
861 UsbCommand c
= {CMD_T55XX_WRITE_BLOCK
, {data
, block
, 0}};
863 c
.d
.asBytes
[0] = (page1
) ? 0x2 : 0;
865 char pwdStr
[16] = {0};
866 snprintf(pwdStr
, sizeof(pwdStr
), "pwd: 0x%08X", password
);
868 PrintAndLog("Writing page %d block: %02d data: 0x%08X %s", page1
, block
, data
, (usepwd
) ? pwdStr
: "" );
873 c
.d
.asBytes
[0] |= 0x1;
875 clearCommandBuffer();
877 if (!WaitForResponseTimeout(CMD_ACK
, &resp
, 1000)){
878 PrintAndLog("Error occurred, device did not ACK write operation. (May be due to old firmware)");
884 int CmdT55xxReadTrace(const char *Cmd
) {
885 char cmdp
= param_getchar(Cmd
, 0);
886 bool pwdmode
= false;
887 uint32_t password
= 0;
888 if (strlen(Cmd
) > 1 || cmdp
== 'h' || cmdp
== 'H') return usage_t55xx_trace();
891 if ( !AquireData( T55x7_PAGE1
, REGULAR_READ_MODE_BLOCK
, pwdmode
, password
) )
894 if (!DecodeT55xxBlock()) return 0;
896 if ( !DemodBufferLen
) return 0;
898 RepaintGraphWindow();
900 if (config
.offset
> 5)
902 uint8_t si
= config
.offset
+repeat
;
903 uint32_t bl1
= PackBits(si
, 32, DemodBuffer
);
904 uint32_t bl2
= PackBits(si
+32, 32, DemodBuffer
);
906 uint32_t acl
= PackBits(si
, 8, DemodBuffer
); si
+= 8;
907 uint32_t mfc
= PackBits(si
, 8, DemodBuffer
); si
+= 8;
908 uint32_t cid
= PackBits(si
, 5, DemodBuffer
); si
+= 5;
909 uint32_t icr
= PackBits(si
, 3, DemodBuffer
); si
+= 3;
910 uint32_t year
= PackBits(si
, 4, DemodBuffer
); si
+= 4;
911 uint32_t quarter
= PackBits(si
, 2, DemodBuffer
); si
+= 2;
912 uint32_t lotid
= PackBits(si
, 14, DemodBuffer
); si
+= 14;
913 uint32_t wafer
= PackBits(si
, 5, DemodBuffer
); si
+= 5;
914 uint32_t dw
= PackBits(si
, 15, DemodBuffer
);
916 time_t t
= time(NULL
);
917 struct tm tm
= *localtime(&t
);
918 if ( year
> tm
.tm_year
-110)
923 if (config
.Q5
) PrintAndLog("*** Warning *** Info read off a Q5 will not work as expected");
925 PrintAndLog("The modulation is most likely wrong since the ACL is not 0xE0. ");
929 PrintAndLog("-- T55xx Trace Information ----------------------------------");
930 PrintAndLog("-------------------------------------------------------------");
931 PrintAndLog(" ACL Allocation class (ISO/IEC 15963-1) : 0x%02X (%d)", acl
, acl
);
932 PrintAndLog(" MFC Manufacturer ID (ISO/IEC 7816-6) : 0x%02X (%d) - %s", mfc
, mfc
, getTagInfo(mfc
));
933 PrintAndLog(" CID : 0x%02X (%d) - %s", cid
, cid
, GetModelStrFromCID(cid
));
934 PrintAndLog(" ICR IC Revision : %d",icr
);
935 PrintAndLog(" Manufactured");
936 PrintAndLog(" Year/Quarter : %d/%d",year
, quarter
);
937 PrintAndLog(" Lot ID : %d", lotid
);
938 PrintAndLog(" Wafer number : %d", wafer
);
939 PrintAndLog(" Die Number : %d", dw
);
940 PrintAndLog("-------------------------------------------------------------");
941 PrintAndLog(" Raw Data - Page 1");
942 PrintAndLog(" Block 1 : 0x%08X %s", bl1
, sprint_bin(DemodBuffer
+config
.offset
+repeat
,32) );
943 PrintAndLog(" Block 2 : 0x%08X %s", bl2
, sprint_bin(DemodBuffer
+config
.offset
+repeat
+32,32) );
944 PrintAndLog("-------------------------------------------------------------");
949 1-8 ACL Allocation class (ISO/IEC 15963-1) 0xE0
950 9-16 MFC Manufacturer ID (ISO/IEC 7816-6) 0x15 Atmel Corporation
951 17-21 CID 0x1 = Atmel ATA5577M1 0x2 = Atmel ATA5577M2
952 22-24 ICR IC revision
953 25-28 YEAR (BCD encoded) 9 (= 2009)
954 29-30 QUARTER 1,2,3,4
960 18-32 DW, die number sequential
966 int CmdT55xxInfo(const char *Cmd
){
968 Page 0 Block 0 Configuration data.
972 bool pwdmode
= false;
973 uint32_t password
= 0;
974 char cmdp
= param_getchar(Cmd
, 0);
976 if (strlen(Cmd
) > 1 || cmdp
== 'h' || cmdp
== 'H') return usage_t55xx_info();
979 if ( !AquireData( T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, pwdmode
, password
) )
982 if (!DecodeT55xxBlock()) return 1;
984 if ( DemodBufferLen
< 32) return 1;
986 uint8_t si
= config
.offset
;
987 uint32_t bl0
= PackBits(si
, 32, DemodBuffer
);
989 uint32_t safer
= PackBits(si
, 4, DemodBuffer
); si
+= 4;
990 uint32_t resv
= PackBits(si
, 7, DemodBuffer
); si
+= 7;
991 uint32_t dbr
= PackBits(si
, 3, DemodBuffer
); si
+= 3;
992 uint32_t extend
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
993 uint32_t datamod
= PackBits(si
, 5, DemodBuffer
); si
+= 5;
994 uint32_t pskcf
= PackBits(si
, 2, DemodBuffer
); si
+= 2;
995 uint32_t aor
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
996 uint32_t otp
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
997 uint32_t maxblk
= PackBits(si
, 3, DemodBuffer
); si
+= 3;
998 uint32_t pwd
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
999 uint32_t sst
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1000 uint32_t fw
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1001 uint32_t inv
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1002 uint32_t por
= PackBits(si
, 1, DemodBuffer
); si
+= 1;
1003 if (config
.Q5
) PrintAndLog("*** Warning *** Config Info read off a Q5 will not display as expected");
1005 PrintAndLog("-- T55xx Configuration & Tag Information --------------------");
1006 PrintAndLog("-------------------------------------------------------------");
1007 PrintAndLog(" Safer key : %s", GetSaferStr(safer
));
1008 PrintAndLog(" reserved : %d", resv
);
1009 PrintAndLog(" Data bit rate : %s", GetBitRateStr(dbr
));
1010 PrintAndLog(" eXtended mode : %s", (extend
) ? "Yes - Warning":"No");
1011 PrintAndLog(" Modulation : %s", GetModulationStr(datamod
));
1012 PrintAndLog(" PSK clock frequency : %d", pskcf
);
1013 PrintAndLog(" AOR - Answer on Request : %s", (aor
) ? "Yes":"No");
1014 PrintAndLog(" OTP - One Time Pad : %s", (otp
) ? "Yes - Warning":"No" );
1015 PrintAndLog(" Max block : %d", maxblk
);
1016 PrintAndLog(" Password mode : %s", (pwd
) ? "Yes":"No");
1017 PrintAndLog(" Sequence Start Terminator : %s", (sst
) ? "Yes":"No");
1018 PrintAndLog(" Fast Write : %s", (fw
) ? "Yes":"No");
1019 PrintAndLog(" Inverse data : %s", (inv
) ? "Yes":"No");
1020 PrintAndLog(" POR-Delay : %s", (por
) ? "Yes":"No");
1021 PrintAndLog("-------------------------------------------------------------");
1022 PrintAndLog(" Raw Data - Page 0");
1023 PrintAndLog(" Block 0 : 0x%08X %s", bl0
, sprint_bin(DemodBuffer
+config
.offset
,32) );
1024 PrintAndLog("-------------------------------------------------------------");
1029 int CmdT55xxDump(const char *Cmd
){
1031 uint32_t password
= 0;
1032 bool override
= false;
1033 char cmdp
= param_getchar(Cmd
, 0);
1034 if ( cmdp
== 'h' || cmdp
== 'H') return usage_t55xx_dump();
1036 bool usepwd
= ( strlen(Cmd
) > 0);
1038 password
= param_get32ex(Cmd
, 0, 0, 16);
1039 if (param_getchar(Cmd
, 1) =='o' )
1044 for ( uint8_t i
= 0; i
< 8; ++i
)
1045 T55xxReadBlock(i
, 0, usepwd
, override
, password
);
1048 for ( uint8_t i
= 0; i
< 4; i
++)
1049 T55xxReadBlock(i
, 1, usepwd
, override
, password
);
1054 int AquireData( uint8_t page
, uint8_t block
, bool pwdmode
, uint32_t password
){
1057 // bit1 = page to read from
1058 uint8_t arg0
= (page
<<1) | pwdmode
;
1059 UsbCommand c
= {CMD_T55XX_READ_BLOCK
, {arg0
, block
, password
}};
1061 clearCommandBuffer();
1063 if ( !WaitForResponseTimeout(CMD_ACK
,NULL
,2500) ) {
1064 PrintAndLog("command execution time out");
1069 GetFromBigBuf(got
,sizeof(got
),0);
1070 WaitForResponse(CMD_ACK
,NULL
);
1071 setGraphBuf(got
, sizeof(got
));
1075 char * GetBitRateStr(uint32_t id
){
1076 static char buf
[25];
1081 snprintf(retStr
,sizeof(buf
),"%d - RF/8",id
);
1084 snprintf(retStr
,sizeof(buf
),"%d - RF/16",id
);
1087 snprintf(retStr
,sizeof(buf
),"%d - RF/32",id
);
1090 snprintf(retStr
,sizeof(buf
),"%d - RF/40",id
);
1093 snprintf(retStr
,sizeof(buf
),"%d - RF/50",id
);
1096 snprintf(retStr
,sizeof(buf
),"%d - RF/64",id
);
1099 snprintf(retStr
,sizeof(buf
),"%d - RF/100",id
);
1102 snprintf(retStr
,sizeof(buf
),"%d - RF/128",id
);
1105 snprintf(retStr
,sizeof(buf
),"%d - (Unknown)",id
);
1112 char * GetSaferStr(uint32_t id
){
1113 static char buf
[40];
1116 snprintf(retStr
,sizeof(buf
),"%d",id
);
1118 snprintf(retStr
,sizeof(buf
),"%d - passwd",id
);
1121 snprintf(retStr
,sizeof(buf
),"%d - testmode",id
);
1127 char * GetModulationStr( uint32_t id
){
1128 static char buf
[60];
1133 snprintf(retStr
,sizeof(buf
),"%d - DIRECT (ASK/NRZ)",id
);
1136 snprintf(retStr
,sizeof(buf
),"%d - PSK 1 phase change when input changes",id
);
1139 snprintf(retStr
,sizeof(buf
),"%d - PSK 2 phase change on bitclk if input high",id
);
1142 snprintf(retStr
,sizeof(buf
),"%d - PSK 3 phase change on rising edge of input",id
);
1145 snprintf(retStr
,sizeof(buf
),"%d - FSK 1 RF/8 RF/5",id
);
1148 snprintf(retStr
,sizeof(buf
),"%d - FSK 2 RF/8 RF/10",id
);
1151 snprintf(retStr
,sizeof(buf
),"%d - FSK 1a RF/5 RF/8",id
);
1154 snprintf(retStr
,sizeof(buf
),"%d - FSK 2a RF/10 RF/8",id
);
1157 snprintf(retStr
,sizeof(buf
),"%d - Manchester",id
);
1160 snprintf(retStr
,sizeof(buf
),"%d - Biphase",id
);
1163 snprintf(retStr
,sizeof(buf
),"%d - Biphase a - AKA Conditional Dephase Encoding(CDP)",id
);
1166 snprintf(retStr
,sizeof(buf
),"%d - Reserved",id
);
1169 snprintf(retStr
,sizeof(buf
),"0x%02X (Unknown)",id
);
1175 char * GetModelStrFromCID(uint32_t cid
){
1177 static char buf
[10];
1180 if (cid
== 1) snprintf(retStr
, sizeof(buf
),"ATA5577M1");
1181 if (cid
== 2) snprintf(retStr
, sizeof(buf
),"ATA5577M2");
1185 char * GetSelectedModulationStr( uint8_t id
){
1187 static char buf
[20];
1192 snprintf(retStr
,sizeof(buf
),"FSK");
1195 snprintf(retStr
,sizeof(buf
),"FSK1");
1198 snprintf(retStr
,sizeof(buf
),"FSK1a");
1201 snprintf(retStr
,sizeof(buf
),"FSK2");
1204 snprintf(retStr
,sizeof(buf
),"FSK2a");
1207 snprintf(retStr
,sizeof(buf
),"ASK");
1210 snprintf(retStr
,sizeof(buf
),"DIRECT/NRZ");
1213 snprintf(retStr
,sizeof(buf
),"PSK1");
1216 snprintf(retStr
,sizeof(buf
),"PSK2");
1219 snprintf(retStr
,sizeof(buf
),"PSK3");
1222 snprintf(retStr
,sizeof(buf
),"BIPHASE");
1225 snprintf(retStr
,sizeof(buf
),"BIPHASEa - (CDP)");
1228 snprintf(retStr
,sizeof(buf
),"(Unknown)");
1234 void t55x7_create_config_block( int tagtype
){
1237 T55X7_DEFAULT_CONFIG_BLOCK, T55X7_RAW_CONFIG_BLOCK
1238 T55X7_EM_UNIQUE_CONFIG_BLOCK, T55X7_FDXB_CONFIG_BLOCK,
1239 T55X7_FDXB_CONFIG_BLOCK, T55X7_HID_26_CONFIG_BLOCK, T55X7_INDALA_64_CONFIG_BLOCK, T55X7_INDALA_224_CONFIG_BLOCK
1240 T55X7_GUARDPROXII_CONFIG_BLOCK, T55X7_VIKING_CONFIG_BLOCK, T55X7_NORALYS_CONFIG_BLOCK, T55X7_IOPROX_CONFIG_BLOCK
1242 static char buf
[60];
1246 case 0: snprintf(retStr
, sizeof(buf
),"%08X - T55X7 Default", T55X7_DEFAULT_CONFIG_BLOCK
); break;
1247 case 1: snprintf(retStr
, sizeof(buf
),"%08X - T55X7 Raw", T55X7_RAW_CONFIG_BLOCK
); break;
1254 int CmdResetRead(const char *Cmd
) {
1255 UsbCommand c
= {CMD_T55XX_RESET_READ
, {0,0,0}};
1257 clearCommandBuffer();
1259 if ( !WaitForResponseTimeout(CMD_ACK
,NULL
,2500) ) {
1260 PrintAndLog("command execution time out");
1264 uint8_t got
[BIGBUF_SIZE
-1];
1265 GetFromBigBuf(got
,sizeof(got
),0);
1266 WaitForResponse(CMD_ACK
,NULL
);
1267 setGraphBuf(got
, sizeof(got
));
1271 int CmdT55xxWipe(const char *Cmd
) {
1272 char writeData
[20] = {0};
1273 char *ptrData
= writeData
;
1275 PrintAndLog("\nBeginning Wipe of a T55xx tag (assuming the tag is not password protected)\n");
1277 //try with the default password to reset block 0 (with a pwd should work even if pwd bit not set)
1278 snprintf(ptrData
,sizeof(writeData
),"b 0 d 000880E0 p 0");
1280 if (!CmdT55xxWriteBlock(ptrData
))
1281 PrintAndLog("Error writing blk 0");
1283 for (uint8_t blk
= 1; blk
<8; blk
++) {
1285 snprintf(ptrData
,sizeof(writeData
),"b %d d 0", blk
);
1287 if (!CmdT55xxWriteBlock(ptrData
))
1288 PrintAndLog("Error writing blk %d", blk
);
1290 memset(writeData
, sizeof(writeData
), 0x00);
1295 static command_t CommandTable
[] =
1297 {"help", CmdHelp
, 1, "This help"},
1298 {"config", CmdT55xxSetConfig
, 1, "Set/Get T55XX configuration (modulation, inverted, offset, rate)"},
1299 {"detect", CmdT55xxDetect
, 0, "[1] Try detecting the tag modulation from reading the configuration block."},
1300 {"read", CmdT55xxReadBlock
, 0, "b <block> p [password] [o] [1] -- Read T55xx block data. Optional [p password], [override], [page1]"},
1301 {"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)"},
1302 {"write", CmdT55xxWriteBlock
,0, "b <block> d <data> p [password] [1] -- Write T55xx block data. Optional [p password], [page1]"},
1303 {"trace", CmdT55xxReadTrace
, 0, "[1] Show T55x7 traceability data (page 1/ blk 0-1)"},
1304 {"info", CmdT55xxInfo
, 0, "[1] Show T55x7 configuration data (page 0/ blk 0)"},
1305 {"dump", CmdT55xxDump
, 0, "[password] [o] Dump T55xx card block 0-7. Optional [password], [override]"},
1306 {"special", special
, 0, "Show block changes with 64 different offsets"},
1307 {"wakeup", CmdT55xxWakeUp
, 0, "Send AOR wakeup command"},
1308 {"wipe", CmdT55xxWipe
, 0, "Wipe a T55xx tag and set defaults (will destroy any data on tag)"},
1309 {NULL
, NULL
, 0, NULL
}
1312 int CmdLFT55XX(const char *Cmd
)
1314 CmdsParse(CommandTable
, Cmd
);
1318 int CmdHelp(const char *Cmd
)
1320 CmdsHelp(CommandTable
);