1 //-----------------------------------------------------------------------------
2 // Jonathan Westhues, split Nov 2006
3 // Modified by Greg Jones, Jan 2009
4 // Modified by Adrian Dabrowski "atrox", Mar-Sept 2010,Oct 2011
6 // This code is licensed to you under the terms of the GNU GPL, version 2 or,
7 // at your option, any later version. See the LICENSE.txt file for the text of
9 //-----------------------------------------------------------------------------
10 // Routines to support ISO 15693. This includes both the reader software and
11 // the `fake tag' modes, but at the moment I've implemented only the reader
12 // stuff, and that barely.
13 // Modified to perform modulation onboard in arm rather than on PC
14 // Also added additional reader commands (SELECT, READ etc.)
15 //-----------------------------------------------------------------------------
16 // The ISO 15693 describes two transmission modes from reader to tag, and 4
17 // transmission modes from tag to reader. As of Mar 2010 this code only
18 // supports one of each: "1of4" mode from reader to tag, and the highspeed
19 // variant with one subcarrier from card to reader.
20 // As long, as the card fully support ISO 15693 this is no problem, since the
21 // reader chooses both data rates, but some non-standard tags do not. Further for
22 // the simulation to work, we will need to support all data rates.
24 // VCD (reader) -> VICC (tag)
26 // data rate: 1,66 kbit/s (fc/8192)
27 // used for long range
29 // data rate: 26,48 kbit/s (fc/512)
30 // used for short range, high speed
32 // VICC (tag) -> VCD (reader)
34 // ASK / one subcarrier (423,75 khz)
35 // FSK / two subcarriers (423,75 khz && 484,28 khz)
36 // Data Rates / Modes:
37 // low ASK: 6,62 kbit/s
38 // low FSK: 6.67 kbit/s
39 // high ASK: 26,48 kbit/s
40 // high FSK: 26,69 kbit/s
41 //-----------------------------------------------------------------------------
42 // added "1 out of 256" mode (for VCD->PICC) - atrox 20100911
46 // *) UID is always used "transmission order" (LSB), which is reverse to display order
48 // TODO / BUGS / ISSUES:
49 // *) writing to tags takes longer: we miss the answer from the tag in most cases
50 // -> tweak the read-timeout times
51 // *) signal decoding from the card is still a bit shaky.
52 // *) signal decoding is unable to detect collissions.
53 // *) add anti-collission support for inventory-commands
54 // *) read security status of a block
55 // *) sniffing and simulation do only support one transmission mode. need to support
56 // all 8 transmission combinations
57 // *) remove or refactor code under "depricated"
58 // *) document all the functions
61 #include "../include/proxmark3.h"
65 #include "../common/iso15693tools.h"
66 #include "../common/cmd.h"
68 #include "mifareutil.h"
70 #define arraylen(x) (sizeof(x)/sizeof((x)[0]))
72 ///////////////////////////////////////////////////////////////////////
73 // ISO 15693 Part 2 - Air Interface
74 // This section basicly contains transmission and receiving of bits
75 ///////////////////////////////////////////////////////////////////////
77 #define FrameSOF Iso15693FrameSOF
78 #define Logic0 Iso15693Logic0
79 #define Logic1 Iso15693Logic1
80 #define FrameEOF Iso15693FrameEOF
82 #define Crc(data,datalen) Iso15693Crc(data,datalen)
83 #define AddCrc(data,datalen) Iso15693AddCrc(data,datalen)
84 #define sprintUID(target,uid) Iso15693sprintUID(target,uid)
89 // ---------------------------
91 // ---------------------------
93 // prepare data using "1 out of 4" code for later transmission
94 // resulting data rate is 26,48 kbit/s (fc/512)
96 // n ... length of data
97 static void CodeIso15693AsReader(uint8_t *cmd
, int n
)
103 // Give it a bit of slack at the beginning
104 for(i
= 0; i
< 24; i
++) {
117 for(i
= 0; i
< n
; i
++) {
118 for(j
= 0; j
< 8; j
+= 2) {
119 int these
= (cmd
[i
] >> j
) & 3;
170 // And slack at the end, too.
171 for(i
= 0; i
< 24; i
++) {
176 // encode data using "1 out of 256" sheme
177 // data rate is 1,66 kbit/s (fc/8192)
178 // is designed for more robust communication over longer distances
179 static void CodeIso15693AsReader256(uint8_t *cmd
, int n
)
185 // Give it a bit of slack at the beginning
186 for(i
= 0; i
< 24; i
++) {
200 for(i
= 0; i
< n
; i
++) {
201 for (j
= 0; j
<=255; j
++) {
217 // And slack at the end, too.
218 for(i
= 0; i
< 24; i
++) {
224 // Transmit the command (to the tag) that was placed in ToSend[].
225 static void TransmitTo15693Tag(const uint8_t *cmd
, int len
, int *samples
, int *wait
)
229 // FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_ISO14443A | FPGA_HF_ISO14443A_READER_MOD);
230 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_TX
);
231 if(*wait
< 10) { *wait
= 10; }
233 // for(c = 0; c < *wait;) {
234 // if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_TXRDY)) {
235 // AT91C_BASE_SSC->SSC_THR = 0x00; // For exact timing!
238 // if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_RXRDY)) {
239 // volatile uint32_t r = AT91C_BASE_SSC->SSC_RHR;
247 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_TXRDY
)) {
248 AT91C_BASE_SSC
->SSC_THR
= cmd
[c
];
254 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_RXRDY
)) {
255 volatile uint32_t r
= AT91C_BASE_SSC
->SSC_RHR
;
260 *samples
= (c
+ *wait
) << 3;
263 //-----------------------------------------------------------------------------
264 // Transmit the command (to the reader) that was placed in ToSend[].
265 //-----------------------------------------------------------------------------
266 static void TransmitTo15693Reader(const uint8_t *cmd
, int len
, int *samples
, int *wait
)
269 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_SIMULATOR
|FPGA_HF_SIMULATOR_MODULATE_424K
);
270 if(*wait
< 10) { *wait
= 10; }
273 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_TXRDY
)) {
274 AT91C_BASE_SSC
->SSC_THR
= cmd
[c
];
280 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_RXRDY
)) {
281 volatile uint32_t r
= AT91C_BASE_SSC
->SSC_RHR
;
286 *samples
= (c
+ *wait
) << 3;
297 // number of decoded bytes
298 static int GetIso15693AnswerFromTag(uint8_t *receivedResponse
, int maxLen
, int *samples
, int *elapsed
)
301 uint8_t *dest
= (uint8_t *)BigBuf
;
307 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_RX_XCORR
);
308 //spindelay(60); // greg - experiment to get rid of some of the 0 byte/failed reads
312 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_TXRDY
)) {
313 AT91C_BASE_SSC
->SSC_THR
= 0x43;
315 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_RXRDY
)) {
317 b
= (int8_t)AT91C_BASE_SSC
->SSC_RHR
;
319 // The samples are correlations against I and Q versions of the
320 // tone that the tag AM-modulates, so every other sample is I,
321 // every other is Q. We just want power, so abs(I) + abs(Q) is
322 // close to what we want.
337 dest
[c
++] = (uint8_t)r
;
350 //////////////////////////////////////////
351 /////////// DEMODULATE ///////////////////
352 //////////////////////////////////////////
355 int max
= 0, maxPos
=0;
359 // if(GraphTraceLen < 1000) return; // THIS CHECKS FOR A BUFFER TO SMALL
361 // First, correlate for SOF
362 for(i
= 0; i
< 100; i
++) {
364 for(j
= 0; j
< arraylen(FrameSOF
); j
+= skip
) {
365 corr
+= FrameSOF
[j
]*dest
[i
+(j
/skip
)];
372 // DbpString("SOF at %d, correlation %d", maxPos,max/(arraylen(FrameSOF)/skip));
374 int k
= 0; // this will be our return value
376 // greg - If correlation is less than 1 then there's little point in continuing
377 if ((max
/(arraylen(FrameSOF
)/skip
)) >= 1)
380 i
= maxPos
+ arraylen(FrameSOF
)/skip
;
383 memset(outBuf
, 0, sizeof(outBuf
));
386 int corr0
= 0, corr1
= 0, corrEOF
= 0;
387 for(j
= 0; j
< arraylen(Logic0
); j
+= skip
) {
388 corr0
+= Logic0
[j
]*dest
[i
+(j
/skip
)];
390 for(j
= 0; j
< arraylen(Logic1
); j
+= skip
) {
391 corr1
+= Logic1
[j
]*dest
[i
+(j
/skip
)];
393 for(j
= 0; j
< arraylen(FrameEOF
); j
+= skip
) {
394 corrEOF
+= FrameEOF
[j
]*dest
[i
+(j
/skip
)];
396 // Even things out by the length of the target waveform.
400 if(corrEOF
> corr1
&& corrEOF
> corr0
) {
401 // DbpString("EOF at %d", i);
403 } else if(corr1
> corr0
) {
404 i
+= arraylen(Logic1
)/skip
;
407 i
+= arraylen(Logic0
)/skip
;
414 if((i
+(int)arraylen(FrameEOF
)) >= 2000) {
415 DbpString("ran off end!");
419 if(mask
!= 0x01) { // this happens, when we miss the EOF
420 // TODO: for some reason this happens quite often
421 if (DEBUG
) Dbprintf("error, uneven octet! (extra bits!) mask=%02x", mask
);
422 if (mask
<0x08) k
--; // discard the last uneven octet;
423 // 0x08 is an assumption - but works quite often
427 // strncat(str1," octets read",8);
429 // DbpString( str1); // DbpString("%d octets", k);
431 // for(i = 0; i < k; i+=3) {
432 // //DbpString("# %2d: %02x ", i, outBuf[i]);
433 // DbpIntegers(outBuf[i],outBuf[i+1],outBuf[i+2]);
436 for(i
= 0; i
< k
; i
++) {
437 receivedResponse
[i
] = outBuf
[i
];
439 } // "end if correlation > 0" (max/(arraylen(FrameSOF)/skip))
440 return k
; // return the number of bytes demodulated
442 /// DbpString("CRC=%04x", Iso15693Crc(outBuf, k-2));
447 // Now the GetISO15693 message from sniffing command
448 static int GetIso15693AnswerFromSniff(uint8_t *receivedResponse
, int maxLen
, int *samples
, int *elapsed
)
451 uint8_t *dest
= (uint8_t *)BigBuf
;
457 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_RX_XCORR
);
458 //spindelay(60); // greg - experiment to get rid of some of the 0 byte/failed reads
462 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_TXRDY
)) {
463 AT91C_BASE_SSC
->SSC_THR
= 0x43;
465 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_RXRDY
)) {
467 b
= (int8_t)AT91C_BASE_SSC
->SSC_RHR
;
469 // The samples are correlations against I and Q versions of the
470 // tone that the tag AM-modulates, so every other sample is I,
471 // every other is Q. We just want power, so abs(I) + abs(Q) is
472 // close to what we want.
487 dest
[c
++] = (uint8_t)r
;
500 //////////////////////////////////////////
501 /////////// DEMODULATE ///////////////////
502 //////////////////////////////////////////
505 int max
= 0, maxPos
=0;
509 // if(GraphTraceLen < 1000) return; // THIS CHECKS FOR A BUFFER TO SMALL
511 // First, correlate for SOF
512 for(i
= 0; i
< 19000; i
++) {
514 for(j
= 0; j
< arraylen(FrameSOF
); j
+= skip
) {
515 corr
+= FrameSOF
[j
]*dest
[i
+(j
/skip
)];
522 // DbpString("SOF at %d, correlation %d", maxPos,max/(arraylen(FrameSOF)/skip));
524 int k
= 0; // this will be our return value
526 // greg - If correlation is less than 1 then there's little point in continuing
527 if ((max
/(arraylen(FrameSOF
)/skip
)) >= 1) // THIS SHOULD BE 1
530 i
= maxPos
+ arraylen(FrameSOF
)/skip
;
533 memset(outBuf
, 0, sizeof(outBuf
));
536 int corr0
= 0, corr1
= 0, corrEOF
= 0;
537 for(j
= 0; j
< arraylen(Logic0
); j
+= skip
) {
538 corr0
+= Logic0
[j
]*dest
[i
+(j
/skip
)];
540 for(j
= 0; j
< arraylen(Logic1
); j
+= skip
) {
541 corr1
+= Logic1
[j
]*dest
[i
+(j
/skip
)];
543 for(j
= 0; j
< arraylen(FrameEOF
); j
+= skip
) {
544 corrEOF
+= FrameEOF
[j
]*dest
[i
+(j
/skip
)];
546 // Even things out by the length of the target waveform.
550 if(corrEOF
> corr1
&& corrEOF
> corr0
) {
551 // DbpString("EOF at %d", i);
553 } else if(corr1
> corr0
) {
554 i
+= arraylen(Logic1
)/skip
;
557 i
+= arraylen(Logic0
)/skip
;
564 if((i
+(int)arraylen(FrameEOF
)) >= 2000) {
565 DbpString("ran off end!");
570 DbpString("sniff: error, uneven octet! (discard extra bits!)");
571 /// DbpString(" mask=%02x", mask);
575 // strncat(str1," octets read",8);
577 // DbpString( str1); // DbpString("%d octets", k);
579 // for(i = 0; i < k; i+=3) {
580 // //DbpString("# %2d: %02x ", i, outBuf[i]);
581 // DbpIntegers(outBuf[i],outBuf[i+1],outBuf[i+2]);
584 for(i
= 0; i
< k
; i
++) {
585 receivedResponse
[i
] = outBuf
[i
];
587 } // "end if correlation > 0" (max/(arraylen(FrameSOF)/skip))
588 return k
; // return the number of bytes demodulated
590 /// DbpString("CRC=%04x", Iso15693Crc(outBuf, k-2));
594 static void BuildIdentifyRequest(void);
595 //-----------------------------------------------------------------------------
596 // Start to read an ISO 15693 tag. We send an identify request, then wait
597 // for the response. The response is not demodulated, just left in the buffer
598 // so that it can be downloaded to a PC and processed there.
599 //-----------------------------------------------------------------------------
600 void AcquireRawAdcSamplesIso15693(void)
602 uint8_t *dest
= mifare_get_bigbufptr();
608 FpgaDownloadAndGo(FPGA_BITSTREAM_HF
);
609 BuildIdentifyRequest();
611 SetAdcMuxFor(GPIO_MUXSEL_HIPKD
);
613 // Give the tags time to energize
614 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_RX_XCORR
);
617 // Now send the command
619 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_TX
);
623 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_TXRDY
)) {
624 AT91C_BASE_SSC
->SSC_THR
= ToSend
[c
];
626 if(c
== ToSendMax
+3) {
630 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_RXRDY
)) {
631 volatile uint32_t r
= AT91C_BASE_SSC
->SSC_RHR
;
637 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_RX_XCORR
);
642 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_TXRDY
)) {
643 AT91C_BASE_SSC
->SSC_THR
= 0x43;
645 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_RXRDY
)) {
647 b
= (int8_t)AT91C_BASE_SSC
->SSC_RHR
;
649 // The samples are correlations against I and Q versions of the
650 // tone that the tag AM-modulates, so every other sample is I,
651 // every other is Q. We just want power, so abs(I) + abs(Q) is
652 // close to what we want.
667 dest
[c
++] = (uint8_t)r
;
682 void RecordRawAdcSamplesIso15693(void)
684 uint8_t *dest
= mifare_get_bigbufptr();
690 FpgaDownloadAndGo(FPGA_BITSTREAM_HF
);
694 // Start from off (no field generated)
695 FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF
);
698 SetAdcMuxFor(GPIO_MUXSEL_HIPKD
);
702 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_RX_XCORR
);
707 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_TXRDY
)) {
708 AT91C_BASE_SSC
->SSC_THR
= 0x43;
710 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_RXRDY
)) {
712 b
= (int8_t)AT91C_BASE_SSC
->SSC_RHR
;
714 // The samples are correlations against I and Q versions of the
715 // tone that the tag AM-modulates, so every other sample is I,
716 // every other is Q. We just want power, so abs(I) + abs(Q) is
717 // close to what we want.
732 dest
[c
++] = (uint8_t)r
;
745 Dbprintf("fin record");
749 // Initialize the proxmark as iso15k reader
750 // (this might produces glitches that confuse some tags
751 void Iso15693InitReader() {
757 FpgaDownloadAndGo(FPGA_BITSTREAM_HF
);
761 // Start from off (no field generated)
762 FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF
);
765 SetAdcMuxFor(GPIO_MUXSEL_HIPKD
);
768 // Give the tags time to energize
769 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_RX_XCORR
);
778 ///////////////////////////////////////////////////////////////////////
779 // ISO 15693 Part 3 - Air Interface
780 // This section basicly contains transmission and receiving of bits
781 ///////////////////////////////////////////////////////////////////////
783 // Encode (into the ToSend buffers) an identify request, which is the first
784 // thing that you must send to a tag to get a response.
785 static void BuildIdentifyRequest(void)
790 // one sub-carrier, inventory, 1 slot, fast rate
791 // AFI is at bit 5 (1<<4) when doing an INVENTORY
792 cmd
[0] = (1 << 2) | (1 << 5) | (1 << 1);
793 // inventory command code
802 CodeIso15693AsReader(cmd
, sizeof(cmd
));
805 // uid is in transmission order (which is reverse of display order)
806 static void BuildReadBlockRequest(uint8_t *uid
, uint8_t blockNumber
)
811 // If we set the Option_Flag in this request, the VICC will respond with the secuirty status of the block
812 // followed by teh block data
813 // one sub-carrier, inventory, 1 slot, fast rate
814 cmd
[0] = (1 << 6)| (1 << 5) | (1 << 1); // no SELECT bit, ADDR bit, OPTION bit
815 // READ BLOCK command code
817 // UID may be optionally specified here
826 cmd
[9] = uid
[7]; // 0xe0; // always e0 (not exactly unique)
827 // Block number to read
828 cmd
[10] = blockNumber
;//0x00;
830 crc
= Crc(cmd
, 11); // the crc needs to be calculated over 12 bytes
831 cmd
[11] = crc
& 0xff;
834 CodeIso15693AsReader(cmd
, sizeof(cmd
));
837 // Now the VICC>VCD responses when we are simulating a tag
838 static void BuildInventoryResponse( uint8_t *uid
)
843 // one sub-carrier, inventory, 1 slot, fast rate
844 // AFI is at bit 5 (1<<4) when doing an INVENTORY
845 cmd
[0] = 0x0d; // COM LEN? Data 8 + 4 //(1 << 2) | (1 << 5) | (1 << 1);
846 cmd
[1] = 0; // com_Adr
847 cmd
[2] = 0; // status 00 = success
849 cmd
[3] = uid
[7]; //0x32;
850 cmd
[4] = uid
[6]; //0x4b;
851 cmd
[5] = uid
[5]; //0x03;
852 cmd
[6] = uid
[4]; //0x01;
853 cmd
[7] = uid
[3]; //0x00;
854 cmd
[8] = uid
[2]; //0x10;
855 cmd
[9] = uid
[1]; //0x05;
856 cmd
[10] = uid
[0]; //0xe0;
859 cmd
[11] = crc
& 0xff;
862 CodeIso15693AsReader(cmd
, sizeof(cmd
));
865 // Universal Method for sending to and recv bytes from a tag
866 // init ... should we initialize the reader?
867 // speed ... 0 low speed, 1 hi speed
868 // **recv will return you a pointer to the received data
869 // If you do not need the answer use NULL for *recv[]
870 // return: lenght of received data
871 int SendDataTag(uint8_t *send
, int sendlen
, int init
, int speed
, uint8_t **recv
) {
884 uint8_t *answer
= (((uint8_t *)BigBuf
) + 3660);
885 if (recv
!=NULL
) memset(BigBuf
+ 3660, 0, 100);
887 if (init
) Iso15693InitReader();
890 // low speed (1 out of 256)
891 CodeIso15693AsReader256(send
, sendlen
);
893 // high speed (1 out of 4)
894 CodeIso15693AsReader(send
, sendlen
);
900 TransmitTo15693Tag(ToSend
,ToSendMax
,&tsamples
, &wait
);
901 // Now wait for a response
905 answerLen
= GetIso15693AnswerFromTag(answer
, 100, &samples
, &elapsed
) ;
918 // --------------------------------------------------------------------
920 // --------------------------------------------------------------------
922 // Decodes a message from a tag and displays its metadata and content
923 #define DBD15STATLEN 48
924 void DbdecodeIso15693Answer(int len
, uint8_t *d
) {
925 char status
[DBD15STATLEN
+1]={0};
930 strncat(status
,"ProtExt ",DBD15STATLEN
);
933 strncat(status
,"Error ",DBD15STATLEN
);
936 strncat(status
,"01:notSupp",DBD15STATLEN
);
939 strncat(status
,"02:notRecog",DBD15STATLEN
);
942 strncat(status
,"03:optNotSupp",DBD15STATLEN
);
945 strncat(status
,"0f:noInfo",DBD15STATLEN
);
948 strncat(status
,"10:dontExist",DBD15STATLEN
);
951 strncat(status
,"11:lockAgain",DBD15STATLEN
);
954 strncat(status
,"12:locked",DBD15STATLEN
);
957 strncat(status
,"13:progErr",DBD15STATLEN
);
960 strncat(status
,"14:lockErr",DBD15STATLEN
);
963 strncat(status
,"unknownErr",DBD15STATLEN
);
965 strncat(status
," ",DBD15STATLEN
);
967 strncat(status
,"NoErr ",DBD15STATLEN
);
971 if ( (( crc
& 0xff ) == d
[len
-2]) && (( crc
>> 8 ) == d
[len
-1]) )
972 strncat(status
,"CrcOK",DBD15STATLEN
);
974 strncat(status
,"CrcFail!",DBD15STATLEN
);
976 Dbprintf("%s",status
);
982 ///////////////////////////////////////////////////////////////////////
983 // Functions called via USB/Client
984 ///////////////////////////////////////////////////////////////////////
986 void SetDebugIso15693(uint32_t debug
) {
988 Dbprintf("Iso15693 Debug is now %s",DEBUG
?"on":"off");
994 //-----------------------------------------------------------------------------
995 // Simulate an ISO15693 reader, perform anti-collision and then attempt to read a sector
996 // all demodulation performed in arm rather than host. - greg
997 //-----------------------------------------------------------------------------
998 void ReaderIso15693(uint32_t parameter
)
1005 uint8_t *answer1
= (((uint8_t *)BigBuf
) + 3660); //
1006 uint8_t *answer2
= (((uint8_t *)BigBuf
) + 3760);
1007 uint8_t *answer3
= (((uint8_t *)BigBuf
) + 3860);
1017 uint8_t TagUID
[8] = {0x00};
1021 memset(BigBuf
+ 3660, 0x00, 300);
1023 FpgaDownloadAndGo(FPGA_BITSTREAM_HF
);
1025 SetAdcMuxFor(GPIO_MUXSEL_HIPKD
);
1029 // Start from off (no field generated)
1030 FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF
);
1033 // Give the tags time to energize
1034 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_RX_XCORR
);
1042 // FIRST WE RUN AN INVENTORY TO GET THE TAG UID
1043 // THIS MEANS WE CAN PRE-BUILD REQUESTS TO SAVE CPU TIME
1045 // Now send the IDENTIFY command
1046 BuildIdentifyRequest();
1048 TransmitTo15693Tag(ToSend
,ToSendMax
,&tsamples
, &wait
);
1050 // Now wait for a response
1051 answerLen1
= GetIso15693AnswerFromTag(answer1
, 100, &samples
, &elapsed
) ;
1053 if (answerLen1
>=12) // we should do a better check than this
1055 TagUID
[0] = answer1
[2];
1056 TagUID
[1] = answer1
[3];
1057 TagUID
[2] = answer1
[4];
1058 TagUID
[3] = answer1
[5];
1059 TagUID
[4] = answer1
[6];
1060 TagUID
[5] = answer1
[7];
1061 TagUID
[6] = answer1
[8]; // IC Manufacturer code
1062 TagUID
[7] = answer1
[9]; // always E0
1066 Dbprintf("%d octets read from IDENTIFY request:", answerLen1
);
1067 DbdecodeIso15693Answer(answerLen1
,answer1
);
1068 Dbhexdump(answerLen1
,answer1
,true);
1071 if (answerLen1
>= 12)
1072 Dbprintf("UID = %02hX%02hX%02hX%02hX%02hX%02hX%02hX%02hX",
1073 TagUID
[7],TagUID
[6],TagUID
[5],TagUID
[4],
1074 TagUID
[3],TagUID
[2],TagUID
[1],TagUID
[0]);
1077 Dbprintf("%d octets read from SELECT request:", answerLen2
);
1078 DbdecodeIso15693Answer(answerLen2
,answer2
);
1079 Dbhexdump(answerLen2
,answer2
,true);
1081 Dbprintf("%d octets read from XXX request:", answerLen3
);
1082 DbdecodeIso15693Answer(answerLen3
,answer3
);
1083 Dbhexdump(answerLen3
,answer3
,true);
1086 if (answerLen1
>= 12 && DEBUG
) {
1088 while (i
< 32) { // sanity check, assume max 32 pages
1089 BuildReadBlockRequest(TagUID
,i
);
1090 TransmitTo15693Tag(ToSend
,ToSendMax
,&tsamples
, &wait
);
1091 answerLen2
= GetIso15693AnswerFromTag(answer2
, 100, &samples
, &elapsed
);
1092 if (answerLen2
> 0) {
1093 Dbprintf("READ SINGLE BLOCK %d returned %d octets:",i
,answerLen2
);
1094 DbdecodeIso15693Answer(answerLen2
,answer2
);
1095 Dbhexdump(answerLen2
,answer2
,true);
1096 if ( *((uint32_t*) answer2
) == 0x07160101 ) break; // exit on NoPageErr
1108 // Simulate an ISO15693 TAG, perform anti-collision and then print any reader commands
1109 // all demodulation performed in arm rather than host. - greg
1110 void SimTagIso15693(uint32_t parameter
, uint8_t *uid
)
1117 uint8_t *buf
= (((uint8_t *)BigBuf
) + 3660); //
1125 memset(buf
, 0x00, 100);
1127 // Inventory response
1128 BuildInventoryResponse(uid
);
1130 FpgaDownloadAndGo(FPGA_BITSTREAM_HF
);
1132 SetAdcMuxFor(GPIO_MUXSEL_HIPKD
);
1136 // Start from off (no field generated)
1137 FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF
);
1146 answerLen1
= GetIso15693AnswerFromSniff(buf
, 100, &samples
, &elapsed
) ;
1148 if (answerLen1
>=1) // we should do a better check than this
1150 // Build a suitable reponse to the reader INVENTORY cocmmand
1151 // not so obsvious, but in the call to BuildInventoryResponse, the command is copied to the global ToSend buffer used below.
1152 TransmitTo15693Reader(ToSend
, ToSendMax
, &tsamples
, &wait
);
1155 Dbprintf("%d octets read from reader command: %x %x %x %x %x %x %x %x %x", answerLen1
,
1156 buf
[0], buf
[1], buf
[2], buf
[3],
1157 buf
[4], buf
[5], buf
[6], buf
[7], buf
[8]);
1166 // Since there is no standardized way of reading the AFI out of a tag, we will brute force it
1167 // (some manufactures offer a way to read the AFI, though)
1168 void BruteforceIso15693Afi(uint32_t speed
)
1172 int datalen
=0, recvlen
=0;
1174 Iso15693InitReader();
1176 // first without AFI
1177 // Tags should respond wihtout AFI and with AFI=0 even when AFI is active
1179 data
[0]=ISO15_REQ_SUBCARRIER_SINGLE
| ISO15_REQ_DATARATE_HIGH
|
1180 ISO15_REQ_INVENTORY
| ISO15_REQINV_SLOT1
;
1181 data
[1]=ISO15_CMD_INVENTORY
;
1182 data
[2]=0; // mask length
1183 datalen
=AddCrc(data
,3);
1184 recvlen
=SendDataTag(data
,datalen
,0,speed
,&recv
);
1187 Dbprintf("NoAFI UID=%s",sprintUID(NULL
,&recv
[2]));
1192 data
[0]=ISO15_REQ_SUBCARRIER_SINGLE
| ISO15_REQ_DATARATE_HIGH
|
1193 ISO15_REQ_INVENTORY
| ISO15_REQINV_AFI
| ISO15_REQINV_SLOT1
;
1194 data
[1]=ISO15_CMD_INVENTORY
;
1196 data
[3]=0; // mask length
1198 for (int i
=0;i
<256;i
++) {
1200 datalen
=AddCrc(data
,4);
1201 recvlen
=SendDataTag(data
,datalen
,0,speed
,&recv
);
1204 Dbprintf("AFI=%i UID=%s",i
,sprintUID(NULL
,&recv
[2]));
1207 Dbprintf("AFI Bruteforcing done.");
1211 // Allows to directly send commands to the tag via the client
1212 void DirectTag15693Command(uint32_t datalen
,uint32_t speed
, uint32_t recv
, uint8_t data
[]) {
1215 uint8_t *recvbuf
=(uint8_t *)BigBuf
;
1220 Dbhexdump(datalen
,data
,true);
1223 recvlen
=SendDataTag(data
,datalen
,1,speed
,(recv
?&recvbuf
:NULL
));
1227 cmd_send(CMD_ACK
,recvlen
>48?48:recvlen
,0,0,recvbuf
,48);
1232 DbdecodeIso15693Answer(recvlen
,recvbuf
);
1233 Dbhexdump(recvlen
,recvbuf
,true);
1242 // --------------------------------------------------------------------
1243 // -- Misc & deprecated functions
1244 // --------------------------------------------------------------------
1248 // do not use; has a fix UID
1249 static void __attribute__((unused)) BuildSysInfoRequest(uint8_t *uid)
1254 // If we set the Option_Flag in this request, the VICC will respond with the secuirty status of the block
1255 // followed by teh block data
1256 // one sub-carrier, inventory, 1 slot, fast rate
1257 cmd[0] = (1 << 5) | (1 << 1); // no SELECT bit
1258 // System Information command code
1260 // UID may be optionally specified here
1269 cmd[9]= 0xe0; // always e0 (not exactly unique)
1271 crc = Crc(cmd, 10); // the crc needs to be calculated over 2 bytes
1272 cmd[10] = crc & 0xff;
1275 CodeIso15693AsReader(cmd, sizeof(cmd));
1279 // do not use; has a fix UID
1280 static void __attribute__((unused)) BuildReadMultiBlockRequest(uint8_t *uid)
1285 // If we set the Option_Flag in this request, the VICC will respond with the secuirty status of the block
1286 // followed by teh block data
1287 // one sub-carrier, inventory, 1 slot, fast rate
1288 cmd[0] = (1 << 5) | (1 << 1); // no SELECT bit
1289 // READ Multi BLOCK command code
1291 // UID may be optionally specified here
1300 cmd[9]= 0xe0; // always e0 (not exactly unique)
1301 // First Block number to read
1303 // Number of Blocks to read
1304 cmd[11] = 0x2f; // read quite a few
1306 crc = Crc(cmd, 12); // the crc needs to be calculated over 2 bytes
1307 cmd[12] = crc & 0xff;
1310 CodeIso15693AsReader(cmd, sizeof(cmd));
1313 // do not use; has a fix UID
1314 static void __attribute__((unused)) BuildArbitraryRequest(uint8_t *uid,uint8_t CmdCode)
1319 // If we set the Option_Flag in this request, the VICC will respond with the secuirty status of the block
1320 // followed by teh block data
1321 // one sub-carrier, inventory, 1 slot, fast rate
1322 cmd[0] = (1 << 5) | (1 << 1); // no SELECT bit
1323 // READ BLOCK command code
1325 // UID may be optionally specified here
1334 cmd[9]= 0xe0; // always e0 (not exactly unique)
1340 // cmd[13] = 0x00; //Now the CRC
1341 crc = Crc(cmd, 12); // the crc needs to be calculated over 2 bytes
1342 cmd[12] = crc & 0xff;
1345 CodeIso15693AsReader(cmd, sizeof(cmd));
1348 // do not use; has a fix UID
1349 static void __attribute__((unused)) BuildArbitraryCustomRequest(uint8_t uid[], uint8_t CmdCode)
1354 // If we set the Option_Flag in this request, the VICC will respond with the secuirty status of the block
1355 // followed by teh block data
1356 // one sub-carrier, inventory, 1 slot, fast rate
1357 cmd[0] = (1 << 5) | (1 << 1); // no SELECT bit
1358 // READ BLOCK command code
1360 // UID may be optionally specified here
1369 cmd[9]= 0xe0; // always e0 (not exactly unique)
1371 cmd[10] = 0x05; // for custom codes this must be manufcturer code
1375 // cmd[13] = 0x00; //Now the CRC
1376 crc = Crc(cmd, 12); // the crc needs to be calculated over 2 bytes
1377 cmd[12] = crc & 0xff;
1380 CodeIso15693AsReader(cmd, sizeof(cmd));