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" 
  26 #include "cmdhf14a.h" //for getTagInfo 
  27 #include "protocols.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"); 
  54         PrintAndLog("       ST                            Set Sequence Terminator on"); 
  56         PrintAndLog("Examples:"); 
  57         PrintAndLog("      lf t55xx config d FSK          - FSK demodulation"); 
  58         PrintAndLog("      lf t55xx config d FSK i 1      - FSK demodulation, inverse data"); 
  59         PrintAndLog("      lf t55xx config d FSK i 1 o 3  - FSK demodulation, inverse data, offset=3,start from position 3 to decode data"); 
  63 int usage_t55xx_read(){ 
  64         PrintAndLog("Usage:  lf t55xx read [b <block>] [p <password>] <override_safety> <page1>"); 
  65         PrintAndLog("Options:"); 
  66         PrintAndLog("     b <block>    - block number to read. Between 0-7"); 
  67         PrintAndLog("     p <password> - OPTIONAL password (8 hex characters)"); 
  68         PrintAndLog("     o            - OPTIONAL override safety check"); 
  69         PrintAndLog("     1            - OPTIONAL read Page 1 instead of Page 0"); 
  70         PrintAndLog("     ****WARNING****"); 
  71         PrintAndLog("     Use of read with password on a tag not configured for a pwd"); 
  72         PrintAndLog("     can damage the tag"); 
  74         PrintAndLog("Examples:"); 
  75         PrintAndLog("      lf t55xx read b 0              - read data from block 0"); 
  76         PrintAndLog("      lf t55xx read b 0 p feedbeef   - read data from block 0 password feedbeef"); 
  77         PrintAndLog("      lf t55xx read b 0 p feedbeef o - read data from block 0 password feedbeef safety check"); 
  81 int usage_t55xx_write(){ 
  82         PrintAndLog("Usage:  lf t55xx write [b <block>] [d <data>] [p <password>] [1] [t]"); 
  83         PrintAndLog("Options:"); 
  84         PrintAndLog("     b <block>    - block number to write. Between 0-7"); 
  85         PrintAndLog("     d <data>     - 4 bytes of data to write (8 hex characters)"); 
  86         PrintAndLog("     p <password> - OPTIONAL password 4bytes (8 hex characters)"); 
  87         PrintAndLog("     1            - OPTIONAL write Page 1 instead of Page 0"); 
  88         PrintAndLog("     t            - OPTIONAL test mode write - ****DANGER****");    
  90         PrintAndLog("Examples:"); 
  91         PrintAndLog("      lf t55xx write b 3 d 11223344            - write 11223344 to block 3"); 
  92         PrintAndLog("      lf t55xx write b 3 d 11223344 p feedbeef - write 11223344 to block 3 password feedbeef"); 
  96 int usage_t55xx_trace() { 
  97         PrintAndLog("Usage:  lf t55xx trace [1]"); 
  98         PrintAndLog("Options:"); 
  99         PrintAndLog("     [graph buffer data]  - if set, use Graphbuffer otherwise read data from tag."); 
 101         PrintAndLog("Examples:"); 
 102         PrintAndLog("      lf t55xx trace"); 
 103         PrintAndLog("      lf t55xx trace 1"); 
 107 int usage_t55xx_info() { 
 108         PrintAndLog("Usage:  lf t55xx info [1]"); 
 109         PrintAndLog("Options:"); 
 110         PrintAndLog("     [graph buffer data]  - if set, use Graphbuffer otherwise read data from tag."); 
 112         PrintAndLog("Examples:"); 
 113         PrintAndLog("      lf t55xx info"); 
 114         PrintAndLog("      lf t55xx info 1"); 
 118 int usage_t55xx_dump(){ 
 119         PrintAndLog("Usage:  lf t55xx dump <password> [o]"); 
 120         PrintAndLog("Options:"); 
 121         PrintAndLog("     <password>  - OPTIONAL password 4bytes (8 hex symbols)"); 
 122         PrintAndLog("     o           - OPTIONAL override, force pwd read despite danger to card"); 
 124         PrintAndLog("Examples:"); 
 125         PrintAndLog("      lf t55xx dump"); 
 126         PrintAndLog("      lf t55xx dump feedbeef o"); 
 130 int usage_t55xx_detect(){ 
 131         PrintAndLog("Usage:  lf t55xx detect [1] [p <password>]"); 
 132         PrintAndLog("Options:"); 
 133         PrintAndLog("     1             - if set, use Graphbuffer otherwise read data from tag."); 
 134         PrintAndLog("     p <password>  - OPTIONAL password (8 hex characters)"); 
 136         PrintAndLog("Examples:"); 
 137         PrintAndLog("      lf t55xx detect"); 
 138         PrintAndLog("      lf t55xx detect 1"); 
 139         PrintAndLog("      lf t55xx detect p 11223344"); 
 143 int usage_t55xx_detectP1(){ 
 144         PrintAndLog("Usage:  lf t55xx page1detect [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 page1detect"); 
 151         PrintAndLog("      lf t55xx page1detect 1"); 
 152         PrintAndLog("      lf t55xx page1detect 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
); 
 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) 
 423                         snprintf(cmdStr
, sizeof(buf
),"%d %d 6", bitRate
[config
.bitrate
], config
.inverted 
); 
 424                         ans 
= PSKDemod(cmdStr
, false); 
 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) 
 433                         snprintf(cmdStr
, sizeof(buf
),"%d 0 6", bitRate
[config
.bitrate
] ); 
 434                         ans 
= PSKDemod(cmdStr
, false); 
 435                         psk1TOpsk2(DemodBuffer
, DemodBufferLen
); 
 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; 
 510         ans 
= fskClocks(&fc1
, &fc2
, (uint8_t *)&clk
, false); 
 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); 
 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 
 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; 
 814                 if (!testModulation(mode
, modread
)) continue; 
 815                 *fndBitRate 
= bitRate
; 
 820         if (testQ5(mode
, offset
, fndBitRate
, clk
)) { 
 827 void printT55xxBlock(const char *blockNum
){ 
 829         uint8_t i 
= config
.offset
; 
 830         uint8_t endpos 
= 32 + i
; 
 831         uint32_t blockData 
= 0; 
 832         uint8_t bits
[64] = {0x00}; 
 834         if ( !DemodBufferLen
) return; 
 836         if ( endpos 
> DemodBufferLen
){ 
 837                 PrintAndLog("The configured offset %d is too big. Possible offset: %d)", i
, DemodBufferLen
-32); 
 841         for (; i 
< endpos
; ++i
) 
 842                 bits
[i 
- config
.offset
]=DemodBuffer
[i
]; 
 844         blockData 
= PackBits(0, 32, bits
); 
 846         PrintAndLog("  %s | %08X | %s", blockNum
, blockData
, sprint_bin(bits
,32)); 
 849 int special(const char *Cmd
) { 
 850         uint32_t blockData 
= 0; 
 851         uint8_t bits
[32] = {0x00}; 
 853         PrintAndLog("OFFSET | DATA       | BINARY"); 
 854         PrintAndLog("----------------------------------------------------"); 
 858                 for (i 
= 0; i 
< 32; ++i
) 
 859                         bits
[i
]=DemodBuffer
[j
+i
]; 
 861                 blockData 
= PackBits(0, 32, bits
); 
 863                 PrintAndLog("    %02d | 0x%08X | %s",j 
, blockData
, sprint_bin(bits
,32));        
 868 int printConfiguration( t55xx_conf_block_t b
){ 
 869         PrintAndLog("Chip Type  : %s", (b
.Q5
) ? "T5555(Q5)" : "T55x7"); 
 870         PrintAndLog("Modulation : %s", GetSelectedModulationStr(b
.modulation
) ); 
 871         PrintAndLog("Bit Rate   : %s", GetBitRateStr(b
.bitrate
, (b
.block0 
& T55x7_X_MODE
)) ); 
 872         PrintAndLog("Inverted   : %s", (b
.inverted
) ? "Yes" : "No" ); 
 873         PrintAndLog("Offset     : %d", b
.offset
); 
 874         PrintAndLog("Seq. Term. : %s", (b
.ST
) ? "Yes" : "No" ); 
 875         PrintAndLog("Block0     : 0x%08X", b
.block0
); 
 880 int CmdT55xxWakeUp(const char *Cmd
) { 
 881         uint32_t password 
= 0; 
 882         if ( strlen(Cmd
) <= 0 ) return usage_t55xx_wakup(); 
 883         char cmdp 
= param_getchar(Cmd
, 0); 
 884         if ( cmdp 
== 'h' || cmdp 
== 'H') return usage_t55xx_wakup(); 
 886         password 
= param_get32ex(Cmd
, 0, 0, 16); 
 888         UsbCommand c 
= {CMD_T55XX_WAKEUP
, {password
, 0, 0}}; 
 889         clearCommandBuffer(); 
 891         PrintAndLog("Wake up command sent. Try read now"); 
 895 int CmdT55xxWriteBlock(const char *Cmd
) { 
 896         uint8_t block 
= 0xFF; //default to invalid block 
 897         uint32_t data 
= 0; //default to blank Block  
 898         uint32_t password 
= 0; //default to blank Block 7 
 901         bool gotdata 
= false; 
 902         bool testMode 
= false; 
 905         while(param_getchar(Cmd
, cmdp
) != 0x00 && !errors
) { 
 906                 switch(param_getchar(Cmd
, cmdp
)) { 
 909                         return usage_t55xx_write(); 
 912                         errors 
|= param_getdec(Cmd
, cmdp
+1, &block
); 
 917                         data 
= param_get32ex(Cmd
, cmdp
+1, 0, 16); 
 923                         password 
= param_get32ex(Cmd
, cmdp
+1, 0, 16); 
 937                         PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd
, cmdp
)); 
 942         if (errors 
|| !gotdata
) return usage_t55xx_write(); 
 945                 PrintAndLog("Block number must be between 0 and 7"); 
 949         UsbCommand c 
= {CMD_T55XX_WRITE_BLOCK
, {data
, block
, 0}}; 
 951         c
.d
.asBytes
[0] = (page1
) ? 0x2 : 0;  
 952         c
.d
.asBytes
[0] |= (testMode
) ? 0x4 : 0;  
 954         char pwdStr
[16] = {0}; 
 955         snprintf(pwdStr
, sizeof(pwdStr
), "pwd: 0x%08X", password
); 
 957         PrintAndLog("Writing page %d  block: %02d  data: 0x%08X %s", page1
, block
, data
,  (usepwd
) ? pwdStr 
: "" ); 
 962                 c
.d
.asBytes
[0] |= 0x1;  
 964         clearCommandBuffer(); 
 966         if (!WaitForResponseTimeout(CMD_ACK
, &resp
, 1000)){ 
 967                 PrintAndLog("Error occurred, device did not ACK write operation. (May be due to old firmware)"); 
 973 int CmdT55xxReadTrace(const char *Cmd
) { 
 974         char cmdp 
= param_getchar(Cmd
, 0); 
 975         bool pwdmode 
= false; 
 976         uint32_t password 
= 0; 
 977         if (strlen(Cmd
) > 1 || cmdp 
== 'h' || cmdp 
== 'H')  
 978                 return usage_t55xx_trace(); 
 981                 if ( !AquireData( T55x7_PAGE1
, REGULAR_READ_MODE_BLOCK
, pwdmode
, password 
) ) 
 985                 if (!DecodeT5555TraceBlock()) return 0; 
 987                 if (!DecodeT55xxBlock()) return 0; 
 990         if ( !DemodBufferLen 
) return 0; 
 992         RepaintGraphWindow(); 
 993         uint8_t repeat 
= (config
.offset 
> 5) ? 32 : 0; 
 995         uint8_t si 
= config
.offset
+repeat
; 
 996         uint32_t bl1     
= PackBits(si
, 32, DemodBuffer
); 
 997         uint32_t bl2     
= PackBits(si
+32, 32, DemodBuffer
); 
1000                 uint32_t hdr 
= PackBits(si
, 9,  DemodBuffer
); si 
+= 9; 
1003                         PrintAndLog("Invalid Q5 Trace data header (expected 0x1FF, found %X)", hdr
); 
1007                 t5555_tracedata_t data 
= {.bl1 
= bl1
, .bl2 
= bl2
, .icr 
= 0, .lotidc 
= '?', .lotid 
= 0, .wafer 
= 0, .dw 
=0}; 
1009                 data
.icr     
= PackBits(si
, 2,  DemodBuffer
); si 
+= 2; 
1010                 data
.lotidc  
= 'Z' - PackBits(si
, 2,  DemodBuffer
); si 
+= 3; 
1012                 data
.lotid   
= PackBits(si
, 4,  DemodBuffer
); si 
+= 5; 
1014                 data
.lotid  
|= PackBits(si
, 4,  DemodBuffer
); si 
+= 5; 
1016                 data
.lotid  
|= PackBits(si
, 4,  DemodBuffer
); si 
+= 5; 
1018                 data
.lotid  
|= PackBits(si
, 4,  DemodBuffer
); si 
+= 5; 
1020                 data
.lotid  
|= PackBits(si
, 1,  DemodBuffer
); si 
+= 1; 
1022                 data
.wafer   
= PackBits(si
, 3,  DemodBuffer
); si 
+= 4; 
1024                 data
.wafer  
|= PackBits(si
, 2,  DemodBuffer
); si 
+= 2; 
1026                 data
.dw      
= PackBits(si
, 2,  DemodBuffer
); si 
+= 3; 
1028                 data
.dw     
|= PackBits(si
, 4,  DemodBuffer
); si 
+= 5; 
1030                 data
.dw     
|= PackBits(si
, 4,  DemodBuffer
); si 
+= 5; 
1032                 data
.dw     
|= PackBits(si
, 4,  DemodBuffer
); si 
+= 5; 
1034                 printT5555Trace(data
, repeat
); 
1038                 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}; 
1040                 data
.acl 
= PackBits(si
, 8,  DemodBuffer
); si 
+= 8; 
1041                 if ( data
.acl 
!= 0xE0 ) { 
1042                         PrintAndLog("The modulation is most likely wrong since the ACL is not 0xE0. "); 
1046                 data
.mfc     
= PackBits(si
, 8,  DemodBuffer
); si 
+= 8; 
1047                 data
.cid     
= PackBits(si
, 5,  DemodBuffer
); si 
+= 5; 
1048                 data
.icr     
= PackBits(si
, 3,  DemodBuffer
); si 
+= 3; 
1049                 data
.year    
= PackBits(si
, 4,  DemodBuffer
); si 
+= 4; 
1050                 data
.quarter 
= PackBits(si
, 2,  DemodBuffer
); si 
+= 2; 
1051                 data
.lotid   
= PackBits(si
, 14, DemodBuffer
); si 
+= 14; 
1052                 data
.wafer   
= PackBits(si
, 5,  DemodBuffer
); si 
+= 5; 
1053                 data
.dw      
= PackBits(si
, 15, DemodBuffer
);  
1055                 time_t t 
= time(NULL
); 
1056                 struct tm tm 
= *localtime(&t
); 
1057                 if ( data
.year 
> tm
.tm_year
-110) 
1062                 printT55x7Trace(data
, repeat
); 
1067 void printT55x7Trace( t55x7_tracedata_t data
, uint8_t repeat 
){ 
1068         PrintAndLog("-- T55x7 Trace Information ----------------------------------"); 
1069         PrintAndLog("-------------------------------------------------------------"); 
1070         PrintAndLog(" ACL Allocation class (ISO/IEC 15963-1)  : 0x%02X (%d)", data
.acl
, data
.acl
); 
1071         PrintAndLog(" MFC Manufacturer ID (ISO/IEC 7816-6)    : 0x%02X (%d) - %s", data
.mfc
, data
.mfc
, getTagInfo(data
.mfc
)); 
1072         PrintAndLog(" CID                                     : 0x%02X (%d) - %s", data
.cid
, data
.cid
, GetModelStrFromCID(data
.cid
)); 
1073         PrintAndLog(" ICR IC Revision                         : %d", data
.icr 
); 
1074         PrintAndLog(" Manufactured"); 
1075         PrintAndLog("     Year/Quarter : %d/%d", data
.year
, data
.quarter
); 
1076         PrintAndLog("     Lot ID       : %d", data
.lotid 
); 
1077         PrintAndLog("     Wafer number : %d", data
.wafer
); 
1078         PrintAndLog("     Die Number   : %d", data
.dw
); 
1079         PrintAndLog("-------------------------------------------------------------"); 
1080         PrintAndLog(" Raw Data - Page 1"); 
1081         PrintAndLog("     Block 1  : 0x%08X  %s", data
.bl1
, sprint_bin(DemodBuffer
+config
.offset
+repeat
,32) ); 
1082         PrintAndLog("     Block 2  : 0x%08X  %s", data
.bl2
, sprint_bin(DemodBuffer
+config
.offset
+repeat
+32,32) ); 
1083         PrintAndLog("-------------------------------------------------------------");    
1088                 1-8             ACL Allocation class (ISO/IEC 15963-1)  0xE0  
1089                 9-16    MFC Manufacturer ID (ISO/IEC 7816-6)    0x15 Atmel Corporation 
1090                 17-21   CID                                                                             0x1 = Atmel ATA5577M1  0x2 = Atmel ATA5577M2  
1091                 22-24   ICR IC revision 
1092                 25-28   YEAR (BCD encoded)                                              9 (= 2009) 
1093                 29-30   QUARTER                                                                 1,2,3,4  
1099                 18-32   DW,  die number sequential 
1103 void printT5555Trace( t5555_tracedata_t data
, uint8_t repeat 
){ 
1104         PrintAndLog("-- T5555 (Q5) Trace Information -----------------------------"); 
1105         PrintAndLog("-------------------------------------------------------------"); 
1106         PrintAndLog(" ICR IC Revision  : %d", data
.icr 
);        
1107         PrintAndLog("     Lot          : %c%d", data
.lotidc
, data
.lotid
); 
1108         PrintAndLog("     Wafer number : %d", data
.wafer
); 
1109         PrintAndLog("     Die Number   : %d", data
.dw
); 
1110         PrintAndLog("-------------------------------------------------------------"); 
1111         PrintAndLog(" Raw Data - Page 1"); 
1112         PrintAndLog("     Block 1  : 0x%08X  %s", data
.bl1
, sprint_bin(DemodBuffer
+config
.offset
+repeat
,32) ); 
1113         PrintAndLog("     Block 2  : 0x%08X  %s", data
.bl2
, sprint_bin(DemodBuffer
+config
.offset
+repeat
+32,32) ); 
1117                 TRACE - BLOCK O and BLOCK1 
1122                 15-35 Lot ID (NB parity) 
1123                 36-41 Wafer number (NB parity) 
1124                 42-58 DW, die number sequential (NB parity) 
1130 //need to add Q5 info... 
1131 int CmdT55xxInfo(const char *Cmd
){ 
1133                 Page 0 Block 0 Configuration data. 
1137         bool pwdmode 
= false; 
1138         uint32_t password 
= 0; 
1139         char cmdp 
= param_getchar(Cmd
, 0); 
1141         if (strlen(Cmd
) > 1 || cmdp 
== 'h' || cmdp 
== 'H') 
1142                 return usage_t55xx_info(); 
1145                 if ( !AquireData( T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, pwdmode
, password 
) ) 
1148         if (!DecodeT55xxBlock()) return 1; 
1150         // too little space to start with 
1151         if ( DemodBufferLen 
< 32) return 1; 
1153         uint8_t si 
= config
.offset
; 
1154         uint32_t bl0      
= PackBits(si
, 32, DemodBuffer
); 
1156         uint32_t safer    
= PackBits(si
, 4, DemodBuffer
); si 
+= 4;       
1157         uint32_t resv     
= PackBits(si
, 7, DemodBuffer
); si 
+= 7; 
1158         uint32_t dbr      
= PackBits(si
, 3, DemodBuffer
); si 
+= 3; 
1159         uint32_t extend   
= PackBits(si
, 1, DemodBuffer
); si 
+= 1; 
1160         uint32_t datamod  
= PackBits(si
, 5, DemodBuffer
); si 
+= 5; 
1161         uint32_t pskcf    
= PackBits(si
, 2, DemodBuffer
); si 
+= 2; 
1162         uint32_t aor      
= PackBits(si
, 1, DemodBuffer
); si 
+= 1;       
1163         uint32_t otp      
= PackBits(si
, 1, DemodBuffer
); si 
+= 1;       
1164         uint32_t maxblk   
= PackBits(si
, 3, DemodBuffer
); si 
+= 3; 
1165         uint32_t pwd      
= PackBits(si
, 1, DemodBuffer
); si 
+= 1;       
1166         uint32_t sst      
= PackBits(si
, 1, DemodBuffer
); si 
+= 1;       
1167         uint32_t fw       
= PackBits(si
, 1, DemodBuffer
); si 
+= 1; 
1168         uint32_t inv      
= PackBits(si
, 1, DemodBuffer
); si 
+= 1;       
1169         uint32_t por      
= PackBits(si
, 1, DemodBuffer
); si 
+= 1; 
1171         if (config
.Q5
) PrintAndLog("*** Warning *** Config Info read off a Q5 will not display as expected"); 
1173         PrintAndLog("-- T55x7 Configuration & Tag Information --------------------"); 
1174         PrintAndLog("-------------------------------------------------------------"); 
1175         PrintAndLog(" Safer key                 : %s", GetSaferStr(safer
)); 
1176         PrintAndLog(" reserved                  : %d", resv
); 
1177         PrintAndLog(" Data bit rate             : %s", GetBitRateStr(dbr
, extend
)); 
1178         PrintAndLog(" eXtended mode             : %s", (extend
) ? "Yes - Warning":"No"); 
1179         PrintAndLog(" Modulation                : %s", GetModulationStr(datamod
)); 
1180         PrintAndLog(" PSK clock frequency       : %d", pskcf
); 
1181         PrintAndLog(" AOR - Answer on Request   : %s", (aor
) ? "Yes":"No"); 
1182         PrintAndLog(" OTP - One Time Pad        : %s", (otp
) ? "Yes - Warning":"No" ); 
1183         PrintAndLog(" Max block                 : %d", maxblk
); 
1184         PrintAndLog(" Password mode             : %s", (pwd
) ? "Yes":"No"); 
1185         PrintAndLog(" Sequence Start Terminator : %s", (sst
) ? "Yes":"No"); 
1186         PrintAndLog(" Fast Write                : %s", (fw
)  ? "Yes":"No"); 
1187         PrintAndLog(" Inverse data              : %s", (inv
) ? "Yes":"No"); 
1188         PrintAndLog(" POR-Delay                 : %s", (por
) ? "Yes":"No"); 
1189         PrintAndLog("-------------------------------------------------------------"); 
1190         PrintAndLog(" Raw Data - Page 0"); 
1191         PrintAndLog("     Block 0  : 0x%08X  %s", bl0
, sprint_bin(DemodBuffer
+config
.offset
,32) ); 
1192         PrintAndLog("-------------------------------------------------------------"); 
1197 int CmdT55xxDump(const char *Cmd
){ 
1199         uint32_t password 
= 0; 
1200         char cmdp 
= param_getchar(Cmd
, 0); 
1201         bool override 
= false; 
1202         if ( cmdp 
== 'h' || cmdp 
== 'H') return usage_t55xx_dump(); 
1204         bool usepwd 
= ( strlen(Cmd
) > 0); 
1206                 password 
= param_get32ex(Cmd
, 0, 0, 16); 
1207                 if (param_getchar(Cmd
, 1) =='o' ) 
1212         for ( uint8_t i 
= 0; i 
<8; ++i
) 
1213                 T55xxReadBlock(i
, 0, usepwd
, override
, password
); 
1216         for ( uint8_t   i 
= 0; i
<4; i
++) 
1217                 T55xxReadBlock(i
, 1, usepwd
, override
, password
);                
1222 int AquireData( uint8_t page
, uint8_t block
, bool pwdmode
, uint32_t password 
){ 
1225         // bit1 = page to read from 
1226         uint8_t arg0 
= (page
<<1) | pwdmode
; 
1227         UsbCommand c 
= {CMD_T55XX_READ_BLOCK
, {arg0
, block
, password
}}; 
1229         clearCommandBuffer(); 
1231         if ( !WaitForResponseTimeout(CMD_ACK
,NULL
,2500) ) { 
1232                 PrintAndLog("command execution time out"); 
1237         GetFromBigBuf(got
,sizeof(got
),0); 
1238         WaitForResponse(CMD_ACK
,NULL
); 
1239         setGraphBuf(got
, sizeof(got
)); 
1243 char * GetBitRateStr(uint32_t id
, bool xmode
) { 
1244         static char buf
[25]; 
1247         if (xmode
) { //xmode bitrate calc is same as em4x05 calc 
1248                 snprintf(retStr
,sizeof(buf
),"%d - RF/%d", id
, EM4x05_GET_BITRATE(id
)); 
1251                         case 0:   snprintf(retStr
,sizeof(buf
),"%d - RF/8",id
);   break; 
1252                         case 1:   snprintf(retStr
,sizeof(buf
),"%d - RF/16",id
);  break; 
1253                         case 2:   snprintf(retStr
,sizeof(buf
),"%d - RF/32",id
);  break; 
1254                         case 3:   snprintf(retStr
,sizeof(buf
),"%d - RF/40",id
);  break; 
1255                         case 4:   snprintf(retStr
,sizeof(buf
),"%d - RF/50",id
);  break; 
1256                         case 5:   snprintf(retStr
,sizeof(buf
),"%d - RF/64",id
);  break; 
1257                         case 6:   snprintf(retStr
,sizeof(buf
),"%d - RF/100",id
); break; 
1258                         case 7:   snprintf(retStr
,sizeof(buf
),"%d - RF/128",id
); break; 
1259                         default:  snprintf(retStr
,sizeof(buf
),"%d - (Unknown)",id
); break; 
1265 char * GetSaferStr(uint32_t id
) { 
1266         static char buf
[40]; 
1269         snprintf(retStr
,sizeof(buf
),"%d",id
); 
1271                 snprintf(retStr
,sizeof(buf
),"%d - passwd",id
); 
1274                 snprintf(retStr
,sizeof(buf
),"%d - testmode",id
); 
1280 char * GetModulationStr( uint32_t id
){ 
1281         static char buf
[60]; 
1285                 case 0: snprintf(retStr
,sizeof(buf
),"%d - DIRECT (ASK/NRZ)",id
); break; 
1286                 case 1: snprintf(retStr
,sizeof(buf
),"%d - PSK 1 phase change when input changes",id
); break; 
1287                 case 2: snprintf(retStr
,sizeof(buf
),"%d - PSK 2 phase change on bitclk if input high",id
); break; 
1288                 case 3: snprintf(retStr
,sizeof(buf
),"%d - PSK 3 phase change on rising edge of input",id
); break; 
1289                 case 4: snprintf(retStr
,sizeof(buf
),"%d - FSK 1 RF/8  RF/5",id
); break; 
1290                 case 5: snprintf(retStr
,sizeof(buf
),"%d - FSK 2 RF/8  RF/10",id
); break; 
1291                 case 6: snprintf(retStr
,sizeof(buf
),"%d - FSK 1a RF/5  RF/8",id
); break; 
1292                 case 7: snprintf(retStr
,sizeof(buf
),"%d - FSK 2a RF/10  RF/8",id
); break; 
1293                 case 8: snprintf(retStr
,sizeof(buf
),"%d - Manchester",id
); break; 
1294                 case 16: snprintf(retStr
,sizeof(buf
),"%d - Biphase",id
); break; 
1295                 case 0x18: snprintf(retStr
,sizeof(buf
),"%d - Biphase a - AKA Conditional Dephase Encoding(CDP)",id
); break; 
1296                 case 17: snprintf(retStr
,sizeof(buf
),"%d - Reserved",id
); break; 
1297                 default: snprintf(retStr
,sizeof(buf
),"0x%02X (Unknown)",id
); break; 
1302 char * GetModelStrFromCID(uint32_t cid
){ 
1304         static char buf
[10]; 
1307         if (cid 
== 1) snprintf(retStr
, sizeof(buf
),"ATA5577M1"); 
1308         if (cid 
== 2) snprintf(retStr
, sizeof(buf
),"ATA5577M2");         
1312 char * GetSelectedModulationStr( uint8_t id
){ 
1314         static char buf
[20]; 
1318                 case DEMOD_FSK
: snprintf(retStr
,sizeof(buf
),"FSK");     break; 
1319                 case DEMOD_FSK1
: snprintf(retStr
,sizeof(buf
),"FSK1"); break; 
1320                 case DEMOD_FSK1a
: snprintf(retStr
,sizeof(buf
),"FSK1a"); break; 
1321                 case DEMOD_FSK2
: snprintf(retStr
,sizeof(buf
),"FSK2"); break; 
1322                 case DEMOD_FSK2a
: snprintf(retStr
,sizeof(buf
),"FSK2a"); break; 
1323                 case DEMOD_ASK
: snprintf(retStr
,sizeof(buf
),"ASK"); break; 
1324                 case DEMOD_NRZ
: snprintf(retStr
,sizeof(buf
),"DIRECT/NRZ"); break; 
1325                 case DEMOD_PSK1
: snprintf(retStr
,sizeof(buf
),"PSK1"); break; 
1326                 case DEMOD_PSK2
: snprintf(retStr
,sizeof(buf
),"PSK2"); break; 
1327                 case DEMOD_PSK3
: snprintf(retStr
,sizeof(buf
),"PSK3"); break; 
1328                 case DEMOD_BI
: snprintf(retStr
,sizeof(buf
),"BIPHASE"); break; 
1329                 case DEMOD_BIa
: snprintf(retStr
,sizeof(buf
),"BIPHASEa - (CDP)"); break; 
1330                 default: snprintf(retStr
,sizeof(buf
),"(Unknown)"); break; 
1335 uint32_t PackBits(uint8_t start
, uint8_t len
, uint8_t* bits
){ 
1340         if (len 
> 32) return 0; 
1343         for (; j 
>= 0; --j
, ++i
) 
1344                 tmp     
|= bits
[i
] << j
; 
1349 int CmdResetRead(const char *Cmd
) { 
1350         UsbCommand c 
= {CMD_T55XX_RESET_READ
, {0,0,0}}; 
1352         clearCommandBuffer(); 
1354         if ( !WaitForResponseTimeout(CMD_ACK
,NULL
,2500) ) { 
1355                 PrintAndLog("command execution time out"); 
1359         uint8_t got
[BIGBUF_SIZE
-1]; 
1360         GetFromBigBuf(got
,sizeof(got
),0); 
1361         WaitForResponse(CMD_ACK
,NULL
); 
1362         setGraphBuf(got
, sizeof(got
)); 
1366 int CmdT55xxWipe(const char *Cmd
) { 
1367         char writeData
[20] = {0}; 
1368         char *ptrData 
= writeData
; 
1370         char cmdp 
= param_getchar(Cmd
, 0);       
1371         if ( cmdp 
== 'h' || cmdp 
== 'H') return usage_t55xx_wipe(); 
1373         bool Q5 
= (cmdp 
== 'q' || cmdp 
== 'Q'); 
1375         // Try with the default password to reset block 0 
1376         // With a pwd should work even if pwd bit not set 
1377         PrintAndLog("\nBeginning Wipe of a T55xx tag (assuming the tag is not password protected)\n"); 
1380                 snprintf(ptrData
,sizeof(writeData
),"b 0 d 6001F004 p 0"); 
1382                 snprintf(ptrData
,sizeof(writeData
),"b 0 d 00088040 p 0"); 
1385         if (!CmdT55xxWriteBlock(ptrData
)) PrintAndLog("Error writing blk 0"); 
1387         for (uint8_t blk 
= 1; blk
<8; blk
++) { 
1388                 snprintf(ptrData
,sizeof(writeData
),"b %d d 0", blk
); 
1389                 if (!CmdT55xxWriteBlock(ptrData
)) 
1390                         PrintAndLog("Error writing blk %d", blk
); 
1392                 memset(writeData
, 0x00, sizeof(writeData
)); 
1397 int CmdT55xxBruteForce(const char *Cmd
) { 
1399         // load a default pwd file. 
1401         char filename
[FILE_PATH_SIZE
]={0}; 
1404         uint8_t stKeyBlock 
= 20; 
1405         uint8_t *keyBlock 
= NULL
, *p 
= NULL
; 
1406         uint32_t start_password 
= 0x00000000; //start password 
1407         uint32_t end_password   
= 0xFFFFFFFF; //end   password 
1410         char cmdp 
= param_getchar(Cmd
, 0); 
1411         if (cmdp 
== 'h' || cmdp 
== 'H') return usage_t55xx_bruteforce(); 
1413         keyBlock 
= calloc(stKeyBlock
, 6); 
1414         if (keyBlock 
== NULL
) return 1; 
1416         if (cmdp 
== 'i' || cmdp 
== 'I') { 
1418                 int len 
= strlen(Cmd
+2); 
1419                 if (len 
> FILE_PATH_SIZE
) len 
= FILE_PATH_SIZE
; 
1420                 memcpy(filename
, Cmd
+2, len
); 
1422                 FILE * f 
= fopen( filename 
, "r"); 
1425                         PrintAndLog("File: %s: not found or locked.", filename
); 
1430                 while( fgets(buf
, sizeof(buf
), f
) ) { 
1431                         if (strlen(buf
) < 8 || buf
[7] == '\n') continue; 
1433                         while (fgetc(f
) != '\n' && !feof(f
)) ;  //goto next line 
1435                         //The line start with # is comment, skip 
1436                         if( buf
[0]=='#' ) continue; 
1438                         if (!isxdigit(buf
[0])) { 
1439                                 PrintAndLog("File content error. '%s' must include 8 HEX symbols", buf
); 
1445                         if ( stKeyBlock 
- keycnt 
< 2) { 
1446                                 p 
= realloc(keyBlock
, 6*(stKeyBlock
+=10)); 
1448                                         PrintAndLog("Cannot allocate memory for defaultKeys"); 
1455                         memset(keyBlock 
+ 4 * keycnt
, 0, 4); 
1456                         num_to_bytes(strtoll(buf
, NULL
, 16), 4, keyBlock 
+ 4*keycnt
); 
1457                         PrintAndLog("chk custom pwd[%2d] %08X", keycnt
, bytes_to_num(keyBlock 
+ 4*keycnt
, 4)); 
1459                         memset(buf
, 0, sizeof(buf
)); 
1464                         PrintAndLog("No keys found in file"); 
1468                 PrintAndLog("Loaded %d keys", keycnt
); 
1471                 uint64_t testpwd 
= 0x00; 
1472                 for (uint16_t c 
= 0; c 
< keycnt
; ++c 
) { 
1477                                 printf("\naborted via keyboard!\n"); 
1482                         testpwd 
= bytes_to_num(keyBlock 
+ 4*c
, 4); 
1484                         PrintAndLog("Testing %08X", testpwd
); 
1486                         if ( !AquireData(T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, true, testpwd
)) { 
1487                                 PrintAndLog("Aquireing data from device failed. Quitting"); 
1492                         found 
= tryDetectModulation(); 
1495                                 PrintAndLog("Found valid password: [%08X]", testpwd
); 
1500                 PrintAndLog("Password NOT found."); 
1505         // Try to read Block 7, first :) 
1507         // incremental pwd range search 
1508         start_password 
= param_get32ex(Cmd
, 0, 0, 16); 
1509         end_password 
= param_get32ex(Cmd
, 1, 0, 16); 
1511         if ( start_password 
>= end_password 
) { 
1513                 return usage_t55xx_bruteforce(); 
1515         PrintAndLog("Search password range [%08X -> %08X]", start_password
, end_password
); 
1517         uint32_t i 
= start_password
; 
1519         while ((!found
) && (i 
<= end_password
)) { 
1526                         printf("\naborted via keyboard!\n"); 
1531                 if (!AquireData(T55x7_PAGE0
, T55x7_CONFIGURATION_BLOCK
, true, i
)) { 
1532                         PrintAndLog("Aquireing data from device failed. Quitting"); 
1536                 found 
= tryDetectModulation(); 
1545                 PrintAndLog("Found valid password: [%08x]", i
); 
1547                 PrintAndLog("Password NOT found. Last tried: [%08x]", --i
); 
1553 // note length of data returned is different for different chips.   
1554 //   some return all page 1 (64 bits) and others return just that block (32 bits)  
1555 //   unfortunately the 64 bits makes this more likely to get a false positive... 
1556 bool tryDetectP1(bool getData
) { 
1557         uint8_t preamble
[] = {1,1,1,0,0,0,0,0,0,0,0,1,0,1,0,1}; 
1558         size_t startIdx 
= 0; 
1559         uint8_t fc1 
= 0, fc2 
= 0, ans 
= 0; 
1564                 if ( !AquireData(T55x7_PAGE1
, 1, false, 0) ) 
1568         // try fsk clock detect. if successful it cannot be any other type of modulation...  (in theory...) 
1569         ans 
= fskClocks(&fc1
, &fc2
, (uint8_t *)&clk
, false); 
1570         if (ans 
&& ((fc1
==10 && fc2
==8) || (fc1
==8 && fc2
==5))) { 
1571                 if ( FSKrawDemod("0 0", false) &&  
1572                           preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&  
1573                           (DemodBufferLen 
== 32 || DemodBufferLen 
== 64) ) { 
1576                 if ( FSKrawDemod("0 1", false) &&  
1577                           preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&  
1578                           (DemodBufferLen 
== 32 || DemodBufferLen 
== 64) ) { 
1584         // try psk clock detect. if successful it cannot be any other type of modulation... (in theory...) 
1585         clk 
= GetPskClock("", false, false); 
1588                 // save_restoreGB(1); 
1589                 // skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise) 
1591                 if ( PSKDemod("0 0 6", false) && 
1592                           preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&  
1593                           (DemodBufferLen 
== 32 || DemodBufferLen 
== 64) ) { 
1594                         //save_restoreGB(0); 
1597                 if ( PSKDemod("0 1 6", false) && 
1598                           preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&  
1599                           (DemodBufferLen 
== 32 || DemodBufferLen 
== 64) ) { 
1600                         //save_restoreGB(0); 
1603                 // PSK2 - needs a call to psk1TOpsk2. 
1604                 if ( PSKDemod("0 0 6", false)) { 
1605                         psk1TOpsk2(DemodBuffer
, DemodBufferLen
); 
1606                         if (preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&  
1607                                   (DemodBufferLen 
== 32 || DemodBufferLen 
== 64) ) { 
1608                                 //save_restoreGB(0); 
1611                 } // inverse waves does not affect PSK2 demod 
1613                 //save_restoreGB(0);  
1614                 // no other modulation clocks = 2 or 4 so quit searching 
1615                 if (fc1 
!= 8) return false; 
1618         // try ask clock detect.  it could be another type even if successful. 
1619         clk 
= GetAskClock("", false, false); 
1621                 if ( ASKDemod_ext("0 0 1", false, false, 1, &st
) && 
1622                           preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&  
1623                           (DemodBufferLen 
== 32 || DemodBufferLen 
== 64) ) { 
1627                 if ( ASKDemod_ext("0 1 1", false, false, 1, &st
)  && 
1628                           preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&  
1629                           (DemodBufferLen 
== 32 || DemodBufferLen 
== 64) ) { 
1632                 if ( ASKbiphaseDemod("0 0 0 2", false) && 
1633                           preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&  
1634                           (DemodBufferLen 
== 32 || DemodBufferLen 
== 64) ) { 
1637                 if ( ASKbiphaseDemod("0 0 1 2", false) && 
1638                           preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&  
1639                           (DemodBufferLen 
== 32 || DemodBufferLen 
== 64) ) { 
1644         // try NRZ clock detect.  it could be another type even if successful. 
1645         clk 
= GetNrzClock("", false, false); //has the most false positives :( 
1647                 if ( NRZrawDemod("0 0 1", false)  && 
1648                           preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&  
1649                           (DemodBufferLen 
== 32 || DemodBufferLen 
== 64) ) { 
1652                 if ( NRZrawDemod("0 1 1", false)  && 
1653                           preambleSearchEx(DemodBuffer
,preamble
,sizeof(preamble
),&DemodBufferLen
,&startIdx
,false) &&  
1654                           (DemodBufferLen 
== 32 || DemodBufferLen 
== 64) ) { 
1660 //  does this need to be a callable command? 
1661 int CmdT55xxDetectPage1(const char *Cmd
){ 
1662         bool errors 
= false; 
1664         bool usepwd 
= false; 
1665         uint32_t password 
= 0; 
1668         while(param_getchar(Cmd
, cmdp
) != 0x00 && !errors
) { 
1669                 switch(param_getchar(Cmd
, cmdp
)) { 
1672                         return usage_t55xx_detectP1(); 
1675                         password 
= param_get32ex(Cmd
, cmdp
+1, 0, 16); 
1680                         // use Graphbuffer data 
1685                         PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd
, cmdp
)); 
1690         if (errors
) return usage_t55xx_detectP1(); 
1693                 if ( !AquireData(T55x7_PAGE1
, 1, usepwd
, password
) ) 
1696         bool success 
= tryDetectP1(false); 
1697         if (success
) PrintAndLog("T55xx chip 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   {"p1detect",  CmdT55xxDetectPage1
,1, "[1] Try detecting if this is a t55xx tag by reading page 1"}, 
1707   {"read",      CmdT55xxReadBlock
, 0, "b <block> p [password] [o] [1] -- Read T55xx block data. Optional [p password], [override], [page1]"}, 
1708   {"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)"}, 
1709   {"write",     CmdT55xxWriteBlock
,0, "b <block> d <data> p [password] [1] -- Write T55xx block data. Optional [p password], [page1]"}, 
1710   {"trace",     CmdT55xxReadTrace
, 1, "[1] Show T55x7 traceability data (page 1/ blk 0-1)"}, 
1711   {"info",      CmdT55xxInfo
,      1, "[1] Show T55x7 configuration data (page 0/ blk 0)"}, 
1712   {"dump",      CmdT55xxDump
,      0, "[password] [o] Dump T55xx card block 0-7. Optional [password], [override]"}, 
1713   {"special",   special
,           0, "Show block changes with 64 different offsets"}, 
1714   {"wakeup",    CmdT55xxWakeUp
,    0, "Send AOR wakeup command"}, 
1715   {"wipe",      CmdT55xxWipe
,      0, "[q] Wipe a T55xx tag and set defaults (will destroy any data on tag)"}, 
1716   {NULL
, NULL
, 0, NULL
} 
1719 int CmdLFT55XX(const char *Cmd
) { 
1720   CmdsParse(CommandTable
, Cmd
); 
1724 int CmdHelp(const char *Cmd
) { 
1725   CmdsHelp(CommandTable
);