[proxmark3-svn] / client / cmdhf14b.c

//-----------------------------------------------------------------------------
// Copyright (C) 2010 iZsh <izsh at fail0verflow.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.
//-----------------------------------------------------------------------------
// High frequency ISO14443B commands
//-----------------------------------------------------------------------------

#include <stdio.h>
#include <stdlib.h>
#include <stdbool.h>
#include <string.h>
#include <stdint.h>
#include "iso14443crc.h"
#include "proxmark3.h"
#include "data.h"
#include "graph.h"
#include "util.h"
#include "ui.h"
#include "cmdparser.h"
#include "cmdhf14b.h"
#include "cmdmain.h"
#include "cmdhf14a.h"
//#include "sleep.h"
#include "cmddata.h"

static int CmdHelp(const char *Cmd);

int CmdHF14BDemod(const char *Cmd)
{
  int i, j, iold;
  int isum, qsum;
  int outOfWeakAt;
  bool negateI, negateQ;

  uint8_t data[256];
  int dataLen = 0;

  // As received, the samples are pairs, correlations against I and Q
  // square waves. So estimate angle of initial carrier (or just
  // quadrant, actually), and then do the demod.

  // First, estimate where the tag starts modulating.
  for (i = 0; i < GraphTraceLen; i += 2) {
    if (abs(GraphBuffer[i]) + abs(GraphBuffer[i + 1]) > 40) {
      break;
    }
  }
  if (i >= GraphTraceLen) {
    PrintAndLog("too weak to sync");
    return 0;
  }
  PrintAndLog("out of weak at %d", i);
  outOfWeakAt = i;

  // Now, estimate the phase in the initial modulation of the tag
  isum = 0;
  qsum = 0;
  for (; i < (outOfWeakAt + 16); i += 2) {
    isum += GraphBuffer[i + 0];
    qsum += GraphBuffer[i + 1];
  }
  negateI = (isum < 0);
  negateQ = (qsum < 0);

  // Turn the correlation pairs into soft decisions on the bit.
  j = 0;
  for (i = 0; i < GraphTraceLen / 2; i++) {
    int si = GraphBuffer[j];
    int sq = GraphBuffer[j + 1];
    if (negateI) si = -si;
    if (negateQ) sq = -sq;
    GraphBuffer[i] = si + sq;
    j += 2;
  }
  GraphTraceLen = i;

  i = outOfWeakAt / 2;
  while (GraphBuffer[i] > 0 && i < GraphTraceLen)
    i++;
  if (i >= GraphTraceLen) goto demodError;

  iold = i;
  while (GraphBuffer[i] < 0 && i < GraphTraceLen)
    i++;
  if (i >= GraphTraceLen) goto demodError;
  if ((i - iold) > 23) goto demodError;

  PrintAndLog("make it to demod loop");

  for (;;) {
    iold = i;
    while (GraphBuffer[i] >= 0 && i < GraphTraceLen)
      i++;
    if (i >= GraphTraceLen) goto demodError;
    if ((i - iold) > 6) goto demodError;

    uint16_t shiftReg = 0;
    if (i + 20 >= GraphTraceLen) goto demodError;

    for (j = 0; j < 10; j++) {
      int soft = GraphBuffer[i] + GraphBuffer[i + 1];

      if (abs(soft) < (abs(isum) + abs(qsum)) / 20) {
        PrintAndLog("weak bit");
      }

      shiftReg >>= 1;
      if(GraphBuffer[i] + GraphBuffer[i+1] >= 0) {
        shiftReg |= 0x200;
      }

      i+= 2;
    }

    if ((shiftReg & 0x200) && !(shiftReg & 0x001))
    {
      // valid data byte, start and stop bits okay
      PrintAndLog("   %02x", (shiftReg >> 1) & 0xff);
      data[dataLen++] = (shiftReg >> 1) & 0xff;
      if (dataLen >= sizeof(data)) {
        return 0;
      }
    } else if (shiftReg == 0x000) {
      // this is EOF
      break;
    } else {
      goto demodError;
    }
  }

  uint8_t first, second;
  ComputeCrc14443(CRC_14443_B, data, dataLen-2, &first, &second);
  PrintAndLog("CRC: %02x %02x (%s)\n", first, second,
    (first == data[dataLen-2] && second == data[dataLen-1]) ?
      "ok" : "****FAIL****");

  RepaintGraphWindow();
  return 0;

demodError:
  PrintAndLog("demod error");
  RepaintGraphWindow();
  return 0;
}

int CmdHF14BList(const char *Cmd)
{
	PrintAndLog("Deprecated command, use 'hf list 14b' instead");

	return 0;
}

int CmdHF14Sim(const char *Cmd)
{
  UsbCommand c={CMD_SIMULATE_TAG_ISO_14443};
	clearCommandBuffer();
  SendCommand(&c);
  return 0;
}

int CmdHFSimlisten(const char *Cmd)
{
  UsbCommand c = {CMD_SIMULATE_TAG_HF_LISTEN};
	clearCommandBuffer();
  SendCommand(&c);
  return 0;
}

int CmdHF14BSnoop(const char *Cmd)
{
  UsbCommand c = {CMD_SNOOP_ISO_14443};
	clearCommandBuffer();
  SendCommand(&c);
  return 0;
}

/* New command to read the contents of a SRI512 tag
 * SRI512 tags are ISO14443-B modulated memory tags,
 * this command just dumps the contents of the memory
 */
int CmdSri512Read(const char *Cmd)
{
  UsbCommand c = {CMD_READ_SRI512_TAG, {strtol(Cmd, NULL, 0), 0, 0}};
	clearCommandBuffer();
  SendCommand(&c);
  return 0;
}

