[proxmark3-svn] / client / cmdhfmfdes.c

//-----------------------------------------------------------------------------
// Copyright (C) 2014 Iceman
//
// This code is licensed to you under the terms of the GNU GPL, version 2 or,
// at your option, any later version. See the LICENSE.txt file for the text of
// the license.
//-----------------------------------------------------------------------------
// High frequency MIFARE Desfire commands
//-----------------------------------------------------------------------------

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <ctype.h>
#include <openssl/des.h>
#include "cmdmain.h"
#include "proxmark3.h"
#include "../include/common.h"
#include "../include/mifare.h"
#include "../common/iso14443crc.h"
#include "data.h"
#include "ui.h"
#include "cmdparser.h"
#include "util.h"
#include "cmdhfmfdes.h"

uint8_t CMDPOS = 0;
uint8_t LENPOS = 1;

uint8_t key_zero_data[16] = { 0x00 };
uint8_t key_ones_data[16] = { 0x01 };
uint8_t key_defa_data[16] = { 0x00,0x01,0x02,0x03,0x04,0x05,0x06,0x07,0x08,0x09,0x0a,0x0b,0x0c,0x0d,0x0e,0x0f };
uint8_t key_picc_data[16] = { 0x40,0x41,0x42,0x43,0x44,0x45,0x46,0x47,0x48,0x49,0x4a,0x4b,0x4c,0x4d,0x4e,0x4f };

static int CmdHelp(const char *Cmd);
static void xor(unsigned char * dst, unsigned char * src, size_t len);
static int32_t le24toh (uint8_t data[3]);


int CmdHF14ADesWb(const char *Cmd)
{
/* 	uint8_t blockNo = 0;
	uint8_t keyType = 0;
	uint8_t key[6] = {0, 0, 0, 0, 0, 0};
	uint8_t bldata[16] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
	
	char cmdp	= 0x00;

	if (strlen(Cmd)<3) {
		PrintAndLog("Usage:  hf mf wrbl    <block number> <key A/B> <key (12 hex symbols)> <block data (32 hex symbols)>");
		PrintAndLog("        sample: hf mf wrbl 0 A FFFFFFFFFFFF 000102030405060708090A0B0C0D0E0F");
		return 0;
	}	

	blockNo = param_get8(Cmd, 0);
	cmdp = param_getchar(Cmd, 1);
	if (cmdp == 0x00) {
		PrintAndLog("Key type must be A or B");
		return 1;
	}
	if (cmdp != 'A' && cmdp != 'a') keyType = 1;
	if (param_gethex(Cmd, 2, key, 12)) {
		PrintAndLog("Key must include 12 HEX symbols");
		return 1;
	}
	if (param_gethex(Cmd, 3, bldata, 32)) {
		PrintAndLog("Block data must include 32 HEX symbols");
		return 1;
	}
	PrintAndLog("--block no:%02x key type:%02x key:%s", blockNo, keyType, sprint_hex(key, 6));
	PrintAndLog("--data: %s", sprint_hex(bldata, 16));
	
  UsbCommand c = {CMD_MIFARE_WRITEBL, {blockNo, keyType, 0}};
	memcpy(c.d.asBytes, key, 6);
	memcpy(c.d.asBytes + 10, bldata, 16);
  SendCommand(&c);

	UsbCommand resp;
	if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
		uint8_t isOK  = resp.arg[0] & 0xff;
		PrintAndLog("isOk:%02x", isOK);
	} else {
		PrintAndLog("Command execute timeout");
	}
 */
	return 0;
}

int CmdHF14ADesRb(const char *Cmd)
{
	// uint8_t blockNo = 0;
	// uint8_t keyType = 0;
	// uint8_t key[6] = {0, 0, 0, 0, 0, 0};
	
	// char cmdp	= 0x00;


	// if (strlen(Cmd)<3) {
		// PrintAndLog("Usage:  hf mf rdbl    <block number> <key A/B> <key (12 hex symbols)>");
		// PrintAndLog("        sample: hf mf rdbl 0 A FFFFFFFFFFFF ");
		// return 0;
	// }	
	
	// blockNo = param_get8(Cmd, 0);
	// cmdp = param_getchar(Cmd, 1);
	// if (cmdp == 0x00) {
		// PrintAndLog("Key type must be A or B");
		// return 1;
	// }
	// if (cmdp != 'A' && cmdp != 'a') keyType = 1;
	// if (param_gethex(Cmd, 2, key, 12)) {
		// PrintAndLog("Key must include 12 HEX symbols");
		// return 1;
	// }
	// PrintAndLog("--block no:%02x key type:%02x key:%s ", blockNo, keyType, sprint_hex(key, 6));
	
  // UsbCommand c = {CMD_MIFARE_READBL, {blockNo, keyType, 0}};
	// memcpy(c.d.asBytes, key, 6);
  // SendCommand(&c);

	// UsbCommand resp;
	// if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
		// uint8_t                isOK  = resp.arg[0] & 0xff;
		// uint8_t              * data  = resp.d.asBytes;

		// if (isOK)
			// PrintAndLog("isOk:%02x data:%s", isOK, sprint_hex(data, 16));
		// else
			// PrintAndLog("isOk:%02x", isOK);
	// } else {
		// PrintAndLog("Command execute timeout");
	// }

  return 0;
}

