mirror of
				https://github.com/RfidResearchGroup/proxmark3.git
				synced 2025-10-31 00:17:02 +08:00 
			
		
		
		
	
		
			
				
	
	
		
			1124 lines
		
	
	
	
		
			35 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			1124 lines
		
	
	
	
		
			35 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| //-----------------------------------------------------------------------------
 | ||
| // Copyright (C) 2010 iZsh <izsh at fail0verflow.com>
 | ||
| // Modified 2010-2012 by <adrian -at- atrox.at>
 | ||
| // Modified 2012 by <vsza at vsza.hu>
 | ||
| //
 | ||
| // 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 <stdio.h>
 | ||
| #include <stdlib.h>
 | ||
| #include <string.h>
 | ||
| #include <stdint.h>
 | ||
| 
 | ||
| #include "proxmark3.h"
 | ||
| #include "data.h"
 | ||
| #include "graph.h"
 | ||
| #include "ui.h"
 | ||
| #include "util.h"
 | ||
| #include "cmdparser.h"
 | ||
| #include "cmdhf15.h"
 | ||
| #include "iso15693tools.h"
 | ||
| #include "cmdmain.h"
 | ||
| 
 | ||
| #define FrameSOF				Iso15693FrameSOF
 | ||
| #define Logic0					Iso15693Logic0
 | ||
| #define Logic1					Iso15693Logic1
 | ||
| #define FrameEOF				Iso15693FrameEOF
 | ||
| 
 | ||
| #define Crc(data,datalen)		Iso15693Crc(data,datalen)
 | ||
| #define AddCrc(data,datalen)	Iso15693AddCrc(data,datalen)
 | ||
| #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;
 | ||
| 	uint8_t *recv;
 | ||
| 	UsbCommand c = {CMD_ISO_15693_COMMAND, {0, 1, 1}}; // len,speed,recv?
 | ||
| 	uint8_t *req = c.d.asBytes;
 | ||
| 	int reqlen = 0;
 | ||
| 	
 | ||
| 	for (int retry = 0; retry <3; retry++) { // don't give up the at the first try		
 | ||
| 		
 | ||
| 		req[0] = ISO15_REQ_SUBCARRIER_SINGLE | ISO15_REQ_DATARATE_HIGH | ISO15_REQ_INVENTORY | ISO15_REQINV_SLOT1;
 | ||
| 		req[1] = ISO15_CMD_INVENTORY;
 | ||
| 		req[2] = 0; // mask length
 | ||
| 		reqlen = AddCrc(req, 3);
 | ||
| 		c.arg[0] = reqlen;
 | ||
| 	
 | ||
| 		SendCommand(&c);
 | ||
| 		
 | ||
| 		if (WaitForResponseTimeout(CMD_ACK, &resp, 1000)) {
 | ||
| 			recv = resp.d.asBytes;
 | ||
| 			if (resp.arg[0] >= 12 && ISO15_CRC_CHECK == Crc(recv,12)) {
 | ||
| 			   memcpy(buf,&recv[2],8);
 | ||
| 			   return 1;
 | ||
| 			} 
 | ||
| 		} 
 | ||
| 	} // retry
 | ||
| 	return 0;
 | ||
| }
 | ||
| 
 | ||
| 
 | ||
| 
 | ||
| // get a product description based on the UID
 | ||
| //		uid[8] 	tag uid
 | ||
| // returns description of the best match	
 | ||
| static char* getTagInfo(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.";
 | ||
| 	}
 | ||
| }
 | ||
| 
 | ||
| 
 | ||
| // Mode 3
 | ||
| int CmdHF15Demod(const char *Cmd)
 | ||
| {
 | ||
| 	// 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 < 100; 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;
 | ||
| 		}
 | ||
| 	}
 | ||
| 	PrintAndLog("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) {
 | ||
| 			PrintAndLog("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) {
 | ||
| 			PrintAndLog("ran off end!");
 | ||
| 			break;
 | ||
| 		}
 | ||
| 	}
 | ||
| 	if (mask != 0x01) {
 | ||
| 		PrintAndLog("error, uneven octet! (discard extra bits!)");
 | ||
| 		PrintAndLog("   mask=%02x", mask);
 | ||
| 	}
 | ||
| 	PrintAndLog("%d octets", k);
 | ||
| 	
 | ||
| 	for (i = 0; i < k; i++) {
 | ||
| 		PrintAndLog("# %2d: %02x ", i, outBuf[i]);
 | ||
| 	}
 | ||
| 	PrintAndLog("CRC=%04x", Iso15693Crc(outBuf, k - 2));
 | ||
| 	return 0;
 | ||
| }
 | ||
| 
 | ||
| 
 | ||
| 
 | ||
| // * Acquire Samples as Reader (enables carrier, sends inquiry)
 | ||
| int CmdHF15Read(const char *Cmd)
 | ||
| {
 | ||
| 	UsbCommand c = {CMD_ACQUIRE_RAW_ADC_SAMPLES_ISO_15693};
 | ||
| 	SendCommand(&c);
 | ||
| 	return 0;
 | ||
| }
 | ||
