//-----------------------------------------------------------------------------
// Copyright (C) 2010 iZsh <izsh at fail0verflow.com>
// Modified 2010-2012 by <adrian -at- atrox.at>
// Modified 2012 by <vsza at vsza.hu>
// Modfified 2018 by <iceman>
//
// 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.
//-----------------------------------------------------------------------------
// High frequency ISO15693 commands
//-----------------------------------------------------------------------------
// There are three basic operation modes, depending on which device (proxmark/pc)
// the signal processing, (de)modulation, transmission protocol and logic is done.
// Mode 1:
// All steps are done on the proxmark, the output of the commands is returned via
// USB-debug-print commands.
// Mode 2: 
// The protocol is done on the PC, passing only Iso15693 data frames via USB. This
// allows direct communication with a tag on command level
// Mode 3:
// The proxmark just samples the antenna and passes this "analog" data via USB to
// the client. Signal Processing & decoding is done on the pc. This is the slowest
// variant, but offers the possibility to analyze the waveforms directly. 
#include "cmdhf15.h"

#define FrameSOF				Iso15693FrameSOF
#define Logic0					Iso15693Logic0
#define Logic1					Iso15693Logic1
#define FrameEOF				Iso15693FrameEOF

#define Crc(data, len)			crc(CRC_15693, (data), (len))
#define CheckCrc(data, len)		check_crc(CRC_15693, (data), (len))
#define AddCrc(data, len)		compute_crc(CRC_15693, (data), (len), (data)+(len), (data)+(len)+1)

#define sprintUID(target, uid)	Iso15693sprintUID((target), (uid))

// structure and database for uid -> tagtype lookups 
typedef struct { 
	uint64_t uid;
	int mask; // how many MSB bits used
	char* desc;
} productName; 