int CmdHF14ADesInfo(const char *Cmd){

	UsbCommand c = {CMD_MIFARE_DESFIRE_INFO};
    SendCommand(&c);
	UsbCommand resp;
	
	if ( !WaitForResponseTimeout(CMD_ACK,&resp,1500) ) {
		PrintAndLog("Command execute timeout");
		return 0;
	}
	uint8_t isOK  = resp.arg[0] & 0xff;
	if ( !isOK ){
		PrintAndLog("Command unsuccessful");
		return 0;
	}  
	PrintAndLog("");
	PrintAndLog("-- Desfire Information --------------------------------------");
	PrintAndLog("-------------------------------------------------------------");
	PrintAndLog("  UID                : %s",sprint_hex(resp.d.asBytes, 7));
	PrintAndLog("  Batch number       : %s",sprint_hex(resp.d.asBytes+28,5));
	PrintAndLog("  Production date    : week %02x, 20%02x",resp.d.asBytes[33], resp.d.asBytes[34]);
	PrintAndLog("  -----------------------------------------------------------");
	PrintAndLog("  Hardware Information");
	PrintAndLog("      Vendor Id      : %s", GetVendorStr(resp.d.asBytes[7]));
	PrintAndLog("      Type           : 0x%02X",resp.d.asBytes[8]);
	PrintAndLog("      Subtype        : 0x%02X",resp.d.asBytes[9]);
	PrintAndLog("      Version        : %d.%d",resp.d.asBytes[10], resp.d.asBytes[11]);
	PrintAndLog("      Storage size   : %s",GetCardSizeStr(resp.d.asBytes[12]));
	PrintAndLog("      Protocol       : %s",GetProtocolStr(resp.d.asBytes[13]));
	PrintAndLog("  -----------------------------------------------------------");
	PrintAndLog("  Software Information");
	PrintAndLog("      Vendor Id      : %s",GetVendorStr(resp.d.asBytes[14]));
	PrintAndLog("      Type           : 0x%02X",resp.d.asBytes[15]);
	PrintAndLog("      Subtype        : 0x%02X",resp.d.asBytes[16]);
	PrintAndLog("      Version        : %d.%d",resp.d.asBytes[17], resp.d.asBytes[18]);
	PrintAndLog("      storage size   : %s", GetCardSizeStr(resp.d.asBytes[19]));
	PrintAndLog("      Protocol       : %s", GetProtocolStr(resp.d.asBytes[20]));
	PrintAndLog("-------------------------------------------------------------");
	
	// Master Key settings
	GetKeySettings(NULL);
	
	// Free memory on card
	c.cmd = CMD_MIFARE_DESFIRE;
	c.arg[0] = (INIT | DISCONNECT);
	c.arg[1] = 0x01;
	c.d.asBytes[0] = GET_FREE_MEMORY;
    SendCommand(&c);
	if ( !WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
		return 0;
	}  
	
	uint8_t tmp[3];
	memcpy(tmp, resp.d.asBytes+3,3); 

	PrintAndLog("   Available free memory on card       : %d bytes", le24toh( tmp ));
	PrintAndLog("-------------------------------------------------------------");

	/*
		Card Master key (CMK)        0x00 AID = 00 00 00 (card level)
		Application Master Key (AMK) 0x00 AID != 00 00 00
		Application keys (APK)       0x01-0x0D
		Application free             0x0E
		Application never            0x0F
		
		ACCESS RIGHTS:
		keys 0,1,2,3     C
		keys 4,5,6,7     RW
		keys 8,9,10,11   W
		keys 12,13,14,15 R
	
	*/
	
    return 1;
}

char * GetVendorStr( uint8_t id){
 	static char buf[30];
	char *retStr = buf;
	
	if ( id == 0x04 )
		sprintf(retStr, "0x%02X (NXP)",id);
	else 
		sprintf(retStr,"0x%02X (Unknown)",id);
	return buf;
}

/*
  The 7 MSBits (= n) code the storage size itself based on 2^n, 
  the LSBit is set to '0' if the size is exactly 2^n
	and set to '1' if the storage size is between 2^n and 2^(n+1). 
	For this version of DESFire the 7 MSBits are set to 0x0C (2^12 = 4096) and the LSBit is '0'.
*/
char * GetCardSizeStr( uint8_t fsize ){
 
 	static char buf[30];
	char *retStr = buf;

	uint16_t usize = 1 << ((fsize >>1) + 1);
	uint16_t lsize = 1 << (fsize >>1);
	
	// is  LSB set?
	if (  fsize & (1 << 0 ) )
		sprintf(retStr, "0x%02X (%d - %d bytes)",fsize, usize, lsize);
	else 
		sprintf(retStr, "0x%02X (%d bytes)", fsize, lsize);		
	return buf;
}

char * GetProtocolStr(uint8_t id){

 	static char buf[30];
	char *retStr = buf;

	if ( id == 0x05)
		sprintf(retStr,"0x%02X (ISO 14443-3, 14443-4)", id);
	else
		sprintf(retStr,"0x%02X", id);	
	return buf;
}