| 
 | ||
| // Record Activity without enabeling carrier
 | ||
| int CmdHF15Record(const char *Cmd)
 | ||
| {
 | ||
| 	UsbCommand c = {CMD_RECORD_RAW_ADC_SAMPLES_ISO_15693};
 | ||
| 	SendCommand(&c);
 | ||
| 	return 0;
 | ||
| }
 | ||
| 
 | ||
| int HF15Reader(const char *Cmd, bool verbose)
 | ||
| {
 | ||
| 	uint8_t uid[8];
 | ||
| 
 | ||
| 	if (!getUID(uid)) {
 | ||
| 		if (verbose) PrintAndLog("No Tag found.");
 | ||
| 		return 0;
 | ||
| 	}
 | ||
| 
 | ||
| 	PrintAndLog("Tag UID : %s",sprintUID(NULL,uid));
 | ||
| 	PrintAndLog("Tag Info: %s",getTagInfo(uid));
 | ||
| 	return 1;
 | ||
| }
 | ||
| 
 | ||
| int CmdHF15Reader(const char *Cmd)
 | ||
| {
 | ||
| 	UsbCommand c = {CMD_READER_ISO_15693, {strtol(Cmd, NULL, 0), 0, 0}};
 | ||
| 	SendCommand(&c);
 | ||
| 	return 0;
 | ||
| }
 | ||
| 
 | ||
| // Simulation is still not working very good
 | ||
| int CmdHF15Sim(const char *Cmd)
 | ||
| {
 | ||
| 	char cmdp = param_getchar(Cmd, 0);
 | ||
| 	uint8_t uid[8] = {0x00};
 | ||
| 
 | ||
| 	//E0 16 24 00 00 00 00 00
 | ||
| 	if (cmdp == 'h' || cmdp == 'H') {
 | ||
| 		PrintAndLog("Usage:  hf 15 sim <UID>");
 | ||
| 		PrintAndLog("");
 | ||
| 		PrintAndLog("     sample: hf 15 sim E016240000000000");
 | ||
| 		return 0;
 | ||
| 	}
 | ||
| 
 | ||
| 	if (param_gethex(Cmd, 0, uid, 16)) {
 | ||
| 		PrintAndLog("UID must include 16 HEX symbols");
 | ||
| 		return 0;
 | ||
| 	}
 | ||
| 	
 | ||
| 	PrintAndLog("Starting simulating UID %02X %02X %02X %02X %02X %02X %02X %02X",
 | ||
| 			uid[0],uid[1],uid[2],uid[3],uid[4], uid[5], uid[6], uid[7]);
 | ||
| 
 | ||
| 	UsbCommand c = {CMD_SIMTAG_ISO_15693, {0, 0, 0}};
 | ||
| 	memcpy(c.d.asBytes,uid,8);
 | ||
| 	
 | ||
| 	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)
 | ||
| int CmdHF15Afi(const char *Cmd)
 | ||
| {
 | ||
| 	UsbCommand c = {CMD_ISO_15693_FIND_AFI, {strtol(Cmd, NULL, 0), 0, 0}};
 | ||
| 	SendCommand(&c);
 | ||
| 	return 0;
 | ||
| }
 | ||
| 
 | ||
| // Reads all memory pages
 | ||
