[proxmark3-svn] / client / cmdlfpcf7931.c

//-----------------------------------------------------------------------------
// Copyright (C) 2012 Chalk <chalk.secu at gmail.com>
//               2015 Dake <thomas.cayrou at gmail.com>
//               2018 sguerrini97 <sguerrini97 at gmail.com>

// 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 PCF7931 commands
//-----------------------------------------------------------------------------

#include "cmdlfpcf7931.h"

#include <stdio.h>
#include <string.h>
#include "comms.h"
#include "ui.h"
#include "util.h"
#include "graph.h"
#include "cmdparser.h"
#include "cmddata.h"
#include "cmdmain.h"
#include "cmdlf.h"

static int CmdHelp(const char *Cmd);

#define PCF7931_DEFAULT_INITDELAY 17500
#define PCF7931_DEFAULT_OFFSET_WIDTH 0
#define PCF7931_DEFAULT_OFFSET_POSITION 0

// Default values - Configuration
struct pcf7931_config configPcf = {
	{0xFF,0xFF,0xFF,0xFF,0xFF,0xFF,0xFF},
	PCF7931_DEFAULT_INITDELAY,
	PCF7931_DEFAULT_OFFSET_WIDTH,
	PCF7931_DEFAULT_OFFSET_POSITION
	};

// Resets the configuration settings to default values.
int pcf7931_resetConfig(){
	memset(configPcf.Pwd, 0xFF, sizeof(configPcf.Pwd) );
	configPcf.InitDelay = PCF7931_DEFAULT_INITDELAY;
	configPcf.OffsetWidth = PCF7931_DEFAULT_OFFSET_WIDTH;
	configPcf.OffsetPosition = PCF7931_DEFAULT_OFFSET_POSITION;
	return 0;
}

int pcf7931_printConfig(){
	PrintAndLog("Password (LSB first on bytes) : %s", sprint_hex( configPcf.Pwd, sizeof(configPcf.Pwd)));
	PrintAndLog("Tag initialization delay      : %d us", configPcf.InitDelay);
	PrintAndLog("Offset low pulses width       : %d us", configPcf.OffsetWidth);
	PrintAndLog("Offset low pulses position    : %d us", configPcf.OffsetPosition);
	return 0;
}

int usage_pcf7931_read(){
	PrintAndLog("Usage: lf pcf7931 read [h] ");
	PrintAndLog("This command tries to read a PCF7931 tag.");
	PrintAndLog("Options:");
	PrintAndLog("       h   This help");
	PrintAndLog("Examples:");
	PrintAndLog("      lf pcf7931 read");
	return 0;
}

int usage_pcf7931_write(){
	PrintAndLog("Usage: lf pcf7931 write [h] <block address> <byte address> <data>");
	PrintAndLog("This command tries to write a PCF7931 tag.");
	PrintAndLog("Options:");
	PrintAndLog("       h          This help");
	PrintAndLog("       blockaddress   Block to save [0-7]");
	PrintAndLog("       byteaddress    Index of byte inside block to write [0-15]");
	PrintAndLog("       data           one byte of data (hex)");
	PrintAndLog("Examples:");
	PrintAndLog("      lf pcf7931 write 2 1 FF");
	return 0;
}

int usage_pcf7931_bruteforce()
{
	PrintAndLog("Usage: lf pcf7931 bruteforce [h] <start password> <tries>");
	PrintAndLog("This command tries to disable PAC of a PCF7931 transponder by bruteforcing the password.");
	PrintAndLog("!! THIS IS NOT INTENDED TO RECOVER THE FULL PASSWORD !!");
	PrintAndLog("!! DO NOT USE UNLESS THE FIRST 5 BYTES OF THE PASSWORD ARE KNOWN !!");
	PrintAndLog("Options:");
	PrintAndLog("       h                This help");
	PrintAndLog("       start password   hex password to start from");
	PrintAndLog("       tries            How many times to send the same data frame");
	PrintAndLog("Examples:");
	PrintAndLog("      lf pcf7931 bruteforce 00000000123456 3");
	return 0;
}

