[proxmark3-svn] / client / cmdhf14a.c

//-----------------------------------------------------------------------------
// 2011, Merlok
// Copyright (C) 2010 iZsh <izsh at fail0verflow.com>, Hagen Fritsch
//
// 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 ISO14443A commands
//-----------------------------------------------------------------------------

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include "util.h"
#include "../common/iso14443crc.h"
#include "data.h"
#include "proxmark3.h"
#include "ui.h"
#include "cmdparser.h"
#include "cmdhf14a.h"
#include "../include/common.h"
#include "cmdmain.h"
#include "../include/mifare.h"

static int CmdHelp(const char *Cmd);
static void waitCmd(uint8_t iLen);

int CmdHF14AList(const char *Cmd)
{
	bool ShowWaitCycles = false;
	char param = param_getchar(Cmd, 0);
	
	if (param == 'h' || (param != 0 && param != 'f')) {
		PrintAndLog("List data in trace buffer.");
		PrintAndLog("Usage:  hf 14a list [f]");
		PrintAndLog("f - show frame delay times as well");
		PrintAndLog("sample: hf 14a list f");
		return 0;
	}	

	if (param == 'f') {
		ShowWaitCycles = true;
	}
		
	uint8_t trace[TRACE_BUFFER_SIZE];
	GetFromBigBuf(trace,TRACE_BUFFER_SIZE,0);
	WaitForResponse(CMD_ACK,NULL);

	PrintAndLog("Recorded Activity");
	PrintAndLog("");
	PrintAndLog("Start = Start of Start Bit, End = End of last modulation. Src = Source of Transfer");
	PrintAndLog("All times are in carrier periods (1/13.56Mhz)");
	PrintAndLog("");
	PrintAndLog("     Start |       End | Src | Data");
	PrintAndLog("-----------|-----------|-----|--------");

	uint16_t tracepos = 0;
	uint16_t duration;
	uint16_t data_len;
	uint16_t parity_len;
	bool isResponse;
	uint32_t timestamp;
	uint32_t first_timestamp;
	uint32_t EndOfTransmissionTimestamp;
	
	for (;;) {
	
		if( tracepos >= TRACE_BUFFER_SIZE) break;
	
		timestamp = *((uint32_t *)(trace + tracepos));
		if(tracepos == 0) {
			first_timestamp = timestamp;
		}
		tracepos += 4;
		duration = *((uint16_t *)(trace + tracepos));
		tracepos += 2;
		data_len = *((uint16_t *)(trace + tracepos));
		tracepos += 2;

		if (data_len & 0x8000) {
			data_len &= 0x7fff;
			isResponse = true;
		} else {
			isResponse = false;
		}

		parity_len = (data_len-1)/8 + 1;


		if (tracepos + data_len + parity_len >= TRACE_BUFFER_SIZE) { break; }

		uint8_t *frame = trace + tracepos;
		tracepos += data_len;
		uint8_t *parityBytes = trace + tracepos;
		tracepos += parity_len;

		// Break and stick with current result if buffer was not completely full
		if (timestamp == 0x44444444) break; 

		char line[1000] = "";
		int j;
		for (j = 0; j < data_len; j++) {
			int oddparity = 0x01;
			int k;

			for (k=0;k<8;k++) {
				oddparity ^= (((frame[j] & 0xFF) >> k) & 0x01);
			}

			uint8_t parityBits = parityBytes[j>>3];
			if (isResponse && (oddparity != ((parityBits >> (7-(j&0x0007))) & 0x01))) {
				sprintf(line+(j*4), "%02x! ", frame[j]);
			} else {
				sprintf(line+(j*4), "%02x ", frame[j]);
			}
		}
			
		char crc[6] = ""; 
		if (data_len > 2) {
			uint8_t b1, b2;
			ComputeCrc14443(CRC_14443_A, frame, data_len-2, &b1, &b2);
			if (b1 != frame[data_len-2] || b2 != frame[data_len-1]) {
				sprintf(crc, (isResponse & (data_len < 6)) ? "" : " !crc");
			} else {
				sprintf(crc, "");
			}
		
		EndOfTransmissionTimestamp = timestamp + duration;
		
		PrintAndLog(" %9d | %9d | %s | %s %s",
			(timestamp - first_timestamp),
			(EndOfTransmissionTimestamp - first_timestamp),
			(isResponse ? "Tag" : "Rdr"),
			line,
			crc);
	
		bool next_isResponse = *((uint16_t *)(trace + tracepos + 6)) & 0x8000;
		if (ShowWaitCycles && !isResponse && next_isResponse) {
			uint32_t next_timestamp = *((uint32_t *)(trace + tracepos));
			if (next_timestamp != 0x44444444) {
			PrintAndLog(" %9d | %9d | %s | fdt (Frame Delay Time): %d",
				(EndOfTransmissionTimestamp - first_timestamp),
				(next_timestamp - first_timestamp),
				" ",
				(next_timestamp - EndOfTransmissionTimestamp));
				}
			}
		}
	}
	return 0;
}

void iso14a_set_timeout(uint32_t timeout) {
	UsbCommand c = {CMD_READER_ISO_14443a, {ISO14A_SET_TIMEOUT, 0, timeout}};
	SendCommand(&c);
}