| int CmdHF15DumpMem(const char*Cmd) {
 | ||
| 
 | ||
| 	uint8_t uid[8] = {0,0,0,0,0,0,0,0};	
 | ||
| 	uint8_t *recv = NULL;
 | ||
| 	UsbCommand resp;
 | ||
| 	UsbCommand c = {CMD_ISO_15693_COMMAND, {0, 1, 1}}; // len,speed,recv?
 | ||
| 	uint8_t *req = c.d.asBytes;
 | ||
| 	int reqlen = 0, blocknum = 0;
 | ||
| 	char output[80] = {0};
 | ||
| 		
 | ||
| 	if (!getUID(uid)) {
 | ||
| 		PrintAndLog("No Tag found.");
 | ||
| 		return 0;
 | ||
| 	}
 | ||
| 	
 | ||
| 	PrintAndLog("Reading memory from tag UID=%s",sprintUID(NULL,uid));
 | ||
| 	PrintAndLog("Tag Info: %s",getTagInfo(uid));
 | ||
| 
 | ||
| 	for (int retry=0; retry<5; retry++) {
 | ||
| 		
 | ||
| 		req[0]= ISO15_REQ_SUBCARRIER_SINGLE | ISO15_REQ_DATARATE_HIGH | 
 | ||
| 		        ISO15_REQ_NONINVENTORY | ISO15_REQ_ADDRESS;
 | ||
| 		req[1]=ISO15_CMD_READ;
 | ||
| 		memcpy(&req[2],uid,8);
 | ||
| 		req[10]=blocknum;
 | ||
| 		reqlen=AddCrc(req,11);
 | ||
| 		c.arg[0]=reqlen;
 | ||
| 	
 | ||
| 		SendCommand(&c);
 | ||
| 		
 | ||
| 		if (WaitForResponseTimeout(CMD_ACK,&resp,1000)) {
 | ||
| 			recv = resp.d.asBytes;
 | ||
| 			if (ISO15_CRC_CHECK==Crc(recv,resp.arg[0])) {
 | ||
| 				if (!(recv[0] & ISO15_RES_ERROR)) {
 | ||
| 					retry = 0;
 | ||
| 					*output = 0; // reset outputstring
 | ||
| 					sprintf(output, "Block %02x   ",blocknum);
 | ||
| 					for ( int i=1; i<resp.arg[0]-2; i++) { // data in hex
 | ||
| 						sprintf(output+strlen(output),"%02X ",recv[i]);
 | ||
| 					}					
 | ||
| 					strcat(output,"   "); 
 | ||
| 					for ( int i = 1; i < resp.arg[0]-2; i++) { // data in cleaned ascii
 | ||
| 						sprintf(output+strlen(output),"%c",(recv[i] > 31 && recv[i] < 127) ? recv[i] : '.');					
 | ||
| 					}					
 | ||
| 					PrintAndLog("%s",output);	
 | ||
| 					blocknum++;
 | ||
| 					// PrintAndLog("bn=%i",blocknum);
 | ||
| 				} else {
 | ||
| 					PrintAndLog("Tag returned Error %i: %s",recv[1],TagErrorStr(recv[1])); 
 | ||
| 					return 1;
 | ||
| 				}
 | ||
| 			} // else PrintAndLog("crc");
 | ||
| 		} // else PrintAndLog("r null");
 | ||
| 	} // retry
 | ||
|   // TODO: need fix
 | ||
| //	if (resp.arg[0]<3)
 | ||
| //		PrintAndLog("Lost Connection");
 | ||
| //	else if (ISO15_CRC_CHECK!=Crc(resp.d.asBytes,resp.arg[0]))
 | ||
| //		PrintAndLog("CRC Failed");
 | ||
| //	else 
 | ||
| //		PrintAndLog("Tag returned Error %i: %s",recv[1],TagErrorStr(recv[1])); 
 | ||
| 	return 1;
 | ||
| }
 | ||
| 
 | ||
| 
 | ||
| // "HF 15" interface
 | ||
| 
 | ||
| static command_t CommandTable15[] = 
 | ||
| {
 | ||
| 	{"help",    CmdHF15Help,    1, "This help"},
 | ||
| 	{"demod",   CmdHF15Demod,   1, "Demodulate ISO15693 from tag"},
 | ||
| 	{"read",    CmdHF15Read,    0, "Read HF tag (ISO 15693)"},
 | ||
| 	{"record",  CmdHF15Record,  0, "Record Samples (ISO 15693)"}, // atrox
 | ||
| 	{"reader",  CmdHF15Reader,  0, "Act like an ISO15693 reader"},
 | ||
| 	{"sim",     CmdHF15Sim,     0, "Fake an ISO15693 tag"},
 | ||
| 	{"cmd",     CmdHF15Cmd,     0, "Send direct commands to ISO15693 tag"},
 | ||
| 	{"findafi", CmdHF15Afi,     0, "Brute force AFI of an ISO15693 tag"},
 | ||
| 	{"dumpmemory", CmdHF15DumpMem,     0, "Read all memory pages of an ISO15693 tag"},
 | ||
| 	{NULL, NULL, 0, NULL}
 | ||
| };
 | ||
| 
 | ||
| int CmdHF15(const char *Cmd)
 | ||
| {
 | ||
| 	CmdsParse(CommandTable15, Cmd);
 | ||
| 	return 0;
 | ||
| }
 | ||
| 
 | ||
| int CmdHF15Help(const char *Cmd)
 | ||
| {
 | ||
| 	CmdsHelp(CommandTable15);
 | ||
| 	return 0;
 | ||
| }
 | ||
| 
 | ||
| 
 | ||
| // "HF 15 Cmd" Interface
 | ||
| // Allows direct communication with the tag on command level
 | ||
| 
 | ||
| int CmdHF15CmdInquiry(const char *Cmd) 
 | ||
| {
 | ||
| 	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;
 | ||
| 	
 | ||
| 	req[0]= ISO15_REQ_SUBCARRIER_SINGLE | ISO15_REQ_DATARATE_HIGH | 
 | ||
| 	        ISO15_REQ_INVENTORY | ISO15_REQINV_SLOT1;
 | ||
| 	req[1]=ISO15_CMD_INVENTORY;
 | ||
| 	req[2]=0; // mask length
 | ||
| 	reqlen=AddCrc(req,3);
 | ||
| 	c.arg[0]=reqlen;
 | ||
| 
 | ||
| 	SendCommand(&c);
 | ||
| 	
 | ||
| 	if (WaitForResponseTimeout(CMD_ACK,&resp,1000)) {
 | ||
| 		if (resp.arg[0]>=12) {
 | ||
| 		   recv = resp.d.asBytes;
 | ||
| 		   PrintAndLog("UID=%s",sprintUID(NULL,&recv[2]));
 | ||
| 		   PrintAndLog("Tag Info: %s",getTagInfo(&recv[2]));	
 | ||
| 		} else {
 | ||
| 			PrintAndLog("Response to short, just %i bytes. No tag?\n",resp.arg[0]);
 | ||
| 		}
 | ||
| 	} else {
 | ||
| 		PrintAndLog("timeout.");
 | ||
| 	}
 | ||
| 	return 0;
 | ||
| }
 | ||
