[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 "iso14443crc.h"
#include "data.h"
#include "proxmark3.h"
#include "ui.h"
#include "cmdparser.h"
#include "cmdhf14a.h"
#include "common.h"
#include "cmdmain.h"
#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 got[1920];
	GetFromBigBuf(got,sizeof(got),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("-----------|-----------|-----|--------");

	int i = 0;
	uint32_t first_timestamp = 0;
	uint32_t timestamp;
	uint32_t EndOfTransmissionTimestamp = 0;
	
	for (;;) {
		if(i >= 1900) {
			break;
		}

		bool isResponse;
		timestamp = *((uint32_t *)(got+i));
		if (timestamp & 0x80000000) {
		  timestamp &= 0x7fffffff;
		  isResponse = true;
		} else {
		  isResponse = false;
		}

		if(i==0) {
			first_timestamp = timestamp;
		}
		
		int parityBits = *((uint32_t *)(got+i+4));

		int len = got[i+8];

		if (len > 100) {
			break;
		}
		if (i + len >= 1900) {
			break;
		}

		uint8_t *frame = (got+i+9);

		// Break and stick with current result if buffer was not completely full
		if (frame[0] == 0x44 && frame[1] == 0x44 && frame[2] == 0x44 && frame[3] == 0x44) break; 

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

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

				//if((parityBits >> (len - j - 1)) & 0x01) {
				if (isResponse && (oddparity != ((parityBits >> (len - j - 1)) & 0x01))) {
					sprintf(line+(j*4), "%02x!  ", frame[j]);
				} else {
					sprintf(line+(j*4), "%02x   ", frame[j]);
				}
			}
		} else {
			if (ShowWaitCycles) {
				uint32_t next_timestamp = (*((uint32_t *)(got+i+9))) & 0x7fffffff;
				sprintf(line, "fdt (Frame Delay Time): %d", (next_timestamp - timestamp));
			}
		}

		char *crc;
		crc = "";
		if (len > 2) {
			uint8_t b1, b2;
			for (j = 0; j < (len - 1); j++) {
				// gives problems... search for the reason..
				/*if(frame[j] == 0xAA) {
					switch(frame[j+1]) {
						case 0x01:
							crc = "[1] Two drops close after each other";
							break;
						case 0x02:
							crc = "[2] Potential SOC with a drop in second half of bitperiod";
							break;
						case 0x03:
							crc = "[3] Segment Z after segment X is not possible";
							break;
						case 0x04:
							crc = "[4] Parity bit of a fully received byte was wrong";
							break;
						default:
							crc = "[?] Unknown error";
							break;
					}
					break;
				}*/
			}

			if (strlen(crc)==0) {
				ComputeCrc14443(CRC_14443_A, frame, len-2, &b1, &b2);
				if (b1 != frame[len-2] || b2 != frame[len-1]) {
					crc = (isResponse & (len < 6)) ? "" : " !crc";
				} else {
					crc = "";
				}
			}
		} else {
			crc = ""; // SHORT
		}

		i += (len + 9);

		EndOfTransmissionTimestamp = (*((uint32_t *)(got+i))) & 0x7fffffff;
		
		if (!ShowWaitCycles) i += 9;
		
		PrintAndLog(" %9d | %9d | %s | %s %s",
			(timestamp - first_timestamp),
			(EndOfTransmissionTimestamp - first_timestamp),
			(len?(isResponse ? "Tag" : "Rdr"):"   "),
			line, crc);

	}
	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 | ISO14A_NO_DISCONNECT, 0, 0}};
	SendCommand(&c);

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

	uint64_t select_status = resp.arg[0];		// 0: couldn't read, 1: OK, with ATS, 2: OK, no ATS
	
	if(select_status == 0) {
		PrintAndLog("iso14443a card select failed");
		return 0;
	}

	PrintAndLog("ATQA : %02x %02x", card.atqa[1], card.atqa[0]);
	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 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: ;
	}

	
	// try to request ATS even if tag claims not to support it
	if (select_status == 2) {
		uint8_t rats[] = { 0xE0, 0x80 }; // FSDI=8 (FSD=256), CID=0
		c.arg[0] = ISO14A_RAW | ISO14A_APPEND_CRC | ISO14A_NO_DISCONNECT;
		c.arg[1] = 2;
		c.arg[2] = 0;
		memcpy(c.d.asBytes, rats, 2);
		SendCommand(&c);
		WaitForResponse(CMD_ACK,&resp);
		
	    memcpy(&card.ats, resp.d.asBytes, resp.arg[0]);
		card.ats_len = resp.arg[0];				// note: ats_len includes CRC Bytes
	} 

	// disconnect
	c.arg[0] = 0;
	c.arg[1] = 0;
	c.arg[2] = 0;
	SendCommand(&c);

	
	if(card.ats_len >= 3) {			// a valid ATS consists of at least the length byte (TL) and 2 CRC bytes
		bool ta1 = 0, tb1 = 0, tc1 = 0;
		int pos;

		if (select_status == 2) {
			PrintAndLog("SAK incorrectly claims that card doesn't support RATS");
		}
		PrintAndLog(" ATS : %s", sprint_hex(card.ats, card.ats_len));
		PrintAndLog("       -  TL : length is %d bytes", card.ats[0]);
		if (card.ats[0] != card.ats_len - 2) {
			PrintAndLog("ATS may be corrupted. Length of ATS (%d bytes incl. 2 Bytes CRC) doesn't match TL", card.ats_len);
		}
		
		if (card.ats[0] > 1) {		// there is a format byte (T0)
			ta1 = (card.ats[1] & 0x10) == 0x10;
			tb1 = (card.ats[1] & 0x20) == 0x20;
			tc1 = (card.ats[1] & 0x40) == 0x40;
			int16_t fsci = card.ats[1] & 0x0f;
			PrintAndLog("       -  T0 : TA1 is%s present, TB1 is%s present, "
					"TC1 is%s present, FSCI is %d (FSC = %ld)",
				(ta1 ? "" : " NOT"), (tb1 ? "" : " NOT"), (tc1 ? "" : " NOT"),
				fsci,
				fsci < 5 ? (fsci - 2) * 8 : 
					fsci < 8 ? (fsci - 3) * 32 :
					fsci == 8 ? 256 :
					-1
				);
		}
		pos = 2;
		if (ta1) {
			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) {
			uint32_t sfgi = card.ats[pos] & 0x0F;
			uint32_t fwi = card.ats[pos] >> 4;
			PrintAndLog("       - TB1 : SFGI = %d (SFGT = %s%ld/fc), FWI = %d (FWT = %ld/fc)",
					(sfgi),
					sfgi ? "" : "(not needed) ",
					sfgi ? (1 << 12) << sfgi : 0,
					fwi,
					(1 << 12) << fwi
					);
			pos++;
		}
		if (tc1) {
			PrintAndLog("       - TC1 : NAD is%s supported, CID is%s supported",
					(card.ats[pos] & 0x01) ? "" : " NOT",
					(card.ats[pos] & 0x02) ? "" : " NOT");
			pos++;
		}
		if (card.ats[0] > pos) {
			char *tip = "";
			if (card.ats[0] - 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[0] - pos), 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 iso14443-4 card found, RATS not supported");
	}

	return select_status;
}

// 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);

		iso14a_card_select_t *card = (iso14a_card_select_t *) resp.d.asBytes;

		// check if command failed
		if (resp.arg[0] == 0) {
			PrintAndLog("Card select failed.");
		} else {
			char uid_string[20];
			for (uint16_t i = 0; i < card->uidlen; i++) {
				sprintf(&uid_string[2*i], "%02X", card->uid[i]);
			}
			PrintAndLog("%s", uid_string);
		}
	}
	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("");
		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;

	
	// 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;
    char buf[5]="";
    int i=0;
    uint8_t data[100];
    unsigned int datalen=0, temp;

    if (strlen(cmd)<2) {
        PrintAndLog("Usage: hf 14a raw [-r] [-c] [-p] [-f] [-b] <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");
        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;
                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>0)
    {
        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(power)
        c.arg[0] |= ISO14A_NO_DISCONNECT;
    if(datalen>0)
        c.arg[0] |= ISO14A_RAW;

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