int CmdHF14AReader(const char *Cmd)
{
	UsbCommand c = {CMD_READER_ISO_14443a, {ISO14A_CONNECT, 0, 0}};
	SendCommand(&c);

	UsbCommand resp;
	WaitForResponse(CMD_ACK,&resp);
	
	iso14a_card_select_t *card = (iso14a_card_select_t *)resp.d.asBytes;

	if(resp.arg[0] == 0) {
		PrintAndLog("iso14443a card select failed");
		return 0;
	}

	PrintAndLog("ATQA : %02x %02x", card->atqa[0], card->atqa[1]);
	PrintAndLog(" UID : %s", sprint_hex(card->uid, card->uidlen));
	PrintAndLog(" SAK : %02x [%d]", card->sak, resp.arg[0]);

	switch (card->sak) {
		case 0x00: PrintAndLog("TYPE : NXP MIFARE Ultralight | Ultralight C"); break;
		case 0x01: PrintAndLog("TYPE : NXP TNP3xxx  Activision Game Appliance"); break;
		case 0x04: PrintAndLog("TYPE : NXP MIFARE (various !DESFire !DESFire EV1)"); break;
		case 0x08: PrintAndLog("TYPE : NXP MIFARE CLASSIC 1k | Plus 2k SL1"); break;
		case 0x09: PrintAndLog("TYPE : NXP MIFARE Mini 0.3k"); break;
		case 0x10: PrintAndLog("TYPE : NXP MIFARE Plus 2k SL2"); break;
		case 0x11: PrintAndLog("TYPE : NXP MIFARE Plus 4k SL2"); break;
		case 0x18: PrintAndLog("TYPE : NXP MIFARE Classic 4k | Plus 4k SL1"); break;
		case 0x20: PrintAndLog("TYPE : NXP MIFARE DESFire 4k | DESFire EV1 2k/4k/8k | Plus 2k/4k SL3 | JCOP 31/41"); break;
		case 0x24: PrintAndLog("TYPE : NXP MIFARE DESFire | DESFire EV1"); break;
		case 0x28: PrintAndLog("TYPE : JCOP31 or JCOP41 v2.3.1"); break;
		case 0x38: PrintAndLog("TYPE : Nokia 6212 or 6131 MIFARE CLASSIC 4K"); break;
		case 0x88: PrintAndLog("TYPE : Infineon MIFARE CLASSIC 1K"); break;
		case 0x98: PrintAndLog("TYPE : Gemplus MPCOS"); break;
		default: ;
	}
	if(resp.arg[0] == 1) {
		bool ta1 = 0, tb1 = 0, tc1 = 0;
		int pos;

		PrintAndLog(" ATS : %s", sprint_hex(card->ats, card->ats_len));
		if (card->ats_len > 0) {
			PrintAndLog("       -  TL : length is %d bytes", card->ats[0]);
		}
		if (card->ats_len > 1) {
			ta1 = (card->ats[1] & 0x10) == 0x10;
			tb1 = (card->ats[1] & 0x20) == 0x20;
			tc1 = (card->ats[1] & 0x40) == 0x40;
			PrintAndLog("       -  T0 : TA1 is%s present, TB1 is%s present, "
					"TC1 is%s present, FSCI is %d",
				(ta1 ? "" : " NOT"), (tb1 ? "" : " NOT"), (tc1 ? "" : " NOT"),
				(card->ats[1] & 0x0f));
		}
		pos = 2;
		if (ta1 && card->ats_len > pos) {
			char dr[16], ds[16];
			dr[0] = ds[0] = '\0';
			if (card->ats[pos] & 0x10) strcat(ds, "2, ");
			if (card->ats[pos] & 0x20) strcat(ds, "4, ");
			if (card->ats[pos] & 0x40) strcat(ds, "8, ");
			if (card->ats[pos] & 0x01) strcat(dr, "2, ");
			if (card->ats[pos] & 0x02) strcat(dr, "4, ");
			if (card->ats[pos] & 0x04) strcat(dr, "8, ");
			if (strlen(ds) != 0) ds[strlen(ds) - 2] = '\0';
			if (strlen(dr) != 0) dr[strlen(dr) - 2] = '\0';
			PrintAndLog("       - TA1 : different divisors are%s supported, "
					"DR: [%s], DS: [%s]",
					(card->ats[pos] & 0x80 ? " NOT" : ""), dr, ds);
			pos++;
		}
		if (tb1 && card->ats_len > pos) {
			PrintAndLog("       - TB1 : SFGI = %d, FWI = %d",
					(card->ats[pos] & 0x08),
					(card->ats[pos] & 0x80) >> 4);
			pos++;
		}
		if (tc1 && card->ats_len > pos) {
			PrintAndLog("       - TC1 : NAD is%s supported, CID is%s supported",
					(card->ats[pos] & 0x01) ? "" : " NOT",
					(card->ats[pos] & 0x02) ? "" : " NOT");
			pos++;
		}
		if (card->ats_len > pos) {
			char *tip = "";
			if (card->ats_len - pos > 7) {
				if (memcmp(card->ats + pos, "\xC1\x05\x2F\x2F\x01\xBC\xD6", 7) == 0) {
					tip = "-> MIFARE Plus X 2K or 4K";
				} else if (memcmp(card->ats + pos, "\xC1\x05\x2F\x2F\x00\x35\xC7", 7) == 0) {
					tip = "-> MIFARE Plus S 2K or 4K";
				}
			} 
			PrintAndLog("       -  HB : %s%s", sprint_hex(card->ats + pos, card->ats_len - pos - 2), tip);
			if (card->ats[pos] == 0xC1) {
				PrintAndLog("               c1 -> Mifare or (multiple) virtual cards of various type");
				PrintAndLog("                  %02x -> Length is %d bytes",
						card->ats[pos + 1], card->ats[pos + 1]);
				switch (card->ats[pos + 2] & 0xf0) {
					case 0x10:
						PrintAndLog("                     1x -> MIFARE DESFire");
						break;
					case 0x20:
						PrintAndLog("                     2x -> MIFARE Plus");
						break;
				}
				switch (card->ats[pos + 2] & 0x0f) {
					case 0x00:
						PrintAndLog("                     x0 -> <1 kByte");
						break;
					case 0x01:
						PrintAndLog("                     x0 -> 1 kByte");
						break;
					case 0x02:
						PrintAndLog("                     x0 -> 2 kByte");
						break;
					case 0x03:
						PrintAndLog("                     x0 -> 4 kByte");
						break;
					case 0x04:
						PrintAndLog("                     x0 -> 8 kByte");
						break;
				}
				switch (card->ats[pos + 3] & 0xf0) {
					case 0x00:
						PrintAndLog("                        0x -> Engineering sample");
						break;
					case 0x20:
						PrintAndLog("                        2x -> Released");
						break;
				}
				switch (card->ats[pos + 3] & 0x0f) {
					case 0x00:
						PrintAndLog("                        x0 -> Generation 1");
						break;
					case 0x01:
						PrintAndLog("                        x1 -> Generation 2");
						break;
					case 0x02:
						PrintAndLog("                        x2 -> Generation 3");
						break;
				}
				switch (card->ats[pos + 4] & 0x0f) {
					case 0x00:
						PrintAndLog("                           x0 -> Only VCSL supported");
						break;
					case 0x01:
						PrintAndLog("                           x1 -> VCS, VCSL, and SVC supported");
						break;
					case 0x0E:
						PrintAndLog("                           xE -> no VCS command supported");
						break;
				}
			}
		}
	} else {
		PrintAndLog("proprietary non iso14443a-4 card found, RATS not supported");
	}

	return resp.arg[0];
}

// Collect ISO14443 Type A UIDs
int CmdHF14ACUIDs(const char *Cmd)
{
	// requested number of UIDs
	int n = atoi(Cmd);
	// collect at least 1 (e.g. if no parameter was given)
	n = n > 0 ? n : 1;

	PrintAndLog("Collecting %d UIDs", n);
	PrintAndLog("Start: %u", time(NULL));
	// repeat n times
	for (int i = 0; i < n; i++) {
		// execute anticollision procedure
		UsbCommand c = {CMD_READER_ISO_14443a, {ISO14A_CONNECT, 0, 0}};
		SendCommand(&c);
    
		UsbCommand resp;
		WaitForResponse(CMD_ACK,&resp);

		uint8_t *uid  = resp.d.asBytes;
		iso14a_card_select_t *card = (iso14a_card_select_t *)(uid + 12);

		// check if command failed
		if (resp.arg[0] == 0) {
			PrintAndLog("Card select failed.");
		} else {
			// check if UID is 4 bytes
			if ((card->atqa[1] & 0xC0) == 0) {
				PrintAndLog("%02X%02X%02X%02X",
				            *uid, *(uid + 1), *(uid + 2), *(uid + 3));
			} else {
				PrintAndLog("UID longer than 4 bytes");
			}
		}
	}
	PrintAndLog("End: %u", time(NULL));

	return 1;
}

