proxmark3/client/src/cmdlft55xx.c

4249 lines
158 KiB
C
Raw Normal View History

//-----------------------------------------------------------------------------
//
// This code is licensed to you under the terms of the GNU GPL, version 2 or,
// at your option, any later version. See the LICENSE.txt file for the text of
// the license.
//-----------------------------------------------------------------------------
// Low frequency T55xx commands
//-----------------------------------------------------------------------------
2019-04-13 09:01:31 +08:00
// ensure localtime_r is available even with -std=c99; must be included before
2019-04-13 08:45:53 +08:00
#if !defined(_WIN32)
#define _POSIX_C_SOURCE 200112L
#endif
#include "cmdlft55xx.h"
#include <ctype.h>
2021-01-10 19:52:57 +08:00
#include <time.h> // MingW
#include "cmdparser.h" // command_t
#include "comms.h"
#include "commonutil.h"
#include "protocols.h"
2020-05-03 06:33:28 +08:00
#include "proxgui.h"
#include "graph.h"
#include "cmddata.h"
#include "lfdemod.h"
2021-01-10 19:52:57 +08:00
#include "cmdhf14a.h" // for getTagInfo
#include "fileutils.h" // loadDictionary
#include "util_posix.h"
2021-01-10 19:52:57 +08:00
#include "cmdlf.h" // for lf sniff
#include "generator.h"
2021-01-10 19:52:57 +08:00
#include "cliparser.h" // cliparsing
2019-07-25 19:00:30 +08:00
// Some defines for readability
2019-07-27 16:25:03 +08:00
#define T55XX_DLMODE_FIXED 0 // Default Mode
#define T55XX_DLMODE_LLR 1 // Long Leading Reference
#define T55XX_DLMODE_LEADING_ZERO 2 // Leading Zero
#define T55XX_DLMODE_1OF4 3 // 1 of 4
2019-09-14 12:13:55 +08:00
// #define T55XX_LONGLEADINGREFERENCE 4 // Value to tell Write Bit to send long reference
#define T55XX_DLMODE_ALL 4 // Tell help to show 'r 4' for all dl modes
#define T55XX_DLMODE_SINGLE 5 // Tell help file NOT to show 'r 4' (not available)
#define T55XX_PrintConfig true
#define T55XX_DontPrintConfig false
2019-07-25 19:00:30 +08:00
//static uint8_t bit_rates[9] = {8, 16, 32, 40, 50, 64, 100, 128, 0};
// Default configuration
2019-09-19 16:54:34 +08:00
t55xx_conf_block_t config = {
.modulation = DEMOD_ASK,
.inverted = false,
.offset = 0x00,
.block0 = 0x00,
.block0Status = notSet,
.Q5 = false,
2019-09-14 12:13:55 +08:00
.usepwd = false,
.downlink_mode = refFixedBit
2019-09-19 16:54:34 +08:00
};
2020-06-02 02:10:45 +08:00
static t55xx_memory_item_t cardmem[T55x7_BLOCK_COUNT] = {{0}};
2019-10-11 17:29:20 +08:00
2020-05-03 07:13:28 +08:00
t55xx_conf_block_t Get_t55xx_Config(void) {
2019-03-10 06:35:06 +08:00
return config;
}
2019-10-10 18:27:48 +08:00
void Set_t55xx_Config(t55xx_conf_block_t conf) {
2019-03-10 06:35:06 +08:00
config = conf;
}
static void print_usage_t55xx_downloadlink(uint8_t ShowAll, uint8_t dl_mode_default) {
2019-09-14 12:13:55 +08:00
if (ShowAll == T55XX_DLMODE_ALL)
PrintAndLogEx(NORMAL, " r <mode> - downlink encoding 0|1|2|3|4");
else
PrintAndLogEx(NORMAL, " r <mode> - downlink encoding 0|1|2|3");
2019-10-13 06:48:26 +08:00
PrintAndLogEx(NORMAL, " 0 - fixed bit length%s", (dl_mode_default == 0) ? " (detected default)" : ""); // default will be whats in config struct
PrintAndLogEx(NORMAL, " 1 - long leading reference%s", (dl_mode_default == 1) ? " (detected default)" : "");
PrintAndLogEx(NORMAL, " 2 - leading zero%s", (dl_mode_default == 2) ? " (detected default)" : "");
PrintAndLogEx(NORMAL, " 3 - 1 of 4 coding reference%s", (dl_mode_default == 3) ? " (detected default)" : "");
2019-09-14 12:13:55 +08:00
if (ShowAll == T55XX_DLMODE_ALL)
2019-10-13 06:48:26 +08:00
PrintAndLogEx(NORMAL, " 4 - Try all downlink modes%s", (dl_mode_default == 4) ? " (default)" : "");
2019-07-28 15:21:02 +08:00
}
static void arg_add_t55xx_downloadlink(void *at[], uint8_t *idx, uint8_t show, uint8_t dl_mode_def) {
2021-01-14 18:39:45 +08:00
char *r0 = (char *)calloc(56, sizeof(uint8_t));
char *r1 = (char *)calloc(56, sizeof(uint8_t));
char *r2 = (char *)calloc(56, sizeof(uint8_t));
char *r3 = (char *)calloc(56, sizeof(uint8_t));
sprintf(r0, "downlink - fixed bit length %s", (dl_mode_def == 0) ? "(detected def)" : "");
sprintf(r1, "downlink - long leading reference %s", (dl_mode_def == 1) ? "(detected def)" : "");
sprintf(r2, "downlink - leading zero %s", (dl_mode_def == 2) ? "(detected def)" : "");
sprintf(r3, "downlink - 1 of 4 coding reference %s", (dl_mode_def == 3) ? "(detected def)" : "");
uint8_t n = *idx;
at[n++] = arg_lit0(NULL, "r0", r0);
at[n++] = arg_lit0(NULL, "r1", r1);
at[n++] = arg_lit0(NULL, "r2", r2);
at[n++] = arg_lit0(NULL, "r3", r3);
if (show == T55XX_DLMODE_ALL) {
2021-01-14 18:39:45 +08:00
char *r4 = (char *)calloc(50, sizeof(uint8_t));
sprintf(r4, "try all downlink modes %s", (dl_mode_def == 4) ? "(def)" : "");
at[n++] = arg_lit0(NULL, "all", r4);
}
at[n++] = arg_param_end;
2021-01-14 18:39:45 +08:00
*idx = n;
}
2020-05-03 07:13:28 +08:00
static int usage_t55xx_config(void) {
PrintAndLogEx(NORMAL, "Usage: lf t55xx config [c <blk0>] [d <demodulation>] [i [0/1]] [o <offset>] [Q5 [0/1]] [ST [0/1]]");
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "Options:");
2019-09-14 12:13:55 +08:00
PrintAndLogEx(NORMAL, " h - This help");
PrintAndLogEx(NORMAL, " c <block0> - set configuration from a block0");
PrintAndLogEx(NORMAL, " b <8|16|32|40|50|64|100|128> - Set bitrate");
PrintAndLogEx(NORMAL, " d <FSK|FSK1|FSK1a|FSK2|FSK2a|ASK|PSK1|PSK2|NRZ|BI|BIa> - Set demodulation FSK / ASK / PSK / NRZ / Biphase / Biphase A");
PrintAndLogEx(NORMAL, " i [0/1] - Set/reset data signal inversion");
PrintAndLogEx(NORMAL, " o [offset] - Set offset, where data should start decode in bitstream");
2020-08-28 21:53:34 +08:00
PrintAndLogEx(NORMAL, " Q5 [0/1] - Set/reset as Q5/T5555 chip instead of T55x7");
2019-09-14 12:13:55 +08:00
PrintAndLogEx(NORMAL, " ST [0/1] - Set/reset Sequence Terminator on");
PrintAndLogEx(NORMAL, ""); // layout is a little differnet, so seperate until a better fix
2019-10-13 06:48:26 +08:00
print_usage_t55xx_downloadlink(T55XX_DLMODE_SINGLE, config.downlink_mode);
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "");
PrintAndLogEx(NORMAL, "Examples:");
2020-08-21 23:15:58 +08:00
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx config d FSK") " - FSK demodulation");
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx config d FSK i 1") " - FSK demodulation, inverse data");
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx config d FSK i 1 o 3") " - FSK demodulation, inverse data, offset=3,start from position 3 to decode data");
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "");
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
2020-05-03 07:13:28 +08:00
static int usage_t55xx_read(void) {
PrintAndLogEx(NORMAL, "Usage: lf t55xx read [r <mode>] b <block> [p <password>] [o] <page1>");
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "Options:");
PrintAndLogEx(NORMAL, " b <block> - block number to read. Between 0-7");
PrintAndLogEx(NORMAL, " p <password> - OPTIONAL password (8 hex characters)");
PrintAndLogEx(NORMAL, " o - OPTIONAL override safety check");
2019-07-27 16:25:03 +08:00
PrintAndLogEx(NORMAL, " 1 - OPTIONAL 0|1 read Page 1 instead of Page 0");
2019-10-13 06:48:26 +08:00
print_usage_t55xx_downloadlink(T55XX_DLMODE_SINGLE, config.downlink_mode);
2019-10-05 18:07:28 +08:00
PrintAndLogEx(NORMAL, " " _RED_("**** WARNING ****"));
PrintAndLogEx(NORMAL, " Use of read with password on a tag not configured");
PrintAndLogEx(NORMAL, " for a password can damage the tag");
PrintAndLogEx(NORMAL, " " _RED_("*****************"));
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "");
PrintAndLogEx(NORMAL, "Examples:");
2020-08-21 23:15:58 +08:00
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx read b 0") " - read data from block 0");
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx read b 0 p feedbeef") " - read data from block 0 password feedbeef");
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx read b 0 p feedbeef o") " - read data from block 0 password feedbeef safety check");
PrintAndLogEx(NORMAL, "");
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
2020-05-03 07:13:28 +08:00
static int usage_t55xx_resetread(void) {
PrintAndLogEx(NORMAL, "Send Reset Cmd then lf read the stream to attempt to identify the start of it (needs a demod and/or plot after)");
PrintAndLogEx(NORMAL, "Usage: lf t55xx resetread [r <mode>]");
PrintAndLogEx(NORMAL, "Options:");
2019-10-13 06:48:26 +08:00
print_usage_t55xx_downloadlink(T55XX_DLMODE_SINGLE, config.downlink_mode);
PrintAndLogEx(NORMAL, "");
PrintAndLogEx(NORMAL, "Examples:");
2020-08-21 23:15:58 +08:00
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx resetread"));
PrintAndLogEx(NORMAL, "");
return PM3_SUCCESS;
}
2020-05-03 07:13:28 +08:00
static int usage_t55xx_write(void) {
PrintAndLogEx(NORMAL, "Usage: lf t55xx write [r <mode>] b <block> d <data> [p <password>] [1] [t] [v]");
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "Options:");
PrintAndLogEx(NORMAL, " b <block> - block number to write. Between 0-7");
PrintAndLogEx(NORMAL, " d <data> - 4 bytes of data to write (8 hex characters)");
PrintAndLogEx(NORMAL, " p <password> - OPTIONAL password 4bytes (8 hex characters)");
PrintAndLogEx(NORMAL, " 1 - OPTIONAL write Page 1 instead of Page 0");
PrintAndLogEx(NORMAL, " t - OPTIONAL test mode write - ****DANGER****");
PrintAndLogEx(NORMAL, " v - OPTIONAL validate data afterwards");
2019-10-13 06:48:26 +08:00
print_usage_t55xx_downloadlink(T55XX_DLMODE_SINGLE, config.downlink_mode);
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "");
PrintAndLogEx(NORMAL, "Examples:");
2020-08-21 23:15:58 +08:00
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx write b 3 d 11223344") " - write 11223344 to block 3");
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx write b 3 d 11223344 p feedbeef") " - write 11223344 to block 3 password feedbeef");
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx write b 3 d 11223344 v") " - write 11223344 to block 3 and try to validate data");
PrintAndLogEx(NORMAL, "");
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
2020-05-03 07:13:28 +08:00
static int usage_t55xx_trace(void) {
PrintAndLogEx(NORMAL, "Usage: lf t55xx trace [1] [r mode]");
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "Options:");
2019-10-13 06:48:26 +08:00
print_usage_t55xx_downloadlink(T55XX_DLMODE_SINGLE, config.downlink_mode);
PrintAndLogEx(NORMAL, " 1 - if set, use Graphbuffer otherwise read data from tag.");
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "");
PrintAndLogEx(NORMAL, "Examples:");
2020-08-21 23:15:58 +08:00
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx trace"));
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx trace 1"));
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "");
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
2020-05-03 07:13:28 +08:00
static int usage_t55xx_info(void) {
PrintAndLogEx(NORMAL, "Usage: lf t55xx info [1] [r <mode>] [c <blk0> [q]]");
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "Options:");
2019-09-14 12:13:55 +08:00
PrintAndLogEx(NORMAL, " (default) - read data from tag.");
PrintAndLogEx(NORMAL, " p <password> - OPTIONAL password 4bytes (8 hex symbols)");
PrintAndLogEx(NORMAL, " 1 - if set, use Graphbuffer instead of reading tag.");
PrintAndLogEx(NORMAL, " c <block0> - set configuration from a block0");
PrintAndLogEx(NORMAL, " if set, use these data instead of reading tag.");
PrintAndLogEx(NORMAL, " q - if set, provided data are interpreted as Q5 config.");
2019-10-13 06:48:26 +08:00
print_usage_t55xx_downloadlink(T55XX_DLMODE_SINGLE, config.downlink_mode);
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "");
PrintAndLogEx(NORMAL, "Examples:");
2020-08-21 23:15:58 +08:00
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx info"));
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx info 1"));
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx info d 00083040"));
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx info d 6001805A q"));
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx info p 11223344"));
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "");
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
2020-05-03 07:13:28 +08:00
static int usage_t55xx_dump(void) {
PrintAndLogEx(NORMAL, "Usage: lf t55xx dump [r <mode>] [p <password> [o]]");
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "Options:");
2019-10-10 18:27:48 +08:00
PrintAndLogEx(NORMAL, " p <password> - OPTIONAL password 4bytes (8 hex symbols)");
PrintAndLogEx(NORMAL, " o - OPTIONAL override, force pwd read despite danger to card");
2020-10-21 02:21:57 +08:00
PrintAndLogEx(NORMAL, " f <prefix> - override filename prefix (optional). Default is based on blk 0");
2019-10-13 06:48:26 +08:00
print_usage_t55xx_downloadlink(T55XX_DLMODE_SINGLE, config.downlink_mode);
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "");
PrintAndLogEx(NORMAL, "Examples:");
2020-08-21 23:15:58 +08:00
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx dump"));
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx dump p feedbeef o"));
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "");
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
2020-05-03 07:13:28 +08:00
static int usage_t55xx_restore(void) {
2019-10-10 18:27:48 +08:00
PrintAndLogEx(NORMAL, "Usage: lf t55xx restore f <filename> [p password]");
PrintAndLogEx(NORMAL, "Options:");
PrintAndLogEx(NORMAL, " f <filename> - filename of the dump file (.bin/.eml)");
PrintAndLogEx(NORMAL, " p <password> - optional password if target card has password set");
PrintAndLogEx(NORMAL, "");
PrintAndLogEx(NORMAL, _YELLOW_(" Assumes lf t55 detect has been run first!"));
PrintAndLogEx(NORMAL, "");
PrintAndLogEx(NORMAL, "Examples:");
2020-08-21 23:15:58 +08:00
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx restore f lf-t55xx-00148040-dump.bin"));
2019-10-10 18:27:48 +08:00
PrintAndLogEx(NORMAL, "");
return PM3_SUCCESS;
}
2020-05-03 07:13:28 +08:00
static int usage_t55xx_detect(void) {
2019-07-23 07:50:28 +08:00
PrintAndLogEx(NORMAL, "Usage: lf t55xx detect [1] [r <mode>] [p <password>]");
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "Options:");
PrintAndLogEx(NORMAL, " 1 - if set, use Graphbuffer otherwise read data from tag.");
2019-07-23 07:50:28 +08:00
PrintAndLogEx(NORMAL, " p <password - OPTIONAL password (8 hex characters)");
2019-10-13 06:48:26 +08:00
print_usage_t55xx_downloadlink(T55XX_DLMODE_ALL, T55XX_DLMODE_ALL);
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "");
PrintAndLogEx(NORMAL, "Examples:");
2020-08-21 23:15:58 +08:00
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx detect"));
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx detect 1"));
PrintAndLogEx(NORMAL, _YELLOW_(" lf t55xx detect p 11223344"));
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "");
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
2021-02-05 15:58:19 +08:00
2020-05-03 07:13:28 +08:00
static int usage_t55xx_dangerraw(void) {
2019-10-13 07:21:59 +08:00
PrintAndLogEx(NORMAL, "This command allows to emit arbitrary raw commands on T5577 and cut the field after arbitrary duration.");
PrintAndLogEx(NORMAL, _RED_("WARNING:") " this may lock definitively the tag in an unusable state!");
PrintAndLogEx(NORMAL, "Uncontrolled usage can easily write an invalid configuration, activate lock bits,");
PrintAndLogEx(NORMAL, "OTP bit, password protection bit, deactivate test-mode, lock your card forever.");
PrintAndLogEx(NORMAL, "Uncontrolled usage is known to the State of California to cause cancer.");
PrintAndLogEx(NORMAL, "");
PrintAndLogEx(NORMAL, "Usage: lf t55xx dangerraw [h] [b <bitstream> t <timing>]");
PrintAndLogEx(NORMAL, "Options:");
PrintAndLogEx(NORMAL, " h - This help");
PrintAndLogEx(NORMAL, " b <bitstream> - raw bitstream");
PrintAndLogEx(NORMAL, " t <timing> - time in microseconds before dropping the field");
PrintAndLogEx(NORMAL, "");
return PM3_SUCCESS;
}
2020-05-03 07:13:28 +08:00
static int usage_t55xx_clonehelp(void) {
PrintAndLogEx(NORMAL, "For cloning specific techs on T55xx tags, see commands available in corresponding LF sub-menus, e.g.:");
PrintAndLogEx(NORMAL, _GREEN_("lf awid clone"));
2020-10-12 18:27:00 +08:00
PrintAndLogEx(NORMAL, _GREEN_("lf destron clone"));
2020-09-29 02:31:45 +08:00
PrintAndLogEx(NORMAL, _GREEN_("lf em 410x_clone"));
2019-10-16 16:57:14 +08:00
// todo: implement restore
// PrintAndLogEx(NORMAL, _GREEN_("lf em 4x05_write"));
// PrintAndLogEx(NORMAL, _GREEN_("lf em 4x50_write"));
PrintAndLogEx(NORMAL, _GREEN_("lf fdxb clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf gallagher clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf gproxii clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf hid clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf indala clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf io clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf jablotron clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf keri clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf nedap clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf noralsy clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf motorola clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf pac clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf paradox clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf presco clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf pyramid clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf securakey clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf viking clone"));
PrintAndLogEx(NORMAL, _GREEN_("lf visa2000 clone"));
return PM3_SUCCESS;
}
2021-01-10 19:52:57 +08:00
2019-10-16 16:57:14 +08:00
static int CmdHelp(const char *Cmd);
static int CmdT55xxCloneHelp(const char *Cmd) {
(void)Cmd; // Cmd is not used so far
return usage_t55xx_clonehelp();
}
2020-05-03 07:13:28 +08:00
static void T55x7_SaveBlockData(uint8_t idx, uint32_t data) {
2019-10-10 18:27:48 +08:00
if (idx < T55x7_BLOCK_COUNT) {
2019-10-13 06:48:26 +08:00
cardmem[idx].valid = true;
2019-10-11 17:29:20 +08:00
cardmem[idx].blockdata = data;
2019-10-10 18:27:48 +08:00
}
}
2020-05-03 07:13:28 +08:00
static void T55x7_ClearAllBlockData(void) {
2019-10-10 18:27:48 +08:00
for (uint8_t idx = 0; idx < T55x7_BLOCK_COUNT; idx++) {
2019-10-13 06:48:26 +08:00
cardmem[idx].valid = false;
2019-10-11 17:29:20 +08:00
cardmem[idx].blockdata = 0x00;
2019-10-10 18:27:48 +08:00
}
}
int clone_t55xx_tag(uint32_t *blockdata, uint8_t numblocks) {
2019-10-10 19:07:57 +08:00
if (blockdata == NULL)
return PM3_EINVARG;
if (numblocks < 1 || numblocks > 8)
return PM3_EINVARG;
PacketResponseNG resp;
// fast push mode
conn.block_after_ACK = true;
for (int8_t i = 0; i < numblocks; i++) {
// Disable fast mode on last packet
if (i == numblocks - 1) {
conn.block_after_ACK = false;
}
clearCommandBuffer();
t55xx_write_block_t ng;
ng.data = blockdata[i];
ng.pwd = 0;
ng.blockno = i;
ng.flags = 0;
SendCommandNG(CMD_LF_T55XX_WRITEBL, (uint8_t *)&ng, sizeof(ng));
if (!WaitForResponseTimeout(CMD_LF_T55XX_WRITEBL, &resp, T55XX_WRITE_TIMEOUT)) {
PrintAndLogEx(ERR, "Error occurred, device did not respond during write operation.");
return PM3_ETIMEOUT;
}
}
2019-10-10 19:07:57 +08:00
2019-10-13 06:48:26 +08:00
uint8_t res = 0;
for (int8_t i = 0; i < numblocks; i++) {
if (i == 0) {
SetConfigWithBlock0(blockdata[0]);
if (t55xxAquireAndCompareBlock0(false, 0, blockdata[0], false))
continue;
}
if (t55xxVerifyWrite(i, 0, false, false, 0, 0xFF, blockdata[i]) == false)
res++;
}
if (res == 0)
2020-11-20 22:45:14 +08:00
PrintAndLogEx(SUCCESS, "Data written and verified");
2019-10-10 19:07:57 +08:00
return PM3_SUCCESS;
}
2019-09-19 16:54:34 +08:00
static bool t55xxProtect(bool lock, bool usepwd, uint8_t override, uint32_t password, uint8_t downlink_mode, uint32_t new_password) {
PrintAndLogEx(INFO, "Checking current configuration");
2019-09-19 16:54:34 +08:00
bool testmode = false;
uint32_t block0 = 0;
int res = T55xxReadBlockEx(T55x7_CONFIGURATION_BLOCK, T55x7_PAGE0, usepwd, override, password, downlink_mode, false);
if (res != PM3_SUCCESS) {
PrintAndLogEx(WARNING, "Failed to read block0, use " _YELLOW_("`p`") " password parameter?");
return false;
}
2019-09-19 16:54:34 +08:00
2020-03-24 18:31:23 +08:00
if (GetT55xxBlockData(&block0) == false) {
PrintAndLogEx(DEBUG, "ERROR decoded block0 == %08x", block0);
return false;
2020-03-24 18:31:23 +08:00
}
PrintAndLogEx(DEBUG, "OK read block0 == %08x", block0);
2019-09-19 16:54:34 +08:00
bool isPwdBitAlreadySet = (block0 >> (32 - 28) & 1);
if (isPwdBitAlreadySet) {
PrintAndLogEx(INFO, "PWD bit is already set");
usepwd = true;
}
2019-09-19 16:54:34 +08:00
// set / clear pwd bit
if (lock) {
block0 |= 1 << 4;
} else {
block0 &= ~(1 << 4);
}
2019-09-19 16:54:34 +08:00
// write new password
if (t55xxWrite(T55x7_PWD_BLOCK, T55x7_PAGE0, usepwd, testmode, password, downlink_mode, new_password) != PM3_SUCCESS) {
PrintAndLogEx(ERR, "Failed to write new password");
return false;
} else {
PrintAndLogEx(SUCCESS, "Wrote new password");
}
// validate new password
uint32_t curr_password = (isPwdBitAlreadySet) ? new_password : password;
2019-09-19 16:54:34 +08:00
if (t55xxVerifyWrite(T55x7_PWD_BLOCK, T55x7_PAGE0, usepwd, override, curr_password, downlink_mode, new_password) == false) {
PrintAndLogEx(WARNING, "Failed to validate the password write. aborting.");
return false;
} else {
PrintAndLogEx(SUCCESS, "Validated new password");
}
2019-09-19 16:54:34 +08:00
// write config
2019-09-19 16:54:34 +08:00
if (t55xxWrite(T55x7_CONFIGURATION_BLOCK, T55x7_PAGE0, usepwd, testmode, curr_password, downlink_mode, block0) != PM3_SUCCESS) {
PrintAndLogEx(ERR, "Failed to write modified configuration block %08X", block0);
return false;
} else {
PrintAndLogEx(SUCCESS, "Wrote modified configuration block");
}
2019-09-19 16:54:34 +08:00
// validate new config. If all went well, card should now demand pwd, hence override = 0.
override = 0;
if (t55xxVerifyWrite(T55x7_CONFIGURATION_BLOCK, T55x7_PAGE0, true, override, new_password, downlink_mode, block0) == false) {
PrintAndLogEx(WARNING, "Failed to validate pwd bit set on configuration block. aborting.");
return false;
} else {
PrintAndLogEx(SUCCESS, "New configuration block " _YELLOW_("%08X")" password " _YELLOW_("%08X"), block0, new_password);
PrintAndLogEx(SUCCESS, "Success, tag is locked");
return true;
}
}
bool t55xxAquireAndCompareBlock0(bool usepwd, uint32_t password, uint32_t known_block0, bool verbose) {
if (verbose)
PrintAndLogEx(INFO, "Block0 write detected, running `detect` to see if validation is possible");
2019-09-19 16:54:34 +08:00
for (uint8_t m = 0; m < 4; m++) {
2019-10-10 19:07:57 +08:00
if (AcquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, usepwd, password, m) == false) {
continue;
}
2019-09-19 16:54:34 +08:00
if (DecodeT55xxBlock() == false) {
continue;
}
2019-09-19 16:54:34 +08:00
for (uint16_t i = 0; DemodBufferLen - 32; i++) {
uint32_t tmp = PackBits(i, 32, DemodBuffer);
2019-09-19 16:54:34 +08:00
if (tmp == known_block0) {
config.offset = i;
config.downlink_mode = m;
return true;
}
}
}
2019-09-19 16:54:34 +08:00
return false;
}
2019-09-16 02:30:05 +08:00
bool t55xxAquireAndDetect(bool usepwd, uint32_t password, uint32_t known_block0, bool verbose) {
if (verbose)
PrintAndLogEx(INFO, "Block0 write detected, running `detect` to see if validation is possible");
2019-09-19 16:54:34 +08:00
for (uint8_t m = 0; m < 4; m++) {
2019-10-10 19:07:57 +08:00
if (AcquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, usepwd, password, m) == false)
2019-09-16 02:30:05 +08:00
continue;
2020-10-09 21:31:27 +08:00
if (t55xxTryDetectModulationEx(m, verbose, known_block0, (usepwd) ? password : -1) == false)
2019-09-16 02:30:05 +08:00
continue;
config.downlink_mode = m;
2019-09-16 02:30:05 +08:00
return true;
}
config.usepwd = false; // unknown so assume no password
config.pwd = 0x00;
2019-09-19 16:54:34 +08:00
return false;
2019-09-16 02:30:05 +08:00
}
bool t55xxVerifyWrite(uint8_t block, bool page1, bool usepwd, uint8_t override, uint32_t password, uint8_t downlink_mode, uint32_t data) {
uint32_t read_data = 0;
2019-09-19 16:54:34 +08:00
if (downlink_mode == 0xFF)
2019-09-16 02:30:05 +08:00
downlink_mode = config.downlink_mode;
int res = T55xxReadBlockEx(block, page1, usepwd, override, password, downlink_mode, false);
if (res == PM3_SUCCESS) {
if (GetT55xxBlockData(&read_data) == false)
return false;
2020-04-29 01:58:07 +08:00
} else if (res == PM3_EWRONGANSWER) {
2019-09-19 16:54:34 +08:00
// could't decode. Lets see if this was a block 0 write and try read/detect it auto.
// this messes up with ppls config..
if (block == 0 && page1 == false) {
2019-09-16 02:30:05 +08:00
if (t55xxAquireAndDetect(usepwd, password, data, true) == false)
return false;
2019-09-19 16:54:34 +08:00
2019-09-16 02:30:05 +08:00
return t55xxVerifyWrite(block, page1, usepwd, 2, password, config.downlink_mode, data);
}
}
return (read_data == data);
}
int t55xxWrite(uint8_t block, bool page1, bool usepwd, bool testMode, uint32_t password, uint8_t downlink_mode, uint32_t data) {
2019-09-19 16:54:34 +08:00
uint8_t flags;
flags = (usepwd) ? 0x1 : 0;
flags |= (page1) ? 0x2 : 0;
flags |= (testMode) ? 0x4 : 0;
flags |= (downlink_mode << 3);
/*
OLD style
arg0 = data, (4 bytes)
arg1 = block (1 byte)
arg2 = password (4 bytes)
flags = data[0] (1 byte)
new style
uses struct in pm3_cmd.h
*/
t55xx_write_block_t ng;
ng.data = data;
ng.pwd = password;
ng.blockno = block;
ng.flags = flags;
PacketResponseNG resp;
clearCommandBuffer();
SendCommandNG(CMD_LF_T55XX_WRITEBL, (uint8_t *)&ng, sizeof(ng));
if (!WaitForResponseTimeout(CMD_LF_T55XX_WRITEBL, &resp, 2000)) {
PrintAndLogEx(ERR, "Error occurred, device did not ACK write operation.");
return PM3_ETIMEOUT;
}
return resp.status;
}
void printT5xxHeader(uint8_t page) {
2019-09-16 02:46:21 +08:00
PrintAndLogEx(SUCCESS, "Reading Page %d:", page);
PrintAndLogEx(SUCCESS, "blk | hex data | binary | ascii");
PrintAndLogEx(SUCCESS, "----+----------+----------------------------------+-------");
}
void SetConfigWithBlock0(uint32_t block0) {
SetConfigWithBlock0Ex(block0, 0, false);
}
void SetConfigWithBlock0Ex(uint32_t block0, uint8_t offset, bool Q5) {
// T55x7
uint32_t extend = (block0 >> (32 - 15)) & 0x01;
uint32_t dbr;
if (extend)
dbr = (block0 >> (32 - 14)) & 0x3F;
else
dbr = (block0 >> (32 - 14)) & 0x07;
uint32_t datamod = (block0 >> (32 - 20)) & 0x1F;
bool pwd = (bool)((block0 >> (32 - 28)) & 0x01);
bool sst = (bool)((block0 >> (32 - 29)) & 0x01);
bool inv = (bool)((block0 >> (32 - 31)) & 0x01);
2019-09-19 16:54:34 +08:00
config.modulation = datamod;
config.bitrate = dbr;
2019-09-19 16:54:34 +08:00
// FSK1a, FSK2a
2019-09-19 16:54:34 +08:00
if (datamod == DEMOD_FSK1a || datamod == DEMOD_FSK2a || datamod == DEMOD_BIa)
config.inverted = 1;
else
config.inverted = inv;
2019-09-19 16:54:34 +08:00
config.Q5 = Q5;
config.ST = sst;
config.usepwd = pwd;
config.offset = offset;
config.block0 = block0;
}
static int CmdT55xxSetConfig(const char *Cmd) {
// No args
if (strlen(Cmd) == 0) return printConfiguration(config);
2019-04-08 16:01:57 +08:00
uint8_t offset = 0, bitRate = 0;
2019-03-10 06:35:06 +08:00
char modulation[6] = {0x00};
2019-03-10 07:00:59 +08:00
uint8_t rates[9] = {8, 16, 32, 40, 50, 64, 100, 128, 0};
2019-03-10 06:35:06 +08:00
uint8_t cmdp = 0;
2019-09-14 12:13:55 +08:00
uint8_t downlink_mode = 0;
2019-03-10 06:35:06 +08:00
bool errors = false;
uint32_t block0 = 0;
bool gotconf = false;
2019-09-19 16:54:34 +08:00
2019-03-10 07:00:59 +08:00
while (param_getchar(Cmd, cmdp) != 0x00 && !errors) {
2019-04-08 16:01:57 +08:00
char tmp = tolower(param_getchar(Cmd, cmdp));
2019-03-10 07:00:59 +08:00
switch (tmp) {
case 'h':
return usage_t55xx_config();
case 'b':
errors |= param_getdec(Cmd, cmdp + 1, &bitRate);
if (!errors) {
uint8_t i = 0;
for (; i < 9; i++) {
if (rates[i] == bitRate) {
config.bitrate = i;
2020-12-07 20:55:11 +08:00
config.block0 = ((config.block0 & ~(0x1c0000)) | (i << 18));
2019-03-10 07:00:59 +08:00
break;
}
2019-03-10 06:35:06 +08:00
}
2019-03-10 07:00:59 +08:00
if (i == 9) errors = true;
2019-03-10 06:35:06 +08:00
}
2019-03-10 07:00:59 +08:00
cmdp += 2;
break;
case 'c':
block0 = param_get32ex(Cmd, cmdp + 1, 0, 16);
gotconf = true;
cmdp += 2;
break;
2019-03-10 07:00:59 +08:00
case 'd':
param_getstr(Cmd, cmdp + 1, modulation, sizeof(modulation));
cmdp += 2;
if (strcmp(modulation, "FSK") == 0) {
config.modulation = DEMOD_FSK;
} else if (strcmp(modulation, "FSK1") == 0) {
config.modulation = DEMOD_FSK1;
config.inverted = 1;
} else if (strcmp(modulation, "FSK1a") == 0) {
config.modulation = DEMOD_FSK1a;
config.inverted = 0;
} else if (strcmp(modulation, "FSK2") == 0) {
config.modulation = DEMOD_FSK2;
config.inverted = 0;
} else if (strcmp(modulation, "FSK2a") == 0) {
config.modulation = DEMOD_FSK2a;
config.inverted = 1;
} else if (strcmp(modulation, "ASK") == 0) {
config.modulation = DEMOD_ASK;
} else if (strcmp(modulation, "NRZ") == 0) {
config.modulation = DEMOD_NRZ;
} else if (strcmp(modulation, "PSK1") == 0) {
config.modulation = DEMOD_PSK1;
} else if (strcmp(modulation, "PSK2") == 0) {
config.modulation = DEMOD_PSK2;
} else if (strcmp(modulation, "PSK3") == 0) {
config.modulation = DEMOD_PSK3;
} else if (strcmp(modulation, "BIa") == 0) {
config.modulation = DEMOD_BIa;
config.inverted = 1;
} else if (strcmp(modulation, "BI") == 0) {
config.modulation = DEMOD_BI;
config.inverted = 0;
} else {
PrintAndLogEx(WARNING, "Unknown modulation '%s'", modulation);
errors = true;
}
2020-12-08 07:33:58 +08:00
config.block0 = ((config.block0 & ~(0x1f000)) | (config.modulation << 12));
2019-03-10 07:00:59 +08:00
break;
case 'i':
if ((param_getchar(Cmd, cmdp + 1) == '0') || (param_getchar(Cmd, cmdp + 1) == '1')) {
config.inverted = param_getchar(Cmd, cmdp + 1) == '1';
cmdp += 2;
} else {
config.inverted = true;
cmdp += 1;
}
2019-03-10 07:00:59 +08:00
break;
case 'o':
errors |= param_getdec(Cmd, cmdp + 1, &offset);
if (!errors)
config.offset = offset;
cmdp += 2;
break;
case 'q':
if ((param_getchar(Cmd, cmdp + 1) == '0') || (param_getchar(Cmd, cmdp + 1) == '1')) {
config.Q5 = param_getchar(Cmd, cmdp + 1) == '1';
cmdp += 2;
} else {
config.Q5 = true;
cmdp += 1;
}
2019-03-10 07:00:59 +08:00
break;
case 's':
if ((param_getchar(Cmd, cmdp + 1) == '0') || (param_getchar(Cmd, cmdp + 1) == '1')) {
config.ST = param_getchar(Cmd, cmdp + 1) == '1';
cmdp += 2;
} else {
config.ST = true;
cmdp += 1;
}
2020-12-07 20:55:11 +08:00
config.block0 = ((config.block0 & ~(0x8)) | (config.ST << 3));
2019-03-10 07:00:59 +08:00
break;
2019-09-14 12:13:55 +08:00
case 'r':
errors = param_getdec(Cmd, cmdp + 1, &downlink_mode);
2019-09-14 12:13:55 +08:00
if (downlink_mode > 3)
downlink_mode = 0;
if (!errors)
config.downlink_mode = downlink_mode;
cmdp += 2;
break;
2019-03-10 07:00:59 +08:00
default:
PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
2019-03-10 06:35:06 +08:00
errors = true;
2019-03-10 07:00:59 +08:00
break;
2019-03-10 06:35:06 +08:00
}
}
//Validations
if (errors) return usage_t55xx_config();
config.block0Status = userSet;
2019-09-19 16:54:34 +08:00
if (gotconf) {
SetConfigWithBlock0Ex(block0, config.offset, config.Q5);
}
2019-03-10 07:00:59 +08:00
return printConfiguration(config);
}
2019-07-23 07:50:28 +08:00
int T55xxReadBlock(uint8_t block, bool page1, bool usepwd, uint8_t override, uint32_t password, uint8_t downlink_mode) {
2020-09-11 17:02:19 +08:00
return T55xxReadBlockEx(block, page1, usepwd, override, password, downlink_mode, true);
}
int T55xxReadBlockEx(uint8_t block, bool page1, bool usepwd, uint8_t override, uint32_t password, uint8_t downlink_mode, bool verbose) {
2019-03-10 06:35:06 +08:00
//Password mode
2019-03-10 07:00:59 +08:00
if (usepwd) {
2019-03-10 06:35:06 +08:00
// try reading the config block and verify that PWD bit is set before doing this!
// override = 1 (override and display)
// override = 2 (override and no display)
if (override == 0) {
2019-10-10 19:07:57 +08:00
if (AcquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, false, 0, downlink_mode) == false)
return PM3_ERFTRANS;
2019-03-10 06:35:06 +08:00
2020-10-09 21:31:27 +08:00
if (t55xxTryDetectModulationEx(downlink_mode, false, 0, password) == false) {
PrintAndLogEx(WARNING, "Safety check: Could not detect if PWD bit is set in config block. Exits.");
2020-04-29 01:58:07 +08:00
return PM3_EWRONGANSWER;
2019-03-10 06:35:06 +08:00
} else {
PrintAndLogEx(WARNING, "Safety check: PWD bit is NOT set in config block. Reading without password...");
2019-03-10 06:35:06 +08:00
usepwd = false;
page1 = false; // ??
2019-03-10 06:35:06 +08:00
}
} else if (override == 1) {
PrintAndLogEx(INFO, "Safety check overridden - proceeding despite risk");
2019-03-10 06:35:06 +08:00
}
}
2019-10-10 19:07:57 +08:00
if (AcquireData(page1, block, usepwd, password, downlink_mode) == false)
return PM3_ERFTRANS;
if (DecodeT55xxBlock() == false)
2020-04-29 01:58:07 +08:00
return PM3_EWRONGANSWER;
if (verbose)
2019-10-13 06:48:26 +08:00
printT55xxBlock(block, page1);
2019-03-10 06:35:06 +08:00
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
static int CmdT55xxReadBlock(const char *Cmd) {
uint8_t block = REGULAR_READ_MODE_BLOCK;
uint8_t override = 0;
uint8_t cmdp = 0;
2019-09-14 12:13:55 +08:00
uint8_t downlink_mode = config.downlink_mode;
uint32_t password = 0; //default to blank Block 7
bool usepwd = false;
bool page1 = false;
bool errors = false;
2019-07-24 05:43:30 +08:00
2019-03-10 07:00:59 +08:00
while (param_getchar(Cmd, cmdp) != 0x00 && !errors) {
switch (tolower(param_getchar(Cmd, cmdp))) {
case 'h':
return usage_t55xx_read();
case 'b':
errors |= param_getdec(Cmd, cmdp + 1, &block);
cmdp += 2;
break;
case 'o':
override = 1;
2019-03-10 07:00:59 +08:00
cmdp++;
break;
case 'p':
password = param_get32ex(Cmd, cmdp + 1, 0, 16);
usepwd = true;
cmdp += 2;
break;
case '1':
page1 = true;
cmdp++;
break;
2019-07-24 05:43:30 +08:00
case 'r':
downlink_mode = param_get8ex(Cmd, cmdp + 1, 0, 10);
if (downlink_mode > 3)
2019-09-13 22:32:37 +08:00
downlink_mode = 0;
2019-07-24 05:43:30 +08:00
cmdp += 2;
break;
2019-03-10 07:00:59 +08:00
default:
PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
errors = true;
break;
2019-03-10 06:35:06 +08:00
}
}
if (errors || cmdp == 0) return usage_t55xx_read();
2019-03-10 06:35:06 +08:00
if (block > 7 && block != REGULAR_READ_MODE_BLOCK) {
PrintAndLogEx(NORMAL, "Block must be between 0 and 7");
2019-05-22 20:48:23 +08:00
return PM3_ESOFT;
2019-03-10 06:35:06 +08:00
}
printT5xxHeader(page1);
2019-07-23 07:50:28 +08:00
return T55xxReadBlock(block, page1, usepwd, override, password, downlink_mode);
}
bool DecodeT55xxBlock(void) {
2019-03-10 06:35:06 +08:00
int ans = 0;
bool ST = config.ST;
2019-03-10 07:00:59 +08:00
uint8_t bitRate[8] = {8, 16, 32, 40, 50, 64, 100, 128};
2019-03-10 06:35:06 +08:00
DemodBufferLen = 0x00;
2019-03-10 07:00:59 +08:00
switch (config.modulation) {
2019-03-10 06:35:06 +08:00
case DEMOD_FSK:
2020-09-28 17:50:20 +08:00
ans = FSKrawDemod(bitRate[config.bitrate], config.inverted, 0, 0, false);
2019-03-10 06:35:06 +08:00
break;
case DEMOD_FSK1:
case DEMOD_FSK1a:
2020-09-28 17:50:20 +08:00
ans = FSKrawDemod(bitRate[config.bitrate], config.inverted, 8, 5, false);
2019-03-10 06:35:06 +08:00
break;
case DEMOD_FSK2:
case DEMOD_FSK2a:
2020-09-28 17:50:20 +08:00
ans = FSKrawDemod(bitRate[config.bitrate], config.inverted, 10, 8, false);
2019-03-10 06:35:06 +08:00
break;
case DEMOD_ASK:
2020-09-28 17:50:20 +08:00
ans = ASKDemod_ext(bitRate[config.bitrate], config.inverted, 1, 0, false, false, false, 1, &ST);
2019-03-10 06:35:06 +08:00
break;
case DEMOD_PSK1:
2020-09-28 17:50:20 +08:00
ans = PSKDemod(bitRate[config.bitrate], config.inverted, 6, false);
2019-03-10 06:35:06 +08:00
break;
case DEMOD_PSK2: //inverted won't affect this
case DEMOD_PSK3: //not fully implemented
2020-09-28 17:50:20 +08:00
ans = PSKDemod(bitRate[config.bitrate], 0, 6, false);
2019-03-10 06:35:06 +08:00
psk1TOpsk2(DemodBuffer, DemodBufferLen);
break;
case DEMOD_NRZ:
2020-09-28 17:50:20 +08:00
ans = NRZrawDemod(bitRate[config.bitrate], config.inverted, 1, false);
2019-03-10 06:35:06 +08:00
break;
case DEMOD_BI:
case DEMOD_BIa:
2020-09-28 17:50:20 +08:00
ans = ASKbiphaseDemod(0, bitRate[config.bitrate], config.inverted, 1, false);
2019-03-10 06:35:06 +08:00
break;
default:
return false;
}
return (ans == PM3_SUCCESS);
}
static bool DecodeT5555TraceBlock(void) {
2019-03-10 06:35:06 +08:00
DemodBufferLen = 0x00;
2019-03-10 06:35:06 +08:00
// According to datasheet. Always: RF/64, not inverted, Manchester
2020-09-28 17:50:20 +08:00
bool st = false;
return (ASKDemod_ext(64, 0, 1, 0, false, false, false, 1, &st) == PM3_SUCCESS);
}
// sanity check. Don't use proxmark if it is offline and you didn't specify useGraphbuf
static int SanityOfflineCheck(bool useGraphBuffer) {
2019-05-01 05:52:40 +08:00
if (!useGraphBuffer && !session.pm3_present) {
2019-04-17 02:00:25 +08:00
PrintAndLogEx(WARNING, "Your proxmark3 device is offline. Specify [1] to use graphbuffer data instead");
2019-05-22 20:48:23 +08:00
return PM3_ENODATA;
2019-03-10 06:35:06 +08:00
}
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
2020-05-03 07:13:28 +08:00
static void T55xx_Print_DownlinkMode(uint8_t downlink_mode) {
2019-07-27 16:25:03 +08:00
char msg[80];
2020-09-07 16:35:09 +08:00
snprintf(msg, sizeof(msg), "Downlink Mode used : ");
2019-07-24 05:43:30 +08:00
switch (downlink_mode) {
case 1 :
2019-07-27 16:25:03 +08:00
strcat(msg, _YELLOW_("long leading reference"));
2019-07-24 05:43:30 +08:00
break;
case 2 :
2019-07-27 16:25:03 +08:00
strcat(msg, _YELLOW_("leading zero reference"));
2019-07-24 05:43:30 +08:00
break;
case 3 :
2019-07-27 16:25:03 +08:00
strcat(msg, _YELLOW_("1 of 4 coding reference"));
2019-07-24 05:43:30 +08:00
break;
default :
2019-07-27 16:25:03 +08:00
strcat(msg, _YELLOW_("default/fixed bit length"));
2019-07-24 05:43:30 +08:00
break;
}
2019-07-27 16:25:03 +08:00
PrintAndLogEx(NORMAL, msg);
2019-07-23 07:50:28 +08:00
}
2019-09-14 12:13:55 +08:00
// Define prototype to call from within detect.
2020-11-23 08:39:54 +08:00
static int CmdT55xxWakeUp(const char *Cmd);
static int CmdT55xxDetect(const char *Cmd) {
2019-07-23 07:50:28 +08:00
bool errors = false;
bool useGB = false;
bool usepwd = false;
bool try_with_pwd = false;
2019-09-14 12:13:55 +08:00
bool try_all_dl_modes = true;
bool found = false;
bool usewake = false;
2020-08-21 23:15:58 +08:00
uint64_t password = -1;
uint8_t cmdp = 0;
uint8_t downlink_mode = 0;
char wakecmd[20] = { 0x00 };
struct timespec sleepperiod;
// Setup the 90ms time value to sleep for after the wake, to allow delay init to complete (~70ms)
sleepperiod.tv_sec = 0;
sleepperiod.tv_nsec = 90000000;
2019-03-10 06:35:06 +08:00
while (param_getchar(Cmd, cmdp) != 0x00 && !errors) {
2019-03-10 07:00:59 +08:00
switch (tolower(param_getchar(Cmd, cmdp))) {
case 'h':
return usage_t55xx_detect();
case 'p':
password = param_get32ex(Cmd, cmdp + 1, 0, 16);
2020-11-23 08:39:54 +08:00
sprintf(wakecmd, "p %08x q", (uint32_t)(password & 0xFFFFFFFF));
2019-03-10 07:00:59 +08:00
usepwd = true;
cmdp += 2;
break;
case '1':
useGB = true;
cmdp++;
break;
2019-07-24 05:43:30 +08:00
case 'r':
downlink_mode = param_get8ex(Cmd, cmdp + 1, 0, 10);
2019-09-14 12:13:55 +08:00
if (downlink_mode <= 3) try_all_dl_modes = false; // User selected ONLY 1 so honor.
if (downlink_mode == 4) try_all_dl_modes = true;
if (downlink_mode > 3) downlink_mode = 0;
2019-07-24 05:43:30 +08:00
cmdp += 2;
break;
2019-03-10 07:00:59 +08:00
default:
PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
errors = true;
break;
2019-03-10 06:35:06 +08:00
}
}
if (errors) return usage_t55xx_detect();
2020-11-23 08:39:54 +08:00
2019-10-10 18:27:48 +08:00
// detect called so clear data blocks
2019-10-13 06:48:26 +08:00
T55x7_ClearAllBlockData();
2019-10-10 18:27:48 +08:00
2019-03-10 06:35:06 +08:00
// sanity check.
if (SanityOfflineCheck(useGB) != PM3_SUCCESS)
return PM3_ESOFT;
if (useGB == false) {
// do ... while not found and not yet tried with wake (for AOR or Init Delay)
do {
// do ... while to check without password then loop back if password supplied
do {
if (try_all_dl_modes) {
for (uint8_t m = downlink_mode; m < 4; m++) {
if (usewake) {
// call wake
if (try_with_pwd)
2020-11-23 08:39:54 +08:00
CmdT55xxWakeUp(wakecmd);
else
2020-11-23 08:39:54 +08:00
CmdT55xxWakeUp("q");
// sleep 90 ms
2020-11-23 08:39:54 +08:00
nanosleep(&sleepperiod, &sleepperiod);
}
2019-10-13 06:48:26 +08:00
if (AcquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, (try_with_pwd && usepwd), password, m) == false)
continue;
2019-10-13 06:48:26 +08:00
if (t55xxTryDetectModulationEx(m, T55XX_PrintConfig, 0, (try_with_pwd && usepwd) ? password : -1) == false)
continue;
found = true;
break;
}
} else {
if (usewake) {
// call wake
if (try_with_pwd)
2020-11-23 08:39:54 +08:00
CmdT55xxWakeUp(wakecmd);
else
2020-11-23 08:39:54 +08:00
CmdT55xxWakeUp("q");
// sleep 90 ms
2020-11-23 08:39:54 +08:00
nanosleep(&sleepperiod, &sleepperiod);
}
2020-09-07 16:35:09 +08:00
if (AcquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, usepwd, password, downlink_mode)) {
found = t55xxTryDetectModulationEx(downlink_mode, T55XX_PrintConfig, 0, (usepwd) ? password : -1);
}
}
2019-09-19 16:54:34 +08:00
// toggle so we loop back if not found and try with pwd
if (!found && usepwd)
try_with_pwd = !try_with_pwd;
2019-10-13 06:48:26 +08:00
// force exit as detect block has been found
if (found)
try_with_pwd = false;
2019-09-16 02:30:05 +08:00
} while (try_with_pwd);
// Toggle so we loop back and try with wakeup.
usewake = !usewake;
} while (!found && usewake);
2019-09-14 12:13:55 +08:00
} else {
2020-10-09 21:31:27 +08:00
found = t55xxTryDetectModulation(downlink_mode, T55XX_PrintConfig);
2019-07-24 05:43:30 +08:00
}
2019-09-19 16:54:34 +08:00
if (found == false) {
config.usepwd = false;
config.pwd = 0x00;
2019-04-07 01:09:01 +08:00
PrintAndLogEx(WARNING, "Could not detect modulation automatically. Try setting it manually with " _YELLOW_("\'lf t55xx config\'"));
}
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
2019-09-14 12:13:55 +08:00
// detect configuration?
2020-10-09 21:31:27 +08:00
bool t55xxTryDetectModulation(uint8_t downlink_mode, bool print_config) {
return t55xxTryDetectModulationEx(downlink_mode, print_config, 0, -1);
2019-09-16 02:30:05 +08:00
}
2020-10-09 21:31:27 +08:00
bool t55xxTryDetectModulationEx(uint8_t downlink_mode, bool print_config, uint32_t wanted_conf, uint64_t pwd) {
2019-03-10 06:35:06 +08:00
t55xx_conf_block_t tests[15];
int bitRate = 0, clk = 0, firstClockEdge = 0;
uint8_t hits = 0, fc1 = 0, fc2 = 0, ans = 0;
ans = fskClocks(&fc1, &fc2, (uint8_t *)&clk, &firstClockEdge);
2019-03-10 07:00:59 +08:00
if (ans && ((fc1 == 10 && fc2 == 8) || (fc1 == 8 && fc2 == 5))) {
2020-09-28 17:50:20 +08:00
if ((FSKrawDemod(0, 0, 0, 0, false) == PM3_SUCCESS) && test(DEMOD_FSK, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
2019-03-10 06:35:06 +08:00
tests[hits].modulation = DEMOD_FSK;
2019-03-10 07:00:59 +08:00
if (fc1 == 8 && fc2 == 5)
2019-03-10 06:35:06 +08:00
tests[hits].modulation = DEMOD_FSK1a;
2019-03-10 07:00:59 +08:00
else if (fc1 == 10 && fc2 == 8)
2019-03-10 06:35:06 +08:00
tests[hits].modulation = DEMOD_FSK2;
tests[hits].bitrate = bitRate;
tests[hits].inverted = false;
tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
tests[hits].ST = false;
2019-09-14 12:13:55 +08:00
tests[hits].downlink_mode = downlink_mode;
2019-03-10 06:35:06 +08:00
++hits;
}
2020-09-28 17:50:20 +08:00
if ((FSKrawDemod(0, 1, 0, 0, false) == PM3_SUCCESS) && test(DEMOD_FSK, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
2019-03-10 06:35:06 +08:00
tests[hits].modulation = DEMOD_FSK;
if (fc1 == 8 && fc2 == 5)
tests[hits].modulation = DEMOD_FSK1;
else if (fc1 == 10 && fc2 == 8)
tests[hits].modulation = DEMOD_FSK2a;
tests[hits].bitrate = bitRate;
tests[hits].inverted = true;
tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
tests[hits].ST = false;
2019-09-14 12:13:55 +08:00
tests[hits].downlink_mode = downlink_mode;
2019-03-10 06:35:06 +08:00
++hits;
}
} else {
clk = GetAskClock("", false);
if (clk > 0) {
tests[hits].ST = true;
// "0 0 1 " == clock auto, invert false, maxError 1.
// false = no verbose
// false = no emSearch
// 1 = Ask/Man
// st = true
2020-09-28 17:50:20 +08:00
if ((ASKDemod_ext(0, 0, 1, 0, false, false, false, 1, &tests[hits].ST) == PM3_SUCCESS) && test(DEMOD_ASK, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
2019-03-10 06:35:06 +08:00
tests[hits].modulation = DEMOD_ASK;
tests[hits].bitrate = bitRate;
tests[hits].inverted = false;
tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
2019-09-14 12:13:55 +08:00
tests[hits].downlink_mode = downlink_mode;
2019-03-10 06:35:06 +08:00
++hits;
}
tests[hits].ST = true;
// "0 0 1 " == clock auto, invert true, maxError 1.
// false = no verbose
// false = no emSearch
// 1 = Ask/Man
// st = true
2020-09-28 17:50:20 +08:00
if ((ASKDemod_ext(0, 1, 1, 0, false, false, false, 1, &tests[hits].ST) == PM3_SUCCESS) && test(DEMOD_ASK, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
2019-03-10 06:35:06 +08:00
tests[hits].modulation = DEMOD_ASK;
tests[hits].bitrate = bitRate;
tests[hits].inverted = true;
tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
2019-09-14 12:13:55 +08:00
tests[hits].downlink_mode = downlink_mode;
2019-03-10 06:35:06 +08:00
++hits;
}
2020-09-28 17:50:20 +08:00
if ((ASKbiphaseDemod(0, 0, 0, 2, false) == PM3_SUCCESS) && test(DEMOD_BI, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
2019-03-10 06:35:06 +08:00
tests[hits].modulation = DEMOD_BI;
tests[hits].bitrate = bitRate;
tests[hits].inverted = false;
tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
tests[hits].ST = false;
2019-09-14 12:13:55 +08:00
tests[hits].downlink_mode = downlink_mode;
2019-03-10 06:35:06 +08:00
++hits;
}
2020-09-28 17:50:20 +08:00
if ((ASKbiphaseDemod(0, 0, 1, 2, false) == PM3_SUCCESS) && test(DEMOD_BIa, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
2019-03-10 06:35:06 +08:00
tests[hits].modulation = DEMOD_BIa;
tests[hits].bitrate = bitRate;
tests[hits].inverted = true;
tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
tests[hits].ST = false;
2019-09-14 12:13:55 +08:00
tests[hits].downlink_mode = downlink_mode;
2019-03-10 06:35:06 +08:00
++hits;
}
}
clk = GetNrzClock("", false);
if (clk > 8) { //clock of rf/8 is likely a false positive, so don't use it.
2020-09-28 17:50:20 +08:00
if ((NRZrawDemod(0, 0, 1, false) == PM3_SUCCESS) && test(DEMOD_NRZ, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
2019-03-10 06:35:06 +08:00
tests[hits].modulation = DEMOD_NRZ;
tests[hits].bitrate = bitRate;
tests[hits].inverted = false;
tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
tests[hits].ST = false;
2019-09-14 12:13:55 +08:00
tests[hits].downlink_mode = downlink_mode;
2019-03-10 06:35:06 +08:00
++hits;
}
2020-09-28 17:50:20 +08:00
if ((NRZrawDemod(0, 1, 1, false) == PM3_SUCCESS) && test(DEMOD_NRZ, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
2019-03-10 06:35:06 +08:00
tests[hits].modulation = DEMOD_NRZ;
tests[hits].bitrate = bitRate;
tests[hits].inverted = true;
tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
tests[hits].ST = false;
2019-09-14 12:13:55 +08:00
tests[hits].downlink_mode = downlink_mode;
2019-03-10 06:35:06 +08:00
++hits;
}
}
clk = GetPskClock("", false);
if (clk > 0) {
// allow undo
save_restoreGB(GRAPH_SAVE);
// skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)
CmdLtrim("160");
2020-09-28 17:50:20 +08:00
if ((PSKDemod(0, 0, 6, false) == PM3_SUCCESS) && test(DEMOD_PSK1, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
2019-03-10 06:35:06 +08:00
tests[hits].modulation = DEMOD_PSK1;
tests[hits].bitrate = bitRate;
tests[hits].inverted = false;
tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
tests[hits].ST = false;
2019-09-14 12:13:55 +08:00
tests[hits].downlink_mode = downlink_mode;
2019-03-10 06:35:06 +08:00
++hits;
}
2020-09-28 17:50:20 +08:00
if ((PSKDemod(0, 1, 6, false) == PM3_SUCCESS) && test(DEMOD_PSK1, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
2019-03-10 06:35:06 +08:00
tests[hits].modulation = DEMOD_PSK1;
tests[hits].bitrate = bitRate;
tests[hits].inverted = true;
tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
tests[hits].ST = false;
2019-09-14 12:13:55 +08:00
tests[hits].downlink_mode = downlink_mode;
2019-03-10 06:35:06 +08:00
++hits;
}
//ICEMAN: are these PSKDemod calls needed?
// PSK2 - needs a call to psk1TOpsk2.
2020-09-28 17:50:20 +08:00
if (PSKDemod(0, 0, 6, false) == PM3_SUCCESS) {
2019-03-10 06:35:06 +08:00
psk1TOpsk2(DemodBuffer, DemodBufferLen);
2019-03-10 07:00:59 +08:00
if (test(DEMOD_PSK2, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
2019-03-10 06:35:06 +08:00
tests[hits].modulation = DEMOD_PSK2;
tests[hits].bitrate = bitRate;
tests[hits].inverted = false;
tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
tests[hits].ST = false;
2019-09-14 12:13:55 +08:00
tests[hits].downlink_mode = downlink_mode;
2019-03-10 06:35:06 +08:00
++hits;
}
} // inverse waves does not affect this demod
// PSK3 - needs a call to psk1TOpsk2.
2020-09-28 17:50:20 +08:00
if (PSKDemod(0, 0, 6, false) == PM3_SUCCESS) {
2019-03-10 06:35:06 +08:00
psk1TOpsk2(DemodBuffer, DemodBufferLen);
2019-03-10 07:00:59 +08:00
if (test(DEMOD_PSK3, &tests[hits].offset, &bitRate, clk, &tests[hits].Q5)) {
2019-03-10 06:35:06 +08:00
tests[hits].modulation = DEMOD_PSK3;
tests[hits].bitrate = bitRate;
tests[hits].inverted = false;
tests[hits].block0 = PackBits(tests[hits].offset, 32, DemodBuffer);
tests[hits].ST = false;
2019-09-14 12:13:55 +08:00
tests[hits].downlink_mode = downlink_mode;
2019-03-10 06:35:06 +08:00
++hits;
}
} // inverse waves does not affect this demod
2019-03-10 07:00:59 +08:00
//undo trim samples
2019-03-10 06:35:06 +08:00
save_restoreGB(GRAPH_RESTORE);
}
}
2019-03-10 07:00:59 +08:00
if (hits == 1) {
2019-03-10 06:35:06 +08:00
config.modulation = tests[0].modulation;
config.bitrate = tests[0].bitrate;
config.inverted = tests[0].inverted;
config.offset = tests[0].offset;
config.block0 = tests[0].block0;
config.Q5 = tests[0].Q5;
config.ST = tests[0].ST;
2019-09-14 12:13:55 +08:00
config.downlink_mode = downlink_mode;
if (pwd != -1) {
config.usepwd = true;
config.pwd = pwd & 0xffffffff;
}
2020-05-14 07:04:26 +08:00
config.block0Status = autoDetect;
if (print_config)
printConfiguration(config);
2019-03-10 06:35:06 +08:00
return true;
}
bool retval = false;
2019-03-10 07:00:59 +08:00
if (hits > 1) {
2019-03-10 06:35:06 +08:00
PrintAndLogEx(SUCCESS, "Found [%d] possible matches for modulation.", hits);
2019-03-10 07:00:59 +08:00
for (int i = 0; i < hits; ++i) {
2019-09-19 16:54:34 +08:00
2019-09-16 02:30:05 +08:00
bool wanted = false;
if (wanted_conf > 0)
wanted = (wanted_conf == tests[i].block0);
2019-09-19 16:54:34 +08:00
2019-03-10 06:35:06 +08:00
retval = testKnownConfigBlock(tests[i].block0);
2019-09-19 16:54:34 +08:00
if (retval || wanted) {
2019-03-10 07:00:59 +08:00
PrintAndLogEx(NORMAL, "--[%d]--------------- << selected this", i + 1);
2019-03-10 06:35:06 +08:00
config.modulation = tests[i].modulation;
config.bitrate = tests[i].bitrate;
config.inverted = tests[i].inverted;
config.offset = tests[i].offset;
config.block0 = tests[i].block0;
config.Q5 = tests[i].Q5;
config.ST = tests[i].ST;
2019-09-14 12:13:55 +08:00
config.downlink_mode = tests[i].downlink_mode;
if (pwd != -1) {
config.usepwd = true;
config.pwd = pwd & 0xffffffff;
}
2019-03-10 06:35:06 +08:00
} else {
2019-03-10 07:00:59 +08:00
PrintAndLogEx(NORMAL, "--[%d]---------------", i + 1);
2019-03-10 06:35:06 +08:00
}
config.block0Status = autoDetect;
if (print_config)
2019-09-19 16:54:34 +08:00
printConfiguration(tests[i]);
2019-03-10 06:35:06 +08:00
}
}
return retval;
}
bool testKnownConfigBlock(uint32_t block0) {
2019-03-10 07:00:59 +08:00
switch (block0) {
2019-03-10 06:35:06 +08:00
case T55X7_DEFAULT_CONFIG_BLOCK:
case T55X7_RAW_CONFIG_BLOCK:
case T55X7_EM_UNIQUE_CONFIG_BLOCK:
case T55X7_FDXB_CONFIG_BLOCK:
case T55X7_FDXB_2_CONFIG_BLOCK:
2019-03-10 06:35:06 +08:00
case T55X7_HID_26_CONFIG_BLOCK:
case T55X7_PYRAMID_CONFIG_BLOCK:
case T55X7_INDALA_64_CONFIG_BLOCK:
case T55X7_INDALA_224_CONFIG_BLOCK:
case T55X7_GUARDPROXII_CONFIG_BLOCK:
case T55X7_VIKING_CONFIG_BLOCK:
case T55X7_NORALSY_CONFIG_BLOCK:
2019-03-10 06:35:06 +08:00
case T55X7_IOPROX_CONFIG_BLOCK:
case T55X7_PRESCO_CONFIG_BLOCK:
case T55X7_NEDAP_64_CONFIG_BLOCK:
case T55X7_NEDAP_128_CONFIG_BLOCK:
case T55X7_VISA2000_CONFIG_BLOCK:
case T55X7_SECURAKEY_CONFIG_BLOCK:
2020-08-13 18:25:04 +08:00
case T55X7_PAC_CONFIG_BLOCK:
case T55X7_VERICHIP_CONFIG_BLOCK:
case T55X7_KERI_CONFIG_BLOCK:
case T55X7_NEXWATCH_CONFIG_BLOCK:
case T55X7_JABLOTRON_CONFIG_BLOCK:
2019-03-10 06:35:06 +08:00
return true;
}
return false;
}
bool GetT55xxBlockData(uint32_t *blockdata) {
if (DemodBufferLen == 0)
return false;
uint8_t idx = config.offset;
2019-04-07 01:09:01 +08:00
if (idx + 32 > DemodBufferLen) {
2019-10-06 05:56:19 +08:00
PrintAndLogEx(WARNING, "The configured offset %d is too big. Possible offset: %zu)", idx, DemodBufferLen - 32);
return false;
}
*blockdata = PackBits(0, 32, DemodBuffer + idx);
return true;
}
2019-10-10 18:27:48 +08:00
void printT55xxBlock(uint8_t blockNum, bool page1) {
uint32_t blockData = 0;
uint8_t bytes[4] = {0};
if (GetT55xxBlockData(&blockData) == false)
return;
num_to_bytes(blockData, 4, bytes);
2019-10-13 06:48:26 +08:00
T55x7_SaveBlockData((page1) ? blockNum + 8 : blockNum, blockData);
2019-10-10 18:27:48 +08:00
2019-09-16 02:46:21 +08:00
PrintAndLogEx(SUCCESS, " %02d | %08X | %s | %s", blockNum, blockData, sprint_bin(DemodBuffer + config.offset, 32), sprint_ascii(bytes, 4));
}
static bool testModulation(uint8_t mode, uint8_t modread) {
2019-03-10 07:00:59 +08:00
switch (mode) {
2019-03-10 06:35:06 +08:00
case DEMOD_FSK:
if (modread >= DEMOD_FSK1 && modread <= DEMOD_FSK2a) return true;
break;
case DEMOD_ASK:
if (modread == DEMOD_ASK) return true;
break;
case DEMOD_PSK1:
if (modread == DEMOD_PSK1) return true;
break;
case DEMOD_PSK2:
if (modread == DEMOD_PSK2) return true;
break;
case DEMOD_PSK3:
if (modread == DEMOD_PSK3) return true;
break;
case DEMOD_NRZ:
if (modread == DEMOD_NRZ) return true;
break;
case DEMOD_BI:
if (modread == DEMOD_BI) return true;
break;
case DEMOD_BIa:
if (modread == DEMOD_BIa) return true;
break;
default:
return false;
}
return false;
}
static bool testQ5Modulation(uint8_t mode, uint8_t modread) {
2019-03-10 07:00:59 +08:00
switch (mode) {
2019-03-10 06:35:06 +08:00
case DEMOD_FSK:
if (modread >= 4 && modread <= 5) return true;
break;
case DEMOD_ASK:
if (modread == 0) return true;
break;
case DEMOD_PSK1:
if (modread == 1) return true;
break;
case DEMOD_PSK2:
if (modread == 2) return true;
break;
case DEMOD_PSK3:
if (modread == 3) return true;
break;
case DEMOD_NRZ:
if (modread == 7) return true;
break;
case DEMOD_BI:
if (modread == 6) return true;
break;
default:
return false;
}
return false;
}
static int convertQ5bitRate(uint8_t bitRateRead) {
2019-03-10 06:35:06 +08:00
uint8_t expected[] = {8, 16, 32, 40, 50, 64, 100, 128};
2019-03-10 07:00:59 +08:00
for (int i = 0; i < 8; i++)
2019-03-10 06:35:06 +08:00
if (expected[i] == bitRateRead)
return i;
2019-03-10 06:35:06 +08:00
return -1;
}
static bool testQ5(uint8_t mode, uint8_t *offset, int *fndBitRate, uint8_t clk) {
2019-03-10 06:35:06 +08:00
2019-03-10 07:00:59 +08:00
if (DemodBufferLen < 64) return false;
2019-04-08 16:01:57 +08:00
2019-03-10 07:00:59 +08:00
for (uint8_t idx = 28; idx < 64; idx++) {
2019-04-08 16:01:57 +08:00
uint8_t si = idx;
2019-03-10 07:00:59 +08:00
if (PackBits(si, 28, DemodBuffer) == 0x00) continue;
2019-03-10 06:35:06 +08:00
2019-03-10 07:00:59 +08:00
uint8_t safer = PackBits(si, 4, DemodBuffer);
si += 4; //master key
uint8_t resv = PackBits(si, 8, DemodBuffer);
si += 8;
2019-03-10 06:35:06 +08:00
// 2nibble must be zeroed.
if (safer != 0x6 && safer != 0x9) continue;
2019-03-10 07:00:59 +08:00
if (resv > 0x00) continue;
2019-03-10 06:35:06 +08:00
//uint8_t pageSel = PackBits(si, 1, DemodBuffer); si += 1;
//uint8_t fastWrite = PackBits(si, 1, DemodBuffer); si += 1;
2019-03-10 07:00:59 +08:00
si += 1 + 1;
int bitRate = PackBits(si, 6, DemodBuffer) * 2 + 2;
si += 6; //bit rate
2019-03-10 06:35:06 +08:00
if (bitRate > 128 || bitRate < 8) continue;
//uint8_t AOR = PackBits(si, 1, DemodBuffer); si += 1;
//uint8_t PWD = PackBits(si, 1, DemodBuffer); si += 1;
//uint8_t pskcr = PackBits(si, 2, DemodBuffer); si += 2; //could check psk cr
//uint8_t inverse = PackBits(si, 1, DemodBuffer); si += 1;
2019-03-10 07:00:59 +08:00
si += 1 + 1 + 2 + 1;
uint8_t modread = PackBits(si, 3, DemodBuffer);
si += 3;
uint8_t maxBlk = PackBits(si, 3, DemodBuffer);
si += 3;
2019-03-10 06:35:06 +08:00
//uint8_t ST = PackBits(si, 1, DemodBuffer); si += 1;
if (maxBlk == 0) continue;
2019-09-19 16:54:34 +08:00
2019-03-10 06:35:06 +08:00
//test modulation
if (!testQ5Modulation(mode, modread)) continue;
if (bitRate != clk) continue;
2019-09-19 16:54:34 +08:00
2019-03-10 06:35:06 +08:00
*fndBitRate = convertQ5bitRate(bitRate);
if (*fndBitRate < 0) continue;
2019-09-19 16:54:34 +08:00
2019-03-10 06:35:06 +08:00
*offset = idx;
return true;
}
return false;
}
static bool testBitRate(uint8_t readRate, uint8_t clk) {
2019-03-10 06:35:06 +08:00
uint8_t expected[] = {8, 16, 32, 40, 50, 64, 100, 128};
if (expected[readRate] == clk)
return true;
2019-03-10 06:35:06 +08:00
return false;
}
bool test(uint8_t mode, uint8_t *offset, int *fndBitRate, uint8_t clk, bool *Q5) {
2019-03-10 07:00:59 +08:00
if (DemodBufferLen < 64) return false;
for (uint8_t idx = 28; idx < 64; idx++) {
2019-06-08 00:41:39 +08:00
uint8_t si = idx;
2019-03-10 07:00:59 +08:00
if (PackBits(si, 28, DemodBuffer) == 0x00) continue;
2019-03-10 06:35:06 +08:00
2019-03-10 07:00:59 +08:00
uint8_t safer = PackBits(si, 4, DemodBuffer);
si += 4; //master key
uint8_t resv = PackBits(si, 4, DemodBuffer);
si += 4; //was 7 & +=7+3 //should be only 4 bits if extended mode
2019-03-10 06:35:06 +08:00
// 2nibble must be zeroed.
// moved test to here, since this gets most faults first.
2019-03-10 07:00:59 +08:00
if (resv > 0x00) continue;
int bitRate = PackBits(si, 6, DemodBuffer);
si += 6; //bit rate (includes extended mode part of rate)
uint8_t extend = PackBits(si, 1, DemodBuffer);
si += 1; //bit 15 extended mode
uint8_t modread = PackBits(si, 5, DemodBuffer);
si += 5 + 2 + 1;
2019-03-10 06:35:06 +08:00
//uint8_t pskcr = PackBits(si, 2, DemodBuffer); si += 2+1; //could check psk cr
//uint8_t nml01 = PackBits(si, 1, DemodBuffer); si += 1+5; //bit 24, 30, 31 could be tested for 0 if not extended mode
//uint8_t nml02 = PackBits(si, 2, DemodBuffer); si += 2;
//if extended mode
2019-03-10 07:00:59 +08:00
bool extMode = ((safer == 0x6 || safer == 0x9) && extend) ? true : false;
2019-03-10 06:35:06 +08:00
2019-03-10 07:00:59 +08:00
if (!extMode) {
2019-03-10 06:35:06 +08:00
if (bitRate > 7) continue;
if (!testBitRate(bitRate, clk)) continue;
} else { //extended mode bitrate = same function to calc bitrate as em4x05
if (EM4x05_GET_BITRATE(bitRate) != clk) continue;
}
//test modulation
if (!testModulation(mode, modread)) continue;
*fndBitRate = bitRate;
*offset = idx;
*Q5 = false;
return true;
}
if (testQ5(mode, offset, fndBitRate, clk)) {
*Q5 = true;
return true;
}
return false;
}
2021-01-29 23:06:26 +08:00
int CmdT55xxSpecial(const char *Cmd) {
CLIParserContext *ctx;
CLIParserInit(&ctx, "lf t55xx special",
"Show block changes with 64 different offsets, data taken from Demod buffer.",
"lf t55xx special\n"
);
void *argtable[] = {
arg_param_begin,
arg_param_end
};
CLIExecWithReturn(ctx, Cmd, argtable, true);
CLIParserFree(ctx);
2019-04-08 16:01:57 +08:00
2019-03-10 06:35:06 +08:00
uint8_t bits[32] = {0x00};
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "OFFSET | DATA | BINARY | ASCII");
PrintAndLogEx(NORMAL, "-------+-------+-------------------------------------+------");
2019-03-10 07:00:59 +08:00
int i, j = 0;
for (; j < 64; ++j) {
2019-03-10 06:35:06 +08:00
for (i = 0; i < 32; ++i)
2019-03-10 07:00:59 +08:00
bits[i] = DemodBuffer[j + i];
2019-04-08 16:01:57 +08:00
uint32_t blockData = PackBits(0, 32, bits);
2019-03-10 07:00:59 +08:00
PrintAndLogEx(NORMAL, "%02d | 0x%08X | %s", j, blockData, sprint_bin(bits, 32));
2019-03-10 06:35:06 +08:00
}
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
int printConfiguration(t55xx_conf_block_t b) {
2020-08-28 21:53:34 +08:00
PrintAndLogEx(INFO, " Chip Type : " _GREEN_("%s"), (b.Q5) ? "Q5/T5555" : "T55x7");
2020-05-11 17:45:45 +08:00
PrintAndLogEx(INFO, " Modulation : " _GREEN_("%s"), GetSelectedModulationStr(b.modulation));
PrintAndLogEx(INFO, " Bit Rate : %s", GetBitRateStr(b.bitrate, (b.block0 & T55x7_X_MODE && (b.block0 >> 28 == 6 || b.block0 >> 28 == 9))));
PrintAndLogEx(INFO, " Inverted : %s", (b.inverted) ? _GREEN_("Yes") : "No");
PrintAndLogEx(INFO, " Offset : %d", b.offset);
PrintAndLogEx(INFO, " Seq. Term. : %s", (b.ST) ? _GREEN_("Yes") : "No");
PrintAndLogEx(INFO, " Block0 : 0x%08X %s", b.block0, GetConfigBlock0Source(b.block0Status));
2020-05-11 17:45:45 +08:00
PrintAndLogEx(INFO, " Downlink Mode : %s", GetDownlinkModeStr(b.downlink_mode));
PrintAndLogEx(INFO, " Password Set : %s", (b.usepwd) ? _RED_("Yes") : _GREEN_("No"));
if (b.usepwd) {
PrintAndLogEx(INFO, " Password : %08X", b.pwd);
}
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "");
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
static int CmdT55xxWakeUp(const char *Cmd) {
2021-02-05 15:58:19 +08:00
CLIParserContext *ctx;
CLIParserInit(&ctx, "lf t55xx wakeup",
"This commands sends the Answer-On-Request command and leaves the readerfield ON afterwards",
"lf t55xx wakeup -p 11223344 --> send wakeup with password\n"
);
// 3 + (5 or 6)
void *argtable[8] = {
arg_param_begin,
arg_str1("p", "pwd", "<hex>", "password (4 hex bytes)"),
arg_lit0("v", "verbose", "verbose output"),
};
uint8_t idx = 3;
arg_add_t55xx_downloadlink(argtable, &idx, T55XX_DLMODE_SINGLE, config.downlink_mode);
CLIExecWithReturn(ctx, Cmd, argtable, true);
2019-07-24 05:43:30 +08:00
uint32_t password = 0;
2021-02-05 15:58:19 +08:00
int res = arg_get_u32_hexstr_def(ctx, 1, 0, &password);
if (res == 0 || res == 2) {
PrintAndLogEx(ERR, "Password should be 4 hex bytes");
CLIParserFree(ctx);
return PM3_EINVARG;
}
2019-07-23 07:50:28 +08:00
2021-02-05 15:58:19 +08:00
bool verbose = arg_get_lit(ctx, 2);
bool r0 = arg_get_lit(ctx, 3);
bool r1 = arg_get_lit(ctx, 4);
bool r2 = arg_get_lit(ctx, 5);
bool r3 = arg_get_lit(ctx, 6);
CLIParserFree(ctx);
2021-02-05 15:58:19 +08:00
if ((r0 + r1 + r2 + r3) > 1) {
PrintAndLogEx(FAILED, "Error multiple downlink encoding");
return PM3_EINVARG;
2019-03-10 06:35:06 +08:00
}
2019-07-23 07:50:28 +08:00
2021-02-05 15:58:19 +08:00
uint8_t downlink_mode = config.downlink_mode;
if (r0)
downlink_mode = refFixedBit;
else if (r1)
downlink_mode = refLongLeading;
else if (r2)
downlink_mode = refLeading0;
else if (r3)
downlink_mode = ref1of4;
2019-03-10 06:35:06 +08:00
struct p {
uint32_t password;
uint8_t flags;
} PACKED payload;
2019-09-13 22:32:37 +08:00
payload.password = password;
2021-02-05 15:58:19 +08:00
payload.flags = (downlink_mode << 3);
2019-09-13 22:32:37 +08:00
2019-03-10 06:35:06 +08:00
clearCommandBuffer();
SendCommandNG(CMD_LF_T55XX_WAKEUP, (uint8_t *)&payload, sizeof(payload));
2021-02-05 15:58:19 +08:00
if (WaitForResponseTimeout(CMD_LF_T55XX_WAKEUP, NULL, 1000) == false) {
PrintAndLogEx(WARNING, "command execution time out");
return PM3_ETIMEOUT;
}
2019-09-13 22:32:37 +08:00
2021-02-05 15:58:19 +08:00
if (verbose)
PrintAndLogEx(SUCCESS, "Wake up command sent. Try read now");
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
static int CmdT55xxWriteBlock(const char *Cmd) {
uint8_t block = 0xFF; // default to invalid block
uint32_t data = 0; // default to blank Block
uint32_t password = 0; // default to blank Block 7
bool usepwd = false;
bool page1 = false;
bool gotdata = false;
bool testMode = false;
bool errors = false;
bool validate = false;
uint8_t cmdp = 0;
2020-05-12 16:30:14 +08:00
uint32_t downlink_mode = config.downlink_mode;
2019-07-24 05:43:30 +08:00
2019-03-10 06:35:06 +08:00
while (param_getchar(Cmd, cmdp) != 0x00 && !errors) {
switch (tolower(param_getchar(Cmd, cmdp))) {
2019-03-10 07:00:59 +08:00
case 'h':
return usage_t55xx_write();
case 'b':
errors |= param_getdec(Cmd, cmdp + 1, &block);
cmdp += 2;
if (block > 7) {
PrintAndLogEx(WARNING, "Block number must be between 0 and 7");
errors = true;
}
2019-03-10 07:00:59 +08:00
break;
case 'd':
data = param_get32ex(Cmd, cmdp + 1, 0, 16);
gotdata = true;
cmdp += 2;
break;
case 'p':
password = param_get32ex(Cmd, cmdp + 1, 0, 16);
usepwd = true;
cmdp += 2;
break;
case 't':
testMode = true;
cmdp++;
break;
case '1':
page1 = true;
cmdp++;
break;
2019-07-24 05:43:30 +08:00
case 'r':
downlink_mode = param_get8ex(Cmd, cmdp + 1, 0, 10);
if (downlink_mode > 3)
downlink_mode = 0;
2019-09-13 22:32:37 +08:00
2019-07-24 05:43:30 +08:00
cmdp += 2;
break;
case 'v':
validate = true;
cmdp++;
break;
2019-03-10 07:00:59 +08:00
default:
PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
errors = true;
break;
2019-03-10 06:35:06 +08:00
}
}
if (errors || !gotdata) return usage_t55xx_write();
char pwdStr[16] = {0};
snprintf(pwdStr, sizeof(pwdStr), "pwd: 0x%08X", password);
2019-03-10 07:00:59 +08:00
PrintAndLogEx(INFO, "Writing page %d block: %02d data: 0x%08X %s", page1, block, data, (usepwd) ? pwdStr : "");
2019-03-10 06:35:06 +08:00
2019-09-19 16:54:34 +08:00
if (t55xxWrite(block, page1, usepwd, testMode, password, downlink_mode, data) != PM3_SUCCESS) {
PrintAndLogEx(ERR, "Write failed");
return PM3_ESOFT;
2019-03-10 06:35:06 +08:00
}
if (validate) {
bool isOK = t55xxVerifyWrite(block, page1, usepwd, 1, password, downlink_mode, data);
2019-09-19 16:54:34 +08:00
if (isOK)
PrintAndLogEx(SUCCESS, "Write OK, validation successful");
else
PrintAndLogEx(WARNING, "Write could not validate the written data");
}
2019-09-19 16:54:34 +08:00
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
2019-10-10 19:07:57 +08:00
static int CmdT55xxDangerousRaw(const char *Cmd) {
// supports only default downlink mode
t55xx_test_block_t ng;
ng.time = 0;
ng.bitlen = 0;
memset(ng.data, 0x00, sizeof(ng.data));
bool errors = false;
uint8_t cmdp = 0;
while (param_getchar(Cmd, cmdp) != 0x00 && !errors) {
switch (tolower(param_getchar(Cmd, cmdp))) {
2019-10-13 07:21:59 +08:00
case 'h':
return usage_t55xx_dangerraw();
2019-10-10 19:07:57 +08:00
case 't':
ng.time = param_get32ex(Cmd, cmdp + 1, 0, 10);
if (ng.time == 0 || ng.time > 200000) {
PrintAndLogEx(ERR, "Timing off 1..200000 limits, got %i", ng.time);
errors = true;
break;
}
cmdp += 2;
break;
case 'b': {
uint32_t n = param_getlength(Cmd, cmdp + 1);
if (n > 128) {
PrintAndLogEx(ERR, "Bitstream too long, max 128 bits, got %i", n);
errors = true;
break;
}
for (uint8_t i = 0; i < n; i++) {
char c = param_getchar_indx(Cmd, i, cmdp + 1);
if (c == '0')
ng.data[i] = 0;
else if (c == '1')
ng.data[i] = 1;
else {
PrintAndLogEx(ERR, "Unknown bit char '%c'", c);
errors = true;
break;
}
}
ng.bitlen = n;
cmdp += 2;
break;
}
default:
PrintAndLogEx(ERR, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
errors = true;
break;
}
}
if (errors || ng.bitlen == 0 || ng.time == 0) {
2019-10-13 07:21:59 +08:00
return usage_t55xx_dangerraw();
2019-10-10 19:07:57 +08:00
}
PacketResponseNG resp;
clearCommandBuffer();
SendCommandNG(CMD_LF_T55XX_DANGERRAW, (uint8_t *)&ng, sizeof(ng));
if (!WaitForResponseTimeout(CMD_LF_T55XX_DANGERRAW, &resp, 2000)) {
PrintAndLogEx(ERR, "Error occurred, device did not ACK write operation.");
return PM3_ETIMEOUT;
}
return resp.status;
}
static int CmdT55xxReadTrace(const char *Cmd) {
2019-07-24 05:43:30 +08:00
bool frombuff = false;
2020-05-12 16:30:14 +08:00
uint8_t downlink_mode = config.downlink_mode;
uint8_t cmdp = 0;
bool errors = false;
2019-09-14 12:13:55 +08:00
while (param_getchar(Cmd, cmdp) != 0x00 && !errors) {
switch (tolower(param_getchar(Cmd, cmdp))) {
case 'h':
return usage_t55xx_trace();
case 'r':
downlink_mode = param_get8ex(Cmd, cmdp + 1, 0, 10);
2019-09-13 22:32:37 +08:00
if (downlink_mode > 3)
downlink_mode = 0;
2019-09-13 22:32:37 +08:00
cmdp += 2;
break;
case '1':
frombuff = true;
cmdp += 2;
break;
default:
PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
errors = true;
break;
}
2019-07-24 05:43:30 +08:00
}
if (errors) return usage_t55xx_trace();
if (!frombuff) {
2019-03-10 06:35:06 +08:00
// sanity check.
if (SanityOfflineCheck(false) != PM3_SUCCESS) return PM3_ENODATA;
2019-03-10 06:35:06 +08:00
2019-04-08 16:01:57 +08:00
bool pwdmode = false;
uint32_t password = 0;
// REGULAR_READ_MODE_BLOCK - yeilds correct Page 1 Block 2 data i.e. + 32 bit offset.
2019-10-10 19:07:57 +08:00
if (!AcquireData(T55x7_PAGE1, REGULAR_READ_MODE_BLOCK, pwdmode, password, downlink_mode))
2019-05-22 20:48:23 +08:00
return PM3_ENODATA;
2019-03-10 06:35:06 +08:00
}
2019-09-13 22:32:37 +08:00
2019-03-10 07:00:59 +08:00
if (config.Q5) {
2019-05-22 20:48:23 +08:00
if (!DecodeT5555TraceBlock()) return PM3_ESOFT;
2019-03-10 06:35:06 +08:00
} else {
2019-05-22 20:48:23 +08:00
if (!DecodeT55xxBlock()) return PM3_ESOFT;
2019-03-10 06:35:06 +08:00
}
2019-05-22 20:48:23 +08:00
if (!DemodBufferLen) return PM3_ESOFT;
2019-03-10 06:35:06 +08:00
RepaintGraphWindow();
uint8_t repeat = (config.offset > 5) ? 32 : 0;
uint8_t si = config.offset + repeat;
uint32_t bl1 = PackBits(si, 32, DemodBuffer);
2019-03-10 07:00:59 +08:00
uint32_t bl2 = PackBits(si + 32, 32, DemodBuffer);
2019-03-10 06:35:06 +08:00
if (config.Q5) {
2019-03-10 07:00:59 +08:00
uint32_t hdr = PackBits(si, 9, DemodBuffer);
si += 9;
2019-03-10 06:35:06 +08:00
if (hdr != 0x1FF) {
2020-08-28 21:53:34 +08:00
PrintAndLogEx(FAILED, "Invalid Q5/T5555 Trace data header (expected 0x1FF, found %X)", hdr);
2019-05-22 20:48:23 +08:00
return PM3_ESOFT;
2019-03-10 06:35:06 +08:00
}
2019-03-10 07:00:59 +08:00
t5555_tracedata_t data = {.bl1 = bl1, .bl2 = bl2, .icr = 0, .lotidc = '?', .lotid = 0, .wafer = 0, .dw = 0};
2019-03-10 06:35:06 +08:00
2019-03-10 07:00:59 +08:00
data.icr = PackBits(si, 2, DemodBuffer);
si += 2;
data.lotidc = 'Z' - PackBits(si, 2, DemodBuffer);
si += 3;
2019-03-10 06:35:06 +08:00
2019-03-10 07:00:59 +08:00
data.lotid = PackBits(si, 4, DemodBuffer);
si += 5;
2019-03-10 06:35:06 +08:00
data.lotid <<= 4;
2019-03-10 07:00:59 +08:00
data.lotid |= PackBits(si, 4, DemodBuffer);
si += 5;
2019-03-10 06:35:06 +08:00
data.lotid <<= 4;
2019-03-10 07:00:59 +08:00
data.lotid |= PackBits(si, 4, DemodBuffer);
si += 5;
2019-03-10 06:35:06 +08:00
data.lotid <<= 4;
2019-03-10 07:00:59 +08:00
data.lotid |= PackBits(si, 4, DemodBuffer);
si += 5;
2019-03-10 06:35:06 +08:00
data.lotid <<= 1;
2019-03-10 07:00:59 +08:00
data.lotid |= PackBits(si, 1, DemodBuffer);
si += 1;
2019-03-10 06:35:06 +08:00
2019-03-10 07:00:59 +08:00
data.wafer = PackBits(si, 3, DemodBuffer);
si += 4;
2019-03-10 06:35:06 +08:00
data.wafer <<= 2;
2019-03-10 07:00:59 +08:00
data.wafer |= PackBits(si, 2, DemodBuffer);
si += 2;
2019-03-10 06:35:06 +08:00
2019-03-10 07:00:59 +08:00
data.dw = PackBits(si, 2, DemodBuffer);
si += 3;
2019-03-10 06:35:06 +08:00
data.dw <<= 4;
2019-03-10 07:00:59 +08:00
data.dw |= PackBits(si, 4, DemodBuffer);
si += 5;
2019-03-10 06:35:06 +08:00
data.dw <<= 4;
2019-03-10 07:00:59 +08:00
data.dw |= PackBits(si, 4, DemodBuffer);
si += 5;
2019-03-10 06:35:06 +08:00
data.dw <<= 4;
2019-03-10 07:00:59 +08:00
data.dw |= PackBits(si, 4, DemodBuffer);
2019-03-10 06:35:06 +08:00
printT5555Trace(data, repeat);
} else {
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};
2019-03-10 07:00:59 +08:00
data.acl = PackBits(si, 8, DemodBuffer);
si += 8;
if (data.acl != 0xE0) {
2019-03-10 06:35:06 +08:00
PrintAndLogEx(FAILED, "The modulation is most likely wrong since the ACL is not 0xE0. ");
2019-05-22 20:48:23 +08:00
return PM3_ESOFT;
2019-03-10 06:35:06 +08:00
}
2019-03-10 07:00:59 +08:00
data.mfc = PackBits(si, 8, DemodBuffer);
si += 8;
data.cid = PackBits(si, 5, DemodBuffer);
si += 5;
data.icr = PackBits(si, 3, DemodBuffer);
si += 3;
data.year = PackBits(si, 4, DemodBuffer);
si += 4;
data.quarter = PackBits(si, 2, DemodBuffer);
si += 2;
data.lotid = PackBits(si, 14, DemodBuffer);
si += 14;
data.wafer = PackBits(si, 5, DemodBuffer);
si += 5;
2019-03-10 06:35:06 +08:00
data.dw = PackBits(si, 15, DemodBuffer);
2019-04-13 09:01:31 +08:00
struct tm *ct, tm_buf;
time_t now = time(NULL);
#if defined(_WIN32)
ct = localtime_s(&tm_buf, &now) == 0 ? &tm_buf : NULL;
#else
ct = localtime_r(&now, &tm_buf);
2019-04-14 19:37:53 +08:00
#endif
2019-04-13 09:01:31 +08:00
if (data.year > ct->tm_year - 110)
2019-03-10 06:35:06 +08:00
data.year += 2000;
else
data.year += 2010;
printT55x7Trace(data, repeat);
}
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
void printT55x7Trace(t55x7_tracedata_t data, uint8_t repeat) {
2020-08-28 21:53:34 +08:00
PrintAndLogEx(NORMAL, "--- " _CYAN_("T55x7 Trace Information") " ----------------------------------");
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "-------------------------------------------------------------");
PrintAndLogEx(NORMAL, " ACL Allocation class (ISO/IEC 15963-1) : 0x%02X (%d)", data.acl, data.acl);
PrintAndLogEx(NORMAL, " MFC Manufacturer ID (ISO/IEC 7816-6) : 0x%02X (%d) - %s", data.mfc, data.mfc, getTagInfo(data.mfc));
PrintAndLogEx(NORMAL, " CID : 0x%02X (%d) - %s", data.cid, data.cid, GetModelStrFromCID(data.cid));
2019-03-10 07:00:59 +08:00
PrintAndLogEx(NORMAL, " ICR IC Revision : %d", data.icr);
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, " Manufactured");
PrintAndLogEx(NORMAL, " Year/Quarter : %d/%d", data.year, data.quarter);
2019-03-10 07:00:59 +08:00
PrintAndLogEx(NORMAL, " Lot ID : %d", data.lotid);
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, " Wafer number : %d", data.wafer);
PrintAndLogEx(NORMAL, " Die Number : %d", data.dw);
PrintAndLogEx(NORMAL, "-------------------------------------------------------------");
PrintAndLogEx(NORMAL, " Raw Data - Page 1");
2019-03-10 07:00:59 +08:00
PrintAndLogEx(NORMAL, " Block 1 : 0x%08X %s", data.bl1, sprint_bin(DemodBuffer + config.offset + repeat, 32));
PrintAndLogEx(NORMAL, " Block 2 : 0x%08X %s", data.bl2, sprint_bin(DemodBuffer + config.offset + repeat + 32, 32));
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "-------------------------------------------------------------");
/*
2019-10-13 06:48:26 +08:00
Trace info.
M1, M2 has the about ATMEL defintion of trace data.
M3 has unique format following industry defacto standard with row/col parity
2019-10-08 17:49:23 +08:00
2019-03-10 06:35:06 +08:00
TRACE - BLOCK O
Bits Definition HEX
1-8 ACL Allocation class (ISO/IEC 15963-1) 0xE0
9-16 MFC Manufacturer ID (ISO/IEC 7816-6) 0x15 Atmel Corporation
2019-10-08 17:49:23 +08:00
17-21 CID 0x1 = Atmel ATA5577M1
0x2 = Atmel ATA5577M2
0x3 = Atmel ATA5577M3
2019-03-10 06:35:06 +08:00
22-24 ICR IC revision
25-28 YEAR (BCD encoded) 9 (= 2009)
29-30 QUARTER 1,2,3,4
31-32 LOT ID
TRACE - BLOCK 1
1-12 LOT ID
13-17 Wafer number
18-32 DW, die number sequential
2019-10-13 06:48:26 +08:00
2019-10-08 17:49:23 +08:00
Startup times (FC)
2019-10-13 06:48:26 +08:00
M1, M2 = 192
M3 = 128
2019-03-10 06:35:06 +08:00
*/
}
void printT5555Trace(t5555_tracedata_t data, uint8_t repeat) {
2020-08-28 21:53:34 +08:00
PrintAndLogEx(NORMAL, "--- " _CYAN_("Q5/T5555 Trace Information") " ---------------------------");
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "-------------------------------------------------------------");
2019-03-10 07:00:59 +08:00
PrintAndLogEx(NORMAL, " ICR IC Revision : %d", data.icr);
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, " Lot : %c%d", data.lotidc, data.lotid);
PrintAndLogEx(NORMAL, " Wafer number : %d", data.wafer);
PrintAndLogEx(NORMAL, " Die Number : %d", data.dw);
PrintAndLogEx(NORMAL, "-------------------------------------------------------------");
PrintAndLogEx(NORMAL, " Raw Data - Page 1");
2019-03-10 07:00:59 +08:00
PrintAndLogEx(NORMAL, " Block 1 : 0x%08X %s", data.bl1, sprint_bin(DemodBuffer + config.offset + repeat, 32));
PrintAndLogEx(NORMAL, " Block 2 : 0x%08X %s", data.bl2, sprint_bin(DemodBuffer + config.offset + repeat + 32, 32));
2019-03-10 06:35:06 +08:00
/*
** Q5 **
TRACE - BLOCK O and BLOCK1
Bits Definition HEX
1-9 Header 0x1FF
10-11 IC Revision
12-13 Lot ID char
15-35 Lot ID (NB parity)
36-41 Wafer number (NB parity)
42-58 DW, die number sequential (NB parity)
60-63 Parity bits
64 Always zero
*/
}
static void printT5x7KnownBlock0(uint32_t b0) {
2019-04-03 04:32:45 +08:00
char s[40];
memset(s, 0, sizeof(s));
2019-04-03 04:32:45 +08:00
switch (b0) {
case T55X7_DEFAULT_CONFIG_BLOCK:
2019-04-03 04:32:45 +08:00
snprintf(s, sizeof(s) - strlen(s), "T55x7 Default ");
break;
case T55X7_RAW_CONFIG_BLOCK:
2019-04-03 04:32:45 +08:00
snprintf(s + strlen(s), sizeof(s) - strlen(s), "T55x7 Raw ");
break;
case T55X7_EM_UNIQUE_CONFIG_BLOCK:
2019-04-05 02:06:15 +08:00
snprintf(s + strlen(s), sizeof(s) - strlen(s), "EM unique, Paxton ");
break;
2020-07-08 19:41:38 +08:00
case T55X7_FDXB_2_CONFIG_BLOCK:
case T55X7_FDXB_CONFIG_BLOCK:
2019-04-03 04:32:45 +08:00
snprintf(s + strlen(s), sizeof(s) - strlen(s), "FDXB ");
break;
case T55X7_HID_26_CONFIG_BLOCK:
snprintf(s + strlen(s), sizeof(s) - strlen(s), "HID 26b (ProxCard), Paradox, AWID ");
break;
case T55X7_PYRAMID_CONFIG_BLOCK:
2019-04-03 04:32:45 +08:00
snprintf(s + strlen(s), sizeof(s) - strlen(s), "Pyramid ");
break;
case T55X7_INDALA_64_CONFIG_BLOCK:
snprintf(s + strlen(s), sizeof(s) - strlen(s), "Indala 64, Motorola");
break;
case T55X7_INDALA_224_CONFIG_BLOCK:
2019-04-03 04:32:45 +08:00
snprintf(s + strlen(s), sizeof(s) - strlen(s), "Indala 224 ");
break;
case T55X7_GUARDPROXII_CONFIG_BLOCK:
2019-04-03 04:32:45 +08:00
snprintf(s + strlen(s), sizeof(s) - strlen(s), "Guard Prox II ");
break;
case T55X7_VIKING_CONFIG_BLOCK:
2019-04-03 04:32:45 +08:00
snprintf(s + strlen(s), sizeof(s) - strlen(s), "Viking ");
break;
case T55X7_NORALSY_CONFIG_BLOCK:
2019-04-03 04:32:45 +08:00
snprintf(s + strlen(s), sizeof(s) - strlen(s), "Noralys ");
break;
case T55X7_IOPROX_CONFIG_BLOCK:
2019-04-03 04:32:45 +08:00
snprintf(s + strlen(s), sizeof(s) - strlen(s), "IO Prox ");
break;
case T55X7_PRESCO_CONFIG_BLOCK:
2019-04-03 04:32:45 +08:00
snprintf(s + strlen(s), sizeof(s) - strlen(s), "Presco ");
break;
case T55X7_NEDAP_64_CONFIG_BLOCK:
2019-04-03 04:32:45 +08:00
snprintf(s + strlen(s), sizeof(s) - strlen(s), "Nedap 64 ");
break;
case T55X7_NEDAP_128_CONFIG_BLOCK:
2019-04-03 04:32:45 +08:00
snprintf(s + strlen(s), sizeof(s) - strlen(s), "Nedap 128 ");
break;
2020-07-08 19:41:38 +08:00
case T55X7_PAC_CONFIG_BLOCK:
snprintf(s + strlen(s), sizeof(s) - strlen(s), "PAC/Stanley ");
2020-07-08 19:41:38 +08:00
break;
case T55X7_VERICHIP_CONFIG_BLOCK:
snprintf(s + strlen(s), sizeof(s) - strlen(s), "Verichip ");
break;
case T55X7_VISA2000_CONFIG_BLOCK:
snprintf(s + strlen(s), sizeof(s) - strlen(s), "VISA2000 ");
break;
case T55X7_JABLOTRON_CONFIG_BLOCK:
snprintf(s + strlen(s), sizeof(s) - strlen(s), "Jablotron ");
break;
case T55X7_KERI_CONFIG_BLOCK:
snprintf(s + strlen(s), sizeof(s) - strlen(s), "KERI ");
break;
case T55X7_SECURAKEY_CONFIG_BLOCK:
snprintf(s + strlen(s), sizeof(s) - strlen(s), "SecuraKey ");
break;
case T55X7_NEXWATCH_CONFIG_BLOCK:
snprintf(s + strlen(s), sizeof(s) - strlen(s), "NexWatch, Quadrakey ");
2020-08-13 18:25:04 +08:00
break;
2019-04-03 04:32:45 +08:00
default:
break;
}
2019-04-03 04:32:45 +08:00
2019-04-05 02:06:15 +08:00
if (strlen(s) > 0)
PrintAndLogEx(SUCCESS, "\nConfig block match : " _YELLOW_("%s"), s);
}
static int CmdT55xxInfo(const char *Cmd) {
2019-03-10 06:35:06 +08:00
/*
Page 0 Block 0 Configuration data.
Normal mode
Extended mode
*/
bool frombuff = false, gotdata = false, dataasq5 = false, usepwd = false;
uint8_t cmdp = 0;
2019-09-14 12:13:55 +08:00
uint8_t downlink_mode = config.downlink_mode;
uint32_t block0 = 0, password = 0;
2019-07-24 05:43:30 +08:00
while (param_getchar(Cmd, cmdp) != 0x00) {
switch (tolower(param_getchar(Cmd, cmdp))) {
case 'h':
return usage_t55xx_info();
case 'c':
block0 = param_get32ex(Cmd, cmdp + 1, 0, 16);
gotdata = true;
cmdp += 2;
break;
case 'p':
password = param_get32ex(Cmd, cmdp + 1, 0, 16);
usepwd = true;
cmdp += 2;
break;
case '1':
frombuff = true;
cmdp += 2;
break;
case 'q':
dataasq5 = true;
cmdp += 2;
break;
2019-07-24 05:43:30 +08:00
case 'r':
downlink_mode = param_get8ex(Cmd, cmdp + 1, 0, 10);
2019-09-13 22:32:37 +08:00
if (downlink_mode > 3)
downlink_mode = 0;
2019-09-13 22:32:37 +08:00
2019-07-24 05:43:30 +08:00
cmdp += 2;
break;
default:
PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
return usage_t55xx_info();
}
}
2019-03-10 06:35:06 +08:00
if (gotdata && frombuff)
return usage_t55xx_info();
2019-03-10 06:35:06 +08:00
if (dataasq5 && !gotdata)
return usage_t55xx_info();
if (!frombuff && !gotdata) {
2019-03-10 06:35:06 +08:00
// sanity check.
if (SanityOfflineCheck(false) != PM3_SUCCESS) return PM3_ENODATA;
2019-03-10 06:35:06 +08:00
2019-10-10 19:07:57 +08:00
if (!AcquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, usepwd, password, downlink_mode))
2019-05-22 20:48:23 +08:00
return PM3_ENODATA;
2019-03-10 06:35:06 +08:00
}
2019-09-13 22:32:37 +08:00
if (!gotdata) {
2019-05-22 20:48:23 +08:00
if (!DecodeT55xxBlock()) return PM3_ESOFT;
// too little space to start with
2019-05-22 20:48:23 +08:00
if (DemodBufferLen < 32 + config.offset) return PM3_ESOFT;
2019-03-10 06:35:06 +08:00
//PrintAndLogEx(NORMAL, "Offset+32 ==%d\n DemodLen == %d", config.offset + 32, DemodBufferLen);
block0 = PackBits(config.offset, 32, DemodBuffer);
}
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "");
2019-04-03 04:08:50 +08:00
if (((!gotdata) && config.Q5) || (gotdata && dataasq5)) {
uint32_t header = (block0 >> (32 - 12)) & 0xFFF;
uint32_t ps = (block0 >> (32 - 13)) & 0x01;
uint32_t fw = (block0 >> (32 - 14)) & 0x01;
uint32_t dbr = (block0 >> (32 - 20)) & 0x3F;
uint32_t aor = (block0 >> (32 - 21)) & 0x01;
uint32_t pwd = (block0 >> (32 - 22)) & 0x01;
uint32_t pskcf = (block0 >> (32 - 24)) & 0x03;
uint32_t inv = (block0 >> (32 - 25)) & 0x01;
uint32_t datamod = (block0 >> (32 - 28)) & 0x07;
uint32_t maxblk = (block0 >> (32 - 31)) & 0x07;
2019-10-05 18:07:28 +08:00
uint32_t st = block0 & 0x01;
2020-05-11 17:45:45 +08:00
PrintAndLogEx(NORMAL, "--- " _CYAN_("Q5 Configuration & Information") " ------------");
PrintAndLogEx(NORMAL, "-------------------------------------------------------------");
PrintAndLogEx(NORMAL, " Header : 0x%03X%s", header, (header != 0x600) ? _RED_(" - Warning") : "");
PrintAndLogEx(NORMAL, " Page select : %d", ps);
PrintAndLogEx(NORMAL, " Fast Write : %s", (fw) ? _GREEN_("Yes") : "No");
PrintAndLogEx(NORMAL, " Data bit rate : %s", GetBitRateStr(dbr, 1));
PrintAndLogEx(NORMAL, " AOR - Answer on Request : %s", (aor) ? _GREEN_("Yes") : "No");
PrintAndLogEx(NORMAL, " Password mode : %s", (pwd) ? _GREEN_("Yes") : "No");
PrintAndLogEx(NORMAL, " PSK clock frequency : %s", GetPskCfStr(pskcf, 1));
PrintAndLogEx(NORMAL, " Inverse data : %s", (inv) ? _GREEN_("Yes") : "No");
PrintAndLogEx(NORMAL, " Modulation : %s", GetQ5ModulationStr(datamod));
PrintAndLogEx(NORMAL, " Max block : %d", maxblk);
PrintAndLogEx(NORMAL, " Sequence Terminator : %s", (st) ? _GREEN_("Yes") : "No");
} else {
uint32_t safer = (block0 >> (32 - 4)) & 0x0F;
uint32_t extend = (block0 >> (32 - 15)) & 0x01;
uint32_t resv, dbr;
if (extend) {
resv = (block0 >> (32 - 8)) & 0x0F;
dbr = (block0 >> (32 - 14)) & 0x3F;
} else {
resv = (block0 >> (32 - 11)) & 0x7F;
dbr = (block0 >> (32 - 14)) & 0x07;
}
uint32_t datamod = (block0 >> (32 - 20)) & 0x1F;
uint32_t pskcf = (block0 >> (32 - 22)) & 0x03;
uint32_t aor = (block0 >> (32 - 23)) & 0x01;
uint32_t otp = (block0 >> (32 - 24)) & 0x01;
uint32_t maxblk = (block0 >> (32 - 27)) & 0x07;
uint32_t pwd = (block0 >> (32 - 28)) & 0x01;
uint32_t sst = (block0 >> (32 - 29)) & 0x01;
uint32_t fw = (block0 >> (32 - 30)) & 0x01;
uint32_t inv = (block0 >> (32 - 31)) & 0x01;
uint32_t por = (block0 >> (32 - 32)) & 0x01;
2020-05-11 17:45:45 +08:00
PrintAndLogEx(NORMAL, "--- " _CYAN_("T55x7 Configuration & Information") " ---------");
PrintAndLogEx(NORMAL, "-------------------------------------------------------------");
PrintAndLogEx(NORMAL, " Safer key : %s", GetSaferStr(safer));
PrintAndLogEx(NORMAL, " reserved : %d", resv);
PrintAndLogEx(NORMAL, " Data bit rate : %s", GetBitRateStr(dbr, extend));
PrintAndLogEx(NORMAL, " eXtended mode : %s", (extend) ? _YELLOW_("Yes - Warning") : "No");
PrintAndLogEx(NORMAL, " Modulation : %s", GetModulationStr(datamod, extend));
PrintAndLogEx(NORMAL, " PSK clock frequency : %s", GetPskCfStr(pskcf, 0));
PrintAndLogEx(NORMAL, " AOR - Answer on Request : %s", (aor) ? _GREEN_("Yes") : "No");
PrintAndLogEx(NORMAL, " OTP - One Time Pad : %s", (otp) ? ((extend) ? _YELLOW_("Yes - Warning") : _RED_("Yes - Warning")) : "No");
PrintAndLogEx(NORMAL, " Max block : %d", maxblk);
PrintAndLogEx(NORMAL, " Password mode : %s", (pwd) ? _GREEN_("Yes") : "No");
PrintAndLogEx(NORMAL, " Sequence %-12s : %s", (extend) ? "Start Marker" : "Terminator", (sst) ? _GREEN_("Yes") : "No");
PrintAndLogEx(NORMAL, " Fast Write : %s", (fw) ? ((extend) ? _GREEN_("Yes") : _RED_("Yes - Warning")) : "No");
PrintAndLogEx(NORMAL, " Inverse data : %s", (inv) ? ((extend) ? _GREEN_("Yes") : _RED_("Yes - Warning")) : "No");
PrintAndLogEx(NORMAL, " POR-Delay : %s", (por) ? _GREEN_("Yes") : "No");
}
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "-------------------------------------------------------------");
2020-07-08 19:41:38 +08:00
PrintAndLogEx(NORMAL, " Raw Data - Page 0, block 0");
if (gotdata)
2020-07-08 19:41:38 +08:00
PrintAndLogEx(NORMAL, " 0x" _GREEN_("%08X"), block0);
else
2020-07-08 19:41:38 +08:00
PrintAndLogEx(NORMAL, " 0x" _GREEN_("%08X") " %s", block0, sprint_bin(DemodBuffer + config.offset, 32));
2019-04-05 02:06:15 +08:00
2019-04-03 04:08:50 +08:00
if (((!gotdata) && (!config.Q5)) || (gotdata && (!dataasq5)))
printT5x7KnownBlock0(block0);
2019-04-07 01:09:01 +08:00
2019-04-05 02:06:15 +08:00
PrintAndLogEx(NORMAL, "-------------------------------------------------------------");
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
static int CmdT55xxDump(const char *Cmd) {
uint32_t password = 0;
uint8_t override = 0;
2020-05-12 16:30:14 +08:00
uint8_t downlink_mode = config.downlink_mode;
bool usepwd = false;
bool errors = false;
uint8_t cmdp = 0;
2019-10-10 18:27:48 +08:00
char preferredName[FILE_PATH_SIZE] = {0};
bool success = true;
while (param_getchar(Cmd, cmdp) != 0x00 && !errors) {
switch (tolower(param_getchar(Cmd, cmdp))) {
case 'h':
2019-09-13 22:32:37 +08:00
return usage_t55xx_dump();
case 'r':
downlink_mode = param_get8ex(Cmd, cmdp + 1, 0, 10);
2019-09-13 22:32:37 +08:00
if (downlink_mode > 3)
downlink_mode = 0;
cmdp += 2;
break;
case 'p':
password = param_get32ex(Cmd, cmdp + 1, 0, 16);
usepwd = true;
cmdp += 2;
break;
case 'o':
override = 1;
cmdp++;
break;
2019-10-10 18:27:48 +08:00
case 'f':
2019-10-13 06:48:26 +08:00
param_getstr(Cmd, cmdp + 1, preferredName, FILE_PATH_SIZE);
cmdp += 2;
if (strlen(preferredName) == 0)
errors = true;
break;
default:
PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
errors = true;
break;
}
2019-03-10 06:35:06 +08:00
}
if (errors) return usage_t55xx_dump();
2019-10-10 18:27:48 +08:00
// Due to the few different T55xx cards and number of blocks supported
// will save the dump file if ALL page 0 is OK
2019-03-10 06:35:06 +08:00
printT5xxHeader(0);
2019-07-23 07:50:28 +08:00
for (uint8_t i = 0; i < 8; ++i) {
2019-10-10 18:27:48 +08:00
if (T55xxReadBlock(i, 0, usepwd, override, password, downlink_mode) != PM3_SUCCESS)
success = false;
2019-07-24 05:43:30 +08:00
// idea for better user experience and display.
// only show override warning on the first block read
if (override == 1) override++; // flag not to show safty for 2nd and on.
2019-07-24 05:43:30 +08:00
}
2019-03-10 06:35:06 +08:00
printT5xxHeader(1);
2019-10-13 06:48:26 +08:00
for (uint8_t i = 0; i < 4; i++)
2019-10-10 18:27:48 +08:00
if (T55xxReadBlock(i, 1, usepwd, override, password, downlink_mode) != PM3_SUCCESS)
2019-10-13 06:48:26 +08:00
T55x7_SaveBlockData(8 + i, 0x00);
2019-10-10 18:27:48 +08:00
if (success) { // all ok save dump to file
// saveFileEML will add .eml extension to filename
// saveFile (binary) passes in the .bin extension.
2019-10-13 06:48:26 +08:00
if (strcmp(preferredName, "") == 0) { // Set default filename, if not set by user
strcpy(preferredName, "lf-t55xx");
2019-10-10 18:27:48 +08:00
for (uint8_t i = 1; i <= 7; i++) {
2019-10-11 17:29:20 +08:00
if ((cardmem[i].blockdata != 0x00) && (cardmem[i].blockdata != 0xFFFFFFFF))
2020-09-07 16:35:09 +08:00
snprintf(preferredName + strlen(preferredName), sizeof(preferredName) - strlen(preferredName), "-%08X", cardmem[i].blockdata);
2019-10-10 18:27:48 +08:00
else
break;
}
strcat(preferredName, "-dump");
2019-10-10 18:27:48 +08:00
}
// Swap endian so the files match the txt display
uint32_t data[T55x7_BLOCK_COUNT];
2019-10-13 06:48:26 +08:00
2019-10-10 18:27:48 +08:00
for (int i = 0; i < T55x7_BLOCK_COUNT; i++)
2019-10-11 17:29:20 +08:00
data[i] = BSWAP_32(cardmem[i].blockdata);
2019-10-10 18:27:48 +08:00
saveFileJSON(preferredName, jsfT55x7, (uint8_t *)data, T55x7_BLOCK_COUNT * sizeof(uint32_t), NULL);
2019-10-13 06:48:26 +08:00
saveFileEML(preferredName, (uint8_t *)data, T55x7_BLOCK_COUNT * sizeof(uint32_t), sizeof(uint32_t));
saveFile(preferredName, ".bin", data, sizeof(data));
2019-10-10 18:27:48 +08:00
}
2019-10-13 06:48:26 +08:00
2019-10-10 18:27:48 +08:00
return PM3_SUCCESS;
}
static int CmdT55xxRestore(const char *Cmd) {
bool errors = false;
uint8_t cmdp = 0;
char preferredName[FILE_PATH_SIZE] = {0};
char ext[FILE_PATH_SIZE] = {0};
int success = PM3_ESOFT;
uint32_t password = 0x00;
bool usepwd = false;
uint32_t data[12] = {0};
size_t datalen = 0;
uint8_t blockidx;
uint8_t downlink_mode;
char writeCmdOpt[100];
char pwdOpt [11] = {0}; // p XXXXXXXX
while (param_getchar(Cmd, cmdp) != 0x00 && !errors) {
switch (tolower(param_getchar(Cmd, cmdp))) {
case 'h':
return usage_t55xx_restore();
2019-10-13 06:48:26 +08:00
case 'f':
param_getstr(Cmd, cmdp + 1, preferredName, FILE_PATH_SIZE);
if (strlen(preferredName) == 0)
errors = true;
cmdp += 2;
break;
2019-10-10 18:27:48 +08:00
case 'p':
password = param_get32ex(Cmd, cmdp + 1, 0, 16);
usepwd = true;
cmdp += 2;
2019-10-13 06:48:26 +08:00
break;
2019-10-10 18:27:48 +08:00
default:
PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
errors = true;
break;
}
}
// File name expected to be .eml .bin or .json so sould be at least 4
2019-10-13 06:48:26 +08:00
if (errors || (strlen(preferredName) == 0)) return usage_t55xx_restore();
2019-10-10 18:27:48 +08:00
// split file name into prefix and ext.
int fnLength;
2019-10-13 06:48:26 +08:00
fnLength = strlen(preferredName);
2019-10-11 17:29:20 +08:00
success = PM3_ESOFT;
if (fnLength > 4) { // Holds extension [.bin|.eml]
2019-10-13 06:48:26 +08:00
memcpy(ext, &preferredName[fnLength - 4], 4);
2019-10-10 18:27:48 +08:00
ext[5] = 0x00;
2019-10-11 17:29:20 +08:00
// check if valid file extension and attempt to load data
2019-10-13 06:48:26 +08:00
if (memcmp(ext, ".bin", 4) == 0) {
preferredName[fnLength - 4] = 0x00;
success = loadFile(preferredName, ".bin", data, sizeof(data), &datalen);
} else if (memcmp(ext, ".eml", 4) == 0) {
preferredName[fnLength - 4] = 0x00;
2019-10-10 18:27:48 +08:00
datalen = 12;
success = loadFileEML(preferredName, (uint8_t *)data, &datalen);
2019-10-11 17:29:20 +08:00
2019-10-13 06:48:26 +08:00
} else
PrintAndLogEx(WARNING, "\nWarning: invalid dump filename "_YELLOW_("%s")" to restore!\n", preferredName);
2019-10-10 18:27:48 +08:00
}
if (success == PM3_SUCCESS) { // Got data, so write to cards
if (datalen == T55x7_BLOCK_COUNT * 4) { // 12 blocks * 4 bytes per block
if (usepwd)
2020-08-29 20:13:18 +08:00
snprintf(pwdOpt, sizeof(pwdOpt), "p %08X", password);
2019-10-10 18:27:48 +08:00
// Restore endien for writing to card
2019-10-13 06:48:26 +08:00
for (blockidx = 0; blockidx < 12; blockidx++)
2019-10-10 18:27:48 +08:00
data[blockidx] = BSWAP_32(data[blockidx]);
// Have data ready, lets write
// Order
// write blocks 1..7 page 0
// write blocks 1..3 page 1
// update downlink mode (if needed) and write b 0
downlink_mode = 0;
if ((((data[11] >> 28) & 0xf) == 6) || (((data[11] >> 28) & 0xf) == 9))
downlink_mode = (data[11] >> 10) & 3;
2019-10-13 06:48:26 +08:00
2019-10-10 18:27:48 +08:00
// write out blocks 1-7 page 0
for (blockidx = 1; blockidx <= 7; blockidx++) {
2020-08-29 20:13:18 +08:00
snprintf(writeCmdOpt, sizeof(writeCmdOpt), "b %d d %08X %s", blockidx, data[blockidx], pwdOpt);
2019-10-10 18:27:48 +08:00
if (CmdT55xxWriteBlock(writeCmdOpt) != PM3_SUCCESS)
2019-10-13 06:48:26 +08:00
PrintAndLogEx(WARNING, "Warning: error writing blk %d", blockidx);
2019-10-10 18:27:48 +08:00
}
// if password was set on the "blank" update as we may have just changed it
if (usepwd)
2020-08-29 20:13:18 +08:00
snprintf(pwdOpt, sizeof(pwdOpt), "p %08X", data[7]);
2019-10-10 18:27:48 +08:00
// write out blocks 1-3 page 1
for (blockidx = 9; blockidx <= 11; blockidx++) {
2020-08-29 20:13:18 +08:00
snprintf(writeCmdOpt, sizeof(writeCmdOpt), "b %d 1 d %08X %s", blockidx - 8, data[blockidx], pwdOpt);
2019-10-10 18:27:48 +08:00
if (CmdT55xxWriteBlock(writeCmdOpt) != PM3_SUCCESS)
2019-10-13 06:48:26 +08:00
PrintAndLogEx(WARNING, "Warning: error writing blk %d", blockidx);
2019-10-10 18:27:48 +08:00
}
// Update downlink mode for the page 0 config write.
config.downlink_mode = downlink_mode;
2019-10-13 06:48:26 +08:00
2019-10-10 18:27:48 +08:00
// Write the page 0 config
2020-08-29 20:13:18 +08:00
snprintf(writeCmdOpt, sizeof(writeCmdOpt), "b 0 d %08X %s", data[0], pwdOpt);
2019-10-10 18:27:48 +08:00
if (CmdT55xxWriteBlock(writeCmdOpt) != PM3_SUCCESS)
PrintAndLogEx(WARNING, "Warning: error writing blk 0");
}
}
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
2019-10-11 17:29:20 +08:00
/*
2019-10-10 19:07:57 +08:00
static int CmdT55xxRestore(const char *Cmd) {
uint32_t password = 0;
uint8_t override = 0;
2020-05-12 16:30:14 +08:00
uint8_t downlink_mode = config.downlink_mode;
2019-10-10 19:07:57 +08:00
bool usepwd = false;
bool errors = false;
uint8_t cmdp = 0;
while (param_getchar(Cmd, cmdp) != 0x00 && !errors) {
switch (tolower(param_getchar(Cmd, cmdp))) {
case 'h':
return usage_t55xx_restore();
case 'r':
downlink_mode = param_get8ex(Cmd, cmdp + 1, 0, 10);
if (downlink_mode > 3)
downlink_mode = 0;
cmdp += 2;
break;
case 'p':
password = param_get32ex(Cmd, cmdp + 1, 0, 16);
usepwd = true;
cmdp += 2;
break;
case 'o':
override = 1;
cmdp++;
break;
default:
PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
errors = true;
break;
}
}
if (errors) return usage_t55xx_restore();
PrintAndLogEx(INFO, "Work in progress. To be implemented");
if (usepwd || password || override ) {
}
// load file name (json/eml/bin)
// Print dump data?
uint32_t res = PM3_SUCCESS;
// page0.
// res = clone_t55xx_tag(blockdata, numblocks);
return res;
}
2019-10-11 17:29:20 +08:00
*/
2019-10-10 19:07:57 +08:00
bool AcquireData(uint8_t page, uint8_t block, bool pwdmode, uint32_t password, uint8_t downlink_mode) {
2019-03-10 06:35:06 +08:00
// arg0 bitmodes:
// b0 = pwdmode
// b1 = page to read from
// b2 = brute_mem (armside function)
2019-03-10 06:35:06 +08:00
// arg1: which block to read
// arg2: password
struct p {
uint32_t password;
2019-07-23 07:50:28 +08:00
uint8_t blockno;
uint8_t page;
bool pwdmode;
2019-07-24 05:43:30 +08:00
uint8_t downlink_mode;
} PACKED;
struct p payload;
2019-07-23 07:50:28 +08:00
payload.password = password;
payload.blockno = block;
payload.page = page & 0x1;
payload.pwdmode = pwdmode;
2019-07-24 05:43:30 +08:00
payload.downlink_mode = downlink_mode;
2019-03-10 06:35:06 +08:00
clearCommandBuffer();
SendCommandNG(CMD_LF_T55XX_READBL, (uint8_t *)&payload, sizeof(payload));
if (!WaitForResponseTimeout(CMD_LF_T55XX_READBL, NULL, 2500)) {
2019-03-10 06:35:06 +08:00
PrintAndLogEx(WARNING, "command execution time out");
return false;
}
getSamples(12000, false);
bool ok = !getSignalProperties()->isnoise;
2019-03-10 06:35:06 +08:00
config.usepwd = pwdmode;
return ok;
}
char *GetPskCfStr(uint32_t id, bool q5) {
static char buf[40];
char *retStr = buf;
switch (id) {
case 0:
snprintf(retStr, sizeof(buf), "%u - RF/2", id);
break;
case 1:
snprintf(retStr, sizeof(buf), "%u - RF/4", id);
break;
case 2:
snprintf(retStr, sizeof(buf), "%u - RF/8", id);
break;
case 3:
if (q5)
snprintf(retStr, sizeof(buf), "%u - RF/8", id);
else
snprintf(retStr, sizeof(buf), "%u - " _RED_("(Unknown)"), id);
break;
default:
snprintf(retStr, sizeof(buf), "%u - " _RED_("(Unknown)"), id);
break;
}
return buf;
}
char *GetBitRateStr(uint32_t id, bool xmode) {
2019-03-10 06:35:06 +08:00
static char buf[25];
char *retStr = buf;
if (xmode) { //xmode bitrate calc is same as em4x05 calc
2019-03-19 06:55:39 +08:00
snprintf(retStr, sizeof(buf), "%u - RF/%d", id, EM4x05_GET_BITRATE(id));
2019-03-10 06:35:06 +08:00
} else {
2019-03-10 07:00:59 +08:00
switch (id) {
case 0:
snprintf(retStr, sizeof(buf), "%u - "_GREEN_("RF/8"), id);
2019-03-10 07:00:59 +08:00
break;
case 1:
snprintf(retStr, sizeof(buf), "%u - "_GREEN_("RF/16"), id);
2019-03-10 07:00:59 +08:00
break;
case 2:
snprintf(retStr, sizeof(buf), "%u - "_GREEN_("RF/32"), id);
2019-03-10 07:00:59 +08:00
break;
case 3:
snprintf(retStr, sizeof(buf), "%u - "_GREEN_("RF/40"), id);
2019-03-10 07:00:59 +08:00
break;
case 4:
snprintf(retStr, sizeof(buf), "%u - "_GREEN_("RF/50"), id);
2019-03-10 07:00:59 +08:00
break;
case 5:
snprintf(retStr, sizeof(buf), "%u - "_GREEN_("RF/64"), id);
2019-03-10 07:00:59 +08:00
break;
case 6:
snprintf(retStr, sizeof(buf), "%u - "_GREEN_("RF/100"), id);
2019-03-10 07:00:59 +08:00
break;
case 7:
snprintf(retStr, sizeof(buf), "%u - "_GREEN_("RF/128"), id);
2019-03-10 07:00:59 +08:00
break;
default:
snprintf(retStr, sizeof(buf), "%u - " _RED_("(Unknown)"), id);
2019-03-10 07:00:59 +08:00
break;
2019-03-10 06:35:06 +08:00
}
}
return buf;
}
char *GetSaferStr(uint32_t id) {
2019-03-10 06:35:06 +08:00
static char buf[40];
char *retStr = buf;
2019-03-19 00:46:52 +08:00
snprintf(retStr, sizeof(buf), "%u", id);
2019-03-10 06:35:06 +08:00
if (id == 6) {
2019-03-19 00:46:52 +08:00
snprintf(retStr, sizeof(buf), "%u - " _YELLOW_("passwd"), id);
2019-03-10 06:35:06 +08:00
}
2019-03-10 07:00:59 +08:00
if (id == 9) {
2019-03-19 00:46:52 +08:00
snprintf(retStr, sizeof(buf), "%u - " _YELLOW_("testmode"), id);
2019-03-10 06:35:06 +08:00
}
return buf;
}
char *GetModulationStr(uint32_t id, bool xmode) {
2019-03-10 06:35:06 +08:00
static char buf[60];
char *retStr = buf;
2019-03-10 07:00:59 +08:00
switch (id) {
case 0:
2019-03-19 00:46:52 +08:00
snprintf(retStr, sizeof(buf), "%u - DIRECT (ASK/NRZ)", id);
2019-03-10 07:00:59 +08:00
break;
case 1:
2019-03-19 00:46:52 +08:00
snprintf(retStr, sizeof(buf), "%u - PSK 1 phase change when input changes", id);
2019-03-10 07:00:59 +08:00
break;
case 2:
2019-03-19 00:46:52 +08:00
snprintf(retStr, sizeof(buf), "%u - PSK 2 phase change on bitclk if input high", id);
2019-03-10 07:00:59 +08:00
break;
case 3:
2019-03-19 00:46:52 +08:00
snprintf(retStr, sizeof(buf), "%u - PSK 3 phase change on rising edge of input", id);
2019-03-10 07:00:59 +08:00
break;
case 4:
2019-03-19 00:46:52 +08:00
snprintf(retStr, sizeof(buf), "%u - FSK 1 RF/8 RF/5", id);
2019-03-10 07:00:59 +08:00
break;
case 5:
2019-03-19 00:46:52 +08:00
snprintf(retStr, sizeof(buf), "%u - FSK 2 RF/8 RF/10", id);
2019-03-10 07:00:59 +08:00
break;
case 6:
snprintf(retStr, sizeof(buf), "%u - %s RF/5 RF/8", id, (xmode) ? "FSK 1a" : _YELLOW_("FSK 1a"));
2019-03-10 07:00:59 +08:00
break;
case 7:
snprintf(retStr, sizeof(buf), "%u - %s RF/10 RF/8", id, (xmode) ? "FSK 2a" : _YELLOW_("FSK 2a"));
2019-03-10 07:00:59 +08:00
break;
case 8:
2019-03-19 00:46:52 +08:00
snprintf(retStr, sizeof(buf), "%u - Manchester", id);
2019-03-10 07:00:59 +08:00
break;
case 16:
2019-03-19 00:46:52 +08:00
snprintf(retStr, sizeof(buf), "%u - Biphase", id);
2019-03-10 07:00:59 +08:00
break;
case 24:
snprintf(retStr, sizeof(buf), "%u - %s", id, (xmode) ? "Biphase a - AKA Conditional Dephase Encoding(CDP)" : _YELLOW_("Reserved"));
2019-03-10 07:00:59 +08:00
break;
default:
snprintf(retStr, sizeof(buf), "0x%02X " _RED_("(Unknown)"), id);
break;
}
return buf;
}
2019-09-19 16:54:34 +08:00
char *GetDownlinkModeStr(uint8_t downlink_mode) {
2019-09-14 12:13:55 +08:00
static char buf[30];
char *retStr = buf;
switch (downlink_mode) {
case T55XX_DLMODE_FIXED :
2019-09-19 16:54:34 +08:00
snprintf(retStr, sizeof(buf), "default/fixed bit length");
2019-09-14 12:13:55 +08:00
break;
case T55XX_DLMODE_LLR :
2019-09-19 16:54:34 +08:00
snprintf(retStr, sizeof(buf), "long leading reference");
2019-09-14 12:13:55 +08:00
break;
case T55XX_DLMODE_LEADING_ZERO :
2019-09-19 16:54:34 +08:00
snprintf(retStr, sizeof(buf), "leading zero reference");
2019-09-14 12:13:55 +08:00
break;
case T55XX_DLMODE_1OF4 :
2019-09-19 16:54:34 +08:00
snprintf(retStr, sizeof(buf), "1 of 4 coding reference");
2019-09-14 12:13:55 +08:00
break;
default:
snprintf(retStr, sizeof(buf), _RED_("(Unknown)"));
break;
}
return buf;
}
char *GetQ5ModulationStr(uint32_t id) {
static char buf[60];
char *retStr = buf;
switch (id) {
case 0:
snprintf(retStr, sizeof(buf), "%u - Manchester", id);
break;
case 1:
snprintf(retStr, sizeof(buf), "%u - PSK 1 phase change when input changes", id);
break;
case 2:
snprintf(retStr, sizeof(buf), "%u - PSK 2 phase change on bitclk if input high", id);
break;
case 3:
snprintf(retStr, sizeof(buf), "%u - PSK 3 phase change on rising edge of input", id);
break;
case 4:
snprintf(retStr, sizeof(buf), "%u - FSK 1a RF/5 RF/8", id);
break;
case 5:
snprintf(retStr, sizeof(buf), "%u - FSK 2a RF/10 RF/8", id);
break;
case 6:
snprintf(retStr, sizeof(buf), "%u - Biphase", id);
break;
case 7:
snprintf(retStr, sizeof(buf), "%u - NRZ / Direct", id);
2019-03-10 07:00:59 +08:00
break;
}
2019-03-10 06:35:06 +08:00
return buf;
}
char *GetModelStrFromCID(uint32_t cid) {
2019-03-10 06:35:06 +08:00
static char buf[10];
char *retStr = buf;
2019-03-10 07:00:59 +08:00
if (cid == 1) snprintf(retStr, sizeof(buf), "ATA5577M1");
if (cid == 2) snprintf(retStr, sizeof(buf), "ATA5577M2");
2019-10-08 17:49:23 +08:00
if (cid == 3) snprintf(retStr, sizeof(buf), "ATA5577M3");
2019-03-10 06:35:06 +08:00
return buf;
}
char *GetConfigBlock0Source(uint8_t id) {
2020-12-12 21:46:40 +08:00
static char buf[40];
char *retStr = buf;
switch (id) {
case autoDetect:
snprintf(retStr, sizeof(buf), _YELLOW_("(Auto detect)"));
break;
case userSet:
snprintf(retStr, sizeof(buf), _YELLOW_("(User set)"));
break;
case tagRead:
snprintf(retStr, sizeof(buf), _GREEN_("(Tag read)"));
break;
default:
snprintf(retStr, sizeof(buf), _RED_("(Unknown)"));
break;
}
return buf;
}
char *GetSelectedModulationStr(uint8_t id) {
2019-03-10 06:35:06 +08:00
static char buf[20];
char *retStr = buf;
2019-03-10 07:00:59 +08:00
switch (id) {
case DEMOD_FSK:
snprintf(retStr, sizeof(buf), "FSK");
break;
case DEMOD_FSK1:
snprintf(retStr, sizeof(buf), "FSK1");
break;
case DEMOD_FSK1a:
snprintf(retStr, sizeof(buf), "FSK1a");
break;
case DEMOD_FSK2:
snprintf(retStr, sizeof(buf), "FSK2");
break;
case DEMOD_FSK2a:
snprintf(retStr, sizeof(buf), "FSK2a");
break;
case DEMOD_ASK:
snprintf(retStr, sizeof(buf), "ASK");
break;
case DEMOD_NRZ:
snprintf(retStr, sizeof(buf), "DIRECT/NRZ");
break;
case DEMOD_PSK1:
snprintf(retStr, sizeof(buf), "PSK1");
break;
case DEMOD_PSK2:
snprintf(retStr, sizeof(buf), "PSK2");
break;
case DEMOD_PSK3:
snprintf(retStr, sizeof(buf), "PSK3");
break;
case DEMOD_BI:
snprintf(retStr, sizeof(buf), "BIPHASE");
break;
case DEMOD_BIa:
snprintf(retStr, sizeof(buf), "BIPHASEa - (CDP)");
break;
default:
snprintf(retStr, sizeof(buf), _RED_("(Unknown)"));
2019-03-10 07:00:59 +08:00
break;
}
2019-03-10 06:35:06 +08:00
return buf;
}
/*
static void t55x7_create_config_block(int tagtype) {
// T55X7_DEFAULT_CONFIG_BLOCK, T55X7_RAW_CONFIG_BLOCK
// T55X7_EM_UNIQUE_CONFIG_BLOCK, T55X7_FDXB_CONFIG_BLOCK,
// T55X7_FDXB_CONFIG_BLOCK, T55X7_HID_26_CONFIG_BLOCK, T55X7_INDALA_64_CONFIG_BLOCK, T55X7_INDALA_224_CONFIG_BLOCK
// T55X7_GUARDPROXII_CONFIG_BLOCK, T55X7_VIKING_CONFIG_BLOCK, T55X7_NORALYS_CONFIG_BLOCK, T55X7_IOPROX_CONFIG_BLOCK
2019-03-10 06:35:06 +08:00
static char buf[60];
char *retStr = buf;
2019-03-10 07:00:59 +08:00
switch (tagtype) {
case 0:
snprintf(retStr, sizeof(buf), "%08X - T55X7 Default", T55X7_DEFAULT_CONFIG_BLOCK);
break;
case 1:
snprintf(retStr, sizeof(buf), "%08X - T55X7 Raw", T55X7_RAW_CONFIG_BLOCK);
break;
case 2:
2020-08-28 21:53:34 +08:00
snprintf(retStr, sizeof(buf), "%08X - Q5/T5555 Default", T5555_DEFAULT_CONFIG_BLOCK);
2019-03-10 07:00:59 +08:00
break;
2019-03-10 06:35:06 +08:00
default:
break;
}
PrintAndLogEx(NORMAL, buf);
}
*/
static int CmdResetRead(const char *Cmd) {
2019-07-23 07:50:28 +08:00
2020-05-12 16:30:14 +08:00
uint8_t downlink_mode = config.downlink_mode;
uint8_t flags = 0;
uint8_t cmdp = 0;
bool errors = false;
2019-07-24 05:43:30 +08:00
while (param_getchar(Cmd, cmdp) != 0x00 && !errors) {
switch (tolower(param_getchar(Cmd, cmdp))) {
case 'h':
return usage_t55xx_resetread();
case 'r':
downlink_mode = param_get8ex(Cmd, cmdp + 1, 0, 10);
2019-09-13 22:32:37 +08:00
if (downlink_mode > 3)
downlink_mode = 0;
2019-09-13 22:32:37 +08:00
cmdp += 2;
break;
default:
PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
errors = true;
break;
}
}
2019-07-24 05:43:30 +08:00
if (errors) return usage_t55xx_resetread();
2019-07-24 05:43:30 +08:00
flags = downlink_mode << 3;
2019-09-13 22:32:37 +08:00
PacketResponseNG resp;
2019-03-10 06:35:06 +08:00
clearCommandBuffer();
SendCommandNG(CMD_LF_T55XX_RESET_READ, &flags, sizeof(flags));
if (!WaitForResponseTimeout(CMD_LF_T55XX_RESET_READ, &resp, 2500)) {
2019-03-10 06:35:06 +08:00
PrintAndLogEx(WARNING, "command execution time out");
2019-05-22 20:48:23 +08:00
return PM3_ETIMEOUT;
2019-03-10 06:35:06 +08:00
}
if (resp.status == PM3_SUCCESS) {
uint16_t gotsize = pm3_capabilities.bigbuf_size - 1;
2019-10-10 19:07:57 +08:00
uint8_t *got = calloc(gotsize, sizeof(uint8_t));
if (got == NULL) {
PrintAndLogEx(WARNING, "failed to allocate memory");
return PM3_EMALLOC;
}
2019-10-10 19:07:57 +08:00
if (!GetFromDevice(BIG_BUF, got, gotsize, 0, NULL, 0, NULL, 2500, false)) {
PrintAndLogEx(WARNING, "command execution time out");
2019-10-06 07:18:04 +08:00
free(got);
return PM3_ETIMEOUT;
}
2019-10-10 19:07:57 +08:00
setGraphBuf(got, gotsize);
free(got);
2019-03-10 06:35:06 +08:00
}
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
static int CmdT55xxWipe(const char *Cmd) {
CLIParserContext *ctx;
CLIParserInit(&ctx, "lf t55xx wipe",
"This commands wipes a tag, fills blocks 1-7 with zeros and a default configuration block",
"lf t55xx wipe -> wipes a T55x7 tag, config block 0x000880E0\n"
"lf t55xx wipe --q5 -> wipes a Q5/T5555 tag, config block 0x6001F004\n"
"lf t55xx wipe -p 11223344 -> wipes a T55x7 tag, config block 0x000880E0, using pwd"
);
// 4 + (5 or 6)
2021-01-14 18:39:45 +08:00
void *argtable[9] = {
arg_param_begin,
arg_str0("c", "cfg", "<hex>", "configuration block0 (4 hex bytes)"),
arg_str0("p", "pwd", "<hex>", "password (4 hex bytes)"),
arg_lit0(NULL, "q5", "specify writing to Q5/T5555 tag using dedicated config block"),
};
uint8_t idx = 4;
arg_add_t55xx_downloadlink(argtable, &idx, T55XX_DLMODE_SINGLE, config.downlink_mode);
CLIExecWithReturn(ctx, Cmd, argtable, true);
bool usepwd = false, gotconf = false;
2021-01-14 18:39:45 +08:00
uint32_t block0 = 0;
int res = arg_get_u32_hexstr_def(ctx, 1, 0, &block0);
if (res == 1) {
gotconf = true;
}
if (res == 2) {
CLIParserFree(ctx);
PrintAndLogEx(WARNING, "config block needs to be 4 hex bytes");
return PM3_EINVARG;
}
uint32_t password = 0;
res = arg_get_u32_hexstr_def(ctx, 2, 0x51243648, &password);
if (res) {
usepwd = true;
}
if (res == 2) {
PrintAndLogEx(WARNING, "Password should be 4 bytes, using default pwd");
}
2021-01-14 18:39:45 +08:00
bool Q5 = arg_get_lit(ctx, 3);
CLIParserFree(ctx);
PrintAndLogEx(INFO, "Target " _YELLOW_("%s")" tag", (Q5) ? "Q5/T5555" : "T55x7");
// default config blocks.
if (gotconf == false) {
block0 = (Q5) ? 0x6001F004 : 0x000880E0;
}
if (usepwd)
PrintAndLogEx(INFO, "Using password " _GREEN_("%08X"), password);
char msg[80] = {0};
if (gotconf)
snprintf(msg, sizeof(msg), "User provided configuration block " _GREEN_("%08X"), block0);
2019-03-10 06:35:06 +08:00
else
snprintf(msg, sizeof(msg), "Default configuration block " _GREEN_("%08X"), block0);
2019-09-19 16:54:34 +08:00
PrintAndLogEx(INFO, "%s\n", msg);
PrintAndLogEx(INFO, "Begin wiping...");
2019-09-19 16:54:34 +08:00
// Creating cmd string for write block :)
char writeData[36] = {0};
char *ptrData = writeData;
snprintf(ptrData, sizeof(writeData), "b 0 ");
if (usepwd) {
snprintf(ptrData + strlen(writeData), sizeof(writeData) - strlen(writeData), "p %08x ", password);
}
snprintf(ptrData + strlen(writeData), sizeof(writeData) - strlen(writeData), "d %08X", block0);
2019-09-19 16:54:34 +08:00
if (CmdT55xxWriteBlock(ptrData) != PM3_SUCCESS)
PrintAndLogEx(WARNING, "Warning: error writing blk 0");
2019-03-10 07:00:59 +08:00
for (uint8_t blk = 1; blk < 8; blk++) {
2019-03-10 07:00:59 +08:00
snprintf(ptrData, sizeof(writeData), "b %d d 0", blk);
if (CmdT55xxWriteBlock(ptrData) != PM3_SUCCESS)
PrintAndLogEx(WARNING, "Warning: error writing blk %d", blk);
2019-03-10 06:35:06 +08:00
memset(writeData, 0x00, sizeof(writeData));
}
2019-09-19 16:54:34 +08:00
2019-09-14 12:13:55 +08:00
// Check and rest t55xx downlink mode.
if (config.downlink_mode != T55XX_DLMODE_FIXED) { // Detect found a different mode so card must support
snprintf(ptrData, sizeof(writeData), "b 3 1 d 00000000");
if (CmdT55xxWriteBlock(ptrData) != PM3_SUCCESS) {
PrintAndLogEx(WARNING, "Warning: failed writing block 3 page 1 (config)");
}
2019-09-14 12:13:55 +08:00
memset(writeData, 0x00, sizeof(writeData));
}
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
static bool IsCancelled(void) {
if (kbd_enter_pressed()) {
2019-03-10 06:35:06 +08:00
PrintAndLogEx(WARNING, "\naborted via keyboard!\n");
return true;
}
return false;
}
// load a default pwd file.
static int CmdT55xxChkPwds(const char *Cmd) {
CLIParserContext *ctx;
CLIParserInit(&ctx, "lf t55xx chk",
"This command uses a dictionary attack.\n"
"For some cloners, try '--em' for known pwdgen algo.\n"
"Try to reading Page 0 block 7 before.\n"
_RED_("WARNING:") _CYAN_(" this may brick non-password protected chips!"),
"lf t55xx chk -m -> use dictionary from flash memory (RDV4)\n"
"lf t55xx chk -f my_dictionary_pwds -> loads a default keys dictionary file\n"
"lf t55xx chk --em aa11223344 -> try known pwdgen algo from some cloners based on EM4100 ID"
);
2021-01-28 22:29:52 +08:00
// Calculate size of argtable accordingly:
// 1 (help) + 3 (three user specified params) + ( 5 or 6 T55XX_DLMODE)
// 4 + (T55XX_DLMODE_xxx 5)
// 4 + (T55XX_DLMODE_ALL 6) == 10
void *argtable[10] = {
arg_param_begin,
arg_lit0("m", "fm", "use dictionary from flash memory (RDV4)"),
arg_str0("f", "file", "<filename>", "file name"),
arg_str0(NULL, "em", "<hex>", "EM4100 ID (5 hex bytes)"),
};
uint8_t idx = 4;
arg_add_t55xx_downloadlink(argtable, &idx, T55XX_DLMODE_ALL, T55XX_DLMODE_ALL);
CLIExecWithReturn(ctx, Cmd, argtable, true);
bool from_flash = arg_get_lit(ctx, 1);
int fnlen = 0;
char filename[FILE_PATH_SIZE] = {0};
CLIParamStrToBuf(arg_get_str(ctx, 2), (uint8_t *)filename, sizeof(filename), &fnlen);
2019-07-24 05:43:30 +08:00
// White cloner password based on EM4100 ID
bool use_calc_password = false;
uint32_t card_password = 0x00;
uint64_t cardid = 0;
int res = arg_get_u64_hexstr_def_nlen(ctx, 3, 0x00, &cardid, 5, true);
if (res == 1) {
use_calc_password = true;
uint32_t calc = cardid & 0xFFFFFFFF;
card_password = lf_t55xx_white_pwdgen(calc);
2019-07-24 05:43:30 +08:00
}
if (res == 2) {
CLIParserFree(ctx);
PrintAndLogEx(WARNING, "EM4100 ID must be 5 hex bytes");
return PM3_EINVARG;
}
if (res == 0) {
CLIParserFree(ctx);
return PM3_EINVARG;
}
bool r0 = arg_get_lit(ctx, 4);
bool r1 = arg_get_lit(ctx, 5);
bool r2 = arg_get_lit(ctx, 6);
bool r3 = arg_get_lit(ctx, 7);
bool ra = arg_get_lit(ctx, 8);
CLIParserFree(ctx);
2019-07-24 05:43:30 +08:00
if ((r0 + r1 + r2 + r3 + ra) > 1) {
PrintAndLogEx(FAILED, "Error multiple downlink encoding");
return PM3_EINVARG;
}
2020-11-02 08:46:47 +08:00
uint8_t downlink_mode = config.downlink_mode;
if (r0)
downlink_mode = refFixedBit;
else if (r1)
downlink_mode = refLongLeading;
else if (r2)
downlink_mode = refLeading0;
else if (r3)
downlink_mode = ref1of4;
bool use_pwd_file = false;
2020-11-02 08:46:47 +08:00
if (strlen(filename) == 0) {
snprintf(filename, sizeof(filename), "t55xx_default_pwds");
use_pwd_file = true;
}
2019-03-10 06:35:06 +08:00
PrintAndLogEx(INFO, "press " _GREEN_("'enter'") " to cancel the command");
PrintAndLogEx(NORMAL, "");
2019-03-10 06:35:06 +08:00
/*
// block 7, page1 = false, usepwd = false, override = false, pwd = 00000000
2019-05-24 19:06:08 +08:00
if ( T55xxReadBlock(7, false, false, false, 0x00000000) == PM3_SUCCESS) {
2019-03-10 06:35:06 +08:00
// now try to validate it..
PrintAndLogEx(WARNING, "\n Block 7 was readable");
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
2019-03-10 06:35:06 +08:00
}
*/
bool found = false;
2019-03-10 06:35:06 +08:00
uint64_t t1 = msclock();
2019-07-24 05:43:30 +08:00
uint8_t flags = downlink_mode << 3;
2019-07-23 07:50:28 +08:00
if (from_flash) {
2019-03-10 06:35:06 +08:00
clearCommandBuffer();
SendCommandNG(CMD_LF_T55XX_CHK_PWDS, &flags, sizeof(flags));
2019-04-18 18:43:35 +08:00
PacketResponseNG resp;
2019-03-10 06:35:06 +08:00
uint8_t timeout = 0;
while (!WaitForResponseTimeout(CMD_LF_T55XX_CHK_PWDS, &resp, 2000)) {
2019-03-10 06:35:06 +08:00
timeout++;
2020-08-29 20:13:18 +08:00
PrintAndLogEx(NORMAL, "." NOLF);
2019-03-10 06:35:06 +08:00
if (timeout > 180) {
PrintAndLogEx(WARNING, "\nno response from Proxmark3. Aborting...");
2019-05-22 20:48:23 +08:00
return PM3_ENODATA;
2019-03-10 06:35:06 +08:00
}
}
2020-08-29 20:13:18 +08:00
PrintAndLogEx(NORMAL, "");
struct p {
bool found;
uint32_t candidate;
} PACKED;
2020-09-07 16:35:09 +08:00
struct p *packet = (struct p *)resp.data.asBytes;
2019-03-10 06:35:06 +08:00
if (packet->found) {
PrintAndLogEx(SUCCESS, "\nfound a candidate [ " _YELLOW_("%08"PRIX32) " ]", packet->candidate);
2019-03-10 06:35:06 +08:00
if (AcquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, true, packet->candidate, downlink_mode)) {
2020-10-09 21:31:27 +08:00
found = t55xxTryDetectModulationEx(downlink_mode, T55XX_PrintConfig, 0, packet->candidate);
2019-04-08 20:41:06 +08:00
if (found) {
PrintAndLogEx(SUCCESS, "found valid password [ " _GREEN_("%08"PRIX32) " ]", packet->candidate);
2019-07-23 07:50:28 +08:00
2019-04-08 20:41:06 +08:00
} else {
PrintAndLogEx(WARNING, "check pwd failed");
2019-04-08 20:41:06 +08:00
}
2019-03-10 06:35:06 +08:00
} else {
PrintAndLogEx(WARNING, "check pwd failed");
2019-03-10 06:35:06 +08:00
}
} else {
PrintAndLogEx(WARNING, "check pwd failed");
2019-03-10 06:35:06 +08:00
}
goto out;
}
// to try each downlink mode for each password
int dl_mode;
// try calculated password
if (use_calc_password) {
PrintAndLogEx(INFO, "testing %08"PRIX32" generated ", card_password);
for (dl_mode = downlink_mode; dl_mode <= 3; dl_mode++) {
if (!AcquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, true, card_password, dl_mode)) {
continue;
}
found = t55xxTryDetectModulationEx(dl_mode, T55XX_PrintConfig, 0, card_password);
if (found) {
PrintAndLogEx(SUCCESS, "found valid password : [ " _GREEN_("%08"PRIX32) " ]", card_password);
break;
}
if (ra == false)
break;
}
}
if ((found == false) && use_pwd_file) {
uint32_t keycount = 0;
uint8_t *keyblock = NULL;
2019-03-28 21:19:41 +08:00
res = loadFileDICTIONARY_safe(filename, (void **) &keyblock, 4, &keycount);
if (res != PM3_SUCCESS || keycount == 0 || keyblock == NULL) {
PrintAndLogEx(WARNING, "no keys found in file");
if (keyblock != NULL)
free(keyblock);
2019-08-29 03:16:09 +08:00
2019-05-22 20:48:23 +08:00
return PM3_ESOFT;
2019-03-10 06:35:06 +08:00
}
2020-11-02 08:46:47 +08:00
PrintAndLogEx(INFO, "press " _GREEN_("'enter'") " to cancel the command");
2020-11-02 08:46:47 +08:00
for (uint32_t c = 0; c < keycount && found == false; ++c) {
2019-03-10 06:35:06 +08:00
2019-05-01 05:52:40 +08:00
if (!session.pm3_present) {
PrintAndLogEx(WARNING, "device offline\n");
free(keyblock);
2019-05-22 20:48:23 +08:00
return PM3_ENODATA;
2019-03-10 06:35:06 +08:00
}
if (IsCancelled()) {
free(keyblock);
2019-05-22 20:48:23 +08:00
return PM3_EOPABORTED;
2019-03-10 06:35:06 +08:00
}
uint32_t curr_password = bytes_to_num(keyblock + 4 * c, 4);
2019-03-10 06:35:06 +08:00
PrintAndLogEx(INFO, "testing %08"PRIX32, curr_password);
2019-07-24 05:43:30 +08:00
for (dl_mode = downlink_mode; dl_mode <= 3; dl_mode++) {
2019-10-10 19:07:57 +08:00
if (!AcquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, true, curr_password, dl_mode)) {
2019-07-24 05:43:30 +08:00
continue;
}
2020-10-09 21:31:27 +08:00
found = t55xxTryDetectModulationEx(dl_mode, T55XX_PrintConfig, 0, curr_password);
2019-07-24 05:43:30 +08:00
if (found) {
PrintAndLogEx(SUCCESS, "found valid password: [ " _GREEN_("%08"PRIX32) " ]", curr_password);
break;
2019-07-24 05:43:30 +08:00
}
if (ra == false) // Exit loop if not trying all downlink modes
break;
2019-07-24 05:43:30 +08:00
}
}
free(keyblock);
2019-03-10 06:35:06 +08:00
}
if (found == false)
PrintAndLogEx(WARNING, "failed to find password");
out:
2019-03-10 06:35:06 +08:00
t1 = msclock() - t1;
2020-08-21 22:47:18 +08:00
PrintAndLogEx(SUCCESS, "\ntime in check pwd " _YELLOW_("%.0f") " seconds\n", (float)t1 / 1000.0);
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
// Bruteforce - incremental password range search
static int CmdT55xxBruteForce(const char *Cmd) {
2021-01-13 03:59:44 +08:00
CLIParserContext *ctx;
CLIParserInit(&ctx, "lf t55xx bruteforce",
"This command uses bruteforce to scan a number range.\n"
"Try reading Page 0, block 7 before.\n\n"
_RED_("WARNING") _CYAN_(" this may brick non-password protected chips!"),
"lf t55xx bruteforce --r2 -s aaaaaa77 -e aaaaaa99\n"
);
2021-01-14 18:39:45 +08:00
void *argtable[3 + 6] = {
2021-01-13 03:59:44 +08:00
arg_param_begin,
arg_str1("s", "start", "<hex>", "search start password (4 hex bytes)"),
arg_str1("e", "end", "<hex>", "search end password (4 hex bytes)"),
};
uint8_t idx = 3;
arg_add_t55xx_downloadlink(argtable, &idx, T55XX_DLMODE_ALL, T55XX_DLMODE_ALL);
CLIExecWithReturn(ctx, Cmd, argtable, true);
2021-01-13 03:59:44 +08:00
uint32_t start_password = 0;
int res = arg_get_u32_hexstr_def(ctx, 1, 0, &start_password);
if (res == 2) {
CLIParserFree(ctx);
PrintAndLogEx(FAILED, "start password should be 4 bytes");
return PM3_EINVARG;
}
2019-09-13 22:32:37 +08:00
2021-01-13 03:59:44 +08:00
uint32_t end_password = 0xFFFFFFFF;
res = arg_get_u32_hexstr_def(ctx, 2, 0xFFFFFFFF, &end_password);
if (res == 2) {
CLIParserFree(ctx);
PrintAndLogEx(FAILED, "end password should be 4 bytes");
return PM3_EINVARG;
}
2019-07-24 05:43:30 +08:00
2021-01-13 03:59:44 +08:00
bool r0 = arg_get_lit(ctx, 3);
bool r1 = arg_get_lit(ctx, 4);
bool r2 = arg_get_lit(ctx, 5);
bool r3 = arg_get_lit(ctx, 6);
bool ra = arg_get_lit(ctx, 7);
CLIParserFree(ctx);
2019-10-10 19:07:57 +08:00
2021-01-13 03:59:44 +08:00
if ((r0 + r1 + r2 + r3 + ra) > 1) {
PrintAndLogEx(FAILED, "Error multiple downlink encoding");
return PM3_EINVARG;
}
2021-01-13 03:59:44 +08:00
uint8_t downlink_mode = config.downlink_mode;
if (r0)
downlink_mode = refFixedBit;
else if (r1)
downlink_mode = refLongLeading;
else if (r2)
downlink_mode = refLeading0;
else if (r3)
downlink_mode = ref1of4;
2021-01-13 03:59:44 +08:00
uint32_t curr = 0;
uint8_t found = 0; // > 0 if found xx1 xx downlink needed, 1 found
2021-01-13 03:59:44 +08:00
if (start_password >= end_password) {
PrintAndLogEx(FAILED, "Error, start larger then end password");
return PM3_EINVARG;
}
PrintAndLogEx(INFO, "press " _GREEN_("'enter'") " to cancel the command");
PrintAndLogEx(INFO, "Search password range [%08X -> %08X]", start_password, end_password);
2021-01-13 03:59:44 +08:00
uint64_t t1 = msclock();
curr = start_password;
2019-03-28 21:19:41 +08:00
2021-01-13 03:59:44 +08:00
while (found == 0) {
2021-01-14 18:39:45 +08:00
2020-08-29 20:13:18 +08:00
PrintAndLogEx(NORMAL, "." NOLF);
2019-03-10 06:35:06 +08:00
if (IsCancelled()) {
2019-05-22 20:48:23 +08:00
return PM3_EOPABORTED;
2019-03-10 06:35:06 +08:00
}
2021-01-13 03:59:44 +08:00
found = t55xx_try_one_password(curr, downlink_mode, ra);
2019-03-10 06:35:06 +08:00
if (curr == end_password)
break;
2019-03-28 21:19:41 +08:00
2019-03-10 06:35:06 +08:00
curr++;
}
PrintAndLogEx(NORMAL, "");
2019-07-23 07:50:28 +08:00
if (found) {
PrintAndLogEx(SUCCESS, "Found valid password: [ " _GREEN_("%08X") " ]", curr - 1);
2019-07-24 05:43:30 +08:00
T55xx_Print_DownlinkMode((found >> 1) & 3);
} else
PrintAndLogEx(WARNING, "Bruteforce failed, last tried: [ " _YELLOW_("%08X") " ]", curr);
2019-03-10 06:35:06 +08:00
t1 = msclock() - t1;
2020-08-21 22:47:18 +08:00
PrintAndLogEx(SUCCESS, "\ntime in bruteforce " _YELLOW_("%.0f") " seconds\n", (float)t1 / 1000.0);
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
uint8_t t55xx_try_one_password(uint32_t password, uint8_t downlink_mode, bool try_all_dl_modes) {
2019-07-24 05:43:30 +08:00
PrintAndLogEx(INFO, "Trying password %08X", password);
// ensure 0-3
downlink_mode = (downlink_mode & 3);
2019-07-24 05:43:30 +08:00
// check if dl mode 4 and loop if needed
for (uint8_t dl_mode = downlink_mode; dl_mode < 4; dl_mode++) {
2019-07-24 05:43:30 +08:00
2019-10-10 19:07:57 +08:00
if (AcquireData(T55x7_PAGE0, T55x7_CONFIGURATION_BLOCK, true, password, dl_mode)) {
// if (getSignalProperties()->isnoise == false) {
// } else {
2020-10-09 21:31:27 +08:00
if (t55xxTryDetectModulationEx(dl_mode, T55XX_PrintConfig, 0, password)) {
2019-10-10 19:07:57 +08:00
return 1 + (dl_mode << 1);
}
// }
2019-07-24 05:43:30 +08:00
}
if (try_all_dl_modes == false) {
break;
}
2019-07-24 05:43:30 +08:00
}
return 0;
}
static int CmdT55xxRecoverPW(const char *Cmd) {
CLIParserContext *ctx;
CLIParserInit(&ctx, "lf t55xx recoverpw",
"This command uses a few tricks to try to recover mangled password.\n"
"Try reading Page 0, block 7 before.\n\n"
_RED_("WARNING") _CYAN_(" this may brick non-password protected chips!"),
"lf t55xx recoverpw\n"
"lf t55xx recoverpw -p 11223344\n"
"lf t55xx recoverpw -p 11223344 --r3\n"
);
// 2 + (5 or 6)
2021-01-14 18:39:45 +08:00
void *argtable[8] = {
arg_param_begin,
arg_str0("p", "pwd", "<hex>", "password (4 hex bytes)"),
};
uint8_t idx = 2;
arg_add_t55xx_downloadlink(argtable, &idx, T55XX_DLMODE_ALL, T55XX_DLMODE_ALL);
CLIExecWithReturn(ctx, Cmd, argtable, true);
uint32_t orig_password = 0;
int res = arg_get_u32_hexstr_def(ctx, 1, 0x51243648, &orig_password);
if (res == 2) {
PrintAndLogEx(INFO, "Password should be 4 bytes, using default pwd instead");
}
bool r0 = arg_get_lit(ctx, 2);
bool r1 = arg_get_lit(ctx, 3);
bool r2 = arg_get_lit(ctx, 4);
bool r3 = arg_get_lit(ctx, 5);
bool ra = arg_get_lit(ctx, 6);
CLIParserFree(ctx);
if ((r0 + r1 + r2 + r3 + ra) > 1) {
PrintAndLogEx(FAILED, "Error multiple downlink encoding");
return PM3_EINVARG;
}
uint8_t downlink_mode = config.downlink_mode;
if (r0)
downlink_mode = refFixedBit;
else if (r1)
downlink_mode = refLongLeading;
else if (r2)
downlink_mode = refLeading0;
else if (r3)
downlink_mode = ref1of4;
2021-01-13 03:59:44 +08:00
PrintAndLogEx(NORMAL, "press " _GREEN_("'enter'") " to cancel the command");
int bit = 0;
2019-03-10 06:35:06 +08:00
uint32_t curr_password = 0x0;
uint32_t prev_password = 0xffffffff;
uint32_t mask = 0x0;
uint8_t found = 0;
2019-03-10 06:35:06 +08:00
// first try fliping each bit in the expected password
while (bit < 32) {
curr_password = orig_password ^ (1u << bit);
found = t55xx_try_one_password(curr_password, downlink_mode, ra);
2019-07-23 07:50:28 +08:00
if (found > 0) // xx1 for found xx = dl mode used
goto out;
2019-03-28 21:19:41 +08:00
2019-03-10 06:35:06 +08:00
bit++;
2019-03-28 21:19:41 +08:00
if (IsCancelled())
2019-05-22 20:48:23 +08:00
return PM3_EOPABORTED;
2019-03-10 06:35:06 +08:00
}
// now try to use partial original password, since block 7 should have been completely
// erased during the write sequence and it is possible that only partial password has been
// written
// not sure from which end the bit bits are written, so try from both ends
// from low bit to high bit
bit = 0;
while (bit < 32) {
mask += (1u << bit);
2019-03-10 06:35:06 +08:00
curr_password = orig_password & mask;
// if updated mask didn't change the password, don't try it again
if (prev_password == curr_password) {
bit++;
continue;
}
2019-03-28 21:19:41 +08:00
found = t55xx_try_one_password(curr_password, downlink_mode, ra);
2019-07-23 07:50:28 +08:00
if (found > 0)
2019-03-28 21:19:41 +08:00
goto out;
2019-03-10 06:35:06 +08:00
bit++;
prev_password = curr_password;
2019-03-28 21:19:41 +08:00
if (IsCancelled())
2019-05-22 20:48:23 +08:00
return PM3_EOPABORTED;
2019-03-10 06:35:06 +08:00
}
// from high bit to low
bit = 0;
mask = 0xffffffff;
while (bit < 32) {
mask -= (1u << bit);
2019-03-10 06:35:06 +08:00
curr_password = orig_password & mask;
// if updated mask didn't change the password, don't try it again
if (prev_password == curr_password) {
bit++;
continue;
}
found = t55xx_try_one_password(curr_password, downlink_mode, ra);
2019-07-23 07:50:28 +08:00
if (found > 0)
goto out;
2019-03-10 06:35:06 +08:00
bit++;
prev_password = curr_password;
2019-03-28 21:19:41 +08:00
if (IsCancelled())
2019-05-22 20:48:23 +08:00
return PM3_EOPABORTED;
2019-03-10 06:35:06 +08:00
}
out:
2019-03-10 06:35:06 +08:00
PrintAndLogEx(NORMAL, "");
2019-07-23 07:50:28 +08:00
if (found > 0) {
PrintAndLogEx(SUCCESS, "Found valid password: [ " _GREEN_("%08X") " ]", curr_password);
2019-07-24 05:43:30 +08:00
T55xx_Print_DownlinkMode((found >> 1) & 3);
} else {
PrintAndLogEx(FAILED, "Recover password failed");
}
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
// note length of data returned is different for different chips.
// some return all page 1 (64 bits) and others return just that block (32 bits)
// unfortunately the 64 bits makes this more likely to get a false positive...
bool tryDetectP1(bool getData) {
2019-07-23 07:50:28 +08:00
uint8_t preamble[] = {1, 1, 1, 0, 0, 0, 0, 0, 0, 0, 0, 1, 0, 1, 0, 1};
size_t startIdx = 0;
uint8_t fc1 = 0, fc2 = 0, ans = 0;
int clk = 0, firstClockEdge = 0;
bool st = true;
2019-03-10 06:35:06 +08:00
2019-03-10 07:00:59 +08:00
if (getData) {
2019-10-10 19:07:57 +08:00
if (!AcquireData(T55x7_PAGE1, T55x7_TRACE_BLOCK1, false, 0, 0))
2019-03-10 06:35:06 +08:00
return false;
}
// try fsk clock detect. if successful it cannot be any other type of modulation... (in theory...)
ans = fskClocks(&fc1, &fc2, (uint8_t *)&clk, &firstClockEdge);
2019-03-10 07:00:59 +08:00
if (ans && ((fc1 == 10 && fc2 == 8) || (fc1 == 8 && fc2 == 5))) {
2020-09-28 17:50:20 +08:00
if ((FSKrawDemod(0, 0, 0, 0, false) == PM3_SUCCESS) &&
preambleSearchEx(DemodBuffer, preamble, sizeof(preamble), &DemodBufferLen, &startIdx, false) &&
(DemodBufferLen == 32 || DemodBufferLen == 64)) {
2019-03-10 06:35:06 +08:00
return true;
}
2020-09-28 17:50:20 +08:00
if ((FSKrawDemod(0, 1, 0, 0, false) == PM3_SUCCESS) &&
preambleSearchEx(DemodBuffer, preamble, sizeof(preamble), &DemodBufferLen, &startIdx, false) &&
(DemodBufferLen == 32 || DemodBufferLen == 64)) {
2019-03-10 06:35:06 +08:00
return true;
}
return false;
}
2019-07-13 06:38:30 +08:00
2019-03-10 06:35:06 +08:00
// try ask clock detect. it could be another type even if successful.
clk = GetAskClock("", false);
if (clk > 0) {
2020-09-28 17:50:20 +08:00
if ((ASKDemod_ext(0, 0, 1, 0, false, false, false, 1, &st) == PM3_SUCCESS) &&
preambleSearchEx(DemodBuffer, preamble, sizeof(preamble), &DemodBufferLen, &startIdx, false) &&
(DemodBufferLen == 32 || DemodBufferLen == 64)) {
2019-03-10 06:35:06 +08:00
return true;
}
2019-07-13 06:38:30 +08:00
2019-03-10 06:35:06 +08:00
st = true;
2020-09-28 17:50:20 +08:00
if ((ASKDemod_ext(0, 1, 1, 0, false, false, false, 1, &st) == PM3_SUCCESS) &&
preambleSearchEx(DemodBuffer, preamble, sizeof(preamble), &DemodBufferLen, &startIdx, false) &&
(DemodBufferLen == 32 || DemodBufferLen == 64)) {
2019-03-10 06:35:06 +08:00
return true;
}
2019-07-13 06:38:30 +08:00
2020-09-28 17:50:20 +08:00
if ((ASKbiphaseDemod(0, 0, 0, 2, false) == PM3_SUCCESS) &&
preambleSearchEx(DemodBuffer, preamble, sizeof(preamble), &DemodBufferLen, &startIdx, false) &&
(DemodBufferLen == 32 || DemodBufferLen == 64)) {
2019-03-10 06:35:06 +08:00
return true;
}
2019-06-08 22:11:18 +08:00
2020-09-28 17:50:20 +08:00
if ((ASKbiphaseDemod(0, 0, 1, 2, false) == PM3_SUCCESS) &&
preambleSearchEx(DemodBuffer, preamble, sizeof(preamble), &DemodBufferLen, &startIdx, false) &&
(DemodBufferLen == 32 || DemodBufferLen == 64)) {
2019-03-10 06:35:06 +08:00
return true;
}
}
2019-07-13 06:38:30 +08:00
2019-03-10 06:35:06 +08:00
// try NRZ clock detect. it could be another type even if successful.
clk = GetNrzClock("", false); //has the most false positives :(
if (clk > 0) {
2020-09-28 17:50:20 +08:00
if ((NRZrawDemod(0, 0, 1, false) == PM3_SUCCESS) &&
preambleSearchEx(DemodBuffer, preamble, sizeof(preamble), &DemodBufferLen, &startIdx, false) &&
(DemodBufferLen == 32 || DemodBufferLen == 64)) {
2019-03-10 06:35:06 +08:00
return true;
}
2020-09-28 17:50:20 +08:00
if ((NRZrawDemod(0, 1, 1, false) == PM3_SUCCESS) &&
preambleSearchEx(DemodBuffer, preamble, sizeof(preamble), &DemodBufferLen, &startIdx, false) &&
(DemodBufferLen == 32 || DemodBufferLen == 64)) {
2019-03-10 06:35:06 +08:00
return true;
}
}
// Fewer card uses PSK
// try psk clock detect. if successful it cannot be any other type of modulation... (in theory...)
clk = GetPskClock("", false);
if (clk > 0) {
// allow undo
// save_restoreGB(GRAPH_SAVE);
// skip first 160 samples to allow antenna to settle in (psk gets inverted occasionally otherwise)
//CmdLtrim("160");
2020-09-28 17:50:20 +08:00
if ((PSKDemod(0, 0, 6, false) == PM3_SUCCESS) &&
preambleSearchEx(DemodBuffer, preamble, sizeof(preamble), &DemodBufferLen, &startIdx, false) &&
(DemodBufferLen == 32 || DemodBufferLen == 64)) {
2019-03-10 06:35:06 +08:00
//save_restoreGB(GRAPH_RESTORE);
return true;
}
2020-09-28 17:50:20 +08:00
if ((PSKDemod(0, 1, 6, false) == PM3_SUCCESS) &&
preambleSearchEx(DemodBuffer, preamble, sizeof(preamble), &DemodBufferLen, &startIdx, false) &&
(DemodBufferLen == 32 || DemodBufferLen == 64)) {
2019-03-10 06:35:06 +08:00
//save_restoreGB(GRAPH_RESTORE);
return true;
}
// PSK2 - needs a call to psk1TOpsk2.
2020-09-28 17:50:20 +08:00
if (PSKDemod(0, 0, 6, false) == PM3_SUCCESS) {
2019-03-10 06:35:06 +08:00
psk1TOpsk2(DemodBuffer, DemodBufferLen);
if (preambleSearchEx(DemodBuffer, preamble, sizeof(preamble), &DemodBufferLen, &startIdx, false) &&
(DemodBufferLen == 32 || DemodBufferLen == 64)) {
2019-03-10 06:35:06 +08:00
//save_restoreGB(GRAPH_RESTORE);
return true;
}
} // inverse waves does not affect PSK2 demod
//undo trim samples
//save_restoreGB(GRAPH_RESTORE);
// no other modulation clocks = 2 or 4 so quit searching
if (fc1 != 8) return false;
}
return false;
}
// does this need to be a callable command?
static int CmdT55xxDetectPage1(const char *Cmd) {
CLIParserContext *ctx;
CLIParserInit(&ctx, "lf t55xx p1detect",
"Detect Page 1 of a T55xx chip",
"lf t55xx p1detect\n"
"lf t55xx p1detect -1\n"
"lf t55xx p1detect -p 11223344 --r3\n"
);
// 2 + (5 or 6)
2021-01-14 18:39:45 +08:00
void *argtable[7] = {
arg_param_begin,
arg_lit0("1", NULL, "extract using data from graphbuffer"),
arg_str0("p", "pwd", "<hex>", "password (4 hex bytes)"),
};
uint8_t idx = 3;
arg_add_t55xx_downloadlink(argtable, &idx, T55XX_DLMODE_SINGLE, config.downlink_mode);
CLIExecWithReturn(ctx, Cmd, argtable, true);
bool use_graphbuf = arg_get_lit(ctx, 1);
2019-09-16 02:30:05 +08:00
bool usepwd = false;
uint32_t password = 0;
int res = arg_get_u32_hexstr_def(ctx, 2, 0, &password);
if (res == 2) {
PrintAndLogEx(INFO, "Password should be 4 hex bytes");
2021-01-29 23:06:45 +08:00
CLIParserFree(ctx);
return PM3_EINVARG;
2021-01-14 18:39:45 +08:00
} else if (res == 1) {
usepwd = true;
}
2019-03-10 06:35:06 +08:00
bool r0 = arg_get_lit(ctx, 3);
bool r1 = arg_get_lit(ctx, 4);
bool r2 = arg_get_lit(ctx, 5);
bool r3 = arg_get_lit(ctx, 6);
CLIParserFree(ctx);
2019-09-13 22:32:37 +08:00
if ((r0 + r1 + r2 + r3) > 1) {
PrintAndLogEx(FAILED, "Error multiple downlink encoding");
return PM3_EINVARG;
2019-03-10 06:35:06 +08:00
}
uint8_t downlink_mode = config.downlink_mode;
if (r0)
downlink_mode = refFixedBit;
else if (r1)
downlink_mode = refLongLeading;
else if (r2)
downlink_mode = refLeading0;
else if (r3)
downlink_mode = ref1of4;
bool try_all_dl_modes = true;
//ICEMAN STRANGE
if (downlink_mode == 4)
try_all_dl_modes = true;
if (downlink_mode < 4)
try_all_dl_modes = false;
if (downlink_mode > 3)
downlink_mode = 0;
bool found = false;
uint8_t found_mode = 0;
if (use_graphbuf == false) {
for (uint8_t dl_mode = downlink_mode; dl_mode < 4; dl_mode++) {
2021-01-14 18:39:45 +08:00
if (AcquireData(T55x7_PAGE1, T55x7_TRACE_BLOCK1, usepwd, password, dl_mode) == false)
2020-01-03 02:52:23 +08:00
continue;
2020-01-03 02:52:23 +08:00
if (tryDetectP1(false)) {
2019-09-14 12:13:55 +08:00
found = true;
found_mode = dl_mode;
break;
2020-01-03 02:52:23 +08:00
} else {
found = false;
}
2019-07-24 05:43:30 +08:00
if (try_all_dl_modes == false) {
break;
2020-01-03 02:52:23 +08:00
}
2019-07-24 05:43:30 +08:00
}
2019-09-14 12:13:55 +08:00
} else {
found = tryDetectP1(false);
2019-07-24 05:43:30 +08:00
}
2019-09-19 16:54:34 +08:00
2019-07-24 05:43:30 +08:00
if (found) {
PrintAndLogEx(SUCCESS, "T55xx chip found!");
2019-09-14 12:13:55 +08:00
T55xx_Print_DownlinkMode(found_mode);
2019-07-24 05:43:30 +08:00
} else
PrintAndLogEx(WARNING, "Could not detect modulation automatically. Try setting it manually with " _YELLOW_("\'lf t55xx config\'"));
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
static int CmdT55xxSetDeviceConfig(const char *Cmd) {
CLIParserContext *ctx;
CLIParserInit(&ctx, "lf t55xx deviceconfig",
"Sets t55x7 timings for direct commands.\n"
"The timings are set here in Field Clocks (FC) which is converted to (US) on device.",
"lf t55xx deviceconfig -a 29 -b 17 -c 15 -d 47 -e 15 -> default T55XX\n"
"lf t55xx deviceconfig -a 55 -b 14 -c 21 -d 30 -> default EM4305"
);
2019-07-24 05:43:30 +08:00
2021-01-14 18:39:45 +08:00
void *argtable[10 + 5] = {
arg_param_begin,
arg_int0("a", NULL, "<8..255>", "Set start gap"),
arg_int0("b", NULL, "<8..255>", "Set write gap"),
arg_int0("c", NULL, "<8..255>", "Set write ZERO gap"),
arg_int0("d", NULL, "<8..255>", "Set write ONE gap"),
arg_int0("e", NULL, "<8..255>", "Set read gap"),
arg_int0("f", NULL, "<8..255>", "Set write TWO gap (1 of 4 only)"),
arg_int0("g", NULL, "<8..255>", "Set write THREE gap (1 of 4 only)"),
arg_lit0("p", "persist", "persist to flash memory (RDV4)"),
arg_lit0("z", NULL, "Set default t55x7 timings (use `-p` to save if required)"),
};
uint8_t idx = 10;
arg_add_t55xx_downloadlink(argtable, &idx, T55XX_DLMODE_SINGLE, config.downlink_mode);
CLIExecWithReturn(ctx, Cmd, argtable, false);
uint8_t startgap = arg_get_int(ctx, 1);
uint8_t writegap = arg_get_int(ctx, 2);
uint8_t write0 = arg_get_int(ctx, 3);
uint8_t write1 = arg_get_int(ctx, 4);
uint8_t readgap = arg_get_int(ctx, 5);
uint8_t write2 = arg_get_int(ctx, 6);
uint8_t write3 = arg_get_int(ctx, 7);
bool shall_persist = arg_get_lit(ctx, 8);
bool set_defaults = arg_get_lit(ctx, 9);
bool r0 = arg_get_lit(ctx, 10);
bool r1 = arg_get_lit(ctx, 11);
bool r2 = arg_get_lit(ctx, 12);
bool r3 = arg_get_lit(ctx, 13);
CLIParserFree(ctx);
if ((r0 + r1 + r2 + r3) > 1) {
PrintAndLogEx(FAILED, "Error multiple downlink encoding");
2021-01-14 18:39:45 +08:00
return PM3_EINVARG;
2019-03-10 06:35:06 +08:00
}
uint8_t downlink_mode = 0;
if (r0)
downlink_mode = refFixedBit;
else if (r1)
downlink_mode = refLongLeading;
else if (r2)
downlink_mode = refLeading0;
else if (r3)
downlink_mode = ref1of4;
2019-03-10 06:35:06 +08:00
2019-08-12 05:53:45 +08:00
t55xx_configurations_t configurations = {{{0}, {0}, {0}, {0}}};
2019-07-27 16:25:03 +08:00
2019-07-27 14:39:30 +08:00
if (set_defaults) {
// fixed bit length
2019-07-28 03:15:43 +08:00
configurations.m[T55XX_DLMODE_FIXED].start_gap = 29 * 8;
configurations.m[T55XX_DLMODE_FIXED].write_gap = 17 * 8;
configurations.m[T55XX_DLMODE_FIXED].write_0 = 15 * 8;
configurations.m[T55XX_DLMODE_FIXED].write_1 = 47 * 8;
configurations.m[T55XX_DLMODE_FIXED].read_gap = 15 * 8;
configurations.m[T55XX_DLMODE_FIXED].write_2 = 0;
configurations.m[T55XX_DLMODE_FIXED].write_3 = 0;
2019-07-27 14:39:30 +08:00
// long leading reference
configurations.m[T55XX_DLMODE_LLR].start_gap = 29 * 8;
configurations.m[T55XX_DLMODE_LLR].write_gap = 17 * 8;
configurations.m[T55XX_DLMODE_LLR].write_0 = 15 * 8;
configurations.m[T55XX_DLMODE_LLR].write_1 = 47 * 8;
2019-07-28 03:15:43 +08:00
configurations.m[T55XX_DLMODE_LLR].read_gap = 15 * 8;
configurations.m[T55XX_DLMODE_LLR].write_2 = 0;
configurations.m[T55XX_DLMODE_LLR].write_3 = 0;
2019-07-27 14:39:30 +08:00
// leading zero
configurations.m[T55XX_DLMODE_LEADING_ZERO].start_gap = 29 * 8;
configurations.m[T55XX_DLMODE_LEADING_ZERO].write_gap = 17 * 8;
configurations.m[T55XX_DLMODE_LEADING_ZERO].write_0 = 15 * 8;
2019-07-28 03:15:43 +08:00
configurations.m[T55XX_DLMODE_LEADING_ZERO].write_1 = 40 * 8;
configurations.m[T55XX_DLMODE_LEADING_ZERO].read_gap = 15 * 8;
configurations.m[T55XX_DLMODE_LEADING_ZERO].write_2 = 0;
configurations.m[T55XX_DLMODE_LEADING_ZERO].write_3 = 0;
2019-07-27 14:39:30 +08:00
// 1 of 4 coding reference
2019-07-28 03:15:43 +08:00
configurations.m[T55XX_DLMODE_1OF4].start_gap = 29 * 8;
configurations.m[T55XX_DLMODE_1OF4].write_gap = 17 * 8;
configurations.m[T55XX_DLMODE_1OF4].write_0 = 15 * 8;
configurations.m[T55XX_DLMODE_1OF4].write_1 = 31 * 8;
configurations.m[T55XX_DLMODE_1OF4].read_gap = 15 * 8;
configurations.m[T55XX_DLMODE_1OF4].write_2 = 47 * 8;
configurations.m[T55XX_DLMODE_1OF4].write_3 = 63 * 8;
2019-07-27 14:39:30 +08:00
} else {
2019-07-28 03:15:43 +08:00
configurations.m[downlink_mode].start_gap = startgap * 8;
configurations.m[downlink_mode].write_gap = writegap * 8;
configurations.m[downlink_mode].write_0 = write0 * 8;
configurations.m[downlink_mode].write_1 = write1 * 8;
configurations.m[downlink_mode].read_gap = readgap * 8;
configurations.m[downlink_mode].write_2 = write2 * 8;
configurations.m[downlink_mode].write_3 = write3 * 8;
2019-07-27 14:39:30 +08:00
}
2019-03-10 06:35:06 +08:00
clearCommandBuffer();
2020-05-27 17:59:24 +08:00
SendCommandMIX(CMD_LF_T55XX_SET_CONFIG, shall_persist, 0, 0, &configurations, sizeof(t55xx_configurations_t));
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
static int CmdT55xxProtect(const char *Cmd) {
CLIParserContext *ctx;
CLIParserInit(&ctx, "lf t55xx protect",
"This command sets the pwd bit on T5577.\n"
_RED_("WARNING") _CYAN_(" this locks the tag!"),
"lf t55xx protect -n 01020304 -> sets new pwd 01020304\n"
"lf t55xx protect -p 11223344 -n 00000000 -> use pwd 11223344, sets new pwd 00000000"
);
// 4 + (5 or 6)
2021-01-14 18:39:45 +08:00
void *argtable[4 + 5] = {
arg_param_begin,
arg_lit0("o", "override", "override safety check"),
arg_str0("p", "pwd", "<hex>", "password (4 hex bytes)"),
arg_str1("n", "new", "<hex>", "new password (4 hex bytes)"),
};
uint8_t idx = 4;
arg_add_t55xx_downloadlink(argtable, &idx, T55XX_DLMODE_SINGLE, config.downlink_mode);
CLIExecWithReturn(ctx, Cmd, argtable, true);
uint8_t override = 0;
2021-01-14 18:39:45 +08:00
if (arg_get_lit(ctx, 1))
override = 2;
uint32_t password = 0;
2021-01-14 18:39:45 +08:00
bool usepwd = false;
int res = arg_get_u32_hexstr_def(ctx, 2, 0, &password);
if (res == 2) {
CLIParserFree(ctx);
PrintAndLogEx(FAILED, "Error parsing password bytes");
return PM3_EINVARG;
2021-01-14 18:39:45 +08:00
} else if (res == 1) {
usepwd = true;
override = 1;
}
uint32_t new_password = 0;
res = arg_get_u32_hexstr_def(ctx, 3, 0, &new_password);
if (res == 2) {
CLIParserFree(ctx);
PrintAndLogEx(FAILED, "Error parsing new password bytes");
return PM3_EINVARG;
} else if (res == 0) {
PrintAndLogEx(FAILED, "Must specify new password param");
CLIParserFree(ctx);
return PM3_EINVARG;
}
bool r0 = arg_get_lit(ctx, 4);
bool r1 = arg_get_lit(ctx, 5);
bool r2 = arg_get_lit(ctx, 6);
bool r3 = arg_get_lit(ctx, 7);
CLIParserFree(ctx);
if ((r0 + r1 + r2 + r3) > 1) {
PrintAndLogEx(FAILED, "Error multiple downlink encoding");
return PM3_EINVARG;
}
uint8_t downlink_mode = config.downlink_mode;
if (r0)
downlink_mode = refFixedBit;
else if (r1)
downlink_mode = refLongLeading;
else if (r2)
downlink_mode = refLeading0;
else if (r3)
downlink_mode = ref1of4;
2019-09-19 16:54:34 +08:00
// sanity check.
if (SanityOfflineCheck(false) != PM3_SUCCESS)
return PM3_ESOFT;
2019-09-19 16:54:34 +08:00
// lock
2019-09-19 16:54:34 +08:00
if (t55xxProtect(true, usepwd, override, password, downlink_mode, new_password) == false) {
PrintAndLogEx(WARNING, "Command failed. Did you run " _YELLOW_("`lf t55xx detect`") " before?");
return PM3_ESOFT;
}
return PM3_SUCCESS;
}
2021-01-10 19:52:57 +08:00
// if the difference between a and b is less then or eq to d i.e. does a = b +/- d
#define APPROX_EQ(a, b, d) ((abs(a - b) <= d) ? true : false)
2021-01-10 19:52:57 +08:00
static uint8_t t55sniff_get_packet(int *pulseBuffer, char *data, uint8_t width0, uint8_t width1, uint8_t tolerance) {
2020-09-19 21:04:57 +08:00
int i = 0;
bool ok = true;
2021-01-10 19:52:57 +08:00
uint8_t len = 0;
2020-09-19 21:04:57 +08:00
while (ok && (i < 73)) { // 70 bits max Fixed bit packet
2021-01-10 19:52:57 +08:00
if (APPROX_EQ(width0, pulseBuffer[i], tolerance)) {
data[len++] = '0';
2020-09-19 21:04:57 +08:00
i++;
continue;
}
2021-01-10 19:52:57 +08:00
if (APPROX_EQ(width1, pulseBuffer[i], tolerance)) {
data[len++] = '1';
2020-09-19 21:04:57 +08:00
i++;
continue;
}
ok = false;
}
2021-01-10 19:52:57 +08:00
data[len] = 0x00;
return len;
}
2021-01-10 19:52:57 +08:00
static uint8_t t55sniff_trim_samples(int *pulseBuffer, int *pulseIdx, uint8_t len) {
for (uint8_t i = 0; i < (80 - len); i++) {
pulseBuffer[i] = pulseBuffer[i + len];
2020-09-19 21:04:57 +08:00
}
2020-09-30 20:27:19 +08:00
2020-09-19 21:04:57 +08:00
*pulseIdx -= len;
return PM3_SUCCESS;
}
static int CmdT55xxSniff(const char *Cmd) {
2021-01-10 19:52:57 +08:00
CLIParserContext *ctx;
CLIParserInit(&ctx, "lf t55xx sniff",
"Sniff LF t55xx based trafic and decode possible cmd / blocks.\n"
"Lower tolerance means tighter pulses. ",
"lf t55xx sniff\n"
"lf t55xx sniff -1 -t 2 -> use buffer with tolernace of 2\n"
"lf t55xx sniff -1 --zero 7 --one 14 -> use buffer, zero pulse width 7, one pulse width 15"
);
void *argtable[] = {
arg_param_begin,
arg_lit0("1", NULL, "extract using data from graphbuffer"),
arg_int0("t", "tol", "<dec>", "set tolerance level (default 5)"),
// arg_int0(NULL, "signal", "<dec>", "set minimum signal level (default 20)"),
arg_int0("o", "one", "<dec>", "set samples width for ONE pulse (default auto)"),
arg_int0("z", "zero", "<dec>", "set samples width for ZERO pulse (default auto)"),
arg_param_end
};
CLIExecWithReturn(ctx, Cmd, argtable, true);
bool use_graphbuf = arg_get_lit(ctx, 1);
uint8_t tolerance = arg_get_int_def(ctx, 2, 5);
2021-01-27 05:26:19 +08:00
int opt_width1 = arg_get_int_def(ctx, 3, -1);
int opt_width0 = arg_get_int_def(ctx, 4, -1);
2021-01-10 19:52:57 +08:00
CLIParserFree(ctx);
2021-01-27 05:26:19 +08:00
if (opt_width0 > 0 && opt_width1 == -1) {
2021-01-10 19:52:57 +08:00
PrintAndLogEx(ERR, _RED_("Missing sample width for ONE"));
return PM3_EINVARG;
}
2020-09-19 21:04:57 +08:00
2021-01-27 05:26:19 +08:00
if (opt_width1 > 0 && opt_width0 == -1) {
2021-01-10 19:52:57 +08:00
PrintAndLogEx(ERR, _RED_("Missing sample width for ZERO"));
return PM3_EINVARG;
}
2020-09-19 21:04:57 +08:00
2021-01-27 05:26:19 +08:00
if (opt_width0 == 0) {
PrintAndLogEx(ERR, "Must call with --zero larger than 0");
2021-01-10 19:52:57 +08:00
return PM3_EINVARG;
}
2021-01-27 05:26:19 +08:00
if ((opt_width0 == 0) || (opt_width1 == 0)) {
PrintAndLogEx(ERR, "Must call with --one larger than 0");
return PM3_EINVARG;
}
uint8_t width1 = 0;
uint8_t width0 = 0;
if (opt_width0 > -1)
width0 = (uint8_t)opt_width0 & 0xFF;
if (opt_width1 > -1)
width1 = (uint8_t)opt_width1 & 0xFF;
/*
Notes:
T55xx packet lengths (1 of 4 needs to be checked)
-----------------------------------------------
| Default | LL 0 | Leading 0 | 1 of 4 |
----------------------------------------------------------------|
| Standard Write | 38 | 39 | 39 | 40 |
| Protect Write | 70 | 71 | 73 | 74 |
| AOR | 34 | 35 | 37 | 38 |
| Standard Read | 5 | 6 | 7 | 8 |
| Protect Read | 38 | 39 | 41 | 42 |
| Regular Read | 2 | 3 | 3 | 4 |
| Reset | 2 | 3 | 3 | 4 |
----------------------------------------------------------------
2020-09-30 20:27:19 +08:00
T55xx bit widths (decimation 1) - Expected, but may vary a little
Reference 0 for LL0 and Leading 0 can be longer
-----------------------------------------------
| Default | LL 0 | Leading 0 | 1 of 4 |
----------------------------------------------------|
| 0 | 16 - 32 | 9 - 33 | 5 - 80 | tbc |
| 1 | 48 - 64 | 41 - 72 | 21 - 96 | tbc |
----------------------------------------------------
00 01 10 11
*/
bool have_data = false;
2021-01-10 19:52:57 +08:00
uint8_t page, blockAddr;
uint16_t dataLen = 0;
size_t idx = 0;
uint32_t usedPassword, blockData;
int pulseSamples = 0;
int pulseIdx = 0;
int minWidth = 1000;
int maxWidth = 0;
char modeText [100];
char pwdText [100];
char dataText [100];
int pulseBuffer[80] = { 0 }; // max should be 73 +/- - Holds Pulse widths
char data[80]; // linked to pulseBuffer. - Holds 0/1 from pulse widths
2021-01-14 18:39:45 +08:00
2020-09-19 21:04:57 +08:00
// setup and sample data from Proxmark
// if not directed to existing sample/graphbuffer
2021-01-10 19:52:57 +08:00
if (use_graphbuf == false) {
2020-09-30 20:27:19 +08:00
CmdLFSniff("");
}
// Headings
PrintAndLogEx(NORMAL, "");
2020-09-30 20:27:19 +08:00
PrintAndLogEx(INFO, _CYAN_("T55xx command detection"));
PrintAndLogEx(SUCCESS, "Downlink mode | password | Data | blk | page | 0 | 1 | raw");
PrintAndLogEx(SUCCESS, "----------------------+----------+----------+-----+------+-----+-----+-------------------------------------------------------------------------------");
idx = 0;
// loop though sample buffer
2020-09-19 21:04:57 +08:00
while (idx < GraphTraceLen) {
minWidth = 1000;
maxWidth = 0;
dataLen = 0;
data[0] = 0;
have_data = false;
sprintf(modeText, "Default");
sprintf(pwdText, " ");
sprintf(dataText, " ");
2020-09-19 21:04:57 +08:00
if (pulseSamples == 0) {
idx++;
}
// find high
2020-09-19 21:04:57 +08:00
while ((idx < GraphTraceLen) && (GraphBuffer[idx] < 0)) {
idx++;
2020-09-19 21:04:57 +08:00
}
// count high samples
pulseSamples = 0;
while ((idx < GraphTraceLen) && (GraphBuffer[idx] > 0)) { // last bit seems to be high to zero, but can vary in width..
pulseSamples++;
idx++;
}
if (pulseSamples > 0) {
pulseBuffer[pulseIdx++] = pulseSamples;
if (pulseIdx > 79) { // make room for next sample - if not used by now, it wont be.
2021-01-10 19:52:57 +08:00
t55sniff_trim_samples(pulseBuffer, &pulseIdx, 1);
}
// Check Samples for valid packets;
// We should find (outside of leading bits) we have a packet of "1" and "0" at same widths.
if (pulseIdx >= 6) {// min size for a read - ignoring 1of4 10 0 <adr>
2020-09-30 20:27:19 +08:00
// We auto find widths
if ((width0 == 0) && (width1 == 0)) {
// We ignore bit 0 for the moment as it may be a ref. pulse, so check last
uint8_t ii = 2;
minWidth = pulseBuffer[1];
maxWidth = pulseBuffer[1];
bool done = false;
2020-09-30 20:27:19 +08:00
2021-01-10 19:52:57 +08:00
while ((!done) && (ii < pulseIdx) && ((maxWidth <= minWidth) || (APPROX_EQ(minWidth, maxWidth, tolerance)))) { // min should be 8, 16-32 more normal
2020-09-30 20:27:19 +08:00
if (pulseBuffer[ii] + 3 < minWidth) {
minWidth = pulseBuffer[ii];
done = true;
}
2020-09-30 20:27:19 +08:00
if (pulseBuffer[ii] - 1 > maxWidth) {
maxWidth = pulseBuffer[ii];
done = true;
}
ii++;
}
} else {
minWidth = width0;
maxWidth = width1;
}
}
// out of bounds... min max far enough appart and minWidth is large enough
2020-09-30 20:27:19 +08:00
if (((maxWidth - minWidth) < 6) || (minWidth < 6)) // min 8 +/-
continue;
2020-09-30 20:27:19 +08:00
// At this point we should have
// - a min of 6 samples
// - the 0 and 1 sample widths
// - min 0 and min seperations (worst case)
// No max checks done (yet) as have seen samples > then specs in use.
2020-09-30 20:27:19 +08:00
// Check first bit.
2020-09-30 20:27:19 +08:00
// Long leading 0
if (have_data == false && (APPROX_EQ(pulseBuffer[0], 136 + minWidth, tolerance) && APPROX_EQ(pulseBuffer[1], maxWidth, tolerance))) {
2020-09-30 20:27:19 +08:00
// printf ("Long Leading 0 - not yet hanled | have 1 Fisrt bit | Min : %-3d - Max : %-3d : diff : %d\n",minWidth,maxWidth, maxWidth-minWidth);
continue;
}
// Fixed bit - Default
if (have_data == false && (APPROX_EQ(pulseBuffer[0], maxWidth, tolerance))) {
2021-01-10 19:52:57 +08:00
dataLen = t55sniff_get_packet(pulseBuffer, data, minWidth, maxWidth, tolerance);
2020-09-30 20:27:19 +08:00
// if ((dataLen == 39) )
// printf ("Fixed | Data end of 80 samples | offset : %llu - datalen %-2d - data : %s --- - Bit 0 width : %d\n",idx,dataLen,data,pulseBuffer[0]);
if (data[0] == '0') { // should never get here..
2020-09-30 20:27:19 +08:00
dataLen = 0;
data[0] = 0;
} else {
// Default Read
if (dataLen == 6) {
2021-01-10 19:52:57 +08:00
t55sniff_trim_samples(pulseBuffer, &pulseIdx, 4); // left 1 or 2 samples seemed to help
page = data[1] - '0';
blockAddr = 0;
for (uint8_t i = 3; i < 6; i++) {
blockAddr <<= 1;
2020-09-30 20:27:19 +08:00
if (data[i] == '1')
blockAddr |= 1;
}
blockData = 0;
have_data = true;
sprintf(modeText, "Default Read");
}
// Password Write
if (dataLen == 70) {
2021-01-10 19:52:57 +08:00
t55sniff_trim_samples(pulseBuffer, &pulseIdx, 70);
page = data[1] - '0';
usedPassword = 0;
for (uint8_t i = 2; i <= 33; i++) {
usedPassword <<= 1;
2020-09-30 20:27:19 +08:00
if (data[i] == '1')
usedPassword |= 1;
}
// Lock bit 34
blockData = 0;
for (uint8_t i = 35; i <= 66; i++) {
blockData <<= 1;
2020-09-30 20:27:19 +08:00
if (data[i] == '1')
blockData |= 1;
}
blockAddr = 0;
for (uint8_t i = 67; i <= 69; i++) {
blockAddr <<= 1;
2020-09-30 20:27:19 +08:00
if (data[i] == '1')
blockAddr |= 1;
}
have_data = true;
sprintf(modeText, "Default pwd write");
sprintf(pwdText, "%08X", usedPassword);
2020-09-30 20:27:19 +08:00
sprintf(dataText, "%08X", blockData);
}
// Default Write (or password read ??)
2020-09-19 21:04:57 +08:00
if (dataLen == 38) {
2021-01-10 19:52:57 +08:00
t55sniff_trim_samples(pulseBuffer, &pulseIdx, 38);
page = data[1] - '0';
usedPassword = 0;
blockData = 0;
for (uint8_t i = 3; i <= 34; i++) {
blockData <<= 1;
2020-09-30 20:27:19 +08:00
if (data[i] == '1')
blockData |= 1;
}
blockAddr = 0;
for (uint8_t i = 35; i <= 37; i++) {
blockAddr <<= 1;
2020-09-30 20:27:19 +08:00
if (data[i] == '1')
blockAddr |= 1;
}
have_data = true;
sprintf(modeText, "Default write");
2020-09-30 20:27:19 +08:00
sprintf(dataText, "%08X", blockData);
}
}
}
// Leading 0
if (have_data == false && (APPROX_EQ(pulseBuffer[0], minWidth, tolerance))) {
2020-09-30 20:27:19 +08:00
// leading 0 (should = 0 width)
// 1 of 4 (leads with 00)
2021-01-10 19:52:57 +08:00
dataLen = t55sniff_get_packet(pulseBuffer, data, minWidth, maxWidth, tolerance);
// **** Should check to 0 to be actual 0 as well i.e. 01 .... data ....
if ((data[0] == '0') && (data[1] == '1')) {
if (dataLen == 73) {
2021-01-10 19:52:57 +08:00
t55sniff_trim_samples(pulseBuffer, &pulseIdx, 73);
page = data[2] - '0';
usedPassword = 0;
for (uint8_t i = 5; i <= 36; i++) {
usedPassword <<= 1;
2020-09-30 20:27:19 +08:00
if (data[i] == '1')
usedPassword |= 1;
}
blockData = 0;
for (uint8_t i = 38; i <= 69; i++) {
blockData <<= 1;
2020-09-30 20:27:19 +08:00
if (data[i] == '1')
blockData |= 1;
}
blockAddr = 0;
for (uint8_t i = 70; i <= 72; i++) {
blockAddr <<= 1;
2020-09-30 20:27:19 +08:00
if (data[i] == '1')
blockAddr |= 1;
}
have_data = true;
sprintf(modeText, "Leading 0 pwd write");
sprintf(pwdText, "%08X", usedPassword);
2020-09-30 20:27:19 +08:00
sprintf(dataText, "%08X", blockData);
}
}
}
}
// Print results
2021-01-14 18:39:45 +08:00
if (have_data) {
if (blockAddr == 7)
2020-09-30 20:27:19 +08:00
PrintAndLogEx(SUCCESS, "%-20s | "_GREEN_("%8s")" | "_YELLOW_("%8s")" | "_YELLOW_("%d")" | "_GREEN_("%d")" | %3d | %3d | %s", modeText, pwdText, dataText, blockAddr, page, minWidth, maxWidth, data);
else
2020-09-30 20:27:19 +08:00
PrintAndLogEx(SUCCESS, "%-20s | "_GREEN_("%8s")" | "_GREEN_("%8s")" | "_GREEN_("%d")" | "_GREEN_("%d")" | %3d | %3d | %s", modeText, pwdText, dataText, blockAddr, page, minWidth, maxWidth, data);
}
}
// footer
2020-09-30 20:27:19 +08:00
PrintAndLogEx(SUCCESS, "-----------------------------------------------------------------------------------------------------------------------------------------------------");
PrintAndLogEx(NORMAL, "");
return PM3_SUCCESS;
}
static command_t CommandTable[] = {
2021-01-13 03:59:44 +08:00
{"-----------", CmdHelp, AlwaysAvailable, "--------------------- " _CYAN_("operations") " ---------------------"},
{"help", CmdHelp, AlwaysAvailable, "This help"},
{"clonehelp", CmdT55xxCloneHelp, IfPm3Lf, "Shows the available clone commands"},
2020-08-03 23:38:58 +08:00
{"config", CmdT55xxSetConfig, AlwaysAvailable, "Set/Get T55XX configuration (modulation, inverted, offset, rate)"},
2021-01-13 03:59:44 +08:00
{"dangerraw", CmdT55xxDangerousRaw, IfPm3Lf, "Sends raw bitstream. Dangerous, do not use!!"},
{"detect", CmdT55xxDetect, AlwaysAvailable, "Try detecting the tag modulation from reading the configuration block"},
{"deviceconfig", CmdT55xxSetDeviceConfig, IfPm3Lf, "Set/Get T55XX device configuration"},
2021-01-13 03:59:44 +08:00
{"dump", CmdT55xxDump, IfPm3Lf, "Dump T55xx card Page 0 block 0-7"},
{"info", CmdT55xxInfo, AlwaysAvailable, "Show T55x7 configuration data (page 0/ blk 0)"},
{"p1detect", CmdT55xxDetectPage1, IfPm3Lf, "Try detecting if this is a t55xx tag by reading page 1"},
{"read", CmdT55xxReadBlock, IfPm3Lf, "Read T55xx block data"},
{"resetread", CmdResetRead, IfPm3Lf, "Send Reset Cmd then lf read the stream to attempt to identify the start of it (needs a demod and/or plot after)"},
2021-01-13 03:59:44 +08:00
{"restore", CmdT55xxRestore, IfPm3Lf, "Restore T55xx card Page 0 / Page 1 blocks"},
{"trace", CmdT55xxReadTrace, AlwaysAvailable, "Show T55x7 traceability data (page 1/ blk 0-1)"},
{"wakeup", CmdT55xxWakeUp, IfPm3Lf, "Send AOR wakeup command"},
2021-01-13 03:59:44 +08:00
{"write", CmdT55xxWriteBlock, IfPm3Lf, "Write T55xx block data"},
{"-----------", CmdHelp, AlwaysAvailable, "--------------------- " _CYAN_("recovery") " ---------------------"},
{"bruteforce", CmdT55xxBruteForce, IfPm3Lf, "Simple bruteforce attack to find password"},
2020-08-03 23:38:58 +08:00
{"chk", CmdT55xxChkPwds, IfPm3Lf, "Check passwords from dictionary/flash"},
{"protect", CmdT55xxProtect, IfPm3Lf, "Password protect tag"},
{"recoverpw", CmdT55xxRecoverPW, IfPm3Lf, "Try to recover from bad password write from a cloner"},
{"sniff", CmdT55xxSniff, AlwaysAvailable, "Attempt to recover T55xx commands from sample buffer"},
2021-01-29 23:06:26 +08:00
{"special", CmdT55xxSpecial, IfPm3Lf, "Show block changes with 64 different offsets"},
{"wipe", CmdT55xxWipe, IfPm3Lf, "Wipe a T55xx tag and set defaults (will destroy any data on tag)"},
{NULL, NULL, NULL, NULL}
};
static int CmdHelp(const char *Cmd) {
(void)Cmd; // Cmd is not used so far
CmdsHelp(CommandTable);
2019-05-22 20:48:23 +08:00
return PM3_SUCCESS;
}
int CmdLFT55XX(const char *Cmd) {
2019-03-10 06:35:06 +08:00
clearCommandBuffer();
2019-04-19 06:47:51 +08:00
return CmdsParse(CommandTable, Cmd);
}