First check in.

[proxmark3-svn] / armsrc / mifaredesfire.c

#include "mifaredesfire.h"

#define MAX_APPLICATION_COUNT 28
#define MAX_FILE_COUNT 16
#define MAX_FRAME_SIZE 60
#define NOT_YET_AUTHENTICATED 255
#define FRAME_PAYLOAD_SIZE (MAX_FRAME_SIZE - 5)

//static uint8_t __msg[MAX_FRAME_SIZE] = { 0x0A, 0x00, 0x00, /* ..., */ 0x00 };
/*                                       PCB   CID   CMD    PAYLOAD    */
//static uint8_t __res[MAX_FRAME_SIZE];

void MifareDesfireGetInformation(){
	

	uint8_t len = 0;
	uint8_t resp[RECV_RES_SIZE];
	uint8_t dataout[RECV_CMD_SIZE];
	byte_t buf[RECV_RES_SIZE];
	
	memset(resp,0,sizeof(resp));
	memset(dataout,0, sizeof(dataout));
	memset(buf,0,sizeof(buf));
	
	/*
		1 = PCB					1
		2 = cid					2
		3 = desfire command		3 
		4-5 = crc				4  key
								5-6 crc
								
		PCB == 0x0A because sending CID byte.
		CID == 0x00 first card?
		
	*/
	uint8_t cmd1[] = {0x0a,0x00,GET_VERSION, 0x00, 0x00 };	
	uint8_t cmd2[] = {0x0a,0x00,GET_KEY_VERSION, 0x00, 0x00, 0x00 };
	
	iso14a_clear_trace();
	iso14a_set_tracing(TRUE);
	iso14443a_setup(FPGA_HF_ISO14443A_READER_LISTEN);

	// card select - information
	iso14a_card_select_t *card = (iso14a_card_select_t*)buf;
	byte_t isOK = iso14443a_select_card(NULL, card, NULL);
	if (isOK != 1) {
		if (MF_DBGLEVEL >= 1) {
			Dbprintf("Can't select card");
		}
		OnError();
		return;
	}


	memcpy(dataout,card->uid,7);

	LED_A_ON();
	LED_B_OFF();
	LED_C_OFF();
	
	// GET INFORMATION
	AppendCrc14443a(cmd1, 3);
	ReaderTransmit(cmd1, sizeof(cmd1), NULL);
	len = ReaderReceive(resp);
	if ( resp[2] != ADDITIONAL_FRAME) {
		print_result("ERROR <--: ", resp, len);	
		OnError();
		return;
	}

	memcpy(dataout+7,resp+3,7);
	
	// ADDITION_FRAME 1
	++cmd1[0];
	cmd1[2] = ADDITIONAL_FRAME;
	AppendCrc14443a(cmd1, 3);
	ReaderTransmit(cmd1, sizeof(cmd1), NULL);
	len = ReaderReceive(resp);
	
	if ( resp[2] != ADDITIONAL_FRAME) {
		print_result("ERROR <--: ", resp, len);	
		OnError();
		return;
	}	
	memcpy(dataout+7+7,resp+3,7);

	// ADDITION_FRAME 2
	--cmd1[0];
	AppendCrc14443a(cmd1, 3);
	ReaderTransmit(cmd1, sizeof(cmd1), NULL);
	len = ReaderReceive(resp);
	if ( resp[2] != OPERATION_OK) {
		print_result("ERROR <--: ", resp, len);	
		OnError();
		return;
	}
	
	memcpy(dataout+7+7+7,resp+3,14);
	
	// GET MASTER KEYSETTINGS
	cmd1[2] = GET_KEY_SETTINGS;
	AppendCrc14443a(cmd1, 3);
	ReaderTransmit(cmd1, sizeof(cmd1), NULL);
	len = ReaderReceive(resp);
	if (len){
		memcpy(dataout+7+7+7+14,resp+3,2);
	}
	

	// GET MASTER KEY VERSION
	AppendCrc14443a(cmd2, 4);
	ReaderTransmit(cmd2, sizeof(cmd2), NULL);
	len = ReaderReceive(resp);
	if (len){
		memcpy(dataout+7+7+7+14+2,resp+3,1);
	}
	
	// GET FREE MEMORY
	cmd1[2] = GET_FREE_MEMORY;
	AppendCrc14443a(cmd1, 3);
	ReaderTransmit(cmd1, sizeof(cmd1), NULL);
	len = ReaderReceive(resp);
	if (len){
		memcpy(dataout+7+7+7+14+2+1,resp+3,3);
	}

	cmd_send(CMD_ACK,1,0,0,dataout,sizeof(dataout));
	OnSuccess();
}

void MifareDES_Auth1(uint8_t mode, uint8_t algo, uint8_t keyno,  uint8_t *datain){

	uint8_t null_key_data[8] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
	uint8_t new_key_data[8]  = { 0x00, 0x11, 0x22, 0x33, 0x44, 0x55, 0x66, 0x77 };
	int res;
	
	MifareDESFireKey default_key = mifare_desfire_des_key_new_with_version (null_key_data);

	res = mifare_desfire_select_application (tags[i], aid);
	if (res < 0) {
		freefare_perror (tags[i], "mifare_desfire_select_application");
		error = EXIT_FAILURE;
		break;
	}
				
	return;
	//                pcb  cid  cmd               key   crc1  cr2   	
	//uint8_t cmd2[] = {0x02,0x00,GET_KEY_VERSION, 0x00, 0x00, 0x00 };

	//uint8_t* bigbuffer = mifare_get_bigbufptr();
	byte_t isOK = 1;
	uint8_t resp[256];
	uint8_t key[24];
	uint8_t IV[16];