int usage_pcf7931_config(){
	PrintAndLog("Usage: lf pcf7931 config [h] [r] <pwd> <delay> <offset width> <offset position>");
	PrintAndLog("This command tries to set the configuration used with PCF7931 commands");
	PrintAndLog("The time offsets could be useful to correct slew rate generated by the antenna");
	PrintAndLog("Caling without some parameter will print the current configuration.");
	PrintAndLog("Options:");
	PrintAndLog("       h       This help");
	PrintAndLog("       r       Reset configuration to default values");
	PrintAndLog("       pwd     Password, hex, 7bytes, LSB-order");
	PrintAndLog("       delay   Tag initialization delay (in us) decimal");
	PrintAndLog("       offset  Low pulses width (in us) decimal");
	PrintAndLog("       offset  Low pulses position (in us) decimal");
	PrintAndLog("Examples:");
	PrintAndLog("      lf pcf7931 config");
	PrintAndLog("      lf pcf7931 config r");
	PrintAndLog("      lf pcf7931 config 11223344556677 20000");
	PrintAndLog("      lf pcf7931 config 11223344556677 17500 -10 30");
	return 0;
}

int CmdLFPCF7931Read(const char *Cmd){

	uint8_t ctmp = param_getchar(Cmd, 0);
	if ( ctmp == 'H' || ctmp == 'h' ) return usage_pcf7931_read();

	UsbCommand resp;
	UsbCommand c = {CMD_PCF7931_READ, {0, 0, 0}};
	clearCommandBuffer();
	SendCommand(&c);
	if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2500) ) {
		PrintAndLog("command execution time out");
		return 1;
	}
	return 0;
}

int CmdLFPCF7931Config(const char *Cmd){

	uint8_t ctmp = param_getchar(Cmd, 0);
	if ( ctmp == 0) return pcf7931_printConfig();
	if ( ctmp == 'H' || ctmp == 'h' ) return usage_pcf7931_config();
	if ( ctmp == 'R' || ctmp == 'r' ) return pcf7931_resetConfig();

	if ( param_gethex(Cmd, 0, configPcf.Pwd, 14) ) return usage_pcf7931_config();

	configPcf.InitDelay = (param_get32ex(Cmd,1,0,10) & 0xFFFF);
	configPcf.OffsetWidth = (int)(param_get32ex(Cmd,2,0,10) & 0xFFFF);
	configPcf.OffsetPosition = (int)(param_get32ex(Cmd,3,0,10) & 0xFFFF);

	pcf7931_printConfig();
	return 0;
}

int CmdLFPCF7931Write(const char *Cmd){

	uint8_t ctmp = param_getchar(Cmd, 0);
	if (strlen(Cmd) < 1 || ctmp == 'h' || ctmp == 'H') return usage_pcf7931_write();

	uint8_t block = 0, bytepos = 0, data = 0;

	if ( param_getdec(Cmd, 0, &block) ) return usage_pcf7931_write();
	if ( param_getdec(Cmd, 1, &bytepos) ) return usage_pcf7931_write();

	if ( (block > 7) || (bytepos > 15) ) return usage_pcf7931_write();

	data  = param_get8ex(Cmd, 2, 0, 16);

	PrintAndLog("Writing block: %d", block);
	PrintAndLog("          pos: %d", bytepos);
	PrintAndLog("         data: 0x%02X", data);

	UsbCommand c = {CMD_PCF7931_WRITE, { block, bytepos, data} };
	memcpy(c.d.asDwords, configPcf.Pwd, sizeof(configPcf.Pwd) );
	  c.d.asDwords[7] = (configPcf.OffsetWidth + 128);
	  c.d.asDwords[8] = (configPcf.OffsetPosition + 128);
	  c.d.asDwords[9] = configPcf.InitDelay;

	clearCommandBuffer();
	SendCommand(&c);
	//no ack?
	return 0;
}

int CmdLFPCF7931BruteForce(const char *Cmd){

	uint8_t ctmp = param_getchar(Cmd, 0);
	if (strlen(Cmd) < 1 || ctmp == 'h' || ctmp == 'H') return usage_pcf7931_bruteforce();

	uint8_t start_password[7] = {0};
	uint8_t tries = 3;

	if (param_gethex(Cmd, 0, start_password, 14)) return usage_pcf7931_bruteforce();
	if (param_getdec(Cmd, 1, &tries)) return usage_pcf7931_bruteforce();

	PrintAndLog("Bruteforcing from password: %02x %02x %02x %02x %02x %02x %02x",
			start_password[0],
			start_password[1],
			start_password[2],
			start_password[3],
			start_password[4],
			start_password[5],
			start_password[6]);

	PrintAndLog("Trying each password %d times", tries);

	UsbCommand c = {CMD_PCF7931_BRUTEFORCE, {bytes_to_num(start_password, 7), tries} };

	c.d.asDwords[7] = (configPcf.OffsetWidth + 128);
	c.d.asDwords[8] = (configPcf.OffsetPosition + 128);
	c.d.asDwords[9] = configPcf.InitDelay;

	clearCommandBuffer();
	SendCommand(&c);
	//no ack?
	return 0;
}