/* New command to read the contents of a SRIX4K tag
 * SRIX4K tags are ISO14443-B modulated memory tags,
 * this command just dumps the contents of the memory/
 */
int CmdSrix4kRead(const char *Cmd)
{
  UsbCommand c = {CMD_READ_SRIX4K_TAG, {strtol(Cmd, NULL, 0), 0, 0}};
	clearCommandBuffer();
  SendCommand(&c);
  return 0;
}

int rawClose(void){
    UsbCommand resp;
	UsbCommand c = {CMD_ISO_14443B_COMMAND, {0, 0, 0}};
	clearCommandBuffer();
	SendCommand(&c);
	if (!WaitForResponseTimeout(CMD_ACK,&resp,1000)) {
		return 0;
	}
	return 0;	
}

int HF14BCmdRaw(bool reply, bool *crc, uint8_t power_trace, uint8_t *data, uint8_t *datalen, bool verbose){
	UsbCommand resp;
	UsbCommand c = {CMD_ISO_14443B_COMMAND, {0, 0, 0}}; // len,recv,power/trace
  if(*crc)
  {
    uint8_t first, second;
    ComputeCrc14443(CRC_14443_B, data, *datalen, &first, &second);
    data[*datalen] = first;
    data[*datalen + 1] = second;
    *datalen += 2;
  }
  
  c.arg[0] = *datalen;
  c.arg[1] = reply;
	c.arg[2] = power_trace;
  memcpy(c.d.asBytes,data,*datalen);
	clearCommandBuffer();
  SendCommand(&c);
  
  if (!reply) return 1; 

  if (!WaitForResponseTimeout(CMD_ACK,&resp,1000)) {
    if (verbose) PrintAndLog("timeout while waiting for reply.");
    return 0;
  }
  *datalen = resp.arg[0];
	if (verbose) PrintAndLog("received %u octets", *datalen);
	if(*datalen<2) return 0;

  memcpy(data, resp.d.asBytes, *datalen);
  if (verbose) PrintAndLog("%s", sprint_hex(data, *datalen));

  uint8_t first, second;
  ComputeCrc14443(CRC_14443_B, data, *datalen-2, &first, &second);
  if(data[*datalen-2] == first && data[*datalen-1] == second) {
    if (verbose) PrintAndLog("CRC OK");
    *crc = true;
  } else {
    if (verbose) PrintAndLog("CRC failed");
    *crc = false;
  }
  return 1;
}

int CmdHF14BCmdRaw (const char *Cmd) {
    bool reply = true;
    bool crc = false;
	uint8_t power_trace = 0;
    char buf[5]="";
    uint8_t data[100] = {0x00};
    uint8_t datalen = 0;
    unsigned int temp;
    int i = 0;
    if (strlen(Cmd)<3) {
        PrintAndLog("Usage: hf 14b raw [-r] [-c] [-p] <0A 0B 0C ... hex>");
        PrintAndLog("       -r    do not read response");
        PrintAndLog("       -c    calculate and append CRC");
        PrintAndLog("       -p    leave the field on after receive");
        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 = false;
                    break;
                case 'c':
                case 'C':                
                    crc = true;
                    break;
                case 'p': 
                case 'P': 
					power_trace |= 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);
                *buf=0;
            }
            continue;
        }
        PrintAndLog("Invalid char on input");
        return 1;
    }
    if (datalen == 0)
    {
      PrintAndLog("Missing data input");
      return 0;
    }

	return HF14BCmdRaw(reply, &crc, power_trace, data, &datalen, true);
}

static void print_atqb_resp(uint8_t *data){
  PrintAndLog ("           UID: %s", sprint_hex(data+1,4));
  PrintAndLog ("      App Data: %s", sprint_hex(data+5,4));
  PrintAndLog ("      Protocol: %s", sprint_hex(data+9,3));
  uint8_t BitRate = data[9];
  if (!BitRate) 
    PrintAndLog ("      Bit Rate: 106 kbit/s only PICC <-> PCD");
  if (BitRate & 0x10)
    PrintAndLog ("      Bit Rate: 212 kbit/s PICC -> PCD supported");
  if (BitRate & 0x20)
    PrintAndLog ("      Bit Rate: 424 kbit/s PICC -> PCD supported"); 
  if (BitRate & 0x40)
    PrintAndLog ("      Bit Rate: 847 kbit/s PICC -> PCD supported"); 
  if (BitRate & 0x01)
    PrintAndLog ("      Bit Rate: 212 kbit/s PICC <- PCD supported");
  if (BitRate & 0x02)
    PrintAndLog ("      Bit Rate: 424 kbit/s PICC <- PCD supported"); 
  if (BitRate & 0x04)
    PrintAndLog ("      Bit Rate: 847 kbit/s PICC <- PCD supported"); 
  if (BitRate & 0x80) 
    PrintAndLog ("                Same bit rate <-> required");

  uint16_t maxFrame = data[10]>>4;
  if (maxFrame < 5) 
    maxFrame = 8*maxFrame + 16;
  else if (maxFrame == 5)
    maxFrame = 64;
  else if (maxFrame == 6)
    maxFrame = 96;
  else if (maxFrame == 7)
    maxFrame = 128;
  else if (maxFrame == 8)
    maxFrame = 256;
  else
    maxFrame = 257;

  PrintAndLog ("Max Frame Size: %d%s",maxFrame, (maxFrame == 257) ? "+ RFU" : "");

  uint8_t protocolT = data[10] & 0xF;
  PrintAndLog (" Protocol Type: Protocol is %scompliant with ISO/IEC 14443-4",(protocolT) ? "" : "not " );
  PrintAndLog ("Frame Wait Int: %d", data[11]>>4);
  PrintAndLog (" App Data Code: Application is %s",(data[11]&4) ? "Standard" : "Proprietary");
  PrintAndLog (" Frame Options: NAD is %ssupported",(data[11]&2) ? "" : "not ");
  PrintAndLog (" Frame Options: CID is %ssupported",(data[11]&1) ? "" : "not ");
  
  return;
}