| 
 | ||
| 
 | ||
| // Turns debugging on(1)/off(0)
 | ||
| int CmdHF15CmdDebug( const char *cmd) {
 | ||
| 	int debug=atoi(cmd);
 | ||
| 	if (strlen(cmd)<1) {
 | ||
| 		PrintAndLog("Usage: hf 15 cmd debug  <0|1>");
 | ||
| 		PrintAndLog("	0 no debugging");
 | ||
| 		PrintAndLog("	1 turn debugging on");	
 | ||
| 		return 0;
 | ||
| 	}
 | ||
| 
 | ||
| 	UsbCommand c = {CMD_ISO_15693_DEBUG, {debug, 0, 0}};
 | ||
| 	SendCommand(&c);
 | ||
| 	return 0;
 | ||
| }
 | ||
| 
 | ||
| 
 | ||
| int CmdHF15CmdRaw (const char *cmd) {
 | ||
| 	UsbCommand resp;
 | ||
| 	uint8_t *recv;
 | ||
| 	UsbCommand c = {CMD_ISO_15693_COMMAND, {0, 1, 1}}; // len,speed,recv?
 | ||
| 	int reply=1;
 | ||
| 	int fast=1;	
 | ||
| 	int crc=0;
 | ||
| 	char buf[5]="";
 | ||
| 	int i=0;
 | ||
| 	uint8_t data[100];
 | ||
| 	unsigned int datalen=0, temp;
 | ||
| 	char *hexout;
 | ||
| 
 | ||
| 	
 | ||
| 	if (strlen(cmd)<3) {
 | ||
| 		PrintAndLog("Usage: hf 15 cmd raw  [-r] [-2] [-c] <0A 0B 0C ... hex>");
 | ||
| 		PrintAndLog("       -r    do not read response");
 | ||
| 		PrintAndLog("       -2    use slower '1 out of 256' mode");
 | ||
| 		PrintAndLog("       -c	  calculate and append CRC");
 | ||
| 		PrintAndLog(" Tip: turn on debugging for verbose output");		
 | ||
| 		return 0;	
 | ||
| 	}
 | ||
| 
 | ||
| 	// 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=1;
 | ||
| 					break;
 | ||
| 				default:
 | ||
| 					PrintAndLog("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;
 | ||
| 		}
 | ||
| 		PrintAndLog("Invalid char on input");
 | ||
| 		return 0;
 | ||
| 	}
 | ||
| 	if (crc) datalen=AddCrc(data,datalen);
 | ||
| 	
 | ||
| 	c.arg[0]=datalen;
 | ||
| 	c.arg[1]=fast;
 | ||
| 	c.arg[2]=reply;
 | ||
| 	memcpy(c.d.asBytes,data,datalen);
 | ||
| 	
 | ||
| 	SendCommand(&c);
 | ||
| 	
 | ||
| 	if (reply) {
 | ||
| 		if (WaitForResponseTimeout(CMD_ACK,&resp,1000)) {
 | ||
| 			recv = resp.d.asBytes;
 | ||
| 			PrintAndLog("received %i octets",resp.arg[0]);
 | ||
| 			hexout = (char *)malloc(resp.arg[0] * 3 + 1);
 | ||
| 			if (hexout != NULL) {
 | ||
| 				for (int i = 0; i < resp.arg[0]; i++) { // data in hex
 | ||
| 					sprintf(&hexout[i * 3], "%02X ", recv[i]);
 | ||
| 				}
 | ||
| 				PrintAndLog("%s", hexout);
 | ||
| 				free(hexout);
 | ||
| 			}
 | ||
| 		} else {
 | ||
| 			PrintAndLog("timeout while waiting for reply.");
 | ||
| 		}
 | ||
| 		
 | ||
| 	} // if 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 iso15cmdlen) {
 | ||
| 	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:
 | ||
| 			PrintAndLog("missing addr");
 | ||
| 			return 0;
 | ||
| 			break;
 | ||
| 		case 's':
 | ||
| 		case 'S':
 | ||
| 			// you must have selected the tag earlier
 | ||
| 			req[reqlen++]|= ISO15_REQ_SUBCARRIER_SINGLE | ISO15_REQ_DATARATE_HIGH | 
 | ||
| 		       ISO15_REQ_NONINVENTORY | ISO15_REQ_SELECT;
 | ||
| 		   memcpy(&req[reqlen],&iso15cmd[0],iso15cmdlen);
 | ||
| 			reqlen+=iso15cmdlen;		   
 | ||
| 		   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;
 | ||