static command_t CommandTable[] =
{
	{"help",   CmdHelp,            1, "This help"},
	{"read",   CmdLFPCF7931Read,   0, "Read content of a PCF7931 transponder"},
	{"write",  CmdLFPCF7931Write,  0, "Write data on a PCF7931 transponder."},
	{"config", CmdLFPCF7931Config, 1, "Configure the password, the tags initialization delay and time offsets (optional)"},
	{"bruteforce", CmdLFPCF7931BruteForce, 0, "Bruteforce a PCF7931 transponder password."},
	{NULL,     NULL,               0, NULL}
};

int CmdLFPCF7931(const char *Cmd)
{
	CmdsParse(CommandTable, Cmd);
	return 0;
}

int CmdHelp(const char *Cmd)
{
	CmdsHelp(CommandTable);
	return 0;
}
Commit	Line	Data
54a942b0	1	//-----------------------------------------------------------------------------
54a942b0	2	// Copyright (C) 2012 Chalk <chalk.secu at gmail.com>
dc4300ba	3	// 2015 Dake <thomas.cayrou at gmail.com>
caaa4293	4	// 2018 sguerrini97 <sguerrini97 at gmail.com>
dc4300ba	5
54a942b0	6	// This code is licensed to you under the terms of the GNU GPL, version 2 or,
	7	// at your option, any later version. See the LICENSE.txt file for the text of
	8	// the license.
	9	//-----------------------------------------------------------------------------
	10	// Low frequency PCF7931 commands
	11	//-----------------------------------------------------------------------------
ad939de5	12
	13	#include "cmdlfpcf7931.h"
	14
54a942b0	15	#include <stdio.h>
54a942b0	16	#include <string.h>
ad939de5	17	#include "comms.h"
54a942b0	18	#include "ui.h"
d10e08ae	19	#include "util.h"
54a942b0	20	#include "graph.h"
	21	#include "cmdparser.h"
	22	#include "cmddata.h"
	23	#include "cmdmain.h"
	24	#include "cmdlf.h"
54a942b0	25
	26	static int CmdHelp(const char *Cmd);
	27
d10e08ae	28	#define PCF7931_DEFAULT_INITDELAY 17500
	29	#define PCF7931_DEFAULT_OFFSET_WIDTH 0
	30	#define PCF7931_DEFAULT_OFFSET_POSITION 0
	31
	32	// Default values - Configuration
	33	struct pcf7931_config configPcf = {
	34	{0xFF,0xFF,0xFF,0xFF,0xFF,0xFF,0xFF},
	35	PCF7931_DEFAULT_INITDELAY,
caaa4293	36	PCF7931_DEFAULT_OFFSET_WIDTH,
d10e08ae	37	PCF7931_DEFAULT_OFFSET_POSITION
	38	};
	39
	40	// Resets the configuration settings to default values.
	41	int pcf7931_resetConfig(){
	42	memset(configPcf.Pwd, 0xFF, sizeof(configPcf.Pwd) );
	43	configPcf.InitDelay = PCF7931_DEFAULT_INITDELAY;
caaa4293	44	configPcf.OffsetWidth = PCF7931_DEFAULT_OFFSET_WIDTH;
caaa4293	45	configPcf.OffsetPosition = PCF7931_DEFAULT_OFFSET_POSITION;
d10e08ae	46	return 0;
d10e08ae	47	}
dc4300ba	48
d10e08ae	49	int pcf7931_printConfig(){
	50	PrintAndLog("Password (LSB first on bytes) : %s", sprint_hex( configPcf.Pwd, sizeof(configPcf.Pwd)));
	51	PrintAndLog("Tag initialization delay : %d us", configPcf.InitDelay);
	52	PrintAndLog("Offset low pulses width : %d us", configPcf.OffsetWidth);
	53	PrintAndLog("Offset low pulses position : %d us", configPcf.OffsetPosition);
	54	return 0;
	55	}
	56
	57	int usage_pcf7931_read(){
	58	PrintAndLog("Usage: lf pcf7931 read [h] ");
	59	PrintAndLog("This command tries to read a PCF7931 tag.");
	60	PrintAndLog("Options:");
	61	PrintAndLog(" h This help");
	62	PrintAndLog("Examples:");
	63	PrintAndLog(" lf pcf7931 read");
	64	return 0;
	65	}
	66
	67	int usage_pcf7931_write(){
	68	PrintAndLog("Usage: lf pcf7931 write [h] <block address> <byte address> <data>");
	69	PrintAndLog("This command tries to write a PCF7931 tag.");
	70	PrintAndLog("Options:");
	71	PrintAndLog(" h This help");
	72	PrintAndLog(" blockaddress Block to save [0-7]");
7cfc777b	73	PrintAndLog(" byteaddress Index of byte inside block to write [0-15]");
d10e08ae	74	PrintAndLog(" data one byte of data (hex)");
	75	PrintAndLog("Examples:");
	76	PrintAndLog(" lf pcf7931 write 2 1 FF");
	77	return 0;
54a942b0	78	}
54a942b0	79
818e15b0 S	80	int usage_pcf7931_bruteforce()
	81	{
	82	PrintAndLog("Usage: lf pcf7931 bruteforce [h] <start password> <tries>");
	83	PrintAndLog("This command tries to disable PAC of a PCF7931 transponder by bruteforcing the password.");
	84	PrintAndLog("!! THIS IS NOT INTENDED TO RECOVER THE FULL PASSWORD !!");
	85	PrintAndLog("!! DO NOT USE UNLESS THE FIRST 5 BYTES OF THE PASSWORD ARE KNOWN !!");
	86	PrintAndLog("Options:");
	87	PrintAndLog(" h This help");
	88	PrintAndLog(" start password hex password to start from");
	89	PrintAndLog(" tries How many times to send the same data frame");
	90	PrintAndLog("Examples:");
	91	PrintAndLog(" lf pcf7931 bruteforce 00000000123456 3");
	92	return 0;
	93	}
	94