char *get_ST_Chip_Model(uint8_t data){
	static char model[20];
	char *retStr = model;
	memset(model,0, sizeof(model));

	switch (data) {
		case 0x0: sprintf(retStr, "SRIX4K (Special)"); break;
		case 0x2: sprintf(retStr, "SR176"); break;
		case 0x3: sprintf(retStr, "SRIX4K"); break;
		case 0x4: sprintf(retStr, "SRIX512"); break;
		case 0x6: sprintf(retStr, "SRI512"); break;
		case 0x7: sprintf(retStr, "SRI4K"); break;
		case 0xC: sprintf(retStr, "SRT512"); break;
		default: sprintf(retStr, "Unknown"); break;
	}
	return retStr;
}

static void print_st_info(uint8_t *data){
	//uid = first 8 bytes in data
	PrintAndLog(" UID: %s", sprint_hex(data,8));
	PrintAndLog(" MFG: %02X, %s", data[1], getTagInfo(data[1]));
	PrintAndLog("Chip: %02X, %s", data[2]>>2, get_ST_Chip_Model(data[2]>>2));
	return;
}

int HF14BStdRead(uint8_t *data, uint8_t *datalen){
  bool crc = true;
  *datalen = 3;
  //std read cmd
  data[0] = 0x05;
  data[1] = 0x00;
  data[2] = 0x08;

	if (HF14BCmdRaw(true, &crc, 0, data, datalen, false)==0) return 0;

	if (data[0] != 0x50  || *datalen != 14 || !crc) return 0;

  PrintAndLog ("\n14443-3b tag found:");
  print_atqb_resp(data);

  return 1;
}

int HF14B_ST_Read(uint8_t *data, uint8_t *datalen){
  bool crc = true;
  *datalen = 2;
	//wake cmd
  data[0] = 0x06;
  data[1] = 0x00;

	//leave power on
	// verbose on for now for testing - turn off when functional
	if (HF14BCmdRaw(true, &crc, 1, data, datalen, true)==0) return rawClose();

	if (*datalen != 3 || !crc) return rawClose();

  uint8_t chipID = data[0];
	// select
  data[0] = 0x0E;
  data[1] = chipID;
  *datalen = 2;

	//leave power on
	// verbose on for now for testing - turn off when functional
	if (HF14BCmdRaw(true, &crc, 1, data, datalen, true)==0) return rawClose();

	if (*datalen != 3 || !crc || data[0] != chipID) return rawClose();

	// get uid
  data[0] = 0x0B;
  *datalen = 1;

	//power off
	// verbose on for now for testing - turn off when functional
	if (HF14BCmdRaw(true, &crc, 1, data, datalen, true)==0) return 0;
	rawClose();
	if (*datalen != 10 || !crc) return 0;

	PrintAndLog("\n14443-3b ST tag found:");
	print_st_info(data);
  return 1;
}

int HF14BReader(bool verbose){
  uint8_t data[100];
  uint8_t datalen = 5;
  
  // try std 14b (atqb)
	if (HF14BStdRead(data, &datalen)) return 1;

  // try st 14b
	if (HF14B_ST_Read(data, &datalen)) return 1;

	if (verbose) PrintAndLog("no 14443B tag found");
	return 0;
}

int CmdHF14BReader(const char *Cmd){
	return HF14BReader(true);
}

int CmdHFRawSamples(const char *Cmd){
	UsbCommand resp;
	UsbCommand c = {CMD_ACQUIRE_RAW_ADC_SAMPLES_ISO_14443, {strtol(Cmd,NULL,0), 0, 0}};
	SendCommand(&c);

	if (!WaitForResponseTimeout(CMD_ACK,&resp,1000)) {
		PrintAndLog("timeout while waiting for reply.");
		return 0;
	}
	getSamples("39999", true);
	return 1;
}

int CmdHF14BWrite( const char *Cmd){
/*
 * For SRIX4K  blocks 00 - 7F
 * hf 14b raw -c -p 09 $srix4kwblock $srix4kwdata
 *
 * For SR512  blocks 00 - 0F
 * hf 14b raw -c -p 09 $sr512wblock $sr512wdata
 * 
 * Special block FF =  otp_lock_reg block.
 * Data len 4 bytes-
 */
 	char cmdp = param_getchar(Cmd, 0);
	uint8_t blockno = -1;
	uint8_t data[4] = {0x00};
	bool isSrix4k = true;
	char str[20];	

	if (strlen(Cmd) < 1 || cmdp == 'h' || cmdp == 'H') {
		PrintAndLog("Usage:  hf 14b write <1|2> <BLOCK> <DATA>");
		PrintAndLog("    [1 = SRIX4K]");
		PrintAndLog("    [2 = SRI512]");
		PrintAndLog("    [BLOCK number depends on tag, special block == FF]");
		PrintAndLog("     sample: hf 14b write 1 7F 11223344");
		PrintAndLog("           : hf 14b write 1 FF 11223344");
		PrintAndLog("           : hf 14b write 2 15 11223344");
		PrintAndLog("           : hf 14b write 2 FF 11223344");
		return 0;
	}

	if ( cmdp == '2' )
		isSrix4k = false;
	
	//blockno = param_get8(Cmd, 1);
	
	if ( param_gethex(Cmd,1, &blockno, 2) ) {
		PrintAndLog("Block number must include 2 HEX symbols");
		return 0;
	}
	
	if ( isSrix4k ){
		if ( blockno > 0x7f && blockno != 0xff ){
			PrintAndLog("Block number out of range");
			return 0;
		}		
	} else {
		if ( blockno > 0x0f && blockno != 0xff ){
			PrintAndLog("Block number out of range");
			return 0;
		}		
	}
	
	if (param_gethex(Cmd, 2, data, 8)) {
		PrintAndLog("Data must include 8 HEX symbols");
		return 0;
	}
 
	if ( blockno == 0xff)
		PrintAndLog("[%s] Write special block %02X [ %s ]", (isSrix4k)?"SRIX4K":"SRI512" , blockno,  sprint_hex(data,4) );
	else
		PrintAndLog("[%s] Write block %02X [ %s ]", (isSrix4k)?"SRIX4K":"SRI512", blockno,  sprint_hex(data,4) );
 
	sprintf(str, "-c 09 %02x %02x%02x%02x%02x", blockno, data[0], data[1], data[2], data[3]);

	CmdHF14BCmdRaw(str);
	return 0;
}