| 		   memcpy(&req[reqlen],&iso15cmd[0],iso15cmdlen);
 | ||
| 			reqlen+=iso15cmdlen;		   
 | ||
| 		   break;
 | ||
| 		case '*':
 | ||
| 			// we scan for the UID ourself
 | ||
| 			req[reqlen++]|= ISO15_REQ_SUBCARRIER_SINGLE | ISO15_REQ_DATARATE_HIGH | 
 | ||
| 		       ISO15_REQ_NONINVENTORY | ISO15_REQ_ADDRESS;
 | ||
| 		   memcpy(&req[reqlen],&iso15cmd[0],iso15cmdlen);
 | ||
| 			reqlen+=iso15cmdlen;		   
 | ||
| 		   if (!getUID(uid)) {
 | ||
| 		   	PrintAndLog("No Tag found");
 | ||
| 		   	return 0;
 | ||
| 		   }
 | ||
| 		   memcpy(req+reqlen,uid,8);
 | ||
| 		   PrintAndLog("Detected UID %s",sprintUID(NULL,uid));
 | ||
| 		   reqlen+=8;
 | ||
| 			break;			
 | ||
| 		default:
 | ||
| 			req[reqlen++]|= ISO15_REQ_SUBCARRIER_SINGLE | ISO15_REQ_DATARATE_HIGH | 
 | ||
| 		       ISO15_REQ_NONINVENTORY | ISO15_REQ_ADDRESS;
 | ||
| 			memcpy(&req[reqlen],&iso15cmd[0],iso15cmdlen);
 | ||
| 			reqlen+=iso15cmdlen;		   
 | ||
| 		   
 | ||
| /* 			sscanf(cmd,"%hX%hX%hX%hX%hX%hX%hX%hX",
 | ||
| 				(short unsigned int *)&uid[7],(short unsigned int *)&uid[6],
 | ||
| 				(short unsigned int *)&uid[5],(short unsigned int *)&uid[4],
 | ||
| 				(short unsigned int *)&uid[3],(short unsigned int *)&uid[2],
 | ||
| 				(short unsigned int *)&uid[1],(short unsigned int *)&uid[0]); */
 | ||
| 			for (int i=0;i<8 && (*cmd)[i*2] && (*cmd)[i*2+1];i++) { // parse UID
 | ||
| 				sscanf((char[]){(*cmd)[i*2],(*cmd)[i*2+1],0},"%X",&temp);
 | ||
| 				uid[7-i]=temp&0xff;
 | ||
| 			}				
 | ||
| 				
 | ||
| 			PrintAndLog("Using UID %s",sprintUID(NULL,uid));
 | ||
| 			memcpy(&req[reqlen],&uid[0],8);		   
 | ||
| 		   reqlen+=8;
 | ||
| 	}
 | ||
| 	// 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 SYSINFO
 | ||
|  * get system information from tag/VICC
 | ||
|  */
 | ||