void GetKeySettings( uint8_t *aid){
	
	char messStr[512] = {0x00};
	char *str = messStr;
	uint8_t isOK = 0;
	uint32_t options = NONE;
	UsbCommand c;
	UsbCommand resp;

	//memset(messStr, 0x00, 512);
	
	c.cmd = CMD_MIFARE_DESFIRE;
	
	if ( aid == NULL ){
		PrintAndLog(" CMK - PICC, Card Master Key settings ");
		PrintAndLog("");
		c.arg[CMDPOS] = (INIT | DISCONNECT);
		c.arg[LENPOS] =  0x01;
		c.d.asBytes[0] = GET_KEY_SETTINGS;  // 0x45
		SendCommand(&c);
		if ( !WaitForResponseTimeout(CMD_ACK,&resp,1000) ) {return;}  
		isOK  = resp.arg[0] & 0xff;
		if ( !isOK ){
			PrintAndLog("   Can't select master application");	
			return;
		}	

		str = (resp.d.asBytes[3] & (1 << 3 )) ? "YES":"NO";	
		PrintAndLog("   [0x08] Configuration changeable       : %s", str);
		str = (resp.d.asBytes[3] & (1 << 2 )) ? "NO":"YES";
		PrintAndLog("   [0x04] CMK required for create/delete : %s",str);
		str = (resp.d.asBytes[3] & (1 << 1 )) ? "NO":"YES";
		PrintAndLog("   [0x02] Directory list access with CMK : %s",str);
		str = (resp.d.asBytes[3] & (1 << 0 )) ? "YES" : "NO";
		PrintAndLog("   [0x01] CMK is changeable              : %s", str);
			
		c.arg[LENPOS] = 0x02; //LEN
		c.d.asBytes[0] = GET_KEY_VERSION; //0x64
		c.d.asBytes[1] = 0x00;
		SendCommand(&c);
		if ( !WaitForResponseTimeout(CMD_ACK,&resp,1000) ) {
			return;
		}
		isOK  = resp.arg[0] & 0xff;
		if ( !isOK ){
			PrintAndLog("   Can't read key-version");
			return;
		}
		PrintAndLog("");
		PrintAndLog("   Max number of keys       : %d", resp.d.asBytes[4]);
		PrintAndLog("   Master key Version       : %d (0x%02x)", resp.d.asBytes[3], resp.d.asBytes[3]);
		PrintAndLog("   ----------------------------------------------------------");
		
		c.arg[LENPOS] = 0x02; //LEN
		c.d.asBytes[0] = AUTHENTICATE; //0x0A
		c.d.asBytes[1] = 0x00; // KEY 0
		SendCommand(&c);
		if ( !WaitForResponseTimeout(CMD_ACK,&resp,1000) ) {return;}
		isOK  = resp.d.asBytes[2] & 0xff;
		PrintAndLog("   [0x0A] Authenticate      : %s", ( isOK==0xAE ) ? "NO":"YES");

		c.d.asBytes[0] = AUTHENTICATE_ISO; //0x1A
		SendCommand(&c);
		if ( !WaitForResponseTimeout(CMD_ACK,&resp,1000) ) {return;}
		isOK  = resp.d.asBytes[2] & 0xff;
		PrintAndLog("   [0x1A] Authenticate ISO  : %s", ( isOK==0xAE ) ? "NO":"YES");
		
		c.d.asBytes[0] = AUTHENTICATE_AES; //0xAA
		SendCommand(&c);
		if ( !WaitForResponseTimeout(CMD_ACK,&resp,1000) ) {return;}
		isOK  = resp.d.asBytes[2] & 0xff;
		PrintAndLog("   [0xAA] Authenticate AES  : %s", ( isOK==0xAE ) ? "NO":"YES");
		PrintAndLog("");
		PrintAndLog("   ----------------------------------------------------------");
		
	} else {
		PrintAndLog(" AMK - Application Master Key settings");
		
		// SELECT AID
		c.arg[0] = (INIT | CLEARTRACE);
		c.arg[LENPOS] = 0x04;
		c.d.asBytes[0] = SELECT_APPLICATION;  // 0x5a
		memcpy(c.d.asBytes+1, aid, 3);
		SendCommand(&c);
		
		if (!WaitForResponseTimeout(CMD_ACK,&resp,1500) ) {
			PrintAndLog("   Timed-out");
			return;
		} 
		isOK  = resp.arg[0] & 0xff;
		if ( !isOK ){
			PrintAndLog("   Can't select AID: %s",sprint_hex(aid,3));	
			return;
		}		
		
		// KEY SETTINGS
		options = NONE;
		c.arg[0] = options;
		c.arg[LENPOS] = 0x01;
		c.d.asBytes[0] = GET_KEY_SETTINGS; // 0x45		
		SendCommand(&c);
		if ( !WaitForResponseTimeout(CMD_ACK,&resp,1500) ) {
			return;
		}
		isOK  = resp.arg[0] & 0xff;
		if ( !isOK ){
			PrintAndLog("   Can't read Application Master key settings");
		} else {
			// Access rights.
			uint8_t rights = (resp.d.asBytes[3] >> 4 && 0xff);
			switch (rights){
				case 0x00:
					str = "AMK authentication is necessary to change any key (default)";
					break;
				case 0x0e:
					str = "Authentication with the key to be changed (same KeyNo) is necessary to change a key";
					break;
				case 0x0f:
					str = "All keys (except AMK,see Bit0) within this application are frozen";
					break;
				default:
					str = "Authentication with the specified key is necessary to change any ley. A change key and a PICC master key (CMK) can only be changed after authentication with the master key. For keys other then the master or change key, an authentication with the same key is needed.";
					break;
			}
			PrintAndLog("Changekey Access rights");
			PrintAndLog("-- %s",str);
			PrintAndLog("");	
			// same as CMK
			str = (resp.d.asBytes[3] & (1 << 3 )) ? "YES":"NO";	
			PrintAndLog("   0x08 Configuration changeable       : %s", str);
			str = (resp.d.asBytes[3] & (1 << 2 )) ? "NO":"YES";
			PrintAndLog("   0x04 AMK required for create/delete : %s",str);
			str = (resp.d.asBytes[3] & (1 << 1 )) ? "NO":"YES";
			PrintAndLog("   0x02 Directory list access with AMK : %s",str);
			str = (resp.d.asBytes[3] & (1 << 0 )) ? "YES" : "NO";
			PrintAndLog("   0x01 AMK is changeable              : %s", str);
		}
		
		// KEY VERSION  - AMK 
		c.arg[0] = NONE;
		c.arg[LENPOS] = 0x02;
		c.d.asBytes[0] = GET_KEY_VERSION; //0x64
		c.d.asBytes[1] = 0x00;
		SendCommand(&c);
		if ( !WaitForResponseTimeout(CMD_ACK,&resp,1500) ) {
			PrintAndLog("   Timed-out");
			return;
		}
		
		int numOfKeys;
		
		isOK  = resp.arg[0] & 0xff;
		if ( !isOK ){
			PrintAndLog("   Can't read Application Master key version. Trying all keys");
			numOfKeys = MAX_NUM_KEYS;
		}
		else{
			numOfKeys = resp.d.asBytes[4];
			PrintAndLog("");
			PrintAndLog("     Max number of keys  : %d", numOfKeys );
			PrintAndLog("     Application Master key Version  : %d (0x%02x)", resp.d.asBytes[3], resp.d.asBytes[3]);
			PrintAndLog("-------------------------------------------------------------");			
		}
		
		// LOOP over numOfKeys that we got before. 
		// From 0x01 to numOfKeys.  We already got 0x00. (AMK)
		for(int i=0x01; i<=0x0f; ++i){
					
		}
		
		
	}
}

int CmdHF14ADesEnumApplications(const char *Cmd){
	
	uint8_t isOK = 0x00;
	uint8_t aid[3];
	uint32_t options = (INIT | DISCONNECT);
	
	UsbCommand c = {CMD_MIFARE_DESFIRE, {options , 0x01 }};
	c.d.asBytes[0] = GET_APPLICATION_IDS;  //0x6a
	
    SendCommand(&c);
	UsbCommand resp;
		
	if ( !WaitForResponseTimeout(CMD_ACK,&resp,1500) ) {
		return 0;
	}  
	isOK  = resp.arg[0] & 0xff;
	if ( !isOK ){
		PrintAndLog("Command unsuccessful");
		return 0;
	} 
	PrintAndLog("");	
	PrintAndLog("-- Desfire Enumerate Applications ---------------------------");
	PrintAndLog("-------------------------------------------------------------");

	UsbCommand respAid;
	UsbCommand respFiles;
	
	uint8_t num = 0;
	int max = resp.arg[1] -3 -2;
	
	for(int i=3; i<=max; i+=3){
		PrintAndLog(" Aid %d : %02X %02X %02X ",num ,resp.d.asBytes[i],resp.d.asBytes[i+1],resp.d.asBytes[i+2]);
		num++;
		
		aid[0] = resp.d.asBytes[i];
		aid[1] = resp.d.asBytes[i+1];
		aid[2] = resp.d.asBytes[i+2];
		GetKeySettings(aid);
		
		// Select Application
		c.arg[CMDPOS] = INIT;
		c.arg[LENPOS] = 0x04; 
		c.d.asBytes[0] = SELECT_APPLICATION;  // 0x5a
		c.d.asBytes[1] = resp.d.asBytes[i];
		c.d.asBytes[2] = resp.d.asBytes[i+1];		
		c.d.asBytes[3] = resp.d.asBytes[i+2];
		SendCommand(&c);
		
		if (!WaitForResponseTimeout(CMD_ACK,&respAid,1500) ) {
			PrintAndLog("   Timed-out");
			continue;
		} 
		isOK  = respAid.d.asBytes[2] & 0xff;
		if ( isOK != 0x00 ){
			PrintAndLog("   Can't select AID: %s",sprint_hex(resp.d.asBytes+i,3));	
			continue;
		}
	
		// Get File IDs
		c.arg[CMDPOS] = NONE;
		c.arg[LENPOS] = 0x01;
		c.d.asBytes[0] = GET_FILE_IDS; // 0x6f
		SendCommand(&c);
		
		if ( !WaitForResponseTimeout(CMD_ACK,&respFiles,1500) ) {
			PrintAndLog("   Timed-out");
			continue;
		} else {
			isOK  = respFiles.d.asBytes[2] & 0xff;
			if ( !isOK ){
				PrintAndLog("   Can't get file ids ");
			} else {			
				int respfileLen = resp.arg[1]-3-2;			
				for (int j=0; j< respfileLen; ++j){
					PrintAndLog("   Fileid %d :", resp.d.asBytes[j+3]);
				}
			}
		}
		
		// Get ISO File IDs
		c.arg[CMDPOS] = DISCONNECT;
		c.arg[LENPOS] = 0x01;
		c.d.asBytes[0] = GET_ISOFILE_IDS; // 0x61
		SendCommand(&c);
		
		if ( !WaitForResponseTimeout(CMD_ACK,&respFiles,1500) ) {
			PrintAndLog("   Timed-out");
			continue;
		} else {
			isOK  = respFiles.d.asBytes[2] & 0xff;
			if ( !isOK ){
				PrintAndLog("   Can't get ISO file ids ");
			} else {			
				int respfileLen = resp.arg[1]-3-2;			
				for (int j=0; j< respfileLen; ++j){
					PrintAndLog(" ISO  Fileid %d :", resp.d.asBytes[j+3]);
				}
			}
		}
		
		
	}
	PrintAndLog("-------------------------------------------------------------");
	
	
	return 1;
}

// MIAFRE DesFire Authentication
//
#define BUFSIZE 256 
int CmdHF14ADesAuth(const char *Cmd){
    
	// NR  DESC		KEYLENGHT
	// ------------------------
	// 1 = DES		8
	// 2 = 3DES		16
	// 3 = 3K 3DES	24
	// 4 = AES		16

	uint8_t keylength = 8;
	unsigned char key[24];	
	
    if (strlen(Cmd)<3) {
        PrintAndLog("Usage:  hf mfdes auth <1|2|3> <1|2|3|4> <keyno> <key> ");
		PrintAndLog("		    Auth modes");
		PrintAndLog("                 1 = normal, 2 = iso, 3 = aes");
		PrintAndLog("		    Crypto");
		PrintAndLog("                 1 = DES 2 = 3DES 3 = 3K3DES 4 = AES");
		PrintAndLog("");
        PrintAndLog("        sample: hf mfdes auth 1 1 0 11223344");
		PrintAndLog("        sample: hf mfdes auth 3 4 0 404142434445464748494a4b4c4d4e4f");
        return 0;
    } 
	uint8_t cmdAuthMode	= param_get8(Cmd,0);
	uint8_t cmdAuthAlgo	= param_get8(Cmd,1);
	uint8_t cmdKeyNo	= param_get8(Cmd,2);
	
	switch (cmdAuthMode)
	{
		case 1: 
			if ( cmdAuthAlgo != 1 && cmdAuthAlgo != 2) {
				PrintAndLog("Crypto algo not valid for the auth mode");
				return 1;
			}
			break;
		case 2:
			if ( cmdAuthAlgo != 1 && cmdAuthAlgo != 2 && cmdAuthAlgo != 3) {
				PrintAndLog("Crypto algo not valid for the auth mode");
				return 1;
			}
			break;
		case 3:
			if ( cmdAuthAlgo != 4) {
				PrintAndLog("Crypto algo not valid for the auth mode");
				return 1;
			}
			break;
		default:
			PrintAndLog("Wrong Auth mode");
			return 1;
			break;
	}
	
	switch (cmdAuthAlgo){
		case 2: 
			keylength = 16;
			PrintAndLog("3DES selected");
			break;
		case 3: 
			keylength = 24;
			PrintAndLog("3 key 3DES selected");
			break;
		case 4:
			keylength = 16;
			PrintAndLog("AES selected");
			break;
		default:
			cmdAuthAlgo = 1;
			keylength = 8;
			PrintAndLog("DES selected");
			break;
	}

	// key
	if (param_gethex(Cmd, 3, key, keylength*2)) {
		PrintAndLog("Key must include %d HEX symbols", keylength);
		return 1;
	}
Commit	Line	Data
f38a1528	1	//-----------------------------------------------------------------------------
	2	// Copyright (C) 2014 Iceman
	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 MIFARE Desfire commands
	9	//-----------------------------------------------------------------------------
	10
	11	#include <stdio.h>
	12	#include <stdlib.h>
	13	#include <string.h>
	14	#include <ctype.h>
	15	#include <openssl/des.h>
	16	#include "cmdmain.h"
	17	#include "proxmark3.h"
	18	#include "../include/common.h"
	19	#include "../include/mifare.h"
	20	#include "../common/iso14443crc.h"
	21	#include "data.h"
	22	#include "ui.h"
	23	#include "cmdparser.h"
	24	#include "util.h"
	25	#include "cmdhfmfdes.h"
	26
f6c18637	27	uint8_t CMDPOS = 0;
f6c18637	28	uint8_t LENPOS = 1;
f38a1528	29
95e63594	30	uint8_t key_zero_data[16] = { 0x00 };
95e63594	31	uint8_t key_ones_data[16] = { 0x01 };
f38a1528	32	uint8_t key_defa_data[16] = { 0x00,0x01,0x02,0x03,0x04,0x05,0x06,0x07,0x08,0x09,0x0a,0x0b,0x0c,0x0d,0x0e,0x0f };
f6c18637	33	uint8_t key_picc_data[16] = { 0x40,0x41,0x42,0x43,0x44,0x45,0x46,0x47,0x48,0x49,0x4a,0x4b,0x4c,0x4d,0x4e,0x4f };
f38a1528	34
	35	static int CmdHelp(const char *Cmd);
	36	static void xor(unsigned char * dst, unsigned char * src, size_t len);
	37	static int32_t le24toh (uint8_t data[3]);
	38
	39
	40	int CmdHF14ADesWb(const char *Cmd)
	41	{
	42	/* uint8_t blockNo = 0;
	43	uint8_t keyType = 0;
	44	uint8_t key[6] = {0, 0, 0, 0, 0, 0};
	45	uint8_t bldata[16] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
	46
	47	char cmdp = 0x00;
	48
	49	if (strlen(Cmd)<3) {
	50	PrintAndLog("Usage: hf mf wrbl <block number> <key A/B> <key (12 hex symbols)> <block data (32 hex symbols)>");
	51	PrintAndLog(" sample: hf mf wrbl 0 A FFFFFFFFFFFF 000102030405060708090A0B0C0D0E0F");
	52	return 0;
	53	}
	54
	55	blockNo = param_get8(Cmd, 0);
	56	cmdp = param_getchar(Cmd, 1);
	57	if (cmdp == 0x00) {
	58	PrintAndLog("Key type must be A or B");
	59	return 1;
	60	}
	61	if (cmdp != 'A' && cmdp != 'a') keyType = 1;
	62	if (param_gethex(Cmd, 2, key, 12)) {
	63	PrintAndLog("Key must include 12 HEX symbols");
	64	return 1;
	65	}
	66	if (param_gethex(Cmd, 3, bldata, 32)) {
	67	PrintAndLog("Block data must include 32 HEX symbols");
	68	return 1;
	69	}
	70	PrintAndLog("--block no:%02x key type:%02x key:%s", blockNo, keyType, sprint_hex(key, 6));
	71	PrintAndLog("--data: %s", sprint_hex(bldata, 16));
	72
	73	UsbCommand c = {CMD_MIFARE_WRITEBL, {blockNo, keyType, 0}};
	74	memcpy(c.d.asBytes, key, 6);
	75	memcpy(c.d.asBytes + 10, bldata, 16);
	76	SendCommand(&c);
	77
	78	UsbCommand resp;
	79	if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
	80	uint8_t isOK = resp.arg[0] & 0xff;
	81	PrintAndLog("isOk:%02x", isOK);
	82	} else {
	83	PrintAndLog("Command execute timeout");
	84	}
	85	*/
	86	return 0;
	87	}
	88
	89	int CmdHF14ADesRb(const char *Cmd)
	90	{
	91	// uint8_t blockNo = 0;
	92	// uint8_t keyType = 0;
	93	// uint8_t key[6] = {0, 0, 0, 0, 0, 0};
	94
	95	// char cmdp = 0x00;
	96
	97
98	// if (strlen(Cmd)<3) {
99	// PrintAndLog("Usage: hf mf rdbl <block number> <key A/B> <key (12 hex symbols)>");
100	// PrintAndLog(" sample: hf mf rdbl 0 A FFFFFFFFFFFF ");
101	// return 0;
102	// }
103
104	// blockNo = param_get8(Cmd, 0);
105	// cmdp = param_getchar(Cmd, 1);
106	// if (cmdp == 0x00) {
107	// PrintAndLog("Key type must be A or B");
108	// return 1;
109	// }
110	// if (cmdp != 'A' && cmdp != 'a') keyType = 1;
111	// if (param_gethex(Cmd, 2, key, 12)) {
112	// PrintAndLog("Key must include 12 HEX symbols");
113	// return 1;
114	// }
115	// PrintAndLog("--block no:%02x key type:%02x key:%s ", blockNo, keyType, sprint_hex(key, 6));
116
117	// UsbCommand c = {CMD_MIFARE_READBL, {blockNo, keyType, 0}};
118	// memcpy(c.d.asBytes, key, 6);
119	// SendCommand(&c);
120
121	// UsbCommand resp;
122	// if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
123	// uint8_t isOK = resp.arg[0] & 0xff;
124	// uint8_t * data = resp.d.asBytes;
125
126	// if (isOK)
127	// PrintAndLog("isOk:%02x data:%s", isOK, sprint_hex(data, 16));
128	// else
129	// PrintAndLog("isOk:%02x", isOK);
130	// } else {
131	// PrintAndLog("Command execute timeout");
132	// }
133
134	return 0;
135	}
136
137	int CmdHF14ADesInfo(const char *Cmd){
138
313ee67e	139	UsbCommand c = {CMD_MIFARE_DESFIRE_INFO};
f38a1528	140	SendCommand(&c);
	141	UsbCommand resp;
	142
313ee67e	143	if ( !WaitForResponseTimeout(CMD_ACK,&resp,1500) ) {
f38a1528	144	PrintAndLog("Command execute timeout");
f38a1528	145	return 0;
313ee67e	146	}
	147	uint8_t isOK = resp.arg[0] & 0xff;
	148	if ( !isOK ){
3d93d4f9	149	PrintAndLog("Command unsuccessful");
313ee67e	150	return 0;
f38a1528	151	}
f6c18637	152	PrintAndLog("");
f6c18637	153	PrintAndLog("-- Desfire Information --------------------------------------");
f38a1528	154	PrintAndLog("-------------------------------------------------------------");
	155	PrintAndLog(" UID : %s",sprint_hex(resp.d.asBytes, 7));
	156	PrintAndLog(" Batch number : %s",sprint_hex(resp.d.asBytes+28,5));
	157	PrintAndLog(" Production date : week %02x, 20%02x",resp.d.asBytes[33], resp.d.asBytes[34]);
f6c18637	158	PrintAndLog(" -----------------------------------------------------------");
f38a1528	159	PrintAndLog(" Hardware Information");
	160	PrintAndLog(" Vendor Id : %s", GetVendorStr(resp.d.asBytes[7]));
	161	PrintAndLog(" Type : 0x%02X",resp.d.asBytes[8]);
	162	PrintAndLog(" Subtype : 0x%02X",resp.d.asBytes[9]);
	163	PrintAndLog(" Version : %d.%d",resp.d.asBytes[10], resp.d.asBytes[11]);
	164	PrintAndLog(" Storage size : %s",GetCardSizeStr(resp.d.asBytes[12]));
	165	PrintAndLog(" Protocol : %s",GetProtocolStr(resp.d.asBytes[13]));
f6c18637	166	PrintAndLog(" -----------------------------------------------------------");
f38a1528	167	PrintAndLog(" Software Information");
	168	PrintAndLog(" Vendor Id : %s",GetVendorStr(resp.d.asBytes[14]));
	169	PrintAndLog(" Type : 0x%02X",resp.d.asBytes[15]);
	170	PrintAndLog(" Subtype : 0x%02X",resp.d.asBytes[16]);
	171	PrintAndLog(" Version : %d.%d",resp.d.asBytes[17], resp.d.asBytes[18]);
	172	PrintAndLog(" storage size : %s", GetCardSizeStr(resp.d.asBytes[19]));
	173	PrintAndLog(" Protocol : %s", GetProtocolStr(resp.d.asBytes[20]));
	174	PrintAndLog("-------------------------------------------------------------");
	175
f6c18637	176	// Master Key settings
f6c18637	177	GetKeySettings(NULL);
313ee67e	178
f6c18637	179	// Free memory on card
	180	c.cmd = CMD_MIFARE_DESFIRE;
	181	c.arg[0] = (INIT \| DISCONNECT);
	182	c.arg[1] = 0x01;
	183	c.d.asBytes[0] = GET_FREE_MEMORY;
	184	SendCommand(&c);
313ee67e	185	if ( !WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
	186	return 0;
	187	}
	188
f38a1528	189	uint8_t tmp[3];
313ee67e	190	memcpy(tmp, resp.d.asBytes+3,3);
f38a1528	191
f6c18637	192	PrintAndLog(" Available free memory on card : %d bytes", le24toh( tmp ));
f38a1528	193	PrintAndLog("-------------------------------------------------------------");
3d93d4f9	194
f38a1528	195	/*
75465377	196	Card Master key (CMK) 0x00 AID = 00 00 00 (card level)
	197	Application Master Key (AMK) 0x00 AID != 00 00 00
	198	Application keys (APK) 0x01-0x0D
	199	Application free 0x0E
	200	Application never 0x0F
f38a1528	201
	202	ACCESS RIGHTS:
	203	keys 0,1,2,3 C
	204	keys 4,5,6,7 RW
	205	keys 8,9,10,11 W
	206	keys 12,13,14,15 R
f6c18637	207
f38a1528	208	*/
f38a1528	209
f38a1528	210	return 1;
	211	}
	212
	213	char * GetVendorStr( uint8_t id){
	214	static char buf[30];
	215	char *retStr = buf;
	216
	217	if ( id == 0x04 )
	218	sprintf(retStr, "0x%02X (NXP)",id);
	219	else
	220	sprintf(retStr,"0x%02X (Unknown)",id);
	221	return buf;
	222	}
	223
	224	/*
	225	The 7 MSBits (= n) code the storage size itself based on 2^n,
	226	the LSBit is set to '0' if the size is exactly 2^n
	227	and set to '1' if the storage size is between 2^n and 2^(n+1).
	228	For this version of DESFire the 7 MSBits are set to 0x0C (2^12 = 4096) and the LSBit is '0'.
	229	*/
	230	char * GetCardSizeStr( uint8_t fsize ){
	231
	232	static char buf[30];
	233	char *retStr = buf;
	234
	235	uint16_t usize = 1 << ((fsize >>1) + 1);
	236	uint16_t lsize = 1 << (fsize >>1);
	237
	238	// is LSB set?
	239	if ( fsize & (1 << 0 ) )
	240	sprintf(retStr, "0x%02X (%d - %d bytes)",fsize, usize, lsize);
	241	else
	242	sprintf(retStr, "0x%02X (%d bytes)", fsize, lsize);
	243	return buf;
	244	}
	245
	246	char * GetProtocolStr(uint8_t id){
	247
	248	static char buf[30];
	249	char *retStr = buf;
	250
	251	if ( id == 0x05)
	252	sprintf(retStr,"0x%02X (ISO 14443-3, 14443-4)", id);
	253	else
	254	sprintf(retStr,"0x%02X", id);
	255	return buf;
	256	}
	257
f6c18637	258	void GetKeySettings( uint8_t *aid){
3d93d4f9	259
f6c18637	260	char messStr[512] = {0x00};
	261	char *str = messStr;
	262	uint8_t isOK = 0;
	263	uint32_t options = NONE;
	264	UsbCommand c;
	265	UsbCommand resp;
	266
	267	//memset(messStr, 0x00, 512);
75465377	268
f6c18637	269	c.cmd = CMD_MIFARE_DESFIRE;
	270
	271	if ( aid == NULL ){
	272	PrintAndLog(" CMK - PICC, Card Master Key settings ");
	273	PrintAndLog("");
	274	c.arg[CMDPOS] = (INIT \| DISCONNECT);
	275	c.arg[LENPOS] = 0x01;
	276	c.d.asBytes[0] = GET_KEY_SETTINGS; // 0x45
	277	SendCommand(&c);
	278	if ( !WaitForResponseTimeout(CMD_ACK,&resp,1000) ) {return;}
	279	isOK = resp.arg[0] & 0xff;
	280	if ( !isOK ){
	281	PrintAndLog(" Can't select master application");
	282	return;
	283	}
	284
	285	str = (resp.d.asBytes[3] & (1 << 3 )) ? "YES":"NO";
	286	PrintAndLog(" [0x08] Configuration changeable : %s", str);
	287	str = (resp.d.asBytes[3] & (1 << 2 )) ? "NO":"YES";
	288	PrintAndLog(" [0x04] CMK required for create/delete : %s",str);
	289	str = (resp.d.asBytes[3] & (1 << 1 )) ? "NO":"YES";
	290	PrintAndLog(" [0x02] Directory list access with CMK : %s",str);
	291	str = (resp.d.asBytes[3] & (1 << 0 )) ? "YES" : "NO";
	292	PrintAndLog(" [0x01] CMK is changeable : %s", str);
	293
	294	c.arg[LENPOS] = 0x02; //LEN
	295	c.d.asBytes[0] = GET_KEY_VERSION; //0x64
	296	c.d.asBytes[1] = 0x00;
	297	SendCommand(&c);
	298	if ( !WaitForResponseTimeout(CMD_ACK,&resp,1000) ) {
	299	return;
	300	}
	301	isOK = resp.arg[0] & 0xff;
	302	if ( !isOK ){
	303	PrintAndLog(" Can't read key-version");
	304	return;
	305	}
	306	PrintAndLog("");
	307	PrintAndLog(" Max number of keys : %d", resp.d.asBytes[4]);
	308	PrintAndLog(" Master key Version : %d (0x%02x)", resp.d.asBytes[3], resp.d.asBytes[3]);
	309	PrintAndLog(" ----------------------------------------------------------");
	310
	311	c.arg[LENPOS] = 0x02; //LEN
	312	c.d.asBytes[0] = AUTHENTICATE; //0x0A
	313	c.d.asBytes[1] = 0x00; // KEY 0
	314	SendCommand(&c);
	315	if ( !WaitForResponseTimeout(CMD_ACK,&resp,1000) ) {return;}
	316	isOK = resp.d.asBytes[2] & 0xff;
	317	PrintAndLog(" [0x0A] Authenticate : %s", ( isOK==0xAE ) ? "NO":"YES");
	318
	319	c.d.asBytes[0] = AUTHENTICATE_ISO; //0x1A
	320	SendCommand(&c);
	321	if ( !WaitForResponseTimeout(CMD_ACK,&resp,1000) ) {return;}
	322	isOK = resp.d.asBytes[2] & 0xff;
	323	PrintAndLog(" [0x1A] Authenticate ISO : %s", ( isOK==0xAE ) ? "NO":"YES");
	324
	325	c.d.asBytes[0] = AUTHENTICATE_AES; //0xAA
	326	SendCommand(&c);
	327	if ( !WaitForResponseTimeout(CMD_ACK,&resp,1000) ) {return;}
	328	isOK = resp.d.asBytes[2] & 0xff;
	329	PrintAndLog(" [0xAA] Authenticate AES : %s", ( isOK==0xAE ) ? "NO":"YES");
	330	PrintAndLog("");
	331	PrintAndLog(" ----------------------------------------------------------");
	332
333	} else {
334	PrintAndLog(" AMK - Application Master Key settings");
335
336	// SELECT AID
337	c.arg[0] = (INIT \| CLEARTRACE);
338	c.arg[LENPOS] = 0x04;
339	c.d.asBytes[0] = SELECT_APPLICATION; // 0x5a
340	memcpy(c.d.asBytes+1, aid, 3);
341	SendCommand(&c);
342
343	if (!WaitForResponseTimeout(CMD_ACK,&resp,1500) ) {
344	PrintAndLog(" Timed-out");
345	return;
346	}
347	isOK = resp.arg[0] & 0xff;
348	if ( !isOK ){
349	PrintAndLog(" Can't select AID: %s",sprint_hex(aid,3));
350	return;
351	}
352
353	// KEY SETTINGS
354	options = NONE;
355	c.arg[0] = options;
356	c.arg[LENPOS] = 0x01;
357	c.d.asBytes[0] = GET_KEY_SETTINGS; // 0x45
358	SendCommand(&c);
359	if ( !WaitForResponseTimeout(CMD_ACK,&resp,1500) ) {
360	return;
361	}
362	isOK = resp.arg[0] & 0xff;
363	if ( !isOK ){
364	PrintAndLog(" Can't read Application Master key settings");
365	} else {
366	// Access rights.
367	uint8_t rights = (resp.d.asBytes[3] >> 4 && 0xff);
368	switch (rights){
369	case 0x00:
370	str = "AMK authentication is necessary to change any key (default)";
371	break;
372	case 0x0e:
373	str = "Authentication with the key to be changed (same KeyNo) is necessary to change a key";
374	break;
375	case 0x0f:
376	str = "All keys (except AMK,see Bit0) within this application are frozen";
377	break;
378	default:
379	str = "Authentication with the specified key is necessary to change any ley. A change key and a PICC master key (CMK) can only be changed after authentication with the master key. For keys other then the master or change key, an authentication with the same key is needed.";
380	break;
381	}
382	PrintAndLog("Changekey Access rights");
383	PrintAndLog("-- %s",str);
384	PrintAndLog("");
385	// same as CMK
386	str = (resp.d.asBytes[3] & (1 << 3 )) ? "YES":"NO";
387	PrintAndLog(" 0x08 Configuration changeable : %s", str);
388	str = (resp.d.asBytes[3] & (1 << 2 )) ? "NO":"YES";
389	PrintAndLog(" 0x04 AMK required for create/delete : %s",str);
390	str = (resp.d.asBytes[3] & (1 << 1 )) ? "NO":"YES";
391	PrintAndLog(" 0x02 Directory list access with AMK : %s",str);
392	str = (resp.d.asBytes[3] & (1 << 0 )) ? "YES" : "NO";
393	PrintAndLog(" 0x01 AMK is changeable : %s", str);
394	}
395
396	// KEY VERSION - AMK
397	c.arg[0] = NONE;
398	c.arg[LENPOS] = 0x02;
399	c.d.asBytes[0] = GET_KEY_VERSION; //0x64
400	c.d.asBytes[1] = 0x00;
401	SendCommand(&c);
402	if ( !WaitForResponseTimeout(CMD_ACK,&resp,1500) ) {
403	PrintAndLog(" Timed-out");
404	return;
405	}
406
407	int numOfKeys;
408
409	isOK = resp.arg[0] & 0xff;
410	if ( !isOK ){
411	PrintAndLog(" Can't read Application Master key version. Trying all keys");
412	numOfKeys = MAX_NUM_KEYS;
413	}
414	else{
415	numOfKeys = resp.d.asBytes[4];
416	PrintAndLog("");
417	PrintAndLog(" Max number of keys : %d", numOfKeys );
418	PrintAndLog(" Application Master key Version : %d (0x%02x)", resp.d.asBytes[3], resp.d.asBytes[3]);
419	PrintAndLog("-------------------------------------------------------------");
420	}
421
422	// LOOP over numOfKeys that we got before.
423	// From 0x01 to numOfKeys. We already got 0x00. (AMK)
424	for(int i=0x01; i<=0x0f; ++i){
425
426	}
427
428
429	}
430	}
431
432	int CmdHF14ADesEnumApplications(const char *Cmd){
433
434	uint8_t isOK = 0x00;
435	uint8_t aid[3];
436	uint32_t options = (INIT \| DISCONNECT);
75465377	437
	438	UsbCommand c = {CMD_MIFARE_DESFIRE, {options , 0x01 }};
	439	c.d.asBytes[0] = GET_APPLICATION_IDS; //0x6a
f6c18637	440
3d93d4f9	441	SendCommand(&c);
	442	UsbCommand resp;
	443
	444	if ( !WaitForResponseTimeout(CMD_ACK,&resp,1500) ) {
	445	return 0;
	446	}
f6c18637	447	isOK = resp.arg[0] & 0xff;
3d93d4f9	448	if ( !isOK ){
	449	PrintAndLog("Command unsuccessful");
	450	return 0;
	451	}
f6c18637	452	PrintAndLog("");
f6c18637	453	PrintAndLog("-- Desfire Enumerate Applications ---------------------------");
3d93d4f9	454	PrintAndLog("-------------------------------------------------------------");
3d93d4f9	455
75465377	456	UsbCommand respAid;
75465377	457	UsbCommand respFiles;
3d93d4f9	458
	459	uint8_t num = 0;
	460	int max = resp.arg[1] -3 -2;
	461
	462	for(int i=3; i<=max; i+=3){
75465377	463	PrintAndLog(" Aid %d : %02X %02X %02X ",num ,resp.d.asBytes[i],resp.d.asBytes[i+1],resp.d.asBytes[i+2]);
3d93d4f9	464	num++;
3d93d4f9	465
f6c18637	466	aid[0] = resp.d.asBytes[i];
	467	aid[1] = resp.d.asBytes[i+1];
	468	aid[2] = resp.d.asBytes[i+2];
	469	GetKeySettings(aid);
	470
	471	// Select Application
	472	c.arg[CMDPOS] = INIT;
	473	c.arg[LENPOS] = 0x04;
	474	c.d.asBytes[0] = SELECT_APPLICATION; // 0x5a
	475	c.d.asBytes[1] = resp.d.asBytes[i];
	476	c.d.asBytes[2] = resp.d.asBytes[i+1];
	477	c.d.asBytes[3] = resp.d.asBytes[i+2];
	478	SendCommand(&c);
75465377	479
	480	if (!WaitForResponseTimeout(CMD_ACK,&respAid,1500) ) {
	481	PrintAndLog(" Timed-out");
	482	continue;
	483	}
f6c18637	484	isOK = respAid.d.asBytes[2] & 0xff;
f6c18637	485	if ( isOK != 0x00 ){
75465377	486	PrintAndLog(" Can't select AID: %s",sprint_hex(resp.d.asBytes+i,3));
	487	continue;
	488	}
	489
f6c18637	490	// Get File IDs
	491	c.arg[CMDPOS] = NONE;
	492	c.arg[LENPOS] = 0x01;
	493	c.d.asBytes[0] = GET_FILE_IDS; // 0x6f
	494	SendCommand(&c);
75465377	495
	496	if ( !WaitForResponseTimeout(CMD_ACK,&respFiles,1500) ) {
	497	PrintAndLog(" Timed-out");
	498	continue;
	499	} else {
f6c18637	500	isOK = respFiles.d.asBytes[2] & 0xff;
75465377	501	if ( !isOK ){
f6c18637	502	PrintAndLog(" Can't get file ids ");
	503	} else {
	504	int respfileLen = resp.arg[1]-3-2;
	505	for (int j=0; j< respfileLen; ++j){
	506	PrintAndLog(" Fileid %d :", resp.d.asBytes[j+3]);
	507	}
75465377	508	}
f6c18637	509	}
	510
	511	// Get ISO File IDs
	512	c.arg[CMDPOS] = DISCONNECT;
	513	c.arg[LENPOS] = 0x01;
	514	c.d.asBytes[0] = GET_ISOFILE_IDS; // 0x61
	515	SendCommand(&c);
3d93d4f9	516
f6c18637	517	if ( !WaitForResponseTimeout(CMD_ACK,&respFiles,1500) ) {
	518	PrintAndLog(" Timed-out");
	519	continue;
	520	} else {
	521	isOK = respFiles.d.asBytes[2] & 0xff;
	522	if ( !isOK ){
	523	PrintAndLog(" Can't get ISO file ids ");
	524	} else {
	525	int respfileLen = resp.arg[1]-3-2;
	526	for (int j=0; j< respfileLen; ++j){
	527	PrintAndLog(" ISO Fileid %d :", resp.d.asBytes[j+3]);
	528	}
75465377	529	}
75465377	530	}
3d93d4f9	531
f6c18637	532
3d93d4f9	533	}
	534	PrintAndLog("-------------------------------------------------------------");
	535
	536
f38a1528	537	return 1;
	538	}
	539
f38a1528	540	// MIAFRE DesFire Authentication
f38a1528	541	//
f6c18637	542	#define BUFSIZE 256
f38a1528	543	int CmdHF14ADesAuth(const char *Cmd){
	544
	545	// NR DESC KEYLENGHT
	546	// ------------------------
	547	// 1 = DES 8
	548	// 2 = 3DES 16
	549	// 3 = 3K 3DES 24
	550	// 4 = AES 16
f6c18637	551
f38a1528	552	uint8_t keylength = 8;
f6c18637	553	unsigned char key[24];
f38a1528	554
	555	if (strlen(Cmd)<3) {
	556	PrintAndLog("Usage: hf mfdes auth <1\|2\|3> <1\|2\|3\|4> <keyno> <key> ");
f6c18637	557	PrintAndLog(" Auth modes");
	558	PrintAndLog(" 1 = normal, 2 = iso, 3 = aes");
	559	PrintAndLog(" Crypto");
	560	PrintAndLog(" 1 = DES 2 = 3DES 3 = 3K3DES 4 = AES");
	561	PrintAndLog("");
f38a1528	562	PrintAndLog(" sample: hf mfdes auth 1 1 0 11223344");
f6c18637	563	PrintAndLog(" sample: hf mfdes auth 3 4 0 404142434445464748494a4b4c4d4e4f");
f38a1528	564	return 0;
	565	}
	566	uint8_t cmdAuthMode = param_get8(Cmd,0);
	567	uint8_t cmdAuthAlgo = param_get8(Cmd,1);
	568	uint8_t cmdKeyNo = param_get8(Cmd,2);
	569
	570	switch (cmdAuthMode)
	571	{
	572	case 1:
	573	if ( cmdAuthAlgo != 1 && cmdAuthAlgo != 2) {
	574	PrintAndLog("Crypto algo not valid for the auth mode");
	575	return 1;
	576	}
	577	break;
	578	case 2:
	579	if ( cmdAuthAlgo != 1 && cmdAuthAlgo != 2 && cmdAuthAlgo != 3) {
	580	PrintAndLog("Crypto algo not valid for the auth mode");
	581	return 1;
	582	}
	583	break;
	584	case 3:
	585	if ( cmdAuthAlgo != 4) {
	586	PrintAndLog("Crypto algo not valid for the auth mode");
	587	return 1;
	588	}
	589	break;
	590	default:
	591	PrintAndLog("Wrong Auth mode");
	592	return 1;
	593	break;
	594	}
	595
	596	switch (cmdAuthAlgo){
	597	case 2:
	598	keylength = 16;
	599	PrintAndLog("3DES selected");
	600	break;
	601	case 3:
	602	keylength = 24;
	603	PrintAndLog("3 key 3DES selected");
	604	break;
	605	case 4:
	606	keylength = 16;
	607	PrintAndLog("AES selected");
	608	break;
	609	default:
	610	cmdAuthAlgo = 1;
	611	keylength = 8;
	612	PrintAndLog("DES selected");
	613	break;
	614	}
	615
	616	// key
	617	if (param_gethex(Cmd, 3, key, keylength*2)) {
	618	PrintAndLog("Key must include %d HEX symbols", keylength);
	619	return 1;
	620	}
	621