static command_t CommandTable[] = 
{
  {"help",        CmdHelp,        1, "This help"},
  {"demod",       CmdHF14BDemod,  1, "Demodulate ISO14443 Type B from tag"},
	{"getsamples",  CmdHFRawSamples,0, "[atqb=0 or ST=1] Send wake cmd and Get raw HF samples to GraphBuffer"},
  {"list",        CmdHF14BList,   0, "[Deprecated] List ISO 14443b history"},
  {"reader",      CmdHF14BReader, 0, "Find 14b tag (HF ISO 14443b)"},
  {"sim",         CmdHF14Sim,     0, "Fake ISO 14443 tag"},
  {"simlisten",   CmdHFSimlisten, 0, "Get HF samples as fake tag"},
  {"snoop",       CmdHF14BSnoop,  0, "Eavesdrop ISO 14443"},
  {"sri512read",  CmdSri512Read,  0, "Read contents of a SRI512 tag"},
  {"srix4kread",  CmdSrix4kRead,  0, "Read contents of a SRIX4K tag"},
  {"raw",         CmdHF14BCmdRaw, 0, "Send raw hex data to tag"},
  {"write",       CmdHF14BWrite,  0, "Write data to a SRI512 | SRIX4K tag"},
  {NULL, NULL, 0, NULL}
};

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

int CmdHelp(const char *Cmd)
{
  CmdsHelp(CommandTable);
  return 0;
}
Commit	Line	Data
a553f267	1	//-----------------------------------------------------------------------------
	2	// Copyright (C) 2010 iZsh <izsh at fail0verflow.com>
	3	//
	4	// This code is licensed to you under the terms of the GNU GPL, version 2 or,
	5	// at your option, any later version. See the LICENSE.txt file for the text of
	6	// the license.
	7	//-----------------------------------------------------------------------------
	8	// High frequency ISO14443B commands
	9	//-----------------------------------------------------------------------------
	10
7fe9b0b7	11	#include <stdio.h>
	12	#include <stdlib.h>
	13	#include <stdbool.h>
	14	#include <string.h>
	15	#include <stdint.h>
	16	#include "iso14443crc.h"
902cb3c0	17	#include "proxmark3.h"
7fe9b0b7	18	#include "data.h"
7fe9b0b7	19	#include "graph.h"
3fe4ff4f	20	#include "util.h"
7fe9b0b7	21	#include "ui.h"
	22	#include "cmdparser.h"
	23	#include "cmdhf14b.h"