| int CmdHF15CmdSysinfo(const char *Cmd) {
 | ||
| 	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;
 | ||
| 	char cmdbuf[100];
 | ||
| 	char *cmd = cmdbuf;
 | ||
| 	char output[2048]="";
 | ||
| 	int i;
 | ||
| 	
 | ||
| 	strncpy(cmd,Cmd,99);
 | ||
| 
 | ||
| 	// usage:
 | ||
| 	if (strlen(cmd)<1) {
 | ||
| 		PrintAndLog("Usage:  hf 15 cmd sysinfo    [options] <uid|s|u|*>");
 | ||
| 		PrintAndLog("           options:");
 | ||
| 		PrintAndLog("               -2        use slower '1 out of 256' mode");
 | ||
| 		PrintAndLog("           uid (either): ");
 | ||
| 		PrintAndLog("               <8B hex>  full UID eg E011223344556677");
 | ||
| 		PrintAndLog("               s         selected tag");
 | ||
| 		PrintAndLog("               u         unaddressed mode");
 | ||
| 		PrintAndLog("               *         scan for tag");
 | ||
| 		PrintAndLog("           start#:       page number to start 0-255");  
 | ||
| 		PrintAndLog("           count#:       number of pages");  
 | ||
| 		return 0;
 | ||
| 	}	
 | ||
| 	
 | ||
| 	prepareHF15Cmd(&cmd, &c,(uint8_t[]){ISO15_CMD_SYSINFO},1);	
 | ||
| 	reqlen = c.arg[0];
 | ||
| 	
 | ||
| 	reqlen=AddCrc(req,reqlen);
 | ||
| 	c.arg[0]=reqlen;
 | ||
| 
 | ||
| 	SendCommand(&c);
 | ||
| 
 | ||
| 	if (WaitForResponseTimeout(CMD_ACK,&resp,1000) && resp.arg[0]>2) {
 | ||
| 		recv = resp.d.asBytes;
 | ||
| 		if (ISO15_CRC_CHECK==Crc(recv,resp.arg[0])) {
 | ||
| 			if (!(recv[0] & ISO15_RES_ERROR)) {
 | ||
| 				*output=0; // reset outputstring
 | ||
| 				for ( i=1; i<resp.arg[0]-2; i++) {
 | ||
| 					sprintf(output+strlen(output),"%02X ",recv[i]);
 | ||
| 				}					
 | ||
| 				strcat(output,"\n\r");
 | ||
| 				strcat(output,"UID = ");
 | ||
| 				strcat(output,sprintUID(NULL,recv+2));
 | ||
| 				strcat(output,"\n\r");
 | ||
| 				strcat(output,getTagInfo(recv+2)); //ABC
 | ||
| 				strcat(output,"\n\r");
 | ||
| 				i=10;
 | ||
| 				if (recv[1] & 0x01) 
 | ||
| 					sprintf(output+strlen(output),"DSFID supported, set to %02X\n\r",recv[i++]);
 | ||
| 				else 
 | ||
| 					strcat(output,"DSFID not supported\n\r");
 | ||
| 				if (recv[1] & 0x02) 
 | ||
| 					sprintf(output+strlen(output),"AFI supported, set to %03X\n\r",recv[i++]);
 | ||
| 				else 
 | ||
| 					strcat(output,"AFI not supported\n\r");
 | ||
| 				if (recv[1] & 0x04) {
 | ||
| 					strcat(output,"Tag provides info on memory layout (vendor dependent)\n\r");
 | ||
| 					sprintf(output+strlen(output)," %i (or %i) bytes/page x %i pages \n\r",
 | ||
| 							(recv[i+1]&0x1F)+1, (recv[i+1]&0x1F), recv[i]+1);
 | ||
| 					i+=2;
 | ||
| 				} else 
 | ||
| 					strcat(output,"Tag does not provide information on memory layout\n\r");
 | ||
| 				if (recv[1] & 0x08) sprintf(output+strlen(output),"IC reference given: %02X\n\r",recv[i++]);
 | ||
| 					else strcat(output,"IC reference not given\n\r");
 | ||
| 
 | ||
| 
 | ||
| 				PrintAndLog("%s",output);	
 | ||
| 			} else {
 | ||
| 				PrintAndLog("Tag returned Error %i: %s",recv[0],TagErrorStr(recv[0])); 
 | ||
| 			}		   
 | ||
| 		} else {
 | ||
| 			PrintAndLog("CRC failed");
 | ||
| 		}
 | ||
| 	} else {
 | ||
| 		PrintAndLog("timeout: no answer");
 | ||
| 	}
 | ||
| 	
 | ||
| 	return 0;
 | ||
| }
 | ||
| 
 | ||
| /**
 | ||
|  * Commandline handling: HF15 CMD READMULTI
 | ||
|  * Read multiple blocks at once (not all tags support this)
 | ||
|  */
 | ||
| int CmdHF15CmdReadmulti(const char *Cmd) {
 | ||
| 	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,pagecount;
 | ||
| 	char cmdbuf[100];
 | ||
| 	char *cmd=cmdbuf;
 | ||
| 	char output[2048]="";
 | ||
| 	
 | ||
| 	strncpy(cmd,Cmd,99);
 | ||
| 
 | ||
| 	// usage:
 | ||
| 	if (strlen(cmd)<3) {
 | ||
| 		PrintAndLog("Usage:  hf 15 cmd readmulti  [options] <uid|s|u|*> <start#> <count#>");
 | ||
| 		PrintAndLog("           options:");
 | ||
| 		PrintAndLog("               -2        use slower '1 out of 256' mode");
 | ||
| 		PrintAndLog("           uid (either): ");
 | ||
| 		PrintAndLog("               <8B hex>  full UID eg E011223344556677");
 | ||
| 		PrintAndLog("               s         selected tag");
 | ||
| 		PrintAndLog("               u         unaddressed mode");
 | ||
| 		PrintAndLog("               *         scan for tag");
 | ||
| 		PrintAndLog("           start#:       page number to start 0-255");  
 | ||
| 		PrintAndLog("           count#:       number of pages");  
 | ||
| 		return 0;
 | ||
| 	}	
 | ||
| 	
 | ||
| 	prepareHF15Cmd(&cmd, &c,(uint8_t[]){ISO15_CMD_READMULTI},1);	
 | ||
| 	reqlen=c.arg[0];
 | ||
| 
 | ||
| 	pagenum=strtol(cmd,NULL,0);
 | ||
| 
 | ||
| 	// skip to next space		
 | ||
| 	while (*cmd!=' ' && *cmd!='\t') cmd++;
 | ||
| 	// skip over the space
 | ||
| 	while (*cmd==' ' || *cmd=='\t') cmd++;
 | ||
| 
 | ||
| 	pagecount=strtol(cmd,NULL,0);
 | ||
| 	if (pagecount>0) pagecount--; // 0 means 1 page, 1 means 2 pages, ...	
 | ||
| 	
 | ||
| 	req[reqlen++]=(uint8_t)pagenum;
 | ||
| 	req[reqlen++]=(uint8_t)pagecount;
 | ||
| 	
 | ||
| 	reqlen=AddCrc(req,reqlen);
 | ||
| 	
 | ||
| 	c.arg[0]=reqlen;
 | ||
| 
 | ||
| 	SendCommand(&c);
 | ||
| 
 | ||
| 	if (WaitForResponseTimeout(CMD_ACK,&resp,1000) && resp.arg[0]>2) {
 | ||
| 		recv = resp.d.asBytes;
 | ||
| 		if (ISO15_CRC_CHECK==Crc(recv,resp.arg[0])) {
 | ||
| 			if (!(recv[0] & ISO15_RES_ERROR)) {
 | ||
| 				*output=0; // reset outputstring
 | ||
| 				for ( int i=1; i<resp.arg[0]-2; i++) {
 | ||
| 					sprintf(output+strlen(output),"%02X ",recv[i]);
 | ||
| 				}					
 | ||
| 				strcat(output,"   ");
 | ||
| 				for ( int i=1; i<resp.arg[0]-2; i++) {
 | ||
| 					sprintf(output+strlen(output),"%c",recv[i]>31 && recv[i]<127?recv[i]:'.');					
 | ||
| 				}					
 | ||
| 				PrintAndLog("%s",output);	
 | ||
| 			} else {
 | ||
| 				PrintAndLog("Tag returned Error %i: %s",recv[0],TagErrorStr(recv[0])); 
 | ||
| 			}		   
 | ||
| 		} else {
 | ||
| 			PrintAndLog("CRC failed");
 | ||
| 		}
 | ||
| 	} else {
 | ||
| 		PrintAndLog("no answer");
 | ||
| 	}
 | ||
| 	
 | ||
| 	return 0;
 | ||
| }
 | ||