d10e08ae	95	int usage_pcf7931_config(){
	96	PrintAndLog("Usage: lf pcf7931 config [h] [r] <pwd> <delay> <offset width> <offset position>");
	97	PrintAndLog("This command tries to set the configuration used with PCF7931 commands");
	98	PrintAndLog("The time offsets could be useful to correct slew rate generated by the antenna");
	99	PrintAndLog("Caling without some parameter will print the current configuration.");
	100	PrintAndLog("Options:");
	101	PrintAndLog(" h This help");
	102	PrintAndLog(" r Reset configuration to default values");
	103	PrintAndLog(" pwd Password, hex, 7bytes, LSB-order");
	104	PrintAndLog(" delay Tag initialization delay (in us) decimal");
	105	PrintAndLog(" offset Low pulses width (in us) decimal");
caaa4293	106	PrintAndLog(" offset Low pulses position (in us) decimal");
d10e08ae	107	PrintAndLog("Examples:");
	108	PrintAndLog(" lf pcf7931 config");
	109	PrintAndLog(" lf pcf7931 config r");
	110	PrintAndLog(" lf pcf7931 config 11223344556677 20000");
	111	PrintAndLog(" lf pcf7931 config 11223344556677 17500 -10 30");
	112	return 0;
dc4300ba D	113	}
dc4300ba D	114
caaa4293	115	int CmdLFPCF7931Read(const char *Cmd){
dc4300ba	116
d10e08ae	117	uint8_t ctmp = param_getchar(Cmd, 0);
d10e08ae	118	if ( ctmp == 'H' \|\| ctmp == 'h' ) return usage_pcf7931_read();
dc4300ba	119
d10e08ae	120	UsbCommand resp;
	121	UsbCommand c = {CMD_PCF7931_READ, {0, 0, 0}};
	122	clearCommandBuffer();
	123	SendCommand(&c);
	124	if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2500) ) {
	125	PrintAndLog("command execution time out");
	126	return 1;
	127	}
	128	return 0;