7cf3ef20	24	#include "cmdmain.h"
d71d59db	25	#include "cmdhf14a.h"
abb21530	26	//#include "sleep.h"
abb21530	27	#include "cmddata.h"
7fe9b0b7	28
	29	static int CmdHelp(const char *Cmd);
	30
	31	int CmdHF14BDemod(const char *Cmd)
	32	{
	33	int i, j, iold;
	34	int isum, qsum;
	35	int outOfWeakAt;
	36	bool negateI, negateQ;
	37
	38	uint8_t data[256];
	39	int dataLen = 0;
	40
	41	// As received, the samples are pairs, correlations against I and Q
	42	// square waves. So estimate angle of initial carrier (or just
	43	// quadrant, actually), and then do the demod.
	44
	45	// First, estimate where the tag starts modulating.
	46	for (i = 0; i < GraphTraceLen; i += 2) {
	47	if (abs(GraphBuffer[i]) + abs(GraphBuffer[i + 1]) > 40) {
	48	break;
	49	}
	50	}
	51	if (i >= GraphTraceLen) {
	52	PrintAndLog("too weak to sync");
	53	return 0;
	54	}
	55	PrintAndLog("out of weak at %d", i);
	56	outOfWeakAt = i;
	57
	58	// Now, estimate the phase in the initial modulation of the tag
	59	isum = 0;
	60	qsum = 0;
	61	for (; i < (outOfWeakAt + 16); i += 2) {
	62	isum += GraphBuffer[i + 0];
	63	qsum += GraphBuffer[i + 1];
	64	}
	65	negateI = (isum < 0);
	66	negateQ = (qsum < 0);
	67
	68	// Turn the correlation pairs into soft decisions on the bit.
	69	j = 0;
	70	for (i = 0; i < GraphTraceLen / 2; i++) {
	71	int si = GraphBuffer[j];
	72	int sq = GraphBuffer[j + 1];
	73	if (negateI) si = -si;
	74	if (negateQ) sq = -sq;
	75	GraphBuffer[i] = si + sq;
	76	j += 2;
	77	}
	78	GraphTraceLen = i;
	79
	80	i = outOfWeakAt / 2;
	81	while (GraphBuffer[i] > 0 && i < GraphTraceLen)
	82	i++;
	83	if (i >= GraphTraceLen) goto demodError;
	84
	85	iold = i;
	86	while (GraphBuffer[i] < 0 && i < GraphTraceLen)
	87	i++;
	88	if (i >= GraphTraceLen) goto demodError;
	89	if ((i - iold) > 23) goto demodError;
	90
	91	PrintAndLog("make it to demod loop");
92
93	for (;;) {
94	iold = i;
95	while (GraphBuffer[i] >= 0 && i < GraphTraceLen)
96	i++;
97	if (i >= GraphTraceLen) goto demodError;
98	if ((i - iold) > 6) goto demodError;
99
100	uint16_t shiftReg = 0;
101	if (i + 20 >= GraphTraceLen) goto demodError;
102
103	for (j = 0; j < 10; j++) {
104	int soft = GraphBuffer[i] + GraphBuffer[i + 1];
105
106	if (abs(soft) < (abs(isum) + abs(qsum)) / 20) {
107	PrintAndLog("weak bit");
108	}
109
110	shiftReg >>= 1;
111	if(GraphBuffer[i] + GraphBuffer[i+1] >= 0) {
112	shiftReg \|= 0x200;
113	}
114
115	i+= 2;
116	}
117
118	if ((shiftReg & 0x200) && !(shiftReg & 0x001))
119	{
120	// valid data byte, start and stop bits okay
121	PrintAndLog(" %02x", (shiftReg >> 1) & 0xff);
122	data[dataLen++] = (shiftReg >> 1) & 0xff;
123	if (dataLen >= sizeof(data)) {
124	return 0;
125	}
126	} else if (shiftReg == 0x000) {
127	// this is EOF
128	break;
129	} else {
130	goto demodError;
131	}
132	}
133
134	uint8_t first, second;
135	ComputeCrc14443(CRC_14443_B, data, dataLen-2, &first, &second);
136	PrintAndLog("CRC: %02x %02x (%s)\n", first, second,
137	(first == data[dataLen-2] && second == data[dataLen-1]) ?
138	"ok" : "**FAIL**");
139
140	RepaintGraphWindow();
141	return 0;
142
143	demodError:
144	PrintAndLog("demod error");
145	RepaintGraphWindow();
146	return 0;
147	}
148
149	int CmdHF14BList(const char *Cmd)
150	{
388c92bd	151	PrintAndLog("Deprecated command, use 'hf list 14b' instead");
7fe9b0b7	152
388c92bd	153	return 0;
7fe9b0b7	154	}
7fe9b0b7	155
	156	int CmdHF14Sim(const char *Cmd)
	157	{
	158	UsbCommand c={CMD_SIMULATE_TAG_ISO_14443};
abb21530	159	clearCommandBuffer();
7fe9b0b7	160	SendCommand(&c);
	161	return 0;
	162	}
	163
	164	int CmdHFSimlisten(const char *Cmd)
	165	{
	166	UsbCommand c = {CMD_SIMULATE_TAG_HF_LISTEN};
abb21530	167	clearCommandBuffer();
7fe9b0b7	168	SendCommand(&c);
	169	return 0;
	170	}
	171
	172	int CmdHF14BSnoop(const char *Cmd)
	173	{
	174	UsbCommand c = {CMD_SNOOP_ISO_14443};
abb21530	175	clearCommandBuffer();
7fe9b0b7	176	SendCommand(&c);
	177	return 0;
	178	}
	179
	180	/* New command to read the contents of a SRI512 tag
	181	* SRI512 tags are ISO14443-B modulated memory tags,
	182	* this command just dumps the contents of the memory
	183	*/
	184	int CmdSri512Read(const char *Cmd)
	185	{
	186	UsbCommand c = {CMD_READ_SRI512_TAG, {strtol(Cmd, NULL, 0), 0, 0}};
abb21530	187	clearCommandBuffer();
7fe9b0b7	188	SendCommand(&c);
	189	return 0;
	190	}
	191
	192	/* New command to read the contents of a SRIX4K tag
	193	* SRIX4K tags are ISO14443-B modulated memory tags,
	194	* this command just dumps the contents of the memory/
	195	*/
	196	int CmdSrix4kRead(const char *Cmd)
	197	{
	198	UsbCommand c = {CMD_READ_SRIX4K_TAG, {strtol(Cmd, NULL, 0), 0, 0}};
abb21530	199	clearCommandBuffer();
7fe9b0b7	200	SendCommand(&c);
	201	return 0;
	202	}
	203