const productName uidmapping[] = {

	// UID, #significant Bits, "Vendor(+Product)"
	{ 0xE001000000000000LL, 16, "Motorola UK" },
	
	// E0 02 xx
	//   02 = ST Microelectronics
	//   XX = IC id (Chip ID Family)
	{ 0xE002000000000000LL, 16, "ST Microelectronics SA France" },
	{ 0xE002050000000000LL, 24, "ST Microelectronics; LRI64   [IC id = 05]"},
	{ 0xE002080000000000LL, 24, "ST Microelectronics; LRI2K   [IC id = 08]"},
	{ 0xE0020A0000000000LL, 24, "ST Microelectronics; LRIS2K  [IC id = 10]"},
	{ 0xE002440000000000LL, 24, "ST Microelectronics; LRIS64K [IC id = 68]"},

	{ 0xE003000000000000LL, 16, "Hitachi, Ltd Japan" }, 
	
	// E0 04 xx
	//   04 = Manufacturer code (Philips/NXP)
	//   XX = IC id (Chip ID Family)
	//I-Code SLI SL2 ICS20 [IC id = 01]
	//I-Code SLI-S         [IC id = 02]
	//I-Code SLI-L         [IC id = 03]
	//I-Code SLIX          [IC id = 01 + bit36 set to 1 (starting from bit0 - different from normal SLI)]
	//I-Code SLIX-S        [IC id = 02 + bit36 set to 1]
	//I-Code SLIX-L        [IC id = 03 + bit36 set to 1]
	{ 0xE004000000000000LL, 16, "NXP Semiconductors Germany (Philips)" }, 
	{ 0xE004010000000000LL, 24, "NXP(Philips); IC SL2 ICS20/ICS21(SLI) ICS2002/ICS2102(SLIX)" },
	{ 0xE004020000000000LL, 24, "NXP(Philips); IC SL2 ICS53/ICS54(SLI-S) ICS5302/ICS5402(SLIX-S)" },
	{ 0xE004030000000000LL, 24, "NXP(Philips); IC SL2 ICS50/ICS51(SLI-L) ICS5002/ICS5102(SLIX-L)" },

	// E0 05 XX .. .. ..
	//   05 = Manufacturer code (Infineon)
	//   XX = IC id (Chip ID Family)
	{ 0xE005000000000000LL, 16, "Infineon Technologies AG Germany" }, 
	{ 0xE005A10000000000LL, 24, "Infineon; SRF55V01P [IC id = 161] plain mode 1kBit"},
	{ 0xE005A80000000000LL, 24, "Infineon; SRF55V01P [IC id = 168] pilot series 1kBit"},
	{ 0xE005400000000000LL, 24, "Infineon; SRF55V02P [IC id = 64]  plain mode 2kBit"},
	{ 0xE005000000000000LL, 24, "Infineon; SRF55V10P [IC id = 00]  plain mode 10KBit"},
	{ 0xE005500000000000LL, 24, "Infineon; SRF55V02S [IC id = 80]  secure mode 2kBit"},
	{ 0xE005100000000000LL, 24, "Infineon; SRF55V10S [IC id = 16]  secure mode 10KBit"},
	{ 0xE0051E0000000000LL, 23, "Infineon; SLE66r01P [IC id = 3x = My-d Move or My-d move NFC]"},
	{ 0xE005200000000000LL, 21, "Infineon; SLE66r01P [IC id = 3x = My-d Move or My-d move NFC]"},
	
	{ 0xE006000000000000LL, 16, "Cylink USA" }, 
	
	
	// E0 07 xx
	//   07 = Texas Instruments
	//   XX = from bit 41 to bit 43 = product configuration - from bit 44 to bit 47 IC id (Chip ID Family)
	//Tag IT RFIDType-I Plus, 2kBit, TI Inlay
	//Tag-it HF-I Plus Inlay             [IC id = 00] -> b'0000 000 2kBit
	//Tag-it HF-I Plus Chip              [IC id = 64] -> b'1000 000 2kBit
	//Tag-it HF-I Standard Chip / Inlays [IC id = 96] -> b'1100 000 256Bit
	//Tag-it HF-I Pro Chip / Inlays      [IC id = 98] -> b'1100 010 256Bit, Password protection
	{ 0xE007000000000000LL, 16, "Texas Instrument France" },
	{ 0xE007000000000000LL, 20, "Texas Instrument; Tag-it HF-I Plus Inlay; 64x32bit" },
	{ 0xE007100000000000LL, 20, "Texas Instrument; Tag-it HF-I Plus Chip; 64x32bit" },
	{ 0xE007800000000000LL, 23, "Texas Instrument; Tag-it HF-I Plus (RF-HDT-DVBB tag or Third Party Products)" },
	{ 0xE007C00000000000LL, 23, "Texas Instrument; Tag-it HF-I Standard; 8x32bit" },
	{ 0xE007C40000000000LL, 23, "Texas Instrument; Tag-it HF-I Pro; 8x23bit; password" },	

	{ 0xE008000000000000LL, 16, "Fujitsu Limited Japan" }, 
	{ 0xE009000000000000LL, 16, "Matsushita Electronics Corporation, Semiconductor Company Japan" }, 
	{ 0xE00A000000000000LL, 16, "NEC Japan" }, 
	{ 0xE00B000000000000LL, 16, "Oki Electric Industry Co. Ltd Japan" },
	{ 0xE00C000000000000LL, 16, "Toshiba Corp. Japan" },
	{ 0xE00D000000000000LL, 16, "Mitsubishi Electric Corp. Japan" },
	{ 0xE00E000000000000LL, 16, "Samsung Electronics Co. Ltd Korea" },
	{ 0xE00F000000000000LL, 16, "Hynix / Hyundai, Korea" },
	{ 0xE010000000000000LL, 16, "LG-Semiconductors Co. Ltd Korea" },
	{ 0xE011000000000000LL, 16, "Emosyn-EM Microelectronics USA" },

	{ 0xE012000000000000LL, 16, "HID Corporation" },
	{ 0xE012000000000000LL, 16, "INSIDE Technology France" },
	{ 0xE013000000000000LL, 16, "ORGA Kartensysteme GmbH Germany" },
	{ 0xE014000000000000LL, 16, "SHARP Corporation Japan" },
	{ 0xE015000000000000LL, 16, "ATMEL France" },
	
	{ 0xE016000000000000LL, 16, "EM Microelectronic-Marin SA Switzerland (Skidata)"},
	{ 0xE016040000000000LL, 24, "EM-Marin SA (Skidata Keycard-eco); EM4034 [IC id = 01] (Read/Write - no AFI)"},
	{ 0xE0160C0000000000LL, 24, "EM-Marin SA (Skidata); EM4035 [IC id = 03] (Read/Write - replaced by 4233)"},
	{ 0xE016100000000000LL, 24, "EM-Marin SA (Skidata); EM4135 [IC id = 04] (Read/Write - replaced by 4233) 36x64bit start page 13"},
	{ 0xE016140000000000LL, 24, "EM-Marin SA (Skidata); EM4036 [IC id = 05] 28pF"},
	{ 0xE016180000000000LL, 24, "EM-Marin SA (Skidata); EM4006 [IC id = 06] (Read Only)"}, 
	{ 0xE0161C0000000000LL, 24, "EM-Marin SA (Skidata); EM4133 [IC id = 07] 23,5pF (Read/Write)"},
	{ 0xE016200000000000LL, 24, "EM-Marin SA (Skidata); EM4033 [IC id = 08] 23,5pF (Read Only - no AFI / no DSFID / no security blocks)"},
	{ 0xE016240000000000LL, 24, "EM-Marin SA (Skidata); EM4233 [IC id = 09] 23,5pF CustomerID-102"},
	{ 0xE016280000000000LL, 24, "EM-Marin SA (Skidata); EM4233 SLIC [IC id = 10] 23,5pF (1Kb flash memory - not provide High Security mode and QuietStorage feature)" },
	{ 0xE0163C0000000000LL, 24, "EM-Marin SA (Skidata); EM4237 [IC id = 15] 23,5pF"},
	{ 0xE0167C0000000000LL, 24, "EM-Marin SA (Skidata); EM4233 [IC id = 31] 95pF"},
	{ 0xE016940000000000LL, 24, "EM-Marin SA (Skidata); EM4036 [IC id = 37] 95pF  51x64bit "},
	{ 0xE0169c0000000000LL, 24, "EM-Marin SA (Skidata); EM4133 [IC id = 39] 95pF (Read/Write)" },
	{ 0xE016A80000000000LL, 24, "EM-Marin SA (Skidata); EM4233 SLIC [IC id = 42] 97pF" },
	{ 0xE016BC0000000000LL, 24, "EM-Marin SA (Skidata); EM4237 [IC id = 47] 97pF" },

	{ 0xE017000000000000LL, 16, "KSW Microtec GmbH Germany" },
	{ 0xE018000000000000LL, 16, "ZMD AG Germany" },
	{ 0xE019000000000000LL, 16, "XICOR, Inc. USA" },
	{ 0xE01A000000000000LL, 16, "Sony Corporation Japan Identifier Company Country" },
	{ 0xE01B000000000000LL, 16, "Malaysia Microelectronic Solutions Sdn. Bhd Malaysia" },
	{ 0xE01C000000000000LL, 16, "Emosyn USA" },
	{ 0xE01D000000000000LL, 16, "Shanghai Fudan Microelectronics Co. Ltd. P.R. China" },
	{ 0xE01E000000000000LL, 16, "Magellan Technology Pty Limited Australia" },
	{ 0xE01F000000000000LL, 16, "Melexis NV BO Switzerland" },
	{ 0xE020000000000000LL, 16, "Renesas Technology Corp. Japan" },
	{ 0xE021000000000000LL, 16, "TAGSYS France" },
	{ 0xE022000000000000LL, 16, "Transcore USA" },
	{ 0xE023000000000000LL, 16, "Shanghai belling corp., ltd. China" },
	{ 0xE024000000000000LL, 16, "Masktech Germany Gmbh Germany" },
	{ 0xE025000000000000LL, 16, "Innovision Research and Technology Plc UK" },
	{ 0xE026000000000000LL, 16, "Hitachi ULSI Systems Co., Ltd. Japan" },
	{ 0xE027000000000000LL, 16, "Cypak AB Sweden" },
	{ 0xE028000000000000LL, 16, "Ricoh Japan" },
	{ 0xE029000000000000LL, 16, "ASK France" },
	{ 0xE02A000000000000LL, 16, "Unicore Microsystems, LLC Russian Federation" },
	{ 0xE02B000000000000LL, 16, "Dallas Semiconductor/Maxim USA" },
	{ 0xE02C000000000000LL, 16, "Impinj, Inc. USA" },
	{ 0xE02D000000000000LL, 16, "RightPlug Alliance USA" },
	{ 0xE02E000000000000LL, 16, "Broadcom Corporation USA" },
	{ 0xE02F000000000000LL, 16, "MStar Semiconductor, Inc Taiwan, ROC" },
	{ 0xE030000000000000LL, 16, "BeeDar Technology Inc. USA" },
	{ 0xE031000000000000LL, 16, "RFIDsec Denmark" },
	{ 0xE032000000000000LL, 16, "Schweizer Electronic AG Germany" },
	{ 0xE033000000000000LL, 16, "AMIC Technology Corp Taiwan" }, 
	{ 0xE034000000000000LL, 16, "Mikron JSC Russia" },
	{ 0xE035000000000000LL, 16, "Fraunhofer Institute for Photonic Microsystems Germany" },
	{ 0xE036000000000000LL, 16, "IDS Microchip AG Switzerland" },
	{ 0xE037000000000000LL, 16, "Kovio USA" },
	{ 0xE038000000000000LL, 16, "HMT Microelectronic Ltd Switzerland Identifier Company Country" },
	{ 0xE039000000000000LL, 16, "Silicon Craft Technology Thailand" },
	{ 0xE03A000000000000LL, 16, "Advanced Film Device Inc. Japan" },
	{ 0xE03B000000000000LL, 16, "Nitecrest Ltd UK" },
	{ 0xE03C000000000000LL, 16, "Verayo Inc. USA" },
	{ 0xE03D000000000000LL, 16, "HID Global USA" },
	{ 0xE03E000000000000LL, 16, "Productivity Engineering Gmbh Germany" },
	{ 0xE03F000000000000LL, 16, "Austriamicrosystems AG (reserved) Austria" }, 
	{ 0xE040000000000000LL, 16, "Gemalto SA France" },
	{ 0xE041000000000000LL, 16, "Renesas Electronics Corporation Japan" },
	{ 0xE042000000000000LL, 16, "3Alogics Inc Korea" },
	{ 0xE043000000000000LL, 16, "Top TroniQ Asia Limited Hong Kong" },
	{ 0xE044000000000000LL, 16, "Gentag Inc (USA) USA" },
	{ 0,0,"no tag-info available" } // must be the last entry
};