dc4300ba D	129	}
dc4300ba D	130
caaa4293	131	int CmdLFPCF7931Config(const char *Cmd){
d10e08ae	132
	133	uint8_t ctmp = param_getchar(Cmd, 0);
	134	if ( ctmp == 0) return pcf7931_printConfig();
	135	if ( ctmp == 'H' \|\| ctmp == 'h' ) return usage_pcf7931_config();
caaa4293	136	if ( ctmp == 'R' \|\| ctmp == 'r' ) return pcf7931_resetConfig();
d10e08ae	137
	138	if ( param_gethex(Cmd, 0, configPcf.Pwd, 14) ) return usage_pcf7931_config();
	139
	140	configPcf.InitDelay = (param_get32ex(Cmd,1,0,10) & 0xFFFF);
	141	configPcf.OffsetWidth = (int)(param_get32ex(Cmd,2,0,10) & 0xFFFF);
	142	configPcf.OffsetPosition = (int)(param_get32ex(Cmd,3,0,10) & 0xFFFF);
	143
	144	pcf7931_printConfig();
	145	return 0;
	146	}
	147
	148	int CmdLFPCF7931Write(const char *Cmd){
	149
	150	uint8_t ctmp = param_getchar(Cmd, 0);
caaa4293	151	if (strlen(Cmd) < 1 \|\| ctmp == 'h' \|\| ctmp == 'H') return usage_pcf7931_write();
d10e08ae	152
d10e08ae	153	uint8_t block = 0, bytepos = 0, data = 0;
caaa4293	154
d10e08ae	155	if ( param_getdec(Cmd, 0, &block) ) return usage_pcf7931_write();
d10e08ae	156	if ( param_getdec(Cmd, 1, &bytepos) ) return usage_pcf7931_write();
caaa4293	157
59b5b7e1	158	if ( (block > 7) \|\| (bytepos > 15) ) return usage_pcf7931_write();
d10e08ae	159
d10e08ae	160	data = param_get8ex(Cmd, 2, 0, 16);
caaa4293	161
d10e08ae	162	PrintAndLog("Writing block: %d", block);
	163	PrintAndLog(" pos: %d", bytepos);
	164	PrintAndLog(" data: 0x%02X", data);
	165
	166	UsbCommand c = {CMD_PCF7931_WRITE, { block, bytepos, data} };
	167	memcpy(c.d.asDwords, configPcf.Pwd, sizeof(configPcf.Pwd) );
	168	c.d.asDwords[7] = (configPcf.OffsetWidth + 128);
	169	c.d.asDwords[8] = (configPcf.OffsetPosition + 128);
	170	c.d.asDwords[9] = configPcf.InitDelay;
	171
	172	clearCommandBuffer();
	173	SendCommand(&c);
	174	//no ack?
	175	return 0;
	176	}
dc4300ba	177
818e15b0 S	178	int CmdLFPCF7931BruteForce(const char *Cmd){
	179
	180	uint8_t ctmp = param_getchar(Cmd, 0);
caaa4293	181	if (strlen(Cmd) < 1 \|\| ctmp == 'h' \|\| ctmp == 'H') return usage_pcf7931_bruteforce();
818e15b0	182
caaa4293	183	uint8_t start_password[7] = {0};
818e15b0	184	uint8_t tries = 3;
caaa4293	185
caaa4293	186	if (param_gethex(Cmd, 0, start_password, 14)) return usage_pcf7931_bruteforce();
818e15b0	187	if (param_getdec(Cmd, 1, &tries)) return usage_pcf7931_bruteforce();
caaa4293	188
818e15b0	189	PrintAndLog("Bruteforcing from password: %02x %02x %02x %02x %02x %02x %02x",
caaa4293	190	start_password[0],
	191	start_password[1],
	192	start_password[2],
	193	start_password[3],
	194	start_password[4],
	195	start_password[5],
	196	start_password[6]);
	197
818e15b0 S	198	PrintAndLog("Trying each password %d times", tries);
818e15b0 S	199
caaa4293	200	UsbCommand c = {CMD_PCF7931_BRUTEFORCE, {bytes_to_num(start_password, 7), tries} };
caaa4293	201
818e15b0 S	202	c.d.asDwords[7] = (configPcf.OffsetWidth + 128);
	203	c.d.asDwords[8] = (configPcf.OffsetPosition + 128);
	204	c.d.asDwords[9] = configPcf.InitDelay;
	205
	206	clearCommandBuffer();
	207	SendCommand(&c);
	208	//no ack?
	209	return 0;
	210	}
	211
caaa4293	212	static command_t CommandTable[] =
54a942b0	213	{
d10e08ae	214	{"help", CmdHelp, 1, "This help"},
	215	{"read", CmdLFPCF7931Read, 0, "Read content of a PCF7931 transponder"},
	216	{"write", CmdLFPCF7931Write, 0, "Write data on a PCF7931 transponder."},
	217	{"config", CmdLFPCF7931Config, 1, "Configure the password, the tags initialization delay and time offsets (optional)"},
818e15b0	218	{"bruteforce", CmdLFPCF7931BruteForce, 0, "Bruteforce a PCF7931 transponder password."},
d10e08ae	219	{NULL, NULL, 0, NULL}
54a942b0	220	};
	221
	222	int CmdLFPCF7931(const char *Cmd)
	223	{
d10e08ae	224	CmdsParse(CommandTable, Cmd);
d10e08ae	225	return 0;
54a942b0	226	}
	227
	228	int CmdHelp(const char *Cmd)
	229	{
d10e08ae	230	CmdsHelp(CommandTable);
d10e08ae	231	return 0;
54a942b0	232	}