d71d59db	204	int rawClose(void){
7cf3ef20	205	UsbCommand resp;
d71d59db	206	UsbCommand c = {CMD_ISO_14443B_COMMAND, {0, 0, 0}};
abb21530	207	clearCommandBuffer();
d71d59db	208	SendCommand(&c);
	209	if (!WaitForResponseTimeout(CMD_ACK,&resp,1000)) {
	210	return 0;
	211	}
	212	return 0;
	213	}
	214
	215	int HF14BCmdRaw(bool reply, bool crc, uint8_t power_trace, uint8_t data, uint8_t *datalen, bool verbose){
	216	UsbCommand resp;
abb21530	217	UsbCommand c = {CMD_ISO_14443B_COMMAND, {0, 0, 0}}; // len,recv,power/trace
1299c798	218	if(*crc)
	219	{
	220	uint8_t first, second;
	221	ComputeCrc14443(CRC_14443_B, data, *datalen, &first, &second);
	222	data[*datalen] = first;
	223	data[*datalen + 1] = second;
	224	*datalen += 2;
	225	}
	226
	227	c.arg[0] = *datalen;
	228	c.arg[1] = reply;
d71d59db	229	c.arg[2] = power_trace;
1299c798	230	memcpy(c.d.asBytes,data,*datalen);
abb21530	231	clearCommandBuffer();
1299c798	232	SendCommand(&c);
	233
	234	if (!reply) return 1;
	235
	236	if (!WaitForResponseTimeout(CMD_ACK,&resp,1000)) {
	237	if (verbose) PrintAndLog("timeout while waiting for reply.");
	238	return 0;
	239	}
	240	*datalen = resp.arg[0];
d71d59db	241	if (verbose) PrintAndLog("received %u octets", *datalen);
abb21530	242	if(*datalen<2) return 0;
1299c798	243
	244	memcpy(data, resp.d.asBytes, *datalen);
	245	if (verbose) PrintAndLog("%s", sprint_hex(data, *datalen));
	246
	247	uint8_t first, second;
	248	ComputeCrc14443(CRC_14443_B, data, *datalen-2, &first, &second);
	249	if(data[datalen-2] == first && data[datalen-1] == second) {
	250	if (verbose) PrintAndLog("CRC OK");
	251	*crc = true;
	252	} else {
	253	if (verbose) PrintAndLog("CRC failed");
	254	*crc = false;
	255	}
	256	return 1;
	257	}
	258
	259	int CmdHF14BCmdRaw (const char *Cmd) {
	260	bool reply = true;
	261	bool crc = false;
d71d59db	262	uint8_t power_trace = 0;
7cf3ef20	263	char buf[5]="";
5ee70129	264	uint8_t data[100] = {0x00};
1299c798	265	uint8_t datalen = 0;
	266	unsigned int temp;
	267	int i = 0;
	268	if (strlen(Cmd)<3) {
7cf3ef20	269	PrintAndLog("Usage: hf 14b raw [-r] [-c] [-p] <0A 0B 0C ... hex>");
	270	PrintAndLog(" -r do not read response");
	271	PrintAndLog(" -c calculate and append CRC");
	272	PrintAndLog(" -p leave the field on after receive");
	273	return 0;
	274	}
	275
	276	// strip
1299c798	277	while (Cmd==' ' \|\| Cmd=='\t') Cmd++;
7cf3ef20	278
1299c798	279	while (Cmd[i]!='\0') {
	280	if (Cmd[i]==' ' \|\| Cmd[i]=='\t') { i++; continue; }
	281	if (Cmd[i]=='-') {
	282	switch (Cmd[i+1]) {
7cf3ef20	283	case 'r':
7cf3ef20	284	case 'R':
1299c798	285	reply = false;
7cf3ef20	286	break;
	287	case 'c':
	288	case 'C':
1299c798	289	crc = true;
7cf3ef20	290	break;
	291	case 'p':
	292	case 'P':
d71d59db	293	power_trace \|= 1;
7cf3ef20	294	break;
	295	default:
	296	PrintAndLog("Invalid option");
	297	return 0;
	298	}
	299	i+=2;
	300	continue;
	301	}
1299c798	302	if ((Cmd[i]>='0' && Cmd[i]<='9') \|\|
	303	(Cmd[i]>='a' && Cmd[i]<='f') \|\|
	304	(Cmd[i]>='A' && Cmd[i]<='F') ) {
7cf3ef20	305	buf[strlen(buf)+1]=0;
1299c798	306	buf[strlen(buf)]=Cmd[i];
7cf3ef20	307	i++;
	308
	309	if (strlen(buf)>=2) {
	310	sscanf(buf,"%x",&temp);
1299c798	311	data[datalen++]=(uint8_t)(temp & 0xff);
7cf3ef20	312	*buf=0;
	313	}
	314	continue;
	315	}
	316	PrintAndLog("Invalid char on input");
5ee70129	317	return 1;
7cf3ef20	318	}
06b82e6a	319	if (datalen == 0)
	320	{
	321	PrintAndLog("Missing data input");
	322	return 0;
	323	}
1299c798	324
d71d59db	325	return HF14BCmdRaw(reply, &crc, power_trace, data, &datalen, true);
1299c798	326	}
1299c798	327
d71d59db	328	static void print_atqb_resp(uint8_t *data){
1299c798	329	PrintAndLog (" UID: %s", sprint_hex(data+1,4));
	330	PrintAndLog (" App Data: %s", sprint_hex(data+5,4));
	331	PrintAndLog (" Protocol: %s", sprint_hex(data+9,3));
	332	uint8_t BitRate = data[9];
	333	if (!BitRate)
	334	PrintAndLog (" Bit Rate: 106 kbit/s only PICC <-> PCD");
	335	if (BitRate & 0x10)
	336	PrintAndLog (" Bit Rate: 212 kbit/s PICC -> PCD supported");
	337	if (BitRate & 0x20)
	338	PrintAndLog (" Bit Rate: 424 kbit/s PICC -> PCD supported");
	339	if (BitRate & 0x40)
	340	PrintAndLog (" Bit Rate: 847 kbit/s PICC -> PCD supported");
	341	if (BitRate & 0x01)
	342	PrintAndLog (" Bit Rate: 212 kbit/s PICC <- PCD supported");
	343	if (BitRate & 0x02)
	344	PrintAndLog (" Bit Rate: 424 kbit/s PICC <- PCD supported");
	345	if (BitRate & 0x04)
	346	PrintAndLog (" Bit Rate: 847 kbit/s PICC <- PCD supported");
	347	if (BitRate & 0x80)
	348	PrintAndLog (" Same bit rate <-> required");
	349
	350	uint16_t maxFrame = data[10]>>4;
	351	if (maxFrame < 5)
	352	maxFrame = 8*maxFrame + 16;
	353	else if (maxFrame == 5)
	354	maxFrame = 64;
	355	else if (maxFrame == 6)
	356	maxFrame = 96;
	357	else if (maxFrame == 7)
	358	maxFrame = 128;
	359	else if (maxFrame == 8)
	360	maxFrame = 256;
	361	else
	362	maxFrame = 257;
	363
	364	PrintAndLog ("Max Frame Size: %d%s",maxFrame, (maxFrame == 257) ? "+ RFU" : "");
	365
	366	uint8_t protocolT = data[10] & 0xF;
	367	PrintAndLog (" Protocol Type: Protocol is %scompliant with ISO/IEC 14443-4",(protocolT) ? "" : "not " );
	368	PrintAndLog ("Frame Wait Int: %d", data[11]>>4);
	369	PrintAndLog (" App Data Code: Application is %s",(data[11]&4) ? "Standard" : "Proprietary");
	370	PrintAndLog (" Frame Options: NAD is %ssupported",(data[11]&2) ? "" : "not ");
	371	PrintAndLog (" Frame Options: CID is %ssupported",(data[11]&1) ? "" : "not ");
	372
	373	return;
	374	}
	375