| 
 | ||
| /**
 | ||
|  * Commandline handling: HF15 CMD READ
 | ||
|  * Reads a single Block
 | ||
|  */
 | ||
| int CmdHF15CmdRead(const char *Cmd) {
 | ||
| 	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;
 | ||
| 	char cmdbuf[100];
 | ||
| 	char *cmd=cmdbuf;
 | ||
| 	char output[100]="";
 | ||
| 	
 | ||
| 	strncpy(cmd,Cmd,99);
 | ||
| 
 | ||
| 	// usage:
 | ||
| 	if (strlen(cmd)<3) {
 | ||
| 		PrintAndLog("Usage:  hf 15 cmd read    [options] <uid|s|u|*> <page#>");
 | ||
| 		PrintAndLog("           options:");
 | ||
| 		PrintAndLog("               -2        use slower '1 out of 256' mode");
 | ||
| 		PrintAndLog("           uid (either): ");
 | ||
| 		PrintAndLog("               <8B hex>  full UID eg E011223344556677");
 | ||
| 		PrintAndLog("               s         selected tag");
 | ||
| 		PrintAndLog("               u         unaddressed mode");
 | ||
| 		PrintAndLog("               *         scan for tag");
 | ||
| 		PrintAndLog("           page#:        page number 0-255");  
 | ||
| 		return 0;
 | ||
| 	}	
 | ||
| 	
 | ||
| 	prepareHF15Cmd(&cmd, &c,(uint8_t[]){ISO15_CMD_READ},1);	
 | ||
| 	reqlen=c.arg[0];
 | ||
| 
 | ||
| 	pagenum=strtol(cmd,NULL,0);
 | ||
| 	/*if (pagenum<0) {
 | ||
| 		PrintAndLog("invalid pagenum");
 | ||
| 		return 0;
 | ||
| 	}	*/
 | ||
| 	
 | ||
| 	req[reqlen++]=(uint8_t)pagenum;
 | ||
| 	
 | ||
| 	reqlen=AddCrc(req,reqlen);
 | ||
| 	
 | ||
| 	c.arg[0]=reqlen;
 | ||
| 
 | ||
| 	SendCommand(&c);
 | ||
| 
 | ||
| 	if (WaitForResponseTimeout(CMD_ACK,&resp,1000) && resp.arg[0]>2) {
 | ||
| 		recv = resp.d.asBytes;
 | ||
| 		if (ISO15_CRC_CHECK==Crc(recv,resp.arg[0])) {
 | ||
| 			if (!(recv[0] & ISO15_RES_ERROR)) {
 | ||
| 				*output=0; // reset outputstring
 | ||
| 				//sprintf(output, "Block %2i   ",blocknum);
 | ||
| 				for ( int i=1; i<resp.arg[0]-2; i++) {
 | ||
| 					sprintf(output+strlen(output),"%02X ",recv[i]);
 | ||
| 				}					
 | ||
| 				strcat(output,"   ");
 | ||
| 				for ( int i=1; i<resp.arg[0]-2; i++) {
 | ||
| 					sprintf(output+strlen(output),"%c",recv[i]>31 && recv[i]<127?recv[i]:'.');					
 | ||
| 				}					
 | ||
| 				PrintAndLog("%s",output);	
 | ||
| 			} else {
 | ||
| 				PrintAndLog("Tag returned Error %i: %s",recv[1],TagErrorStr(recv[1])); 
 | ||
| 			}		   
 | ||
| 		} else {
 | ||
| 			PrintAndLog("CRC failed");
 | ||
| 		}
 | ||
| 	} else {
 | ||
| 		PrintAndLog("no answer");
 | ||
| 	}
 | ||
| 	
 | ||
| 	return 0;
 | ||
| }
 | ||