// fast method to just read the UID of a tag (collission detection not supported)
//		*buf	should be large enough to fit the 64bit uid
// returns 1 if suceeded
int getUID(uint8_t *buf) {

	UsbCommand resp;
	UsbCommand c = {CMD_ISO_15693_COMMAND, {0, 1, 1}}; // len,speed,recv?

	c.d.asBytes[0] = ISO15_REQ_SUBCARRIER_SINGLE | ISO15_REQ_DATARATE_HIGH | ISO15_REQ_INVENTORY | ISO15_REQINV_SLOT1;
	c.d.asBytes[1] = ISO15_CMD_INVENTORY;
	c.d.asBytes[2] = 0; // mask length

	AddCrc(c.d.asBytes, 3);
	c.arg[0] = 5; // len

	uint8_t retry;
	
	// don't give up the at the first try			
	for (retry = 0; retry < 3; retry++) {

		clearCommandBuffer();
		SendCommand(&c);
		
		if (WaitForResponseTimeout(CMD_ACK, &resp, 2000)) {
			
			uint8_t resplen = resp.arg[0];
			if (resplen >= 12 && CheckCrc(resp.d.asBytes, 12)) {
			   memcpy(buf, resp.d.asBytes + 2, 8);
			   return 1;
			} 
		} 
	} // retry
	
	if ( retry >= 3 )
		PrintAndLogEx(WARNING, "timeout while waiting for reply.");
	
	return 0;
}

// get a product description based on the UID
//		uid[8] 	tag uid
// returns description of the best match	
static char* getTagInfo_15(uint8_t *uid) {
	uint64_t myuid, mask;
	int i = 0, best = -1;	
	memcpy(&myuid, uid, sizeof(uint64_t));
	while (uidmapping[i].mask > 0) {
		mask = (~0LL) << (64-uidmapping[i].mask);
		if ((myuid & mask) == uidmapping[i].uid) {
			if (best == -1) { 
				best = i;
			} else {
				if (uidmapping[i].mask > uidmapping[best].mask) {
					best=i;
				}
			}					
		} 
		i++;
	} 

	if (best >= 0)
		return uidmapping[best].desc;
	return uidmapping[i].desc; 
}

// return a clear-text message to an errorcode
static char* TagErrorStr(uint8_t error) {
	switch (error) {
		case 0x01: return "The command is not supported";
		case 0x02: return "The command is not recognised";
		case 0x03: return "The option is not supported.";
		case 0x0f: return "Unknown error.";
		case 0x10: return "The specified block is not available (doesn't exist).";
		case 0x11: return "The specified block is already -locked and thus cannot be locked again";
		case 0x12: return "The specified block is locked and its content cannot be changed.";
		case 0x13: return "The specified block was not successfully programmed.";
		case 0x14: return "The specified block was not successfully locked.";
		default: return "Reserved for Future Use or Custom command error.";
	}
}

int usage_15_demod(void){
	PrintAndLogEx(NORMAL, "Tries to demodulate / decode ISO15693, from downloaded samples.\n"
	                      "Gather samples with 'hf 15 read' / 'hf 15 record'");
	return 0;
}
int usage_15_samples(void){
	PrintAndLogEx(NORMAL, "Acquire samples as Reader (enables carrier, send inquiry\n"
	                      "and download it to graphbuffer.  Try 'hf 15 demod'  to try to demodulate/decode signal");
	return 0;
}
int usage_15_info(void){
	PrintAndLogEx(NORMAL, "Uses the optional command 'get_systeminfo' 0x2B to try and extract information\n"
	                      "command may fail, depending on tag.\n"
	                      "defaults to '1 out of 4' mode\n"
	                      "\n"
	                      "Usage:  hf 15 info    [options] <uid|s|u|*>\n"
	                      "Options:\n"
	                      "\t-2        use slower '1 out of 256' mode\n"
	                      "\tuid (either): \n"
	                      "\t  <8B hex>  full UID eg E011223344556677\n"
	                      "\t  u         unaddressed mode\n"
	                      "\t  *         scan for tag\n"
	                      "Examples:\n"
	                      "\thf 15 info u");
	return 0;
}
int usage_15_record(void){
	PrintAndLogEx(NORMAL, "Record activity without enableing carrier");
	return 0;
}
int usage_15_reader(void){
	PrintAndLogEx(NORMAL, "This command identifies a ISO 15693 tag\n"
	                      "\n"
	                      "Usage: hf 15 reader [h]\n"
	                      "Options:\n"
	                      "\th             this help\n"
	                      "\n"
	                      "Example:\n"
	                      "\thf 15 reader");
	return 0;
}
int usage_15_sim(void){
	PrintAndLogEx(NORMAL, "Usage:  hf 15 sim <UID>\n"
	                      "\n"
	                      "Example:\n"
	                      "\thf 15 sim E016240000000000");
	return 0;
}
int usage_15_findafi(void){
	PrintAndLogEx(NORMAL, "'hf 15 finafi' This command needs a helptext. Feel free to add one!");
	return 0;
}
int usage_15_dump(void){
	PrintAndLogEx(NORMAL, "This command dumps the contents of a ISO-15693 tag and save it to file\n"
	                      "\n"
	                      "Usage: hf 15 dump [h] <f filname> \n"
	                      "Options:\n"
	                      "\th             this help\n"
	                      "\tf <name>      filename,  if no <name> UID will be used as filename\n"
	                      "\n"
	                      "Example:\n"
	                      "\thf 15 dump f\n"
	                      "\thf 15 dump f mydump");
	return 0;
}
int usage_15_restore(void){
    char *options[][2]={ 
        {"h", "this help"},
        {"-2", "use slower '1 out of 256' mode"},
        {"-o", "set OPTION Flag (needed for TI)"},
        {"r <NUM>", "numbers of retries on error, default is 3"},
        {"u <UID>", "load hf-15-dump-<UID>.bin"},
        {"f <filename>", "load <filename>"},
        {"b <block size>", "block size, default is 4"}
    };
    PrintAndLogEx(NORMAL, "Usage: hf 15 restore [-2] [-o] [h] [r <NUM>] [u <UID>] [f <filename>] [b <block size>]");
    PrintAndLogOptions(options, 7, 3);
    return 0;
}
int usage_15_raw(void){
    char *options[][2]={
        {"-r", "do not read response" },
        {"-2", "use slower '1 out of 256' mode" },
        {"-c", "calculate and append CRC" },
        {"", "Tip: turn on debugging for verbose output"},
    };
    PrintAndLogEx(NORMAL, "Usage: hf 15 raw  [-r] [-2] [-c] <0A 0B 0C ... hex>\n");
    PrintAndLogOptions(options, 4, 3);
    return 0;
}
int usage_15_read(void){
	PrintAndLogEx(NORMAL, "Usage:  hf 15 read    [options] <uid|s|u|*> <page#>\n"
	                      "Options:\n"
	                      "\t-2        use slower '1 out of 256' mode\n"
	                      "\tuid (either): \n"
	                      "\t   <8B hex>  full UID eg E011223344556677\n"
	                      "\t   u         unaddressed mode\n"
	                      "\t   *         scan for tag\n"
	                      "\tpage#:        page number 0-255");
	return 0;
}
int usage_15_write(void){
	PrintAndLogEx(NORMAL, "Usage:  hf 15 write    [options] <uid|s|u|*> <page#> <hexdata>\n"
	                      "Options:\n"
	                      "\t-2        use slower '1 out of 256' mode\n"
	                      "\t-o        set OPTION Flag (needed for TI)\n"
	                      "\tuid (either): \n"
	                      "\t   <8B hex>  full UID eg E011223344556677\n"
	                      "\t   u         unaddressed mode\n"
	                      "\t   *         scan for tag\n"
	                      "\tpage#:        page number 0-255\n"
	                      "\thexdata:      data to be written eg AA BB CC DD");
	return 0;
}
int usage_15_readmulti(void){
	PrintAndLogEx(NORMAL, "Usage:  hf 15 readmulti  [options] <uid|s|u|*> <start#> <count#>\n"
	                      "Options:\n"
	                      "\t-2        use slower '1 out of 256' mode\n"
	                      "\tuid (either): \n"
	                      "\t   <8B hex>  full UID eg E011223344556677\n"
	                      "\t   u         unaddressed mode\n"
	                      "\t   *         scan for tag\n"
	                      "\tstart#:       page number to start 0-255\n"
	                      "\tcount#:       number of pages");
	return 0;
}
// Mode 3
//helptext
int CmdHF15Demod(const char *Cmd) {
	char cmdp = tolower(param_getchar(Cmd, 0));
	if (cmdp == 'h') return usage_15_demod();
	
	// The sampling rate is 106.353 ksps/s, for T = 18.8 us
	int i, j;
	int max = 0, maxPos = 0;
	int skip = 4;

	if (GraphTraceLen < 1000) return 0;

	// First, correlate for SOF
	for (i = 0; i < 1000; i++) {
		int corr = 0;
		for (j = 0; j < ARRAYLEN(FrameSOF); j += skip) {
			corr += FrameSOF[j] * GraphBuffer[i + (j / skip)];
		}
		if (corr > max) {
			max = corr;
			maxPos = i;
		}
	}

	PrintAndLogEx(NORMAL, "SOF at %d, correlation %d", maxPos, max / (ARRAYLEN(FrameSOF) / skip));
	
	i = maxPos + ARRAYLEN(FrameSOF) / skip;
	int k = 0;
	uint8_t outBuf[20];
	memset(outBuf, 0, sizeof(outBuf));
	uint8_t mask = 0x01;
	for (;;) {
		int corr0 = 0, corr1 = 0, corrEOF = 0;
		for (j = 0; j < ARRAYLEN(Logic0); j += skip) {
			corr0 += Logic0[j] * GraphBuffer[i + (j / skip)];
		}
		for (j = 0; j < ARRAYLEN(Logic1); j += skip) {
			corr1 += Logic1[j] * GraphBuffer[i + (j / skip)];
		}
		for (j = 0; j < ARRAYLEN(FrameEOF); j += skip) {
			corrEOF += FrameEOF[j] * GraphBuffer[i + (j / skip)];
		}
		// Even things out by the length of the target waveform.
		corr0 *= 4;
		corr1 *= 4;
		
		if (corrEOF > corr1 && corrEOF > corr0) {
			PrintAndLogEx(NORMAL, "EOF at %d", i);
			break;
		} else if (corr1 > corr0) {
			i += ARRAYLEN(Logic1) / skip;
			outBuf[k] |= mask;
		} else {
			i += ARRAYLEN(Logic0) / skip;
		}
		mask <<= 1;
		if (mask == 0) {
			k++;
			mask = 0x01;
		}
		if ((i + (int)ARRAYLEN(FrameEOF)) >= GraphTraceLen) {
			PrintAndLogEx(NORMAL, "ran off end!");
			break;
		}
	}
	
	if (mask != 0x01) {
		PrintAndLogEx(WARNING, "Error, uneven octet! (discard extra bits!)");
		PrintAndLogEx(NORMAL, "   mask = %02x", mask);
	}
	PrintAndLogEx(NORMAL, "%d octets", k);
	
	for (i = 0; i < k; i++)
		PrintAndLogEx(NORMAL, "# %2d: %02x ", i, outBuf[i]);

	PrintAndLogEx(NORMAL, "CRC %04x", Crc(outBuf, k - 2));
	return 0;
}

// * Acquire Samples as Reader (enables carrier, sends inquiry)
//helptext
int CmdHF15Samples(const char *Cmd) {
	char cmdp = param_getchar(Cmd, 0);
	if (cmdp == 'h' || cmdp == 'H') return usage_15_samples();

	UsbCommand c = {CMD_ACQUIRE_RAW_ADC_SAMPLES_ISO_15693, {0,0,0}};
	clearCommandBuffer();	
	SendCommand(&c);
	
	//download samples 
	getSamples(0, false);
	return 0;
}

/**
 * Commandline handling: HF15 CMD SYSINFO
 * get system information from tag/VICC
 */
int CmdHF15Info(const char *Cmd) {

	char cmdp = param_getchar(Cmd, 0);
	if (strlen(Cmd)<1 || cmdp == 'h' || cmdp == 'H') return usage_15_info();

	UsbCommand resp;
	uint8_t *recv;
	UsbCommand c = {CMD_ISO_15693_COMMAND, {0, 1, 1}}; // len,speed,recv?
	uint8_t *req = c.d.asBytes;
	char cmdbuf[100];
	char *cmd = cmdbuf;
	memset(cmdbuf, 0, sizeof(cmdbuf));
	
	strncpy(cmd, Cmd, 99);
	
	if ( !prepareHF15Cmd(&cmd, &c, ISO15_CMD_SYSINFO) )
		return 0;

	AddCrc(req,  c.arg[0]);
	c.arg[0] += 2;

	//PrintAndLogEx(NORMAL, "cmd %s", sprint_hex(c.d.asBytes, reqlen) ); 
	
	clearCommandBuffer();
	SendCommand(&c);

	if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2000) ) {
		PrintAndLogEx(WARNING, "iso15693 card select failed");
		return 1;
	}
	
	uint32_t status = resp.arg[0];
	
	if ( status < 2 ) {
		PrintAndLogEx(WARNING, "iso15693 card doesn't answer to systeminfo command");
		return 1;		
	}
	
	recv = resp.d.asBytes;	
	
	if ( recv[0] & ISO15_RES_ERROR ) {
		PrintAndLogEx(WARNING, "iso15693 card returned error %i: %s", recv[0], TagErrorStr(recv[0])); 
		return 3;
	}
	
	PrintAndLogEx(NORMAL, "  UID  : %s", sprintUID(NULL, recv+2));
	PrintAndLogEx(NORMAL, "  TYPE : %s", getTagInfo_15(recv+2));
	PrintAndLogEx(NORMAL, "  SYSINFO : %s", sprint_hex(recv, status-2));

	// DSFID
	if (recv[1] & 0x01) 
		PrintAndLogEx(NORMAL, "     - DSFID supported        [0x%02X]", recv[10]);
	else 
		PrintAndLogEx(NORMAL, "     - DSFID not supported");
	
	// AFI
	if (recv[1] & 0x02) 
		PrintAndLogEx(NORMAL, "     - AFI   supported        [0x%02X]", recv[11]);
	else 
		PrintAndLogEx(NORMAL, "     - AFI   not supported");

	// IC reference
	if (recv[1] & 0x08) 
		PrintAndLogEx(NORMAL, "     - IC reference supported [0x%02X]", recv[14]);
	else 
		PrintAndLogEx(NORMAL, "     - IC reference not supported");

	// memory 
	if (recv[1] & 0x04) {
		PrintAndLogEx(NORMAL, "     - Tag provides info on memory layout (vendor dependent)");
		uint8_t blocks = recv[12]+1;
		uint8_t size = (recv[13] & 0x1F);
		PrintAndLogEx(NORMAL, "           %u (or %u) bytes/blocks x %u blocks", size+1, size, blocks );
	} else {
		PrintAndLogEx(NORMAL, "     - Tag does not provide information on memory layout");
	}
	PrintAndLogEx(NORMAL, "\n");
	return 0;
}

// Record Activity without enabeling carrier
//helptext
int CmdHF15Record(const char *Cmd) {
	char cmdp =  tolower(param_getchar(Cmd, 0));
	if (cmdp == 'h') return usage_15_record();
	
	UsbCommand c = {CMD_RECORD_RAW_ADC_SAMPLES_ISO_15693, {0,0,0}};
	clearCommandBuffer();
	SendCommand(&c);
	return 0;
}

// used with 'hf search'
int HF15Reader(const char *Cmd, bool verbose) {
	uint8_t uid[8] = {0,0,0,0,0,0,0,0};	
	if (!getUID(uid)) {
		if (verbose) PrintAndLogEx(WARNING, "No tag found.");
		return 0;
	}

	PrintAndLogEx(NORMAL, " UID  : %s", sprintUID(NULL, uid));
	PrintAndLogEx(NORMAL, " TYPE : %s", getTagInfo_15(uid));
	return 1;
}

int CmdHF15Reader(const char *Cmd) {
	char cmdp = tolower(param_getchar(Cmd, 0));
	if (cmdp == 'h') return usage_15_reader();
	
	HF15Reader(Cmd, true);
	return 0;
}

// Simulation is still not working very good
// helptext
int CmdHF15Sim(const char *Cmd) {
	char cmdp =tolower(param_getchar(Cmd, 0));
	if (strlen(Cmd) < 1 || cmdp == 'h') return usage_15_sim();

	uint8_t uid[8] = {0,0,0,0,0,0,0,0};	
	if (param_gethex(Cmd, 0, uid, 16)) {
		PrintAndLogEx(WARNING, "UID must include 16 HEX symbols");
		return 0;
	}
	
	PrintAndLogEx(SUCCESS, "Starting simulating UID %s", sprint_hex(uid, sizeof(uid)) );

	UsbCommand c = {CMD_SIMTAG_ISO_15693, {0, 0, 0}};
	memcpy(c.d.asBytes, uid, 8);
	clearCommandBuffer();
	SendCommand(&c);
	return 0;
}

// finds the AFI (Application Family Idendifier) of a card, by trying all values
// (There is no standard way of reading the AFI, allthough some tags support this)
// helptext
int CmdHF15Afi(const char *Cmd) {
	char cmdp = tolower(param_getchar(Cmd, 0));
	if (cmdp == 'h') return usage_15_findafi();

	PrintAndLogEx(SUCCESS, "press pm3-button to cancel");
	
	UsbCommand c = {CMD_ISO_15693_FIND_AFI, {strtol(Cmd, NULL, 0), 0, 0}};
	clearCommandBuffer();
	SendCommand(&c);
	return 0;
}

typedef struct {
	uint8_t lock;
	uint8_t block[4];
} t15memory;

// Reads all memory pages
// need to write to file
int CmdHF15Dump(const char*Cmd) {
	
	uint8_t fileNameLen = 0;
	char filename[FILE_PATH_SIZE] = {0};
	char * fptr = filename;
	bool errors = false;
	uint8_t cmdp = 0;
	uint8_t uid[8] = {0,0,0,0,0,0,0,0};	
	
	while(param_getchar(Cmd, cmdp) != 0x00 && !errors) {
		switch (tolower(param_getchar(Cmd, cmdp))) {
		case 'h':
			return usage_15_dump();
		case 'f':
			fileNameLen = param_getstr(Cmd, cmdp+1, filename, FILE_PATH_SIZE); 
			cmdp += 2;
			break;
		default:
			PrintAndLogEx(WARNING, "Unknown parameter '%c'\n", param_getchar(Cmd, cmdp));
			errors = true;
			break;
		}
	}

	//Validations
	if (errors) return usage_15_dump();
	
	if (fileNameLen < 1) {

		PrintAndLogEx(INFO, "Using UID as filename");

		if (!getUID(uid)) {
			PrintAndLogEx(WARNING, "No tag found.");
			return 1;
		}
		
		fptr += sprintf(fptr, "hf-15-"); 
		FillFileNameByUID(fptr,uid,"-dump",sizeof(uid));
	}	
	// detect blocksize from card :)
	
	PrintAndLogEx(NORMAL, "Reading memory from tag UID " _YELLOW_(%s), sprintUID(NULL, uid));

	int blocknum = 0;
	uint8_t *recv = NULL;

	// memory.
	t15memory mem[256];
	
	uint8_t data[256*4] = {0};
	memset(data, 0, sizeof(data));

	UsbCommand resp;
	UsbCommand c = {CMD_ISO_15693_COMMAND, {0, 1, 1}}; // len,speed,recv?
	uint8_t *req = c.d.asBytes;
	req[0] = ISO15_REQ_SUBCARRIER_SINGLE | ISO15_REQ_DATARATE_HIGH | ISO15_REQ_NONINVENTORY | ISO15_REQ_ADDRESS;
	req[1] = ISO15_CMD_READ;

	// copy uid to read command
	memcpy(req+2, uid, sizeof(uid));
	
	for (int retry = 0; retry < 5; retry++) {
	
		req[10] = blocknum;
		AddCrc(req, 11);
		c.arg[0] = 13;
	
		clearCommandBuffer();
		SendCommand(&c);
				
		if (WaitForResponseTimeout(CMD_ACK, &resp, 2000)) {

			uint8_t len = resp.arg[0];
			if ( len < 2 ) {
				PrintAndLogEx(FAILED, "iso15693 card select failed");
				continue;		
			}
			
			recv = resp.d.asBytes;
			
			if ( !CheckCrc(recv, len) ) {
				PrintAndLogEx(FAILED, "crc fail");
				continue;
			}

			if (recv[0] & ISO15_RES_ERROR) {
				PrintAndLogEx(FAILED, "Tag returned Error %i: %s", recv[1], TagErrorStr(recv[1]) ); 
				break;
			}
								
			mem[blocknum].lock = resp.d.asBytes[0];
			memcpy(mem[blocknum].block, resp.d.asBytes + 1, 4);					
			memcpy(data + (blocknum * 4), resp.d.asBytes + 1, 4);
			
			retry = 0;
			blocknum++;
			
			printf("."); fflush(stdout);
		} 
	}
	PrintAndLogEx(NORMAL, "\n");

	PrintAndLogEx(NORMAL, "block#   | data         |lck| ascii");
	PrintAndLogEx(NORMAL, "---------+--------------+---+----------");	
	for (int i = 0; i < blocknum; i++) {
		PrintAndLogEx(NORMAL, "%3d/0x%02X | %s | %d | %s", i, i, sprint_hex(mem[i].block, 4 ), mem[i].lock, sprint_ascii(mem[i].block, 4) );
	}
	PrintAndLogEx(NORMAL, "\n");

	size_t datalen = blocknum * 4;
	saveFileEML(filename, "eml", data, datalen, 4);	
	saveFile(filename, "bin", data, datalen);
	return 0;
}

int CmdHF15Restore(const char*Cmd) {
	FILE *f;
	
	uint8_t uid[8]={0x00};
	char filename[FILE_PATH_SIZE] = {0x00};
	char buff[255] = {0x00};
	size_t blocksize=4;
	uint8_t cmdp = 0;
	char newCmdPrefix[255] = {0x00}, tmpCmd[255] = {0x00};
	char param[FILE_PATH_SIZE]="";
	char hex[255]="";
	uint8_t retries = 3, tried = 0, i = 0;
	int retval=0;
	size_t bytes_read;

		while(param_getchar(Cmd, cmdp) != 0x00) {
		switch(tolower(param_getchar(Cmd, cmdp))) {
			case '-':
				param_getstr(Cmd, cmdp, param, sizeof(param));
				switch(param[1])
				{
					case '2':
					case 'o':
						strncpy(newCmdPrefix, " ", sizeof(newCmdPrefix)-1);
						strncat(newCmdPrefix, param, sizeof(newCmdPrefix)-1);
								break;
					default:
						PrintAndLogEx(WARNING, "Unknown parameter '%s'", param);
						return usage_15_restore();
				}
				break;
			case 'f':
				param_getstr(Cmd, cmdp+1, filename, FILE_PATH_SIZE);
				cmdp++;	
				break;
			case 'r':
				retries=param_get8ex(Cmd, cmdp+1, 3, 10);
				cmdp++;	
				break;
			case 'b':
				blocksize=param_get8ex(Cmd, cmdp+1, 4, 10);
				cmdp++;	
				break;
			case 'u':
				param_getstr(Cmd, cmdp+1, buff, FILE_PATH_SIZE);
				cmdp++;	
				snprintf(filename,sizeof(filename),"hf-15-dump-%s-bin",buff);				
				break;
			case 'h':
				return usage_15_restore();
			default:
				PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp));
				return usage_15_restore();
		}
		cmdp++;
	}

	PrintAndLogEx(INFO,"Blocksize: %u",blocksize);
	
	if ( !strlen(filename)) {
		PrintAndLogEx(WARNING,"Please provide a filename");
		return usage_15_restore();
	}

	if ((f = fopen(filename, "rb")) == NULL) {
		PrintAndLogEx(WARNING, "Could not find file %s", filename);
		return 2;
	}
	
	if (!getUID(uid)) {
		PrintAndLogEx(WARNING, "No tag found");
		fclose(f);
		return 3;
	}
	
	while (1) {
		tried = 0;
		hex[0] = 0x00;
		tmpCmd[0] = 0x00;
		
		bytes_read = fread( buff, 1, blocksize, f );
		if ( bytes_read == 0) {
			PrintAndLogEx(SUCCESS, "File reading done `%s`", filename);
			fclose(f);
			return 0;
		} else if ( bytes_read != blocksize) {
			PrintAndLogEx(WARNING, "File reading error (%s), %u bytes read instead of %u bytes.", filename, bytes_read, blocksize);
			fclose(f);
			return 2;
		}
		
		for(int j=0; j < blocksize; j++)
			snprintf(hex+j*2, 3, "%02X", buff[j]);
		
		for(int j=0; j < sizeof(uid)/sizeof(uid[0]); j++)
			snprintf(buff+j*2,3,"%02X", uid[j]);
		
		//TODO: Addressed mode currently not work
		//snprintf(tmpCmd, sizeof(tmpCmd), "%s %s %d %s", newCmdPrefix, buff, i, hex);
		snprintf(tmpCmd, sizeof(tmpCmd), "%s u %u %s", newCmdPrefix, i, hex);
		PrintAndLogEx(DEBUG, "Command to be sent| %s", tmpCmd);

		for(tried=0; tried < retries; tried++)
			if(!(retval = CmdHF15Write(tmpCmd)))
				break;
		if(tried >= retries)
			return retval;

		i++;
	}
	fclose(f);
}

int CmdHF15List(const char *Cmd) {
	//PrintAndLogEx(WARNING, "Deprecated command, use 'hf list 15' instead");
	CmdTraceList("15");
	return 0;
}

int CmdHF15Raw(const char *Cmd) {

	char cmdp = param_getchar(Cmd, 0);
	if (strlen(Cmd)<3 || cmdp == 'h' || cmdp == 'H') return usage_15_raw();

	UsbCommand resp;
	UsbCommand c = {CMD_ISO_15693_COMMAND, {0, 1, 1}}; // len,speed,recv?
	int reply = 1, fast = 1, i = 0;
	bool crc = false;
	char buf[5] = "";
	uint8_t data[100];
	uint32_t datalen = 0, temp;
	
	// strip
	while (*Cmd==' ' || *Cmd=='\t') Cmd++;
	
	while (Cmd[i]!='\0') {
		if (Cmd[i]==' ' || Cmd[i]=='\t') { i++; continue; }
		if (Cmd[i]=='-') {
			switch (Cmd[i+1]) {
				case 'r': 
				case 'R': 
					reply = 0;
					break;
				case '2':
					fast = 0;
					break;
				case 'c':
				case 'C':				
					crc = true;
					break;
				default:
					PrintAndLogEx(WARNING, "Invalid option");
					return 0;
			}
			i+=2;
			continue;
		}
		if ((Cmd[i]>='0' && Cmd[i]<='9') ||
		    (Cmd[i]>='a' && Cmd[i]<='f') ||
		    (Cmd[i]>='A' && Cmd[i]<='F') ) {
		    buf[strlen(buf)+1] = 0;
		    buf[strlen(buf)] = Cmd[i];
		    i++;
		    
		    if (strlen(buf) >= 2) {
		    	sscanf(buf, "%x", &temp);
		    	data[datalen] = (uint8_t)(temp & 0xff);
		    	datalen++;
		    	*buf = 0;
		    }
		    continue;
		}
		PrintAndLogEx(WARNING, "Invalid char on input");
		return 0;
	}
	
	if (crc) {
		AddCrc(data, datalen);
		datalen += 2;
	}
	
	c.arg[0] = datalen;
	c.arg[1] = fast;
	c.arg[2] = reply;
	memcpy(c.d.asBytes, data, datalen);

	clearCommandBuffer();	
	SendCommand(&c);
	
	if (reply) {
		if (WaitForResponseTimeout(CMD_ACK, &resp, 2000)) {
			uint8_t len = resp.arg[0];
			PrintAndLogEx(NORMAL, "received %i octets", len);
			PrintAndLogEx(NORMAL, "%s", sprint_hex(resp.d.asBytes, len) );
		} else {
			PrintAndLogEx(WARNING, "timeout while waiting for reply.");
		}		
	}
	return 0;
}

/**
 * parses common HF 15 CMD parameters and prepares some data structures
 * Parameters:
 *  **cmd   	command line
 */
int prepareHF15Cmd(char **cmd, UsbCommand *c, uint8_t iso15cmd) {
	int temp;
	uint8_t *req = c->d.asBytes;
	uint8_t uid[8] = {0x00};
	uint32_t reqlen = 0;

	// strip
	while (**cmd==' ' || **cmd=='\t') (*cmd)++;
	
	if (strstr(*cmd, "-2") == *cmd) {
	 	c->arg[1] = 0; // use 1of256
	 	(*cmd) += 2;
	}

	// strip
	while (**cmd==' ' || **cmd=='\t') (*cmd)++;
	
	if (strstr(*cmd, "-o") == *cmd) {
	 	req[reqlen] = ISO15_REQ_OPTION;
	 	(*cmd) += 2;
	}
	
	// strip
	while (**cmd == ' ' || **cmd == '\t') (*cmd)++;
	
	switch (**cmd) {
		case 0:
			PrintAndLogEx(WARNING, "missing addr");
			return 0;
			break;
		case 'u':
		case 'U':
			// unaddressed mode may not be supported by all vendors
			req[reqlen++] |= ISO15_REQ_SUBCARRIER_SINGLE | ISO15_REQ_DATARATE_HIGH | ISO15_REQ_NONINVENTORY;
			req[reqlen++] = iso15cmd;
			break;
		case '*':
			// we scan for the UID ourself
			req[reqlen++] |= ISO15_REQ_SUBCARRIER_SINGLE | ISO15_REQ_DATARATE_HIGH | ISO15_REQ_NONINVENTORY | ISO15_REQ_ADDRESS;
			req[reqlen++] = iso15cmd;

			if (!getUID(uid)) {
				PrintAndLogEx(WARNING, "No tag found");
				return 0;
			}
			memcpy(&req[reqlen], uid, sizeof(uid));
			PrintAndLogEx(NORMAL, "Detected UID %s", sprintUID(NULL, uid));
			reqlen += sizeof(uid);
			break;			
		default:
			req[reqlen++] |= ISO15_REQ_SUBCARRIER_SINGLE | ISO15_REQ_DATARATE_HIGH | ISO15_REQ_NONINVENTORY | ISO15_REQ_ADDRESS;
			req[reqlen++] = iso15cmd;
			
		    // parse UID
			for (int i=0; i<8 && (*cmd)[i*2] && (*cmd)[i*2+1]; i++) {
				sscanf((char[]){(*cmd)[i*2], (*cmd)[i*2+1],0}, "%X", &temp);
				uid[7-i] = temp & 0xff;
			}				
				
			PrintAndLogEx(NORMAL, "Using UID %s", sprintUID(NULL, uid));
			memcpy(&req[reqlen], uid, sizeof(uid));
			reqlen +=  sizeof(uid);
			break;
	}
	// skip to next space		
	while (**cmd!=' ' && **cmd!='\t') (*cmd)++;
	// skip over the space
	while (**cmd==' ' || **cmd=='\t') (*cmd)++;
	
	c->arg[0] = reqlen;	
	return 1;
}

/**
 * Commandline handling: HF15 CMD READMULTI
 * Read multiple blocks at once (not all tags support this)
 */
int CmdHF15Readmulti(const char *Cmd) {

	char cmdp = param_getchar(Cmd, 0);
	if (strlen(Cmd)<3 || cmdp == 'h' || cmdp == 'H') return usage_15_readmulti();

	UsbCommand resp;
	uint8_t *recv;
	UsbCommand c = {CMD_ISO_15693_COMMAND, {0, 1, 1}}; // len,speed,recv?
	uint8_t *req = c.d.asBytes;
	int reqlen = 0;
	uint8_t pagenum, pagecount;
	char cmdbuf[100];
	char *cmd = cmdbuf;
	strncpy(cmd, Cmd, 99);

	if ( !prepareHF15Cmd(&cmd, &c, ISO15_CMD_READMULTI) )
		return 0;

	// add OPTION flag, in order to get lock-info
	req[0] |= ISO15_REQ_OPTION;
	
	reqlen = c.arg[0];

	// decimal
	pagenum = param_get8ex(cmd, 0, 0, 10);
	pagecount = param_get8ex(cmd, 1, 0, 10);

	//PrintAndLogEx(NORMAL, "ice %d %d\n", pagenum, pagecount);
	
	// 0 means 1 page,
	// 1 means 2 pages, ...	
	if (pagecount > 0) pagecount--; 
	
	req[reqlen++] = pagenum;
	req[reqlen++] = pagecount;
	AddCrc(req, reqlen);
	c.arg[0] = reqlen+2;

	clearCommandBuffer();
	SendCommand(&c);
	
	if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2000) ) {
		PrintAndLogEx(FAILED, "iso15693 card select failed");
		return 1;
	}
	
	uint32_t status = resp.arg[0];	
	if ( status < 2 ) {
		PrintAndLogEx(FAILED, "iso15693 card select failed");
		return 1;		
	}

	recv = resp.d.asBytes;	
	
	if (!CheckCrc(recv, status)) {
		PrintAndLogEx(FAILED, "CRC failed");
		return 2;
	} 
	
	if ( recv[0] & ISO15_RES_ERROR ) {
		PrintAndLogEx(FAILED, "iso15693 card returned error %i: %s", recv[0], TagErrorStr(recv[0])); 
		return 3;
	}

	int start = 1;  // skip status byte
	int stop = (pagecount+1) * 5;
	int currblock = pagenum;
	// print response
	PrintAndLogEx(NORMAL, "");
	PrintAndLogEx(NORMAL, "block#   | data         |lck| ascii");
	PrintAndLogEx(NORMAL, "---------+--------------+---+----------");	
	for (int i = start; i < stop; i += 5) {
		PrintAndLogEx(NORMAL, "%3d/0x%02X | %s | %d | %s", currblock, currblock, sprint_hex(recv+i+1, 4 ), recv[i], sprint_ascii(recv+i+1, 4) );
		currblock++;
	}

	return 0;
}

/**
 * Commandline handling: HF15 CMD READ
 * Reads a single Block
 */
int CmdHF15Read(const char *Cmd) {

	char cmdp = param_getchar(Cmd, 0);
	if (strlen(Cmd)<3 || cmdp == 'h' || cmdp == 'H')  return usage_15_read();
	
	UsbCommand resp;
	uint8_t *recv;

	// UsbCommand arg: len, speed, recv?
	// arg0 (datalen,  cmd len?  .arg0 == crc?)
	// arg1	(speed == 0 == 1 of 256,  == 1 == 1 of 4 )
	// arg2 (recv == 1 == expect a response)
	UsbCommand c = {CMD_ISO_15693_COMMAND, {0, 1, 1}}; 
	uint8_t *req = c.d.asBytes;
	int reqlen = 0, blocknum;
	char cmdbuf[100];
	char *cmd = cmdbuf;
	strncpy(cmd, Cmd, 99);
	
	if ( !prepareHF15Cmd(&cmd, &c, ISO15_CMD_READ) )
		return 0;

	// add OPTION flag, in order to get lock-info
	req[0] |= ISO15_REQ_OPTION;
	
	reqlen = c.arg[0];

	blocknum = strtol(cmd, NULL, 0);
	
	req[reqlen++] = (uint8_t)blocknum;
	
	AddCrc(req, reqlen);
	
	c.arg[0] = reqlen+2;

	clearCommandBuffer();
	SendCommand(&c);

	if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2000) ) {
		PrintAndLogEx(NORMAL, "iso15693 card select failed");
		return 1;
	}
	
	uint32_t status = resp.arg[0];	
	if ( status < 2 ) {
		PrintAndLogEx(NORMAL, "iso15693 card select failed");
		return 1;		
	}

	recv = resp.d.asBytes;	
	
	if ( !CheckCrc(recv, status) ) {
		PrintAndLogEx(NORMAL, "CRC failed");
		return 2;
	} 
	
	if ( recv[0] & ISO15_RES_ERROR ) {
		PrintAndLogEx(WARNING, "iso15693 card returned error %i: %s", recv[0], TagErrorStr(recv[0])); 
		return 3;
	}
	
	// print response
	PrintAndLogEx(NORMAL, "");
	PrintAndLogEx(NORMAL, "block #%3d  |lck| ascii", blocknum );
	PrintAndLogEx(NORMAL, "------------+---+------" );
	PrintAndLogEx(NORMAL, "%s| %d | %s", sprint_hex(recv+2, status-4), recv[1], sprint_ascii(recv+2, status-4) );
	PrintAndLogEx(NORMAL, "");	
	return 0;
}

/**
 * Commandline handling: HF15 CMD WRITE
 * Writes a single Block - might run into timeout, even when successful
 */
int CmdHF15Write(const char *Cmd) {

	char cmdp = param_getchar(Cmd, 0);
	if (strlen(Cmd)<3 || cmdp == 'h' || cmdp == 'H') return usage_15_write();
	
	UsbCommand resp;
	uint8_t *recv;
	UsbCommand c = {CMD_ISO_15693_COMMAND, {0, 1, 1}}; // len,speed,recv?
	uint8_t *req = c.d.asBytes;
	int reqlen = 0, pagenum, temp;
	char cmdbuf[100];
	char *cmd = cmdbuf;
	char *cmd2;
	
	strncpy(cmd, Cmd, 99);

	if ( !prepareHF15Cmd(&cmd, &c, ISO15_CMD_WRITE) )
		return 0;

	reqlen = c.arg[0];
	
	// *cmd -> page num ; *cmd2 -> data 
	cmd2=cmd;
	while (*cmd2!=' ' && *cmd2!='\t' && *cmd2) cmd2++;
	*cmd2 = 0;
	cmd2++;	
		
	pagenum = strtol(cmd, NULL, 0);

	req[reqlen++] = (uint8_t)pagenum;	
	
	while (cmd2[0] && cmd2[1]) { // hexdata, read by 2 hexchars 
		if (*cmd2==' ') {
			cmd2++; 
			continue; 
		}
		sscanf((char[]){cmd2[0],cmd2[1],0},"%X",&temp);
		req[reqlen++]=temp & 0xff;
		cmd2+=2;
	} 
	AddCrc(req, reqlen);
	c.arg[0] = reqlen+2;
	
	PrintAndLogEx(NORMAL, "iso15693 writing to page %02d (0x%02X) | data ", pagenum, pagenum);
	
	clearCommandBuffer();
	SendCommand(&c);

	if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2000) ) {
		PrintAndLogEx(FAILED, "iso15693 card timeout, data may be written anyway");
		return 1;
	}
	
	uint32_t status = resp.arg[0];	
	if ( status < 2 ) {
		PrintAndLogEx(FAILED, "iso15693 card select failed");
		return 1;		
	}

	recv = resp.d.asBytes;	
	
	if ( !CheckCrc(recv, status) ) {
		PrintAndLogEx(FAILED, "CRC failed");
		return 2;
	} 
	
	if ( recv[0] & ISO15_RES_ERROR ) {
		PrintAndLogEx(NORMAL, "iso15693 card returned error %i: %s", recv[0], TagErrorStr(recv[0])); 
		return 3;
	}
	
	PrintAndLogEx(NORMAL, "OK");
	return 0;
}

static command_t CommandTable15[] = {
	{"help",		CmdHF15Help,    	1, "This help"},
	{"demod",		CmdHF15Demod,   	1, "Demodulate ISO15693 from tag"},
	{"dump",		CmdHF15Dump,		0, "Read all memory pages of an ISO15693 tag, save to file"},
	{"findafi",		CmdHF15Afi,     	0, "Brute force AFI of an ISO15693 tag"},
	{"info",		CmdHF15Info,		0, "Tag information"},	
	{"list",		CmdHF15List,    	0, "[Deprecated] List ISO15693 history"},
	{"raw",			CmdHF15Raw,			0, "Send raw hex data to tag"}, 
	{"reader",		CmdHF15Reader,  	0, "Act like an ISO15693 reader"},
	{"record",		CmdHF15Record,  	0, "Record Samples (ISO15693)"},
	{"restore",		CmdHF15Restore,		0, "Restore from file to all memory pages of an ISO15693 tag"},
	{"sim",			CmdHF15Sim,     	0, "Fake an ISO15693 tag"},
	{"samples",		CmdHF15Samples,		0, "Acquire Samples as Reader (enables carrier, sends inquiry)"},
	{"read",		CmdHF15Read,		0, "Read a block"},	
	{"write",		CmdHF15Write,		0, "Write a block"},	
	{"readmulti",	CmdHF15Readmulti,	0, "Reads multiple Blocks"},
	{NULL, NULL, 0, NULL}
};

int CmdHF15(const char *Cmd) {
	clearCommandBuffer();	
	CmdsParse(CommandTable15, Cmd);
	return 0;
}

int CmdHF15Help(const char *Cmd) {
	CmdsHelp(CommandTable15);
	return 0;
}