d71d59db	376	char *get_ST_Chip_Model(uint8_t data){
	377	static char model[20];
	378	char *retStr = model;
	379	memset(model,0, sizeof(model));
	380
	381	switch (data) {
	382	case 0x0: sprintf(retStr, "SRIX4K (Special)"); break;
	383	case 0x2: sprintf(retStr, "SR176"); break;
	384	case 0x3: sprintf(retStr, "SRIX4K"); break;
	385	case 0x4: sprintf(retStr, "SRIX512"); break;
	386	case 0x6: sprintf(retStr, "SRI512"); break;
	387	case 0x7: sprintf(retStr, "SRI4K"); break;
	388	case 0xC: sprintf(retStr, "SRT512"); break;
	389	default: sprintf(retStr, "Unknown"); break;
	390	}
	391	return retStr;
	392	}
	393
	394	static void print_st_info(uint8_t *data){
	395	//uid = first 8 bytes in data
	396	PrintAndLog(" UID: %s", sprint_hex(data,8));
	397	PrintAndLog(" MFG: %02X, %s", data[1], getTagInfo(data[1]));
	398	PrintAndLog("Chip: %02X, %s", data[2]>>2, get_ST_Chip_Model(data[2]>>2));
	399	return;
	400	}
	401
1299c798	402	int HF14BStdRead(uint8_t data, uint8_t datalen){
	403	bool crc = true;
	404	*datalen = 3;
	405	//std read cmd
	406	data[0] = 0x05;
	407	data[1] = 0x00;
	408	data[2] = 0x08;
1299c798	409
abb21530	410	if (HF14BCmdRaw(true, &crc, 0, data, datalen, false)==0) return 0;
1299c798	411
abb21530	412	if (data[0] != 0x50 \|\| *datalen != 14 \|\| !crc) return 0;
1299c798	413
	414	PrintAndLog ("\n14443-3b tag found:");
	415	print_atqb_resp(data);
	416
	417	return 1;
	418	}
	419
	420	int HF14B_ST_Read(uint8_t data, uint8_t datalen){
	421	bool crc = true;
	422	*datalen = 2;
d71d59db	423	//wake cmd
1299c798	424	data[0] = 0x06;
1299c798	425	data[1] = 0x00;
1299c798	426
abb21530	427	//leave power on
	428	// verbose on for now for testing - turn off when functional
	429	if (HF14BCmdRaw(true, &crc, 1, data, datalen, true)==0) return rawClose();
	430
	431	if (*datalen != 3 \|\| !crc) return rawClose();
1299c798	432
1299c798	433	uint8_t chipID = data[0];
d71d59db	434	// select
1299c798	435	data[0] = 0x0E;
	436	data[1] = chipID;
	437	*datalen = 2;
1299c798	438
abb21530	439	//leave power on
	440	// verbose on for now for testing - turn off when functional
	441	if (HF14BCmdRaw(true, &crc, 1, data, datalen, true)==0) return rawClose();
	442
	443	if (*datalen != 3 \|\| !crc \|\| data[0] != chipID) return rawClose();
1299c798	444
d71d59db	445	// get uid
1299c798	446	data[0] = 0x0B;
1299c798	447	*datalen = 1;
1299c798	448
abb21530	449	//power off
	450	// verbose on for now for testing - turn off when functional
	451	if (HF14BCmdRaw(true, &crc, 1, data, datalen, true)==0) return 0;
	452	rawClose();
	453	if (*datalen != 10 \|\| !crc) return 0;
1299c798	454
d71d59db	455	PrintAndLog("\n14443-3b ST tag found:");
d71d59db	456	print_st_info(data);
1299c798	457	return 1;
1299c798	458	}
1299c798	459
d71d59db	460	int HF14BReader(bool verbose){
1299c798	461	uint8_t data[100];
	462	uint8_t datalen = 5;
	463
	464	// try std 14b (atqb)
abb21530	465	if (HF14BStdRead(data, &datalen)) return 1;
1299c798	466
1299c798	467	// try st 14b
abb21530	468	if (HF14B_ST_Read(data, &datalen)) return 1;
abb21530	469
d71d59db	470	if (verbose) PrintAndLog("no 14443B tag found");
d71d59db	471	return 0;
d71d59db	472	}
d71d59db	473
abb21530	474	int CmdHF14BReader(const char *Cmd){
d71d59db	475	return HF14BReader(true);
7cf3ef20	476	}
7cf3ef20	477
abb21530	478	int CmdHFRawSamples(const char *Cmd){
	479	UsbCommand resp;
	480	UsbCommand c = {CMD_ACQUIRE_RAW_ADC_SAMPLES_ISO_14443, {strtol(Cmd,NULL,0), 0, 0}};
	481	SendCommand(&c);
	482
	483	if (!WaitForResponseTimeout(CMD_ACK,&resp,1000)) {
	484	PrintAndLog("timeout while waiting for reply.");
	485	return 0;
	486	}
	487	getSamples("39999", true);
	488	return 1;
	489	}