| 
 | ||
| 
 | ||
| /**
 | ||
|  * Commandline handling: HF15 CMD WRITE
 | ||
|  * Writes a single Block - might run into timeout, even when successful
 | ||
|  */
 | ||
| int CmdHF15CmdWrite(const char *Cmd) {
 | ||
| 	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);
 | ||
| 
 | ||
| 	// usage:
 | ||
| 	if (strlen(cmd)<3) {
 | ||
| 		PrintAndLog("Usage:  hf 15 cmd write    [options] <uid|s|u|*> <page#> <hexdata>");
 | ||
| 		PrintAndLog("           options:");
 | ||
| 		PrintAndLog("               -2        use slower '1 out of 256' mode");
 | ||
| 		PrintAndLog("               -o        set OPTION Flag (needed for TI)");
 | ||
| 		PrintAndLog("           uid (either): ");
 | ||
| 		PrintAndLog("               <8B hex>  full UID eg E011223344556677");
 | ||
| 		PrintAndLog("               s         selected tag");
 | ||
| 		PrintAndLog("               u         unaddressed mode");
 | ||
| 		PrintAndLog("               *         scan for tag");
 | ||
| 		PrintAndLog("           page#:        page number 0-255");  
 | ||
| 		PrintAndLog("           hexdata:      data to be written eg AA BB CC DD");  
 | ||
| 		return 0;
 | ||
| 	}	
 | ||
| 	
 | ||
| 	prepareHF15Cmd(&cmd, &c,(uint8_t[]){ISO15_CMD_WRITE},1);	
 | ||
| 	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);
 | ||
| 	/*if (pagenum<0) {
 | ||
| 		PrintAndLog("invalid pagenum");
 | ||
| 		return 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;
 | ||
| 	} 
 | ||
| 	
 | ||
| 	reqlen=AddCrc(req,reqlen);
 | ||
| 	
 | ||
| 	c.arg[0]=reqlen;
 | ||
| 
 | ||
| 	SendCommand(&c);
 | ||
| 
 | ||
| 	if (WaitForResponseTimeout(CMD_ACK,&resp,2000) && resp.arg[0]>2) {
 | ||
| 		recv = resp.d.asBytes;
 | ||
| 		if (ISO15_CRC_CHECK==Crc(recv,resp.arg[0])) {
 | ||
| 			if (!(recv[0] & ISO15_RES_ERROR)) {					
 | ||
| 				PrintAndLog("OK");	
 | ||
| 			} else {
 | ||
| 				PrintAndLog("Tag returned Error %i: %s",recv[1],TagErrorStr(recv[1])); 
 | ||
| 			}		   
 | ||
| 		} else {
 | ||
| 			PrintAndLog("CRC failed");
 | ||
| 		}
 | ||
| 	} else {
 | ||
| 		PrintAndLog("timeout: no answer - data may be written anyway");
 | ||
| 	}
 | ||
| 	
 | ||
| 	return 0;
 | ||
| }
 | ||
| 
 | ||
| 
 | ||
| 
 | ||
| static command_t CommandTable15Cmd[] =
 | ||
| {
 | ||
| 	{"help",    CmdHF15CmdHelp,    1, "This Help"},
 | ||
|  	{"inquiry", CmdHF15CmdInquiry, 0, "Search for tags in range"},
 | ||
|  /*	
 | ||
| 	{"select",  CmdHF15CmdSelect, 0, "Select an tag with a specific UID for further commands"},
 | ||
|  */
 | ||
| 	{"read",    CmdHF15CmdRead,    0, "Read a block"},	
 | ||
| 	{"write",   CmdHF15CmdWrite,    0, "Write a block"},	
 | ||
| 	{"readmulti",CmdHF15CmdReadmulti,    0, "Reads multiple Blocks"},
 | ||
| 	{"sysinfo",CmdHF15CmdSysinfo,    0, "Get Card Information"},
 | ||
| 	{"raw",		 CmdHF15CmdRaw,		0,	"Send raw hex data to tag"}, 
 | ||
| 	{"debug",    CmdHF15CmdDebug,    0, "Turn debugging on/off"},
 | ||
| 	{NULL, NULL, 0, NULL}
 | ||
| };
 | ||
| 
 | ||
| int CmdHF15Cmd(const char *Cmd)
 | ||
| {
 | ||
| 	CmdsParse(CommandTable15Cmd, Cmd);
 | ||
| 	return 0;
 | ||
| }
 | ||
| 	
 | ||
| int CmdHF15CmdHelp(const char *Cmd)
 | ||
| {
 | ||
| 	CmdsHelp(CommandTable15Cmd);
 | ||
| 	return 0;
 | ||
| }
 | ||
| 
 |