X-Git-Url: https://git.zerfleddert.de/cgi-bin/gitweb.cgi/proxmark3-svn/blobdiff_plain/f7c64b570c154063916d42bc6abe3a36df8f59f6..5a956258d3d8416f1cd2259319eae784d008a46b:/armsrc/iso15693.c?ds=sidebyside
diff --git a/armsrc/iso15693.c b/armsrc/iso15693.c
index 62e480c2..4c9a7d60 100644
--- a/armsrc/iso15693.c
+++ b/armsrc/iso15693.c
@@ -236,7 +236,7 @@ static void BuildIdentifyRequest(void)
CodeIso15693AsReader(cmd, sizeof(cmd));
}
-static void BuildSysInfoRequest(BYTE *uid)
+static void __attribute__((unused)) BuildSysInfoRequest(BYTE *uid)
{
BYTE cmd[12];
@@ -304,7 +304,7 @@ static void BuildSelectRequest( BYTE uid[])
CodeIso15693AsReader(cmd, sizeof(cmd));
}
-static void BuildReadBlockRequest(BYTE *uid, BYTE blockNumber )
+static void __attribute__((unused)) BuildReadBlockRequest(BYTE *uid, BYTE blockNumber )
{
BYTE cmd[13];
@@ -335,7 +335,7 @@ static void BuildReadBlockRequest(BYTE *uid, BYTE blockNumber )
CodeIso15693AsReader(cmd, sizeof(cmd));
}
-static void BuildReadMultiBlockRequest(BYTE *uid)
+static void __attribute__((unused)) BuildReadMultiBlockRequest(BYTE *uid)
{
BYTE cmd[14];
@@ -368,7 +368,7 @@ static void BuildReadMultiBlockRequest(BYTE *uid)
CodeIso15693AsReader(cmd, sizeof(cmd));
}
-static void BuildArbitraryRequest(BYTE *uid,BYTE CmdCode)
+static void __attribute__((unused)) BuildArbitraryRequest(BYTE *uid,BYTE CmdCode)
{
BYTE cmd[14];
@@ -402,7 +402,7 @@ static void BuildArbitraryRequest(BYTE *uid,BYTE CmdCode)
CodeIso15693AsReader(cmd, sizeof(cmd));
}
-static void BuildArbitraryCustomRequest(BYTE uid[], BYTE CmdCode)
+static void __attribute__((unused)) BuildArbitraryCustomRequest(BYTE uid[], BYTE CmdCode)
{
BYTE cmd[14];
@@ -478,12 +478,12 @@ static void TransmitTo15693Tag(const BYTE *cmd, int len, int *samples, int *wait
if(*wait < 10) { *wait = 10; }
// for(c = 0; c < *wait;) {
-// if(SSC_STATUS & (SSC_STATUS_TX_READY)) {
-// SSC_TRANSMIT_HOLDING = 0x00; // For exact timing!
+// if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_TXRDY)) {
+// AT91C_BASE_SSC->SSC_THR = 0x00; // For exact timing!
// c++;
// }
-// if(SSC_STATUS & (SSC_STATUS_RX_READY)) {
-// volatile DWORD r = SSC_RECEIVE_HOLDING;
+// if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_RXRDY)) {
+// volatile DWORD r = AT91C_BASE_SSC->SSC_RHR;
// (void)r;
// }
// WDT_HIT();
@@ -491,15 +491,15 @@ static void TransmitTo15693Tag(const BYTE *cmd, int len, int *samples, int *wait
c = 0;
for(;;) {
- if(SSC_STATUS & (SSC_STATUS_TX_READY)) {
- SSC_TRANSMIT_HOLDING = cmd[c];
+ if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_TXRDY)) {
+ AT91C_BASE_SSC->SSC_THR = cmd[c];
c++;
if(c >= len) {
break;
}
}
- if(SSC_STATUS & (SSC_STATUS_RX_READY)) {
- volatile DWORD r = SSC_RECEIVE_HOLDING;
+ if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_RXRDY)) {
+ volatile DWORD r = AT91C_BASE_SSC->SSC_RHR;
(void)r;
}
WDT_HIT();
@@ -520,15 +520,15 @@ static void TransmitTo15693Reader(const BYTE *cmd, int len, int *samples, int *w
c = 0;
for(;;) {
- if(SSC_STATUS & (SSC_STATUS_TX_READY)) {
- SSC_TRANSMIT_HOLDING = cmd[c];
+ if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_TXRDY)) {
+ AT91C_BASE_SSC->SSC_THR = cmd[c];
c++;
if(c >= len) {
break;
}
}
- if(SSC_STATUS & (SSC_STATUS_RX_READY)) {
- volatile DWORD r = SSC_RECEIVE_HOLDING;
+ if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_RXRDY)) {
+ volatile DWORD r = AT91C_BASE_SSC->SSC_RHR;
(void)r;
}
WDT_HIT();
@@ -550,12 +550,12 @@ static int GetIso15693AnswerFromTag(BYTE *receivedResponse, int maxLen, int *sam
c = 0;
getNext = FALSE;
for(;;) {
- if(SSC_STATUS & (SSC_STATUS_TX_READY)) {
- SSC_TRANSMIT_HOLDING = 0x43;
+ if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_TXRDY)) {
+ AT91C_BASE_SSC->SSC_THR = 0x43;
}
- if(SSC_STATUS & (SSC_STATUS_RX_READY)) {
+ if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_RXRDY)) {
SBYTE b;
- b = (SBYTE)SSC_RECEIVE_HOLDING;
+ b = (SBYTE)AT91C_BASE_SSC->SSC_RHR;
// The samples are correlations against I and Q versions of the
// tone that the tag AM-modulates, so every other sample is I,
@@ -697,12 +697,12 @@ static int GetIso15693AnswerFromSniff(BYTE *receivedResponse, int maxLen, int *s
c = 0;
getNext = FALSE;
for(;;) {
- if(SSC_STATUS & (SSC_STATUS_TX_READY)) {
- SSC_TRANSMIT_HOLDING = 0x43;
+ if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_TXRDY)) {
+ AT91C_BASE_SSC->SSC_THR = 0x43;
}
- if(SSC_STATUS & (SSC_STATUS_RX_READY)) {
+ if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_RXRDY)) {
SBYTE b;
- b = (SBYTE)SSC_RECEIVE_HOLDING;
+ b = (SBYTE)AT91C_BASE_SSC->SSC_RHR;
// The samples are correlations against I and Q versions of the
// tone that the tag AM-modulates, so every other sample is I,
@@ -855,15 +855,15 @@ void AcquireRawAdcSamplesIso15693(void)
c = 0;
for(;;) {
- if(SSC_STATUS & (SSC_STATUS_TX_READY)) {
- SSC_TRANSMIT_HOLDING = ToSend[c];
+ if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_TXRDY)) {
+ AT91C_BASE_SSC->SSC_THR = ToSend[c];
c++;
if(c == ToSendMax+3) {
break;
}
}
- if(SSC_STATUS & (SSC_STATUS_RX_READY)) {
- volatile DWORD r = SSC_RECEIVE_HOLDING;
+ if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_RXRDY)) {
+ volatile DWORD r = AT91C_BASE_SSC->SSC_RHR;
(void)r;
}
WDT_HIT();
@@ -874,12 +874,12 @@ void AcquireRawAdcSamplesIso15693(void)
c = 0;
getNext = FALSE;
for(;;) {
- if(SSC_STATUS & (SSC_STATUS_TX_READY)) {
- SSC_TRANSMIT_HOLDING = 0x43;
+ if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_TXRDY)) {
+ AT91C_BASE_SSC->SSC_THR = 0x43;
}
- if(SSC_STATUS & (SSC_STATUS_RX_READY)) {
+ if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_RXRDY)) {
SBYTE b;
- b = (SBYTE)SSC_RECEIVE_HOLDING;
+ b = (SBYTE)AT91C_BASE_SSC->SSC_RHR;
// The samples are correlations against I and Q versions of the
// tone that the tag AM-modulates, so every other sample is I,
@@ -926,24 +926,18 @@ void ReaderIso15693(DWORD parameter)
//DbpString(parameter);
- BYTE *receivedAnswer0 = (((BYTE *)BigBuf) + 3560); // allow 100 bytes per reponse (way too much)
- BYTE *receivedAnswer1 = (((BYTE *)BigBuf) + 3660); //
- BYTE *receivedAnswer2 = (((BYTE *)BigBuf) + 3760);
- BYTE *receivedAnswer3 = (((BYTE *)BigBuf) + 3860);
+ //BYTE *answer0 = (((BYTE *)BigBuf) + 3560); // allow 100 bytes per reponse (way too much)
+ BYTE *answer1 = (((BYTE *)BigBuf) + 3660); //
+ BYTE *answer2 = (((BYTE *)BigBuf) + 3760);
+ BYTE *answer3 = (((BYTE *)BigBuf) + 3860);
//BYTE *TagUID= (((BYTE *)BigBuf) + 3960); // where we hold the uid for hi15reader
-// int responseLen0 = 0;
- int responseLen1 = 0;
- int responseLen2 = 0;
- int responseLen3 = 0;
+// int answerLen0 = 0;
+ int answerLen1 = 0;
+ int answerLen2 = 0;
+ int answerLen3 = 0;
// Blank arrays
- int j;
- for(j = 0; j < 100; j++) {
- receivedAnswer3[j] = 0;
- receivedAnswer2[j] =0;
- receivedAnswer1[j] = 0;
- receivedAnswer0[j] = 0;
- }
+ memset(BigBuf + 3660, 0, 300);
// Setup SSC
FpgaSetupSsc();
@@ -997,24 +991,24 @@ void ReaderIso15693(DWORD parameter)
//TransmitTo15693Tag(ToSend,ToSendMax+3,&tsamples, &wait);
TransmitTo15693Tag(ToSend,ToSendMax,&tsamples, &wait); // No longer ToSendMax+3
// Now wait for a response
- responseLen1 = GetIso15693AnswerFromTag(receivedAnswer1, 100, &samples, &elapsed) ;
+ answerLen1 = GetIso15693AnswerFromTag(answer1, 100, &samples, &elapsed) ;
- if (responseLen1 >=12) // we should do a better check than this
+ if (answerLen1 >=12) // we should do a better check than this
{
- TagUID[0] = receivedAnswer1[2];
- TagUID[1] = receivedAnswer1[3];
- TagUID[2] = receivedAnswer1[4];
- TagUID[3] = receivedAnswer1[5];
- TagUID[4] = receivedAnswer1[6];
- TagUID[5] = receivedAnswer1[7];
- TagUID[6] = receivedAnswer1[8]; // IC Manufacturer code
+ TagUID[0] = answer1[2];
+ TagUID[1] = answer1[3];
+ TagUID[2] = answer1[4];
+ TagUID[3] = answer1[5];
+ TagUID[4] = answer1[6];
+ TagUID[5] = answer1[7];
+ TagUID[6] = answer1[8]; // IC Manufacturer code
// Now send the SELECT command
BuildSelectRequest(TagUID);
TransmitTo15693Tag(ToSend,ToSendMax,&tsamples, &wait); // No longer ToSendMax+3
// Now wait for a response
- responseLen2 = GetIso15693AnswerFromTag(receivedAnswer2, 100, &samples, &elapsed);
+ answerLen2 = GetIso15693AnswerFromTag(answer2, 100, &samples, &elapsed);
// Now send the MULTI READ command
// BuildArbitraryRequest(*TagUID,parameter);
@@ -1024,34 +1018,25 @@ void ReaderIso15693(DWORD parameter)
//TransmitTo15693Tag(ToSend,ToSendMax+3,&tsamples, &wait);
TransmitTo15693Tag(ToSend,ToSendMax,&tsamples, &wait); // No longer ToSendMax+3
// Now wait for a response
- responseLen3 = GetIso15693AnswerFromTag(receivedAnswer3, 100, &samples, &elapsed) ;
+ answerLen3 = GetIso15693AnswerFromTag(answer3, 100, &samples, &elapsed) ;
}
- char str1 [4];
- //char str2 [200];
- int i;
+ Dbprintf("%d octets read from IDENTIFY request: %x %x %x %x %x %x %x %x %x", answerLen1,
+ answer1[0], answer1[1], answer1[2],
+ answer1[3], answer1[4], answer1[5],
+ answer1[6], answer1[7], answer1[8]);
- itoa(responseLen1,str1);
- strcat(str1," octets read from IDENTIFY request");
- DbpString(str1);
- for(i = 0; i < responseLen1; i+=3) {
- DbpIntegers(receivedAnswer1[i],receivedAnswer1[i+1],receivedAnswer1[i+2]);
- }
+ Dbprintf("%d octets read from SELECT request: %x %x %x %x %x %x %x %x %x", answerLen2,
+ answer2[0], answer2[1], answer2[2],
+ answer2[3], answer2[4], answer2[5],
+ answer2[6], answer2[7], answer2[8]);
- itoa(responseLen2,str1);
- strcat(str1," octets read from SELECT request");
- DbpString(str1);
- for(i = 0; i < responseLen2; i+=3) {
- DbpIntegers(receivedAnswer2[i],receivedAnswer2[i+1],receivedAnswer2[i+2]);
- }
+ Dbprintf("%d octets read from XXX request: %x %x %x %x %x %x %x %x %x", answerLen3,
+ answer3[0], answer3[1], answer3[2],
+ answer3[3], answer3[4], answer3[5],
+ answer3[6], answer3[7], answer3[8]);
- itoa(responseLen3,str1);
- strcat(str1," octets read from XXX request");
- DbpString(str1);
- for(i = 0; i < responseLen3; i+=3) {
- DbpIntegers(receivedAnswer3[i],receivedAnswer3[i+1],receivedAnswer3[i+2]);
- }
// str2[0]=0;
// for(i = 0; i < responseLen3; i++) {
@@ -1077,26 +1062,11 @@ void SimTagIso15693(DWORD parameter)
LED_C_OFF();
LED_D_OFF();
-//DbpString(parameter);
-
- BYTE *receivedAnswer0 = (((BYTE *)BigBuf) + 3560); // allow 100 bytes per reponse (way too much)
- BYTE *receivedAnswer1 = (((BYTE *)BigBuf) + 3660); //
- BYTE *receivedAnswer2 = (((BYTE *)BigBuf) + 3760);
- BYTE *receivedAnswer3 = (((BYTE *)BigBuf) + 3860);
- //BYTE *TagUID= (((BYTE *)BigBuf) + 3960); // where we hold the uid for hi15reader
-// int responseLen0 = 0;
- int responseLen1 = 0;
-// int responseLen2 = 0;
-// int responseLen3 = 0;
+ BYTE *answer1 = (((BYTE *)BigBuf) + 3660); //
+ int answerLen1 = 0;
// Blank arrays
- int j;
- for(j = 0; j < 100; j++) {
- receivedAnswer3[j] = 0;
- receivedAnswer2[j] =0;
- receivedAnswer1[j] = 0;
- receivedAnswer0[j] = 0;
- }
+ memset(answer1, 0, 100);
// Setup SSC
FpgaSetupSsc();
@@ -1122,66 +1092,19 @@ void SimTagIso15693(DWORD parameter)
int wait = 0;
int elapsed = 0;
- // FIRST WE RUN AN INVENTORY TO GET THE TAG UID
- // THIS MEANS WE CAN PRE-BUILD REQUESTS TO SAVE CPU TIME
- // BYTE TagUID[7]; // where we hold the uid for hi15reader
+ answerLen1 = GetIso15693AnswerFromSniff(answer1, 100, &samples, &elapsed) ;
- // Now send the IDENTIFY command
- // BuildIdentifyRequest();
- // TransmitTo15693Tag(ToSend,ToSendMax,&tsamples, &wait); // No longer ToSendMax+3
-
- // Now wait for a command from the reader
- responseLen1=0;
- // while(responseLen1=0) {
- // if(BUTTON_PRESS()) break;
- responseLen1 = GetIso15693AnswerFromSniff(receivedAnswer1, 100, &samples, &elapsed) ;
- // }
-
- if (responseLen1 >=1) // we should do a better check than this
+ if (answerLen1 >=1) // we should do a better check than this
{
// Build a suitable reponse to the reader INVENTORY cocmmand
BuildInventoryResponse();
- TransmitTo15693Reader(ToSend,ToSendMax,&tsamples, &wait);
-
- // Now wait for a command from the reader
-// responseLen2 = GetIso15693AnswerFromTag(receivedAnswer2, 100, &samples, &elapsed);
-
- // Now wait for a command from the reader
-// responseLen3 = GetIso15693AnswerFromTag(receivedAnswer3, 100, &samples, &elapsed) ;
-
+ TransmitTo15693Reader(ToSend,ToSendMax, &tsamples, &wait);
}
- char str1 [4];
- //char str2 [200];
- int i;
-
- itoa(responseLen1,str1);
- strcat(str1," octets read from reader command");
- DbpString(str1);
- for(i = 0; i < responseLen1; i+=3) {
- DbpIntegers(receivedAnswer1[i],receivedAnswer1[i+1],receivedAnswer1[i+2]);
- }
-
-// itoa(responseLen2,str1);
-// strcat(str1," octets read from SELECT request");
-// DbpString(str1);
-// for(i = 0; i < responseLen2; i+=3) {
-// DbpIntegers(receivedAnswer2[i],receivedAnswer2[i+1],receivedAnswer2[i+2]);
-// }
-//
-// itoa(responseLen3,str1);
-// strcat(str1," octets read from XXX request");
-// DbpString(str1);
-// for(i = 0; i < responseLen3; i+=3) {
-// DbpIntegers(receivedAnswer3[i],receivedAnswer3[i+1],receivedAnswer3[i+2]);
-// }
-
-// str2[0]=0;
-// for(i = 0; i < responseLen3; i++) {
-// itoa(str1,receivedAnswer3[i]);
-// strcat(str2,str1);
-// }
-// DbpString(str2);
+ Dbprintf("%d octets read from reader command: %x %x %x %x %x %x %x %x %x", answerLen1,
+ answer1[0], answer1[1], answer1[2],
+ answer1[3], answer1[4], answer1[5],
+ answer1[6], answer1[7], answer1[8]);
LED_A_OFF();
LED_B_OFF();