3fe4ff4f	490
abb21530	491	int CmdHF14BWrite( const char *Cmd){
3fe4ff4f	492	/*
	493	* For SRIX4K blocks 00 - 7F
	494	* hf 14b raw -c -p 09 $srix4kwblock $srix4kwdata
	495	*
	496	* For SR512 blocks 00 - 0F
	497	* hf 14b raw -c -p 09 $sr512wblock $sr512wdata
	498	*
	499	* Special block FF = otp_lock_reg block.
	500	* Data len 4 bytes-
	501	*/
	502	char cmdp = param_getchar(Cmd, 0);
	503	uint8_t blockno = -1;
	504	uint8_t data[4] = {0x00};
	505	bool isSrix4k = true;
	506	char str[20];
	507
b5be31f9	508	if (strlen(Cmd) < 1 \|\| cmdp == 'h' \|\| cmdp == 'H') {
3fe4ff4f	509	PrintAndLog("Usage: hf 14b write <1\|2> <BLOCK> <DATA>");
b5be31f9	510	PrintAndLog(" [1 = SRIX4K]");
	511	PrintAndLog(" [2 = SRI512]");
	512	PrintAndLog(" [BLOCK number depends on tag, special block == FF]");
	513	PrintAndLog(" sample: hf 14b write 1 7F 11223344");
	514	PrintAndLog(" : hf 14b write 1 FF 11223344");
	515	PrintAndLog(" : hf 14b write 2 15 11223344");
	516	PrintAndLog(" : hf 14b write 2 FF 11223344");
3fe4ff4f	517	return 0;
	518	}
	519
b5be31f9	520	if ( cmdp == '2' )
3fe4ff4f	521	isSrix4k = false;
3fe4ff4f	522
b5be31f9	523	//blockno = param_get8(Cmd, 1);
	524
	525	if ( param_gethex(Cmd,1, &blockno, 2) ) {
	526	PrintAndLog("Block number must include 2 HEX symbols");
	527	return 0;
	528	}
3fe4ff4f	529
	530	if ( isSrix4k ){
	531	if ( blockno > 0x7f && blockno != 0xff ){
	532	PrintAndLog("Block number out of range");
	533	return 0;
	534	}
	535	} else {
	536	if ( blockno > 0x0f && blockno != 0xff ){
	537	PrintAndLog("Block number out of range");
	538	return 0;
	539	}
	540	}
	541
	542	if (param_gethex(Cmd, 2, data, 8)) {
	543	PrintAndLog("Data must include 8 HEX symbols");
	544	return 0;
	545	}
	546
	547	if ( blockno == 0xff)
b5be31f9	548	PrintAndLog("[%s] Write special block %02X [ %s ]", (isSrix4k)?"SRIX4K":"SRI512" , blockno, sprint_hex(data,4) );
3fe4ff4f	549	else
b5be31f9	550	PrintAndLog("[%s] Write block %02X [ %s ]", (isSrix4k)?"SRIX4K":"SRI512", blockno, sprint_hex(data,4) );
3fe4ff4f	551
fe5b3a44	552	sprintf(str, "-c 09 %02x %02x%02x%02x%02x", blockno, data[0], data[1], data[2], data[3]);
b5be31f9	553
3fe4ff4f	554	CmdHF14BCmdRaw(str);
	555	return 0;
	556	}
	557
7fe9b0b7	558	static command_t CommandTable[] =
	559	{
	560	{"help", CmdHelp, 1, "This help"},
	561	{"demod", CmdHF14BDemod, 1, "Demodulate ISO14443 Type B from tag"},
abb21530	562	{"getsamples", CmdHFRawSamples,0, "[atqb=0 or ST=1] Send wake cmd and Get raw HF samples to GraphBuffer"},
388c92bd	563	{"list", CmdHF14BList, 0, "[Deprecated] List ISO 14443b history"},
1299c798	564	{"reader", CmdHF14BReader, 0, "Find 14b tag (HF ISO 14443b)"},
7fe9b0b7	565	{"sim", CmdHF14Sim, 0, "Fake ISO 14443 tag"},
	566	{"simlisten", CmdHFSimlisten, 0, "Get HF samples as fake tag"},
	567	{"snoop", CmdHF14BSnoop, 0, "Eavesdrop ISO 14443"},
7cf3ef20	568	{"sri512read", CmdSri512Read, 0, "Read contents of a SRI512 tag"},
	569	{"srix4kread", CmdSrix4kRead, 0, "Read contents of a SRIX4K tag"},
	570	{"raw", CmdHF14BCmdRaw, 0, "Send raw hex data to tag"},
3fe4ff4f	571	{"write", CmdHF14BWrite, 0, "Write data to a SRI512 \| SRIX4K tag"},
7fe9b0b7	572	{NULL, NULL, 0, NULL}
	573	};
	574
	575	int CmdHF14B(const char *Cmd)
	576	{
	577	CmdsParse(CommandTable, Cmd);
	578	return 0;
	579	}
	580
	581	int CmdHelp(const char *Cmd)
	582	{
	583	CmdsHelp(CommandTable);
	584	return 0;
	585	}