// ## simulate iso14443a tag
// ## greg - added ability to specify tag UID
int CmdHF14ASim(const char *Cmd)
{
	UsbCommand c = {CMD_SIMULATE_TAG_ISO_14443a,{0,0,0}};
	
	// Retrieve the tag type
	uint8_t tagtype = param_get8ex(Cmd,0,0,10);
	
	// When no argument was given, just print help message
	if (tagtype == 0) {
		PrintAndLog("");
		PrintAndLog(" Emulating ISO/IEC 14443 type A tag with 4 or 7 byte UID");
		PrintAndLog("");
		PrintAndLog("   syntax: hf 14a sim <type> <uid>");
		PrintAndLog("    types: 1 = MIFARE Classic");
		PrintAndLog("           2 = MIFARE Ultralight");
		PrintAndLog("           3 = MIFARE DESFIRE");
		PrintAndLog("           4 = ISO/IEC 14443-4");
		PrintAndLog("           5 = MIFARE TNP3XXX");		
		PrintAndLog("");
		return 1;
	}
	
	// Store the tag type
	c.arg[0] = tagtype;
	
	// Retrieve the full 4 or 7 byte long uid 
	uint64_t long_uid = param_get64ex(Cmd,1,0,16);

	// Are we handling the (optional) second part uid?
	if (long_uid > 0xffffffff) {
		PrintAndLog("Emulating ISO/IEC 14443 type A tag with 7 byte UID (%014"llx")",long_uid);
		// Store the second part
		c.arg[2] = (long_uid & 0xffffffff);
		long_uid >>= 32;
		// Store the first part, ignore the first byte, it is replaced by cascade byte (0x88)
		c.arg[1] = (long_uid & 0xffffff);
	} else {
		PrintAndLog("Emulating ISO/IEC 14443 type A tag with 4 byte UID (%08x)",long_uid);
		// Only store the first part
		c.arg[1] = long_uid & 0xffffffff;
	}
/*
		// At lease save the mandatory first part of the UID
		c.arg[0] = long_uid & 0xffffffff;

	if (c.arg[1] == 0) {
		PrintAndLog("Emulating ISO/IEC 14443 type A tag with UID %01d %08x %08x",c.arg[0],c.arg[1],c.arg[2]);
	}
	
	switch (c.arg[0]) {
		case 1: {
			PrintAndLog("Emulating ISO/IEC 14443-3 type A tag with 4 byte UID");
			UsbCommand c = {CMD_SIMULATE_TAG_ISO_14443a,param_get32ex(Cmd,0,0,10),param_get32ex(Cmd,1,0,16),param_get32ex(Cmd,2,0,16)};
		} break;
		case 2: {
			PrintAndLog("Emulating ISO/IEC 14443-4 type A tag with 7 byte UID");
		} break;
		default: {
			PrintAndLog("Error: unkown tag type (%d)",c.arg[0]);
			PrintAndLog("syntax: hf 14a sim <uid>",c.arg[0]);
			PrintAndLog(" type1: 4 ",c.arg[0]);

			return 1;
		} break;
	}	
*/
/*
  unsigned int hi = 0, lo = 0;
  int n = 0, i = 0;
  while (sscanf(&Cmd[i++], "%1x", &n ) == 1) {
    hi= (hi << 4) | (lo >> 28);
    lo= (lo << 4) | (n & 0xf);
  }
*/
//	UsbCommand c = {CMD_SIMULATE_TAG_ISO_14443a,param_get32ex(Cmd,0,0,10),param_get32ex(Cmd,1,0,16),param_get32ex(Cmd,2,0,16)};
//  PrintAndLog("Emulating ISO/IEC 14443 type A tag with UID %01d %08x %08x",c.arg[0],c.arg[1],c.arg[2]);
  SendCommand(&c);
  return 0;
}

int CmdHF14ASnoop(const char *Cmd) {
	int param = 0;
	
	if (param_getchar(Cmd, 0) == 'h') {
		PrintAndLog("It get data from the field and saves it into command buffer.");
		PrintAndLog("Buffer accessible from command hf 14a list.");
		PrintAndLog("Usage:  hf 14a snoop [c][r]");
		PrintAndLog("c - triggered by first data from card");
		PrintAndLog("r - triggered by first 7-bit request from reader (REQ,WUP,...)");
		PrintAndLog("sample: hf 14a snoop c r");
		return 0;
	}	
	
	for (int i = 0; i < 2; i++) {
		char ctmp = param_getchar(Cmd, i);
		if (ctmp == 'c' || ctmp == 'C') param |= 0x01;
		if (ctmp == 'r' || ctmp == 'R') param |= 0x02;
	}

  UsbCommand c = {CMD_SNOOP_ISO_14443a, {param, 0, 0}};
  SendCommand(&c);
  return 0;
}

int CmdHF14ACmdRaw(const char *cmd) {
    UsbCommand c = {CMD_READER_ISO_14443a, {0, 0, 0}};
    uint8_t reply=1;
    uint8_t crc=0;
    uint8_t power=0;
    uint8_t active=0;
    uint8_t active_select=0;
    uint16_t numbits=0;
	uint16_t timeout=0;
	uint8_t bTimeout=0;
    char buf[5]="";
    int i=0;
    uint8_t data[USB_CMD_DATA_SIZE];
    unsigned int datalen=0, temp;

    if (strlen(cmd)<2) {
        PrintAndLog("Usage: hf 14a raw [-r] [-c] [-p] [-f] [-b] [-t] <number of bits> <0A 0B 0C ... hex>");
        PrintAndLog("       -r    do not read response");
        PrintAndLog("       -c    calculate and append CRC");
        PrintAndLog("       -p    leave the signal field ON after receive");
        PrintAndLog("       -a    active signal field ON without select");
        PrintAndLog("       -s    active signal field ON with select");
        PrintAndLog("       -b    number of bits to send. Useful for send partial byte");
		PrintAndLog("       -t    timeout");
        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': 
                    reply=0;
                    break;
                case 'c':
                    crc=1;
                    break;
                case 'p':
                    power=1;
                    break;
                case 'a':
                    active=1;
                    break;
                case 's':
                    active_select=1;
                    break;
                case 'b': 
                    sscanf(cmd+i+2,"%d",&temp);
                    numbits = temp & 0xFFFF;
                    i+=3;
                    while(cmd[i]!=' ' && cmd[i]!='\0') { i++; }
                    i-=2;
                    break;
				case 't':
					bTimeout=1;
					sscanf(cmd+i+2,"%d",&temp);
					timeout = temp & 0xFFFF;
					i+=3;
					while(cmd[i]!=' ' && cmd[i]!='\0') { i++; }
					i+=2;
					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;
				if (++datalen>sizeof(data)){
					if (crc)
						PrintAndLog("Buffer is full, we can't add CRC to your data");
					break;
				}
            }
            continue;
        }
        PrintAndLog("Invalid char on input");
        return 0;
    }
    if(crc && datalen>0 && datalen<sizeof(data)-2)
    {
        uint8_t first, second;
        ComputeCrc14443(CRC_14443_A, data, datalen, &first, &second);
        data[datalen++] = first;
        data[datalen++] = second;
    }

    if(active || active_select)
    {
        c.arg[0] |= ISO14A_CONNECT;
        if(active)
            c.arg[0] |= ISO14A_NO_SELECT;
    }
	if(bTimeout){
	    #define MAX_TIMEOUT 624*105 // max timeout is 624 ms
        c.arg[0] |= ISO14A_SET_TIMEOUT;
        c.arg[2] = timeout * 105; // each bit is about 9.4 us
        if(c.arg[2]>MAX_TIMEOUT) {
            c.arg[2] = MAX_TIMEOUT;
            PrintAndLog("Set timeout to 624 ms. The max we can wait for response");
        }
	}
    if(power)
        c.arg[0] |= ISO14A_NO_DISCONNECT;
    if(datalen>0)
        c.arg[0] |= ISO14A_RAW;

	// Max buffer is USB_CMD_DATA_SIZE
    c.arg[1] = (datalen & 0xFFFF) | (numbits << 16);
    memcpy(c.d.asBytes,data,datalen);

    SendCommand(&c);

    if (reply) {
        if(active_select)
            waitCmd(1);
        if(datalen>0)
            waitCmd(0);
    } // if reply
    return 0;
}

static void waitCmd(uint8_t iSelect)
{
    uint8_t *recv;
    UsbCommand resp;
    char *hexout;

    if (WaitForResponseTimeout(CMD_ACK,&resp,10000)) {
        recv = resp.d.asBytes;
        uint8_t iLen = iSelect ? resp.arg[1] : resp.arg[0];
        PrintAndLog("received %i octets",iLen);
        if(!iLen)
            return;
        hexout = (char *)malloc(iLen * 3 + 1);
        if (hexout != NULL) {
            for (int i = 0; i < iLen; i++) { // data in hex
                sprintf(&hexout[i * 3], "%02X ", recv[i]);
            }
            PrintAndLog("%s", hexout);
            free(hexout);
        } else {
            PrintAndLog("malloc failed your client has low memory?");
        }
    } else {
        PrintAndLog("timeout while waiting for reply.");
    }
}

static command_t CommandTable[] = 
{
  {"help",   CmdHelp,              1, "This help"},
  {"list",   CmdHF14AList,         0, "List ISO 14443a history"},
  {"reader", CmdHF14AReader,       0, "Act like an ISO14443 Type A reader"},
  {"cuids",  CmdHF14ACUIDs,        0, "<n> Collect n>0 ISO14443 Type A UIDs in one go"},
  {"sim",    CmdHF14ASim,          0, "<UID> -- Fake ISO 14443a tag"},
  {"snoop",  CmdHF14ASnoop,        0, "Eavesdrop ISO 14443 Type A"},
  {"raw",    CmdHF14ACmdRaw,       0, "Send raw hex data to tag"},
  {NULL, NULL, 0, NULL}
};

int CmdHF14A(const char *Cmd) {
	// flush
	WaitForResponseTimeout(CMD_ACK,NULL,100);

	// parse
  CmdsParse(CommandTable, Cmd);
  return 0;
}

int CmdHelp(const char *Cmd)
{
  CmdsHelp(CommandTable);
  return 0;
}
Commit	Line	Data
a553f267	1	//-----------------------------------------------------------------------------
f89c7050	2	// 2011, Merlok
534983d7	3	// Copyright (C) 2010 iZsh <izsh at fail0verflow.com>, Hagen Fritsch
a553f267	4	//
	5	// This code is licensed to you under the terms of the GNU GPL, version 2 or,
	6	// at your option, any later version. See the LICENSE.txt file for the text of
	7	// the license.
	8	//-----------------------------------------------------------------------------
	9	// High frequency ISO14443A commands
	10	//-----------------------------------------------------------------------------
	11
7fe9b0b7	12	#include <stdio.h>
590f8ff9	13	#include <stdlib.h>
7fe9b0b7	14	#include <string.h>
f397b5cc	15	#include <unistd.h>
20f9a2a1	16	#include "util.h"
f38a1528	17	#include "../common/iso14443crc.h"
7fe9b0b7	18	#include "data.h"
902cb3c0	19	#include "proxmark3.h"
7fe9b0b7	20	#include "ui.h"
	21	#include "cmdparser.h"
	22	#include "cmdhf14a.h"
f38a1528	23	#include "../include/common.h"
20f9a2a1	24	#include "cmdmain.h"
f38a1528	25	#include "../include/mifare.h"
7fe9b0b7	26
7fe9b0b7	27	static int CmdHelp(const char *Cmd);
5f6d6c90	28	static void waitCmd(uint8_t iLen);
7fe9b0b7	29
	30	int CmdHF14AList(const char *Cmd)
	31	{
7bc95e2e	32	bool ShowWaitCycles = false;
	33	char param = param_getchar(Cmd, 0);
	34
	35	if (param == 'h' \|\| (param != 0 && param != 'f')) {
	36	PrintAndLog("List data in trace buffer.");
	37	PrintAndLog("Usage: hf 14a list [f]");
	38	PrintAndLog("f - show frame delay times as well");
	39	PrintAndLog("sample: hf 14a list f");
	40	return 0;
	41	}
	42
	43	if (param == 'f') {
	44	ShowWaitCycles = true;
	45	}
	46
a501c82b	47	uint8_t trace[TRACE_BUFFER_SIZE];
a501c82b	48	GetFromBigBuf(trace,TRACE_BUFFER_SIZE,0);
7bc95e2e	49	WaitForResponse(CMD_ACK,NULL);
	50
	51	PrintAndLog("Recorded Activity");
	52	PrintAndLog("");
	53	PrintAndLog("Start = Start of Start Bit, End = End of last modulation. Src = Source of Transfer");
	54	PrintAndLog("All times are in carrier periods (1/13.56Mhz)");
	55	PrintAndLog("");
	56	PrintAndLog(" Start \| End \| Src \| Data");
	57	PrintAndLog("-----------\|-----------\|-----\|--------");
	58
a501c82b	59	uint16_t tracepos = 0;
	60	uint16_t duration;
	61	uint16_t data_len;
	62	uint16_t parity_len;
	63	bool isResponse;
7bc95e2e	64	uint32_t timestamp;
a501c82b	65	uint32_t first_timestamp;
a501c82b	66	uint32_t EndOfTransmissionTimestamp;
7bc95e2e	67
7bc95e2e	68	for (;;) {
a501c82b	69
	70	if( tracepos >= TRACE_BUFFER_SIZE) break;
	71
	72	timestamp = ((uint32_t )(trace + tracepos));
	73	if(tracepos == 0) {
	74	first_timestamp = timestamp;
e691fc45	75	}
a501c82b	76	tracepos += 4;
	77	duration = ((uint16_t )(trace + tracepos));
	78	tracepos += 2;
	79	data_len = ((uint16_t )(trace + tracepos));
	80	tracepos += 2;
	81
	82	if (data_len & 0x8000) {
	83	data_len &= 0x7fff;
	84	isResponse = true;
7bc95e2e	85	} else {
a501c82b	86	isResponse = false;
7bc95e2e	87	}
7bc95e2e	88
a501c82b	89	parity_len = (data_len-1)/8 + 1;
7bc95e2e	90
7bc95e2e	91
a501c82b	92	if (tracepos + data_len + parity_len >= TRACE_BUFFER_SIZE) { break; }
7bc95e2e	93
a501c82b	94	uint8_t *frame = trace + tracepos;
	95	tracepos += data_len;
	96	uint8_t *parityBytes = trace + tracepos;
	97	tracepos += parity_len;
7bc95e2e	98
7bc95e2e	99	// Break and stick with current result if buffer was not completely full
a501c82b	100	if (timestamp == 0x44444444) break;
7bc95e2e	101
	102	char line[1000] = "";
	103	int j;
a501c82b	104	for (j = 0; j < data_len; j++) {
	105	int oddparity = 0x01;
	106	int k;
7bc95e2e	107
a501c82b	108	for (k=0;k<8;k++) {
a501c82b	109	oddparity ^= (((frame[j] & 0xFF) >> k) & 0x01);
7bc95e2e	110	}
a501c82b	111
	112	uint8_t parityBits = parityBytes[j>>3];
	113	if (isResponse && (oddparity != ((parityBits >> (7-(j&0x0007))) & 0x01))) {
	114	sprintf(line+(j*4), "%02x! ", frame[j]);
	115	} else {
	116	sprintf(line+(j*4), "%02x ", frame[j]);
7bc95e2e	117	}
7bc95e2e	118	}
a501c82b	119
	120	char crc[6] = "";
	121	if (data_len > 2) {
7bc95e2e	122	uint8_t b1, b2;
a501c82b	123	ComputeCrc14443(CRC_14443_A, frame, data_len-2, &b1, &b2);
	124	if (b1 != frame[data_len-2] \|\| b2 != frame[data_len-1]) {
	125	sprintf(crc, (isResponse & (data_len < 6)) ? "" : " !crc");
	126	} else {
	127	sprintf(crc, "");
7bc95e2e	128	}
7bc95e2e	129
a501c82b	130	EndOfTransmissionTimestamp = timestamp + duration;
7bc95e2e	131
	132	PrintAndLog(" %9d \| %9d \| %s \| %s %s",
	133	(timestamp - first_timestamp),
	134	(EndOfTransmissionTimestamp - first_timestamp),
a501c82b	135	(isResponse ? "Tag" : "Rdr"),
	136	line,
	137	crc);
	138
	139	bool next_isResponse = ((uint16_t )(trace + tracepos + 6)) & 0x8000;
	140	if (ShowWaitCycles && !isResponse && next_isResponse) {
	141	uint32_t next_timestamp = ((uint32_t )(trace + tracepos));
	142	if (next_timestamp != 0x44444444) {
	143	PrintAndLog(" %9d \| %9d \| %s \| fdt (Frame Delay Time): %d",
	144	(EndOfTransmissionTimestamp - first_timestamp),
	145	(next_timestamp - first_timestamp),
	146	" ",
	147	(next_timestamp - EndOfTransmissionTimestamp));
	148	}
	149	}
	150	}
7bc95e2e	151	}
f89c7050	152	return 0;
7fe9b0b7	153	}
7fe9b0b7	154
534983d7	155	void iso14a_set_timeout(uint32_t timeout) {
	156	UsbCommand c = {CMD_READER_ISO_14443a, {ISO14A_SET_TIMEOUT, 0, timeout}};
	157	SendCommand(&c);
	158	}
	159
7fe9b0b7	160	int CmdHF14AReader(const char *Cmd)
7fe9b0b7	161	{
f38a1528	162	UsbCommand c = {CMD_READER_ISO_14443a, {ISO14A_CONNECT, 0, 0}};
534983d7	163	SendCommand(&c);
902cb3c0	164
902cb3c0	165	UsbCommand resp;
7bc95e2e	166	WaitForResponse(CMD_ACK,&resp);
902cb3c0	167
f38a1528	168	iso14a_card_select_t card = (iso14a_card_select_t )resp.d.asBytes;
534983d7	169
f38a1528	170	if(resp.arg[0] == 0) {
534983d7	171	PrintAndLog("iso14443a card select failed");
	172	return 0;
	173	}
	174
f38a1528	175	PrintAndLog("ATQA : %02x %02x", card->atqa[0], card->atqa[1]);
	176	PrintAndLog(" UID : %s", sprint_hex(card->uid, card->uidlen));
	177	PrintAndLog(" SAK : %02x [%d]", card->sak, resp.arg[0]);
713e7ffb	178
f38a1528	179	switch (card->sak) {
79a73ab2	180	case 0x00: PrintAndLog("TYPE : NXP MIFARE Ultralight \| Ultralight C"); break;
c15d2bdc	181	case 0x01: PrintAndLog("TYPE : NXP TNP3xxx Activision Game Appliance"); break;
79a73ab2	182	case 0x04: PrintAndLog("TYPE : NXP MIFARE (various !DESFire !DESFire EV1)"); break;
e691fc45	183	case 0x08: PrintAndLog("TYPE : NXP MIFARE CLASSIC 1k \| Plus 2k SL1"); break;
79a73ab2	184	case 0x09: PrintAndLog("TYPE : NXP MIFARE Mini 0.3k"); break;
e691fc45	185	case 0x10: PrintAndLog("TYPE : NXP MIFARE Plus 2k SL2"); break;
	186	case 0x11: PrintAndLog("TYPE : NXP MIFARE Plus 4k SL2"); break;
	187	case 0x18: PrintAndLog("TYPE : NXP MIFARE Classic 4k \| Plus 4k SL1"); break;
	188	case 0x20: PrintAndLog("TYPE : NXP MIFARE DESFire 4k \| DESFire EV1 2k/4k/8k \| Plus 2k/4k SL3 \| JCOP 31/41"); break;
79a73ab2	189	case 0x24: PrintAndLog("TYPE : NXP MIFARE DESFire \| DESFire EV1"); break;
	190	case 0x28: PrintAndLog("TYPE : JCOP31 or JCOP41 v2.3.1"); break;
	191	case 0x38: PrintAndLog("TYPE : Nokia 6212 or 6131 MIFARE CLASSIC 4K"); break;
	192	case 0x88: PrintAndLog("TYPE : Infineon MIFARE CLASSIC 1K"); break;
	193	case 0x98: PrintAndLog("TYPE : Gemplus MPCOS"); break;
9ca155ba M	194	default: ;
9ca155ba M	195	}
f38a1528	196	if(resp.arg[0] == 1) {
561f7c11	197	bool ta1 = 0, tb1 = 0, tc1 = 0;
	198	int pos;
	199
f38a1528	200	PrintAndLog(" ATS : %s", sprint_hex(card->ats, card->ats_len));
	201	if (card->ats_len > 0) {
	202	PrintAndLog(" - TL : length is %d bytes", card->ats[0]);
19d6d91f	203	}
f38a1528	204	if (card->ats_len > 1) {
	205	ta1 = (card->ats[1] & 0x10) == 0x10;
	206	tb1 = (card->ats[1] & 0x20) == 0x20;
	207	tc1 = (card->ats[1] & 0x40) == 0x40;
561f7c11	208	PrintAndLog(" - T0 : TA1 is%s present, TB1 is%s present, "
f38a1528	209	"TC1 is%s present, FSCI is %d",
561f7c11	210	(ta1 ? "" : " NOT"), (tb1 ? "" : " NOT"), (tc1 ? "" : " NOT"),
f38a1528	211	(card->ats[1] & 0x0f));
561f7c11	212	}
561f7c11	213	pos = 2;
f38a1528	214	if (ta1 && card->ats_len > pos) {
561f7c11	215	char dr[16], ds[16];
561f7c11	216	dr[0] = ds[0] = '\0';
f38a1528	217	if (card->ats[pos] & 0x10) strcat(ds, "2, ");
	218	if (card->ats[pos] & 0x20) strcat(ds, "4, ");
	219	if (card->ats[pos] & 0x40) strcat(ds, "8, ");
	220	if (card->ats[pos] & 0x01) strcat(dr, "2, ");
	221	if (card->ats[pos] & 0x02) strcat(dr, "4, ");
	222	if (card->ats[pos] & 0x04) strcat(dr, "8, ");
561f7c11	223	if (strlen(ds) != 0) ds[strlen(ds) - 2] = '\0';
	224	if (strlen(dr) != 0) dr[strlen(dr) - 2] = '\0';
	225	PrintAndLog(" - TA1 : different divisors are%s supported, "
	226	"DR: [%s], DS: [%s]",
f38a1528	227	(card->ats[pos] & 0x80 ? " NOT" : ""), dr, ds);
561f7c11	228	pos++;
561f7c11	229	}
f38a1528	230	if (tb1 && card->ats_len > pos) {
	231	PrintAndLog(" - TB1 : SFGI = %d, FWI = %d",
	232	(card->ats[pos] & 0x08),
	233	(card->ats[pos] & 0x80) >> 4);
561f7c11	234	pos++;
561f7c11	235	}
f38a1528	236	if (tc1 && card->ats_len > pos) {
561f7c11	237	PrintAndLog(" - TC1 : NAD is%s supported, CID is%s supported",
f38a1528	238	(card->ats[pos] & 0x01) ? "" : " NOT",
f38a1528	239	(card->ats[pos] & 0x02) ? "" : " NOT");
561f7c11	240	pos++;
561f7c11	241	}
f38a1528	242	if (card->ats_len > pos) {
561f7c11	243	char *tip = "";
f38a1528	244	if (card->ats_len - pos > 7) {
f38a1528	245	if (memcmp(card->ats + pos, "\xC1\x05\x2F\x2F\x01\xBC\xD6", 7) == 0) {
561f7c11	246	tip = "-> MIFARE Plus X 2K or 4K";
f38a1528	247	} else if (memcmp(card->ats + pos, "\xC1\x05\x2F\x2F\x00\x35\xC7", 7) == 0) {
561f7c11	248	tip = "-> MIFARE Plus S 2K or 4K";
	249	}
	250	}
f38a1528	251	PrintAndLog(" - HB : %s%s", sprint_hex(card->ats + pos, card->ats_len - pos - 2), tip);
f38a1528	252	if (card->ats[pos] == 0xC1) {
561f7c11	253	PrintAndLog(" c1 -> Mifare or (multiple) virtual cards of various type");
561f7c11	254	PrintAndLog(" %02x -> Length is %d bytes",
f38a1528	255	card->ats[pos + 1], card->ats[pos + 1]);
f38a1528	256	switch (card->ats[pos + 2] & 0xf0) {
561f7c11	257	case 0x10:
	258	PrintAndLog(" 1x -> MIFARE DESFire");
	259	break;
	260	case 0x20:
	261	PrintAndLog(" 2x -> MIFARE Plus");
	262	break;
	263	}
f38a1528	264	switch (card->ats[pos + 2] & 0x0f) {
561f7c11	265	case 0x00:
	266	PrintAndLog(" x0 -> <1 kByte");
	267	break;
	268	case 0x01:
	269	PrintAndLog(" x0 -> 1 kByte");
	270	break;
	271	case 0x02:
	272	PrintAndLog(" x0 -> 2 kByte");
	273	break;
	274	case 0x03:
	275	PrintAndLog(" x0 -> 4 kByte");
	276	break;
	277	case 0x04:
	278	PrintAndLog(" x0 -> 8 kByte");
	279	break;
	280	}
f38a1528	281	switch (card->ats[pos + 3] & 0xf0) {
561f7c11	282	case 0x00:
	283	PrintAndLog(" 0x -> Engineering sample");
	284	break;
	285	case 0x20:
	286	PrintAndLog(" 2x -> Released");
	287	break;
	288	}
f38a1528	289	switch (card->ats[pos + 3] & 0x0f) {
561f7c11	290	case 0x00:
	291	PrintAndLog(" x0 -> Generation 1");
	292	break;
	293	case 0x01:
	294	PrintAndLog(" x1 -> Generation 2");
	295	break;
	296	case 0x02:
	297	PrintAndLog(" x2 -> Generation 3");
	298	break;
	299	}
f38a1528	300	switch (card->ats[pos + 4] & 0x0f) {
561f7c11	301	case 0x00:
	302	PrintAndLog(" x0 -> Only VCSL supported");
	303	break;
	304	case 0x01:
	305	PrintAndLog(" x1 -> VCS, VCSL, and SVC supported");
	306	break;
	307	case 0x0E:
	308	PrintAndLog(" xE -> no VCS command supported");
	309	break;
	310	}
	311	}
	312	}
79a73ab2	313	} else {
f38a1528	314	PrintAndLog("proprietary non iso14443a-4 card found, RATS not supported");
19d6d91f	315	}
534983d7	316
f38a1528	317	return resp.arg[0];
7fe9b0b7	318	}
7fe9b0b7	319
db22dfe6	320	// Collect ISO14443 Type A UIDs
	321	int CmdHF14ACUIDs(const char *Cmd)
	322	{
	323	// requested number of UIDs
	324	int n = atoi(Cmd);
	325	// collect at least 1 (e.g. if no parameter was given)
	326	n = n > 0 ? n : 1;
	327
	328	PrintAndLog("Collecting %d UIDs", n);
	329	PrintAndLog("Start: %u", time(NULL));
	330	// repeat n times
	331	for (int i = 0; i < n; i++) {
	332	// execute anticollision procedure
	333	UsbCommand c = {CMD_READER_ISO_14443a, {ISO14A_CONNECT, 0, 0}};
	334	SendCommand(&c);
902cb3c0	335
72b1090a	336	UsbCommand resp;
72b1090a	337	WaitForResponse(CMD_ACK,&resp);
902cb3c0	338
f38a1528	339	uint8_t *uid = resp.d.asBytes;
f38a1528	340	iso14a_card_select_t card = (iso14a_card_select_t )(uid + 12);
db22dfe6	341
db22dfe6	342	// check if command failed
902cb3c0	343	if (resp.arg[0] == 0) {
db22dfe6	344	PrintAndLog("Card select failed.");
db22dfe6	345	} else {
f38a1528	346	// check if UID is 4 bytes
	347	if ((card->atqa[1] & 0xC0) == 0) {
	348	PrintAndLog("%02X%02X%02X%02X",
	349	uid, (uid + 1), (uid + 2), (uid + 3));
	350	} else {
	351	PrintAndLog("UID longer than 4 bytes");
db22dfe6	352	}
	353	}
	354	}
	355	PrintAndLog("End: %u", time(NULL));
	356
	357	return 1;
	358	}
	359
7fe9b0b7	360	// ## simulate iso14443a tag
	361	// ## greg - added ability to specify tag UID
	362	int CmdHF14ASim(const char *Cmd)
81cd0474	363	{
	364	UsbCommand c = {CMD_SIMULATE_TAG_ISO_14443a,{0,0,0}};
	365
	366	// Retrieve the tag type
	367	uint8_t tagtype = param_get8ex(Cmd,0,0,10);
	368
	369	// When no argument was given, just print help message
	370	if (tagtype == 0) {
	371	PrintAndLog("");
	372	PrintAndLog(" Emulating ISO/IEC 14443 type A tag with 4 or 7 byte UID");
	373	PrintAndLog("");
	374	PrintAndLog(" syntax: hf 14a sim <type> <uid>");
	375	PrintAndLog(" types: 1 = MIFARE Classic");
	376	PrintAndLog(" 2 = MIFARE Ultralight");
	377	PrintAndLog(" 3 = MIFARE DESFIRE");
	378	PrintAndLog(" 4 = ISO/IEC 14443-4");
95e63594	379	PrintAndLog(" 5 = MIFARE TNP3XXX");
81cd0474	380	PrintAndLog("");
	381	return 1;
	382	}
	383
	384	// Store the tag type
	385	c.arg[0] = tagtype;
	386
	387	// Retrieve the full 4 or 7 byte long uid
	388	uint64_t long_uid = param_get64ex(Cmd,1,0,16);
	389
	390	// Are we handling the (optional) second part uid?
	391	if (long_uid > 0xffffffff) {
125a98a1	392	PrintAndLog("Emulating ISO/IEC 14443 type A tag with 7 byte UID (%014"llx")",long_uid);
81cd0474	393	// Store the second part
	394	c.arg[2] = (long_uid & 0xffffffff);
	395	long_uid >>= 32;
	396	// Store the first part, ignore the first byte, it is replaced by cascade byte (0x88)
	397	c.arg[1] = (long_uid & 0xffffff);
	398	} else {
	399	PrintAndLog("Emulating ISO/IEC 14443 type A tag with 4 byte UID (%08x)",long_uid);
	400	// Only store the first part
	401	c.arg[1] = long_uid & 0xffffffff;
	402	}
	403	/*
	404	// At lease save the mandatory first part of the UID
	405	c.arg[0] = long_uid & 0xffffffff;
	406
81cd0474	407	if (c.arg[1] == 0) {
	408	PrintAndLog("Emulating ISO/IEC 14443 type A tag with UID %01d %08x %08x",c.arg[0],c.arg[1],c.arg[2]);
	409	}
	410
	411	switch (c.arg[0]) {
	412	case 1: {
	413	PrintAndLog("Emulating ISO/IEC 14443-3 type A tag with 4 byte UID");
	414	UsbCommand c = {CMD_SIMULATE_TAG_ISO_14443a,param_get32ex(Cmd,0,0,10),param_get32ex(Cmd,1,0,16),param_get32ex(Cmd,2,0,16)};
	415	} break;
	416	case 2: {
	417	PrintAndLog("Emulating ISO/IEC 14443-4 type A tag with 7 byte UID");
	418	} break;
	419	default: {
	420	PrintAndLog("Error: unkown tag type (%d)",c.arg[0]);
	421	PrintAndLog("syntax: hf 14a sim <uid>",c.arg[0]);
	422	PrintAndLog(" type1: 4 ",c.arg[0]);
	423
	424	return 1;
	425	} break;
	426	}
	427	*/
	428	/*
7fe9b0b7	429	unsigned int hi = 0, lo = 0;
	430	int n = 0, i = 0;
	431	while (sscanf(&Cmd[i++], "%1x", &n ) == 1) {
	432	hi= (hi << 4) \| (lo >> 28);
	433	lo= (lo << 4) \| (n & 0xf);
	434	}
81cd0474	435	*/
	436	// UsbCommand c = {CMD_SIMULATE_TAG_ISO_14443a,param_get32ex(Cmd,0,0,10),param_get32ex(Cmd,1,0,16),param_get32ex(Cmd,2,0,16)};
	437	// PrintAndLog("Emulating ISO/IEC 14443 type A tag with UID %01d %08x %08x",c.arg[0],c.arg[1],c.arg[2]);
7fe9b0b7	438	SendCommand(&c);
	439	return 0;
	440	}
	441
5cd9ec01 M	442	int CmdHF14ASnoop(const char *Cmd) {
	443	int param = 0;
	444
	445	if (param_getchar(Cmd, 0) == 'h') {
	446	PrintAndLog("It get data from the field and saves it into command buffer.");
	447	PrintAndLog("Buffer accessible from command hf 14a list.");
	448	PrintAndLog("Usage: hf 14a snoop [c][r]");
	449	PrintAndLog("c - triggered by first data from card");
	450	PrintAndLog("r - triggered by first 7-bit request from reader (REQ,WUP,...)");
	451	PrintAndLog("sample: hf 14a snoop c r");
	452	return 0;
	453	}
	454
	455	for (int i = 0; i < 2; i++) {
	456	char ctmp = param_getchar(Cmd, i);
	457	if (ctmp == 'c' \|\| ctmp == 'C') param \|= 0x01;
	458	if (ctmp == 'r' \|\| ctmp == 'R') param \|= 0x02;
	459	}
	460
	461	UsbCommand c = {CMD_SNOOP_ISO_14443a, {param, 0, 0}};
7fe9b0b7	462	SendCommand(&c);
	463	return 0;
	464	}
	465
5f6d6c90	466	int CmdHF14ACmdRaw(const char *cmd) {
	467	UsbCommand c = {CMD_READER_ISO_14443a, {0, 0, 0}};
	468	uint8_t reply=1;
	469	uint8_t crc=0;
	470	uint8_t power=0;
	471	uint8_t active=0;
	472	uint8_t active_select=0;
	473	uint16_t numbits=0;
f38a1528	474	uint16_t timeout=0;
f38a1528	475	uint8_t bTimeout=0;
5f6d6c90	476	char buf[5]="";
5f6d6c90	477	int i=0;
f38a1528	478	uint8_t data[USB_CMD_DATA_SIZE];
5f6d6c90	479	unsigned int datalen=0, temp;
	480
	481	if (strlen(cmd)<2) {
f38a1528	482	PrintAndLog("Usage: hf 14a raw [-r] [-c] [-p] [-f] [-b] [-t] <number of bits> <0A 0B 0C ... hex>");
5f6d6c90	483	PrintAndLog(" -r do not read response");
	484	PrintAndLog(" -c calculate and append CRC");
	485	PrintAndLog(" -p leave the signal field ON after receive");
	486	PrintAndLog(" -a active signal field ON without select");
	487	PrintAndLog(" -s active signal field ON with select");
	488	PrintAndLog(" -b number of bits to send. Useful for send partial byte");
f38a1528	489	PrintAndLog(" -t timeout");
5f6d6c90	490	return 0;
	491	}
	492
	493	// strip
	494	while (cmd==' ' \|\| cmd=='\t') cmd++;
	495
	496	while (cmd[i]!='\0') {
	497	if (cmd[i]==' ' \|\| cmd[i]=='\t') { i++; continue; }
	498	if (cmd[i]=='-') {
	499	switch (cmd[i+1]) {
	500	case 'r':
	501	reply=0;
	502	break;
	503	case 'c':
	504	crc=1;
	505	break;
	506	case 'p':
	507	power=1;
	508	break;
	509	case 'a':
	510	active=1;
	511	break;
	512	case 's':
	513	active_select=1;
	514	break;
	515	case 'b':
	516	sscanf(cmd+i+2,"%d",&temp);
	517	numbits = temp & 0xFFFF;
	518	i+=3;
	519	while(cmd[i]!=' ' && cmd[i]!='\0') { i++; }
	520	i-=2;
	521	break;
f38a1528	522	case 't':
	523	bTimeout=1;
	524	sscanf(cmd+i+2,"%d",&temp);
	525	timeout = temp & 0xFFFF;
	526	i+=3;
	527	while(cmd[i]!=' ' && cmd[i]!='\0') { i++; }
	528	i+=2;
	529	break;
5f6d6c90	530	default:
	531	PrintAndLog("Invalid option");
	532	return 0;
	533	}
	534	i+=2;
	535	continue;
	536	}
	537	if ((cmd[i]>='0' && cmd[i]<='9') \|\|
	538	(cmd[i]>='a' && cmd[i]<='f') \|\|
	539	(cmd[i]>='A' && cmd[i]<='F') ) {
	540	buf[strlen(buf)+1]=0;
	541	buf[strlen(buf)]=cmd[i];
	542	i++;
	543
	544	if (strlen(buf)>=2) {
	545	sscanf(buf,"%x",&temp);
	546	data[datalen]=(uint8_t)(temp & 0xff);
5f6d6c90	547	*buf=0;
f38a1528	548	if (++datalen>sizeof(data)){
	549	if (crc)
	550	PrintAndLog("Buffer is full, we can't add CRC to your data");
	551	break;
	552	}
5f6d6c90	553	}
	554	continue;
	555	}
	556	PrintAndLog("Invalid char on input");
	557	return 0;
	558	}
f38a1528	559	if(crc && datalen>0 && datalen<sizeof(data)-2)
5f6d6c90	560	{
	561	uint8_t first, second;
	562	ComputeCrc14443(CRC_14443_A, data, datalen, &first, &second);
	563	data[datalen++] = first;
	564	data[datalen++] = second;
	565	}
	566
	567	if(active \|\| active_select)
	568	{
	569	c.arg[0] \|= ISO14A_CONNECT;
	570	if(active)
	571	c.arg[0] \|= ISO14A_NO_SELECT;
	572	}
f38a1528	573	if(bTimeout){
	574	#define MAX_TIMEOUT 624*105 // max timeout is 624 ms
	575	c.arg[0] \|= ISO14A_SET_TIMEOUT;
	576	c.arg[2] = timeout * 105; // each bit is about 9.4 us
	577	if(c.arg[2]>MAX_TIMEOUT) {
	578	c.arg[2] = MAX_TIMEOUT;
	579	PrintAndLog("Set timeout to 624 ms. The max we can wait for response");
	580	}
	581	}
5f6d6c90	582	if(power)
	583	c.arg[0] \|= ISO14A_NO_DISCONNECT;
	584	if(datalen>0)
	585	c.arg[0] \|= ISO14A_RAW;
	586
f38a1528	587	// Max buffer is USB_CMD_DATA_SIZE
f38a1528	588	c.arg[1] = (datalen & 0xFFFF) \| (numbits << 16);
5f6d6c90	589	memcpy(c.d.asBytes,data,datalen);
	590
	591	SendCommand(&c);
	592
	593	if (reply) {
	594	if(active_select)
	595	waitCmd(1);
	596	if(datalen>0)
	597	waitCmd(0);
	598	} // if reply
	599	return 0;
	600	}
	601
	602	static void waitCmd(uint8_t iSelect)
	603	{
	604	uint8_t *recv;
	605	UsbCommand resp;
	606	char *hexout;
	607
95e63594	608	if (WaitForResponseTimeout(CMD_ACK,&resp,10000)) {
5f6d6c90	609	recv = resp.d.asBytes;
	610	uint8_t iLen = iSelect ? resp.arg[1] : resp.arg[0];
	611	PrintAndLog("received %i octets",iLen);
	612	if(!iLen)
	613	return;
	614	hexout = (char )malloc(iLen 3 + 1);
	615	if (hexout != NULL) {
5f6d6c90	616	for (int i = 0; i < iLen; i++) { // data in hex
f66021cf	617	sprintf(&hexout[i * 3], "%02X ", recv[i]);
5f6d6c90	618	}
	619	PrintAndLog("%s", hexout);
	620	free(hexout);
	621	} else {
	622	PrintAndLog("malloc failed your client has low memory?");
	623	}
	624	} else {
	625	PrintAndLog("timeout while waiting for reply.");
	626	}
	627	}
	628
7fe9b0b7	629	static command_t CommandTable[] =
7fe9b0b7	630	{
5acd09bd	631	{"help", CmdHelp, 1, "This help"},
	632	{"list", CmdHF14AList, 0, "List ISO 14443a history"},
	633	{"reader", CmdHF14AReader, 0, "Act like an ISO14443 Type A reader"},
	634	{"cuids", CmdHF14ACUIDs, 0, "<n> Collect n>0 ISO14443 Type A UIDs in one go"},
	635	{"sim", CmdHF14ASim, 0, "<UID> -- Fake ISO 14443a tag"},
	636	{"snoop", CmdHF14ASnoop, 0, "Eavesdrop ISO 14443 Type A"},
5f6d6c90	637	{"raw", CmdHF14ACmdRaw, 0, "Send raw hex data to tag"},
7fe9b0b7	638	{NULL, NULL, 0, NULL}
	639	};
	640
902cb3c0	641	int CmdHF14A(const char *Cmd) {
f397b5cc	642	// flush
902cb3c0	643	WaitForResponseTimeout(CMD_ACK,NULL,100);
f397b5cc M	644
f397b5cc M	645	// parse
7fe9b0b7	646	CmdsParse(CommandTable, Cmd);
	647	return 0;
	648	}
	649
	650	int CmdHelp(const char *Cmd)
	651	{
	652	CmdsHelp(CommandTable);
	653	return 0;
	654	}