RfidResearchGroup/proxmark3
1
1
Fork 0
mirror of https://github.com/RfidResearchGroup/proxmark3.git synced 2025-02-15 19:59:34 +08:00
Code Issues Projects Releases Packages Wiki Activity

cleaned up some code

Browse source
This commit is contained in:
roel@libnfc.org 2012-06-29 12:09:24 +00:00
parent 4ab4336a97
commit 254b70a4af
1 changed files with 86 additions and 185 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

183
armsrc/iso14443a.c
View file

@ -1042,49 +1042,9 @@ void SimulateIso14443aTag(int tagType, int uid_1st, int uid_2nd)
response3a[0] = sak & 0xFB; response3a[0] = sak & 0xFB;
ComputeCrc14443(CRC_14443_A, response3a, 1, &response3a[1], &response3a[2]); ComputeCrc14443(CRC_14443_A, response3a, 1, &response3a[1], &response3a[2]);
uint8_t response5[] = { 0x00, 0x00, 0x00, 0x00 }; // Very random tag nonce
/* uint8_t response6[] = { 0x03, 0x3B, 0x00, 0x00, 0x00 }; // dummy ATS (pseudo-ATR), answer to RATS
// Check if the uid uses the (optional) second part ComputeCrc14443(CRC_14443_A, response6, 3, &response6[3], &response6[4]);
if (uid_2nd) {
// Configure the ATQA and SAK accordingly
response1[0] |= 0x40;
sak |= 0x04;
}
*/
//static const uint8_t response2a[] = { 0x51, 0x48, 0x1d, 0x80, 0x84 }; // uid - cascade2 - 2nd half (4 bytes) of UID+ BCCheck
// Prepare protocol messages
// static const uint8_t cmd1[] = { 0x26 };
// static const uint8_t response1[] = { 0x02, 0x00 }; // Says: I am Mifare 4k - original line - greg
//
// uint8_t response1[] = { 0x44, 0x03 }; // Says: I am a DESFire Tag, ph33r me
// static const uint8_t response1[] = { 0x44, 0x00 }; // Says: I am a ULTRALITE Tag, 0wn me
// UID response
// static const uint8_t cmd2[] = { 0x93, 0x20 };
//static const uint8_t response2[] = { 0x9a, 0xe5, 0xe4, 0x43, 0xd8 }; // original value - greg
// my desfire
// uint8_t response2[] = { 0x88, 0x04, 0x21, 0x3f, 0x4d }; // known uid - note cascade (0x88), 2nd byte (0x04) = NXP/Phillips
// When reader selects us during cascade1 it will send cmd3
//uint8_t response3[] = { 0x04, 0x00, 0x00 }; // SAK Select (cascade1) successful response (ULTRALITE)
//uint8_t response3[] = { 0x24, 0x00, 0x00 }; // SAK Select (cascade1) successful response (DESFire)
//ComputeCrc14443(CRC_14443_A, response3, 1, &response3[1], &response3[2]);
// send cascade2 2nd half of UID
//static const uint8_t response2a[] = { 0x51, 0x48, 0x1d, 0x80, 0x84 }; // uid - cascade2 - 2nd half (4 bytes) of UID+ BCCheck
// NOTE : THE CRC on the above may be wrong as I have obfuscated the actual UID
// When reader selects us during cascade2 it will send cmd3a
//uint8_t response3a[] = { 0x00, 0x00, 0x00 }; // SAK Select (cascade2) successful response (ULTRALITE)
//uint8_t response3a[] = { 0x20, 0x00, 0x00 }; // SAK Select (cascade2) successful response (DESFire)
//ComputeCrc14443(CRC_14443_A, response3a, 1, &response3a[1], &response3a[2]);
static const uint8_t response5[] = { 0x00, 0x00, 0x00, 0x00 }; // Very random tag nonce
uint8_t *resp; uint8_t *resp;
int respLen; int respLen;
@ -1131,13 +1091,12 @@ void SimulateIso14443aTag(int tagType, int uid_1st, int uid_2nd)
uint8_t *resp5 = (((uint8_t *)BigBuf) + FREE_BUFFER_OFFSET + (166*5)); uint8_t *resp5 = (((uint8_t *)BigBuf) + FREE_BUFFER_OFFSET + (166*5));
int resp5Len; int resp5Len;
uint8_t *receivedCmd = (((uint8_t *)BigBuf) + RECV_CMD_OFFSET); // Authenticate response - nonce
// uint8_t *receivedCmd = (uint8_t *)BigBuf; uint8_t *resp6 = (((uint8_t *)BigBuf) + FREE_BUFFER_OFFSET + (166*6));
int len; int resp6Len;
//int i; uint8_t *receivedCmd = (((uint8_t *)BigBuf) + RECV_CMD_OFFSET);
//int u; int len;
//uint8_t b;
// To control where we are in the protocol // To control where we are in the protocol
int order = 0; int order = 0;
@ -1152,8 +1111,6 @@ void SimulateIso14443aTag(int tagType, int uid_1st, int uid_2nd)
int respsize = 0; int respsize = 0;
uint8_t nack = 0x04; uint8_t nack = 0x04;
//int fdt_indicator;
memset(receivedCmd, 0x44, RECV_CMD_SIZE); memset(receivedCmd, 0x44, RECV_CMD_SIZE);
// Prepare the responses of the anticollision phase // Prepare the responses of the anticollision phase
@ -1187,6 +1144,10 @@ void SimulateIso14443aTag(int tagType, int uid_1st, int uid_2nd)
CodeIso14443aAsTag(response5, sizeof(response5)); CodeIso14443aAsTag(response5, sizeof(response5));
memcpy(resp5, ToSend, ToSendMax); resp5Len = ToSendMax; memcpy(resp5, ToSend, ToSendMax); resp5Len = ToSendMax;
// dummy ATS (pseudo-ATR), answer to RATS
CodeIso14443aAsTag(response6, sizeof(response6));
memcpy(resp6, ToSend, ToSendMax); resp6Len = ToSendMax;
// We need to listen to the high-frequency, peak-detected path. // We need to listen to the high-frequency, peak-detected path.
SetAdcMuxFor(GPIO_MUXSEL_HIPKD); SetAdcMuxFor(GPIO_MUXSEL_HIPKD);
FpgaSetupSsc(); FpgaSetupSsc();
@ -1203,83 +1164,52 @@ void SimulateIso14443aTag(int tagType, int uid_1st, int uid_2nd)
// doob - added loads of debug strings so we can see what the reader is saying to us during the sim as hi14alist is not populated // doob - added loads of debug strings so we can see what the reader is saying to us during the sim as hi14alist is not populated
// Okay, look at the command now. // Okay, look at the command now.
lastorder = order; lastorder = order;
//i = 1; // first byte transmitted if(receivedCmd[0] == 0x26) { // Received a REQUEST
if(receivedCmd[0] == 0x26) {
// Received a REQUEST
resp = resp1; respLen = resp1Len; order = 1; resp = resp1; respLen = resp1Len; order = 1;
respdata = response1; respdata = response1;
respsize = sizeof(response1); respsize = sizeof(response1);
//DbpString("Hello request from reader:"); } else if(receivedCmd[0] == 0x52) { // Received a WAKEUP
} else if(receivedCmd[0] == 0x52) {
// Received a WAKEUP
resp = resp1; respLen = resp1Len; order = 6; resp = resp1; respLen = resp1Len; order = 6;
// //DbpString("Wakeup request from reader:");
respdata = response1; respdata = response1;
respsize = sizeof(response1); respsize = sizeof(response1);
} else if(receivedCmd[1] == 0x20 && receivedCmd[0] == 0x93) { // greg - cascade 1 anti-collision } else if(receivedCmd[1] == 0x20 && receivedCmd[0] == 0x93) { // Received request for UID (cascade 1)
// Received request for UID (cascade 1)
resp = resp2; respLen = resp2Len; order = 2; resp = resp2; respLen = resp2Len; order = 2;
// DbpString("UID (cascade 1) request from reader:");
// DbpIntegers(receivedCmd[0], receivedCmd[1], receivedCmd[2]);
respdata = response2; respdata = response2;
respsize = sizeof(response2); respsize = sizeof(response2);
} else if(receivedCmd[1] == 0x20 && receivedCmd[0] ==0x95) { // greg - cascade 2 anti-collision } else if(receivedCmd[1] == 0x20 && receivedCmd[0] == 0x95) { // Received request for UID (cascade 2)
// Received request for UID (cascade 2)
resp = resp2a; respLen = resp2aLen; order = 20; resp = resp2a; respLen = resp2aLen; order = 20;
// DbpString("UID (cascade 2) request from reader:");
// DbpIntegers(receivedCmd[0], receivedCmd[1], receivedCmd[2]);
respdata = response2a; respdata = response2a;
respsize = sizeof(response2a); respsize = sizeof(response2a);
} else if(receivedCmd[1] == 0x70 && receivedCmd[0] == 0x93) { // Received a SELECT (cascade 1)
} else if(receivedCmd[1] == 0x70 && receivedCmd[0] ==0x93) { // greg - cascade 1 select
// Received a SELECT
resp = resp3; respLen = resp3Len; order = 3; resp = resp3; respLen = resp3Len; order = 3;
// DbpString("Select (cascade 1) request from reader:");
// DbpIntegers(receivedCmd[0], receivedCmd[1], receivedCmd[2]);
respdata = response3; respdata = response3;
respsize = sizeof(response3); respsize = sizeof(response3);
} else if(receivedCmd[1] == 0x70 && receivedCmd[0] == 0x95) { // Received a SELECT (cascade 2)
} else if(receivedCmd[1] == 0x70 && receivedCmd[0] ==0x95) { // greg - cascade 2 select
// Received a SELECT
resp = resp3a; respLen = resp3aLen; order = 30; resp = resp3a; respLen = resp3aLen; order = 30;
// DbpString("Select (cascade 2) request from reader:");
// DbpIntegers(receivedCmd[0], receivedCmd[1], receivedCmd[2]);
respdata = response3a; respdata = response3a;
respsize = sizeof(response3a); respsize = sizeof(response3a);
} else if(receivedCmd[0] == 0x30) { // Received a (plain) READ
} else if(receivedCmd[0] == 0x30) {
// Received a READ
resp = resp4; respLen = resp4Len; order = 4; // Do nothing resp = resp4; respLen = resp4Len; order = 4; // Do nothing
Dbprintf("Read request from reader: %x %x %x", Dbprintf("Read request from reader: %x %x",receivedCmd[0],receivedCmd[1]);
receivedCmd[0], receivedCmd[1], receivedCmd[2]);
respdata = &nack; respdata = &nack;
respsize = sizeof(nack); // 4-bit answer respsize = sizeof(nack); // 4-bit answer
} else if(receivedCmd[0] == 0x50) { // Received a HALT
} else if(receivedCmd[0] == 0x50) {
// Received a HALT
resp = resp1; respLen = 0; order = 5; // Do nothing
DbpString("Reader requested we HALT!:"); DbpString("Reader requested we HALT!:");
// Do not respond
resp = resp1; respLen = 0; order = 0;
respdata = NULL; respdata = NULL;
respsize = 0; respsize = 0;
} else if(receivedCmd[0] == 0x60 || receivedCmd[0] == 0x61) { // Received an authentication request
} else if(receivedCmd[0] == 0x60) {
// Received an authentication request
resp = resp5; respLen = resp5Len; order = 7; resp = resp5; respLen = resp5Len; order = 7;
Dbprintf("Authenticate request from reader: %x %x %x", respdata = response5;
receivedCmd[0], receivedCmd[1], receivedCmd[2]); respsize = sizeof(response5);
respdata = NULL; } else if(receivedCmd[0] == 0xE0) { // Received a RATS request
respsize = 0; resp = resp6; respLen = resp6Len; order = 70;
respdata = response6;
} else if(receivedCmd[0] == 0xE0) { respsize = sizeof(response6);
// Received a RATS request
resp = resp1; respLen = 0;order = 70;
Dbprintf("RATS request from reader: %x %x %x",
receivedCmd[0], receivedCmd[1], receivedCmd[2]);
respdata = NULL;
respsize = 0;
} else { } else {
// Never seen this command before // Never seen this command before
Dbprintf("Unknown command received from reader (len=%d): %x %x %x %x %x %x %x %x %x", Dbprintf("Received unknown command (len=%d): %02x %02x %02x %02x %02x %02x %02x %02x %02x",
len, len,
receivedCmd[0], receivedCmd[1], receivedCmd[2], receivedCmd[0], receivedCmd[1], receivedCmd[2],
receivedCmd[3], receivedCmd[4], receivedCmd[5], receivedCmd[3], receivedCmd[4], receivedCmd[5],
@ -1302,23 +1232,27 @@ void SimulateIso14443aTag(int tagType, int uid_1st, int uid_2nd)
//i = 0; //i = 0;
} }
if(cmdsRecvd > 999) { if(cmdsRecvd > 999) {
DbpString("1000 commands later..."); DbpString("1000 commands later...");
break; break;
} } else {
else {
cmdsRecvd++; cmdsRecvd++;
} }
if(respLen > 0) { if(respLen > 0) {
//----------------------------
//u = 0;
//b = 0x00;
//fdt_indicator = FALSE;
EmSendCmd14443aRaw(resp, respLen, receivedCmd[0] == 0x52); EmSendCmd14443aRaw(resp, respLen, receivedCmd[0] == 0x52);
} }
// After sending the response, print out some debug data.
if (receivedCmd[0] == 0x60 || receivedCmd[0] == 0x61) {
Dbprintf("Authenticate request from reader: %02x %02x",receivedCmd[0],receivedCmd[1]);
} else if (receivedCmd[0] == 0xE0) {
Dbprintf("RATS request from reader: %02x %02x",receivedCmd[0],receivedCmd[1]);
} else if (receivedCmd[0] == 0x30) {
Dbprintf("READ request from reader: %02x %02x",receivedCmd[0],receivedCmd[1]);
}
if (tracing) { if (tracing) {
LogTrace(receivedCmd,len, 0, Uart.parityBits, TRUE); LogTrace(receivedCmd,len, 0, Uart.parityBits, TRUE);
if (respdata != NULL) { if (respdata != NULL) {
@ -1331,39 +1265,6 @@ void SimulateIso14443aTag(int tagType, int uid_1st, int uid_2nd)
} }
memset(receivedCmd, 0x44, RECV_CMD_SIZE); memset(receivedCmd, 0x44, RECV_CMD_SIZE);
/* // Modulate Manchester
FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_ISO14443A | FPGA_HF_ISO14443A_TAGSIM_MOD);
AT91C_BASE_SSC->SSC_THR = 0x00;
FpgaSetupSsc();
// ### Transmit the response ###
u = 0;
b = 0x00;
fdt_indicator = FALSE;
for(;;) {
if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_RXRDY)) {
volatile uint8_t b = (uint8_t)AT91C_BASE_SSC->SSC_RHR;
(void)b;
}
if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_TXRDY)) {
if(i > respLen) {
b = 0x00;
u++;
} else {
b = resp[i];
i++;
}
AT91C_BASE_SSC->SSC_THR = b;
if(u > 4) {
break;
}
}
if(BUTTON_PRESS()) {
break;
}
}
*/
} }
Dbprintf("%x %x %x", happened, happened2, cmdsRecvd); Dbprintf("%x %x %x", happened, happened2, cmdsRecvd);