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 "proxmark3.h"
65 #include "iso15693tools.h"
68 #define arraylen(x) (sizeof(x)/sizeof((x)[0]))
70 ///////////////////////////////////////////////////////////////////////
71 // ISO 15693 Part 2 - Air Interface
72 // This section basicly contains transmission and receiving of bits
73 ///////////////////////////////////////////////////////////////////////
75 #define FrameSOF Iso15693FrameSOF
76 #define Logic0 Iso15693Logic0
77 #define Logic1 Iso15693Logic1
78 #define FrameEOF Iso15693FrameEOF
80 #define Crc(data,datalen) Iso15693Crc(data,datalen)
81 #define AddCrc(data,datalen) Iso15693AddCrc(data,datalen)
82 #define sprintUID(target,uid) Iso15693sprintUID(target,uid)
84 // approximate amplitude=sqrt(ci^2+cq^2)
85 #define AMPLITUDE(ci, cq) (MAX(ABS(ci), ABS(cq)) + (MIN(ABS(ci), ABS(cq))>>1))
90 // ---------------------------
92 // ---------------------------
94 // prepare data using "1 out of 4" code for later transmission
95 // resulting data rate is 26,48 kbit/s (fc/512)
97 // n ... length of data
98 static void CodeIso15693AsReader(uint8_t *cmd
, int n
)
104 // Give it a bit of slack at the beginning
105 for(i
= 0; i
< 24; i
++) {
118 for(i
= 0; i
< n
; i
++) {
119 for(j
= 0; j
< 8; j
+= 2) {
120 int these
= (cmd
[i
] >> j
) & 3;
171 // And slack at the end, too.
172 for(i
= 0; i
< 24; i
++) {
177 // encode data using "1 out of 256" sheme
178 // data rate is 1,66 kbit/s (fc/8192)
179 // is designed for more robust communication over longer distances
180 static void CodeIso15693AsReader256(uint8_t *cmd
, int n
)
186 // Give it a bit of slack at the beginning
187 for(i
= 0; i
< 24; i
++) {
201 for(i
= 0; i
< n
; i
++) {
202 for (j
= 0; j
<=255; j
++) {
218 // And slack at the end, too.
219 for(i
= 0; i
< 24; i
++) {
225 // Transmit the command (to the tag) that was placed in ToSend[].
226 static void TransmitTo15693Tag(const uint8_t *cmd
, int len
, int *samples
, int *wait
)
230 // FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_ISO14443A | FPGA_HF_ISO14443A_READER_MOD);
231 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_TX
);
232 if(*wait
< 10) { *wait
= 10; }
234 // for(c = 0; c < *wait;) {
235 // if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_TXRDY)) {
236 // AT91C_BASE_SSC->SSC_THR = 0x00; // For exact timing!
239 // if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_RXRDY)) {
240 // volatile uint32_t r = AT91C_BASE_SSC->SSC_RHR;
248 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_TXRDY
)) {
249 AT91C_BASE_SSC
->SSC_THR
= cmd
[c
];
255 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_RXRDY
)) {
256 volatile uint32_t r
= AT91C_BASE_SSC
->SSC_RHR
;
261 *samples
= (c
+ *wait
) << 3;
264 //-----------------------------------------------------------------------------
265 // Transmit the command (to the reader) that was placed in ToSend[].
266 //-----------------------------------------------------------------------------
267 static void TransmitTo15693Reader(const uint8_t *cmd
, int len
, int *samples
, int *wait
)
270 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_SIMULATOR
|FPGA_HF_SIMULATOR_MODULATE_424K
);
271 if(*wait
< 10) { *wait
= 10; }
274 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_TXRDY
)) {
275 AT91C_BASE_SSC
->SSC_THR
= cmd
[c
];
281 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_RXRDY
)) {
282 volatile uint32_t r
= AT91C_BASE_SSC
->SSC_RHR
;
287 *samples
= (c
+ *wait
) << 3;
298 // number of decoded bytes
299 static int GetIso15693AnswerFromTag(uint8_t *receivedResponse
, int maxLen
, int *samples
, int *elapsed
)
302 uint8_t *dest
= BigBuf_get_addr();
308 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_RX_XCORR
);
312 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_RXRDY
)) {
314 b
= (int8_t)AT91C_BASE_SSC
->SSC_RHR
;
316 // The samples are correlations against I and Q versions of the
317 // tone that the tag AM-modulates, so every other sample is I,
318 // every other is Q. We just want power, so abs(I) + abs(Q) is
319 // close to what we want.
321 uint8_t r
= AMPLITUDE(b
, prev
);
336 //////////////////////////////////////////
337 /////////// DEMODULATE ///////////////////
338 //////////////////////////////////////////
341 int max
= 0, maxPos
=0;
345 // First, correlate for SOF
346 for(i
= 0; i
< 200; i
++) { // usually, SOF is found around i = 60
348 for(j
= 0; j
< arraylen(FrameSOF
); j
+= skip
) {
349 corr
+= FrameSOF
[j
]*dest
[i
+(j
/skip
)];
356 if (DEBUG
) Dbprintf("SOF at %d, correlation %d", maxPos
, max
/(arraylen(FrameSOF
)/skip
));
358 int k
= 0; // this will be our return value
360 // greg - If correlation is less than 1 then there's little point in continuing
361 if ((max
/(arraylen(FrameSOF
)/skip
)) >= 1)
364 i
= maxPos
+ arraylen(FrameSOF
)/skip
;
367 memset(outBuf
, 0, sizeof(outBuf
));
370 int corr0
= 0, corr00
= 0, corr01
= 0, corr1
= 0, corrEOF
= 0;
371 for(j
= 0; j
< arraylen(Logic0
); j
+= skip
) {
372 corr0
+= Logic0
[j
]*dest
[i
+(j
/skip
)];
374 corr01
= corr00
= corr0
;
375 for(j
= 0; j
< arraylen(Logic0
); j
+= skip
) {
376 corr00
+= Logic0
[j
]*dest
[i
+arraylen(Logic0
)/skip
+(j
/skip
)];
377 corr01
+= Logic1
[j
]*dest
[i
+arraylen(Logic0
)/skip
+(j
/skip
)];
379 for(j
= 0; j
< arraylen(Logic1
); j
+= skip
) {
380 corr1
+= Logic1
[j
]*dest
[i
+(j
/skip
)];
382 for(j
= 0; j
< arraylen(FrameEOF
); j
+= skip
) {
383 corrEOF
+= FrameEOF
[j
]*dest
[i
+(j
/skip
)];
385 // Even things out by the length of the target waveform.
391 if(corrEOF
> corr1
&& corrEOF
> corr00
&& corrEOF
> corr01
) {
392 if (DEBUG
) Dbprintf("EOF at %d, correlation %d (corr01: %d, corr00: %d, corr1: %d, corr0: %d)",
393 i
, corrEOF
, corr01
, corr00
, corr1
, corr0
);
395 } else if(corr1
> corr0
) {
396 i
+= arraylen(Logic1
)/skip
;
399 i
+= arraylen(Logic0
)/skip
;
406 if((i
+(int)arraylen(FrameEOF
)/skip
) >= 4000) {
407 DbpString("ran off end!");
411 if(mask
!= 0x01) { // this happens, when we miss the EOF
412 // TODO: for some reason this happens quite often
413 if (DEBUG
) Dbprintf("error, uneven octet! (extra bits!) mask=%02x", mask
);
414 if (mask
<0x08) k
--; // discard the last uneven octet;
415 // 0x08 is an assumption - but works quite often
419 // strncat(str1," octets read",8);
421 // DbpString( str1); // DbpString("%d octets", k);
423 // for(i = 0; i < k; i+=3) {
424 // //DbpString("# %2d: %02x ", i, outBuf[i]);
425 // DbpIntegers(outBuf[i],outBuf[i+1],outBuf[i+2]);
428 for(i
= 0; i
< k
; i
++) {
429 receivedResponse
[i
] = outBuf
[i
];
431 } // "end if correlation > 0" (max/(arraylen(FrameSOF)/skip))
432 return k
; // return the number of bytes demodulated
434 /// DbpString("CRC=%04x", Iso15693Crc(outBuf, k-2));
439 // Now the GetISO15693 message from sniffing command
440 static int GetIso15693AnswerFromSniff(uint8_t *receivedResponse
, int maxLen
, int *samples
, int *elapsed
)
443 uint8_t *dest
= BigBuf_get_addr();
449 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_RX_XCORR
);
450 //spindelay(60); // greg - experiment to get rid of some of the 0 byte/failed reads
454 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_RXRDY
)) {
455 int8_t b
= (int8_t)AT91C_BASE_SSC
->SSC_RHR
;
457 // The samples are correlations against I and Q versions of the
458 // tone that the tag AM-modulates, so every other sample is I,
459 // every other is Q. We just want power, so abs(I) + abs(Q) is
460 // close to what we want.
462 uint8_t r
= AMPLITUDE(b
, prev
);
466 if(c
>= BIGBUF_SIZE
) {
477 //////////////////////////////////////////
478 /////////// DEMODULATE ///////////////////
479 //////////////////////////////////////////
482 int max
= 0, maxPos
=0;
486 // First, correlate for SOF
487 for(i
= 0; i
< 38000; i
++) {
489 for(j
= 0; j
< arraylen(FrameSOF
); j
+= skip
) {
490 corr
+= FrameSOF
[j
]*dest
[i
+(j
/skip
)];
497 if (DEBUG
) Dbprintf("SOF at %d, correlation %d", maxPos
,max
/(arraylen(FrameSOF
)/skip
));
499 int k
= 0; // this will be our return value
501 // greg - If correlation is less than 1 then there's little point in continuing
502 if ((max
/(arraylen(FrameSOF
)/skip
)) >= 1) // THIS SHOULD BE 1
505 i
= maxPos
+ arraylen(FrameSOF
)/skip
;
508 memset(outBuf
, 0, sizeof(outBuf
));
511 int corr0
= 0, corr00
= 0, corr01
= 0, corr1
= 0, corrEOF
= 0;
512 for(j
= 0; j
< arraylen(Logic0
); j
+= skip
) {
513 corr0
+= Logic0
[j
]*dest
[i
+(j
/skip
)];
515 corr01
= corr00
= corr0
;
516 for(j
= 0; j
< arraylen(Logic0
); j
+= skip
) {
517 corr00
+= Logic0
[j
]*dest
[i
+arraylen(Logic0
)/skip
+(j
/skip
)];
518 corr01
+= Logic1
[j
]*dest
[i
+arraylen(Logic0
)/skip
+(j
/skip
)];
520 for(j
= 0; j
< arraylen(Logic1
); j
+= skip
) {
521 corr1
+= Logic1
[j
]*dest
[i
+(j
/skip
)];
523 for(j
= 0; j
< arraylen(FrameEOF
); j
+= skip
) {
524 corrEOF
+= FrameEOF
[j
]*dest
[i
+(j
/skip
)];
526 // Even things out by the length of the target waveform.
532 if(corrEOF
> corr1
&& corrEOF
> corr00
&& corrEOF
> corr01
) {
533 if (DEBUG
) Dbprintf("EOF at %d, correlation %d (corr01: %d, corr00: %d, corr1: %d, corr0: %d)",
534 i
, corrEOF
, corr01
, corr00
, corr1
, corr0
);
536 } else if(corr1
> corr0
) {
537 i
+= arraylen(Logic1
)/skip
;
540 i
+= arraylen(Logic0
)/skip
;
547 if((i
+(int)arraylen(FrameEOF
)/skip
) >= BIGBUF_SIZE
) {
548 DbpString("ran off end!");
553 DbpString("sniff: error, uneven octet! (discard extra bits!)");
554 /// DbpString(" mask=%02x", mask);
558 // strncat(str1," octets read",8);
560 // DbpString( str1); // DbpString("%d octets", k);
562 // for(i = 0; i < k; i+=3) {
563 // //DbpString("# %2d: %02x ", i, outBuf[i]);
564 // DbpIntegers(outBuf[i],outBuf[i+1],outBuf[i+2]);
567 for(i
= 0; i
< k
; i
++) {
568 receivedResponse
[i
] = outBuf
[i
];
570 } // "end if correlation > 0" (max/(arraylen(FrameSOF)/skip))
571 return k
; // return the number of bytes demodulated
573 /// DbpString("CRC=%04x", Iso15693Crc(outBuf, k-2));
577 static void BuildIdentifyRequest(void);
578 //-----------------------------------------------------------------------------
579 // Start to read an ISO 15693 tag. We send an identify request, then wait
580 // for the response. The response is not demodulated, just left in the buffer
581 // so that it can be downloaded to a PC and processed there.
582 //-----------------------------------------------------------------------------
583 void AcquireRawAdcSamplesIso15693(void)
585 uint8_t *dest
= BigBuf_get_addr();
591 FpgaDownloadAndGo(FPGA_BITSTREAM_HF
);
592 BuildIdentifyRequest();
594 SetAdcMuxFor(GPIO_MUXSEL_HIPKD
);
596 // Give the tags time to energize
597 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_RX_XCORR
);
600 // Now send the command
602 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_TX
);
606 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_TXRDY
)) {
607 AT91C_BASE_SSC
->SSC_THR
= ToSend
[c
];
609 if(c
== ToSendMax
+3) {
616 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_RX_XCORR
);
621 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_RXRDY
)) {
623 b
= (int8_t)AT91C_BASE_SSC
->SSC_RHR
;
625 // The samples are correlations against I and Q versions of the
626 // tone that the tag AM-modulates, so every other sample is I,
627 // every other is Q. We just want power, so abs(I) + abs(Q) is
628 // close to what we want.
630 uint8_t r
= AMPLITUDE(b
, prev
);
647 void RecordRawAdcSamplesIso15693(void)
649 uint8_t *dest
= BigBuf_get_addr();
655 FpgaDownloadAndGo(FPGA_BITSTREAM_HF
);
659 // Start from off (no field generated)
660 FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF
);
663 SetAdcMuxFor(GPIO_MUXSEL_HIPKD
);
667 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_RX_XCORR
);
672 if(AT91C_BASE_SSC
->SSC_SR
& (AT91C_SSC_RXRDY
)) {
674 b
= (int8_t)AT91C_BASE_SSC
->SSC_RHR
;
676 // The samples are correlations against I and Q versions of the
677 // tone that the tag AM-modulates, so every other sample is I,
678 // every other is Q. We just want power, so abs(I) + abs(Q) is
679 // close to what we want.
681 uint8_t r
= AMPLITUDE(b
, prev
);
696 Dbprintf("fin record");
700 // Initialize the proxmark as iso15k reader
701 // (this might produces glitches that confuse some tags
702 void Iso15693InitReader() {
708 FpgaDownloadAndGo(FPGA_BITSTREAM_HF
);
712 // Start from off (no field generated)
713 FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF
);
716 SetAdcMuxFor(GPIO_MUXSEL_HIPKD
);
719 // Give the tags time to energize
720 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_RX_XCORR
);
729 ///////////////////////////////////////////////////////////////////////
730 // ISO 15693 Part 3 - Air Interface
731 // This section basicly contains transmission and receiving of bits
732 ///////////////////////////////////////////////////////////////////////
734 // Encode (into the ToSend buffers) an identify request, which is the first
735 // thing that you must send to a tag to get a response.
736 static void BuildIdentifyRequest(void)
741 // one sub-carrier, inventory, 1 slot, fast rate
742 // AFI is at bit 5 (1<<4) when doing an INVENTORY
743 cmd
[0] = (1 << 2) | (1 << 5) | (1 << 1);
744 // inventory command code
753 CodeIso15693AsReader(cmd
, sizeof(cmd
));
756 // uid is in transmission order (which is reverse of display order)
757 static void BuildReadBlockRequest(uint8_t *uid
, uint8_t blockNumber
)
762 // If we set the Option_Flag in this request, the VICC will respond with the secuirty status of the block
763 // followed by teh block data
764 // one sub-carrier, inventory, 1 slot, fast rate
765 cmd
[0] = (1 << 6)| (1 << 5) | (1 << 1); // no SELECT bit, ADDR bit, OPTION bit
766 // READ BLOCK command code
768 // UID may be optionally specified here
777 cmd
[9] = uid
[7]; // 0xe0; // always e0 (not exactly unique)
778 // Block number to read
779 cmd
[10] = blockNumber
;//0x00;
781 crc
= Crc(cmd
, 11); // the crc needs to be calculated over 12 bytes
782 cmd
[11] = crc
& 0xff;
785 CodeIso15693AsReader(cmd
, sizeof(cmd
));
788 // Now the VICC>VCD responses when we are simulating a tag
789 static void BuildInventoryResponse( uint8_t *uid
)
794 // one sub-carrier, inventory, 1 slot, fast rate
795 // AFI is at bit 5 (1<<4) when doing an INVENTORY
796 //(1 << 2) | (1 << 5) | (1 << 1);
798 cmd
[1] = 0; // DSFID (data storage format identifier). 0x00 = not supported
800 cmd
[2] = uid
[7]; //0x32;
801 cmd
[3] = uid
[6]; //0x4b;
802 cmd
[4] = uid
[5]; //0x03;
803 cmd
[5] = uid
[4]; //0x01;
804 cmd
[6] = uid
[3]; //0x00;
805 cmd
[7] = uid
[2]; //0x10;
806 cmd
[8] = uid
[1]; //0x05;
807 cmd
[9] = uid
[0]; //0xe0;
810 cmd
[10] = crc
& 0xff;
813 CodeIso15693AsReader(cmd
, sizeof(cmd
));
816 // Universal Method for sending to and recv bytes from a tag
817 // init ... should we initialize the reader?
818 // speed ... 0 low speed, 1 hi speed
819 // **recv will return you a pointer to the received data
820 // If you do not need the answer use NULL for *recv[]
821 // return: lenght of received data
822 int SendDataTag(uint8_t *send
, int sendlen
, int init
, int speed
, uint8_t **recv
) {
834 if (init
) Iso15693InitReader();
837 uint8_t *answer
= BigBuf_get_addr() + 4000;
838 if (recv
!= NULL
) memset(answer
, 0, 100);
841 // low speed (1 out of 256)
842 CodeIso15693AsReader256(send
, sendlen
);
844 // high speed (1 out of 4)
845 CodeIso15693AsReader(send
, sendlen
);
851 TransmitTo15693Tag(ToSend
,ToSendMax
,&tsamples
, &wait
);
852 // Now wait for a response
856 answerLen
= GetIso15693AnswerFromTag(answer
, 100, &samples
, &elapsed
) ;
869 // --------------------------------------------------------------------
871 // --------------------------------------------------------------------
873 // Decodes a message from a tag and displays its metadata and content
874 #define DBD15STATLEN 48
875 void DbdecodeIso15693Answer(int len
, uint8_t *d
) {
876 char status
[DBD15STATLEN
+1]={0};
881 strncat(status
,"ProtExt ",DBD15STATLEN
);
884 strncat(status
,"Error ",DBD15STATLEN
);
887 strncat(status
,"01:notSupp",DBD15STATLEN
);
890 strncat(status
,"02:notRecog",DBD15STATLEN
);
893 strncat(status
,"03:optNotSupp",DBD15STATLEN
);
896 strncat(status
,"0f:noInfo",DBD15STATLEN
);
899 strncat(status
,"10:dontExist",DBD15STATLEN
);
902 strncat(status
,"11:lockAgain",DBD15STATLEN
);
905 strncat(status
,"12:locked",DBD15STATLEN
);
908 strncat(status
,"13:progErr",DBD15STATLEN
);
911 strncat(status
,"14:lockErr",DBD15STATLEN
);
914 strncat(status
,"unknownErr",DBD15STATLEN
);
916 strncat(status
," ",DBD15STATLEN
);
918 strncat(status
,"NoErr ",DBD15STATLEN
);
922 if ( (( crc
& 0xff ) == d
[len
-2]) && (( crc
>> 8 ) == d
[len
-1]) )
923 strncat(status
,"CrcOK",DBD15STATLEN
);
925 strncat(status
,"CrcFail!",DBD15STATLEN
);
927 Dbprintf("%s",status
);
933 ///////////////////////////////////////////////////////////////////////
934 // Functions called via USB/Client
935 ///////////////////////////////////////////////////////////////////////
937 void SetDebugIso15693(uint32_t debug
) {
939 Dbprintf("Iso15693 Debug is now %s",DEBUG
?"on":"off");
945 //-----------------------------------------------------------------------------
946 // Simulate an ISO15693 reader, perform anti-collision and then attempt to read a sector
947 // all demodulation performed in arm rather than host. - greg
948 //-----------------------------------------------------------------------------
949 void ReaderIso15693(uint32_t parameter
)
958 // int answerLen3 = 0;
964 uint8_t TagUID
[8] = {0x00};
966 FpgaDownloadAndGo(FPGA_BITSTREAM_HF
);
968 uint8_t *answer1
= BigBuf_get_addr() + 4000;
969 uint8_t *answer2
= BigBuf_get_addr() + 4100;
970 // uint8_t *answer3 = BigBuf_get_addr() + 4200;
972 memset(answer1
, 0x00, 200);
974 SetAdcMuxFor(GPIO_MUXSEL_HIPKD
);
978 // Start from off (no field generated)
979 FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF
);
982 // Give the tags time to energize
983 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_RX_XCORR
);
991 // FIRST WE RUN AN INVENTORY TO GET THE TAG UID
992 // THIS MEANS WE CAN PRE-BUILD REQUESTS TO SAVE CPU TIME
994 // Now send the IDENTIFY command
995 BuildIdentifyRequest();
997 TransmitTo15693Tag(ToSend
,ToSendMax
,&tsamples
, &wait
);
999 // Now wait for a response
1000 answerLen1
= GetIso15693AnswerFromTag(answer1
, 100, &samples
, &elapsed
) ;
1002 if (answerLen1
>=12) // we should do a better check than this
1004 TagUID
[0] = answer1
[2];
1005 TagUID
[1] = answer1
[3];
1006 TagUID
[2] = answer1
[4];
1007 TagUID
[3] = answer1
[5];
1008 TagUID
[4] = answer1
[6];
1009 TagUID
[5] = answer1
[7];
1010 TagUID
[6] = answer1
[8]; // IC Manufacturer code
1011 TagUID
[7] = answer1
[9]; // always E0
1015 Dbprintf("%d octets read from IDENTIFY request:", answerLen1
);
1016 DbdecodeIso15693Answer(answerLen1
,answer1
);
1017 Dbhexdump(answerLen1
,answer1
,true);
1021 Dbprintf("UID = %02hX%02hX%02hX%02hX%02hX%02hX%02hX%02hX",
1022 TagUID
[7],TagUID
[6],TagUID
[5],TagUID
[4],
1023 TagUID
[3],TagUID
[2],TagUID
[1],TagUID
[0]);
1026 // Dbprintf("%d octets read from SELECT request:", answerLen2);
1027 // DbdecodeIso15693Answer(answerLen2,answer2);
1028 // Dbhexdump(answerLen2,answer2,true);
1030 // Dbprintf("%d octets read from XXX request:", answerLen3);
1031 // DbdecodeIso15693Answer(answerLen3,answer3);
1032 // Dbhexdump(answerLen3,answer3,true);
1035 if (answerLen1
>=12 && DEBUG
) {
1037 while (i
<32) { // sanity check, assume max 32 pages
1038 BuildReadBlockRequest(TagUID
,i
);
1039 TransmitTo15693Tag(ToSend
,ToSendMax
,&tsamples
, &wait
);
1040 answerLen2
= GetIso15693AnswerFromTag(answer2
, 100, &samples
, &elapsed
);
1042 Dbprintf("READ SINGLE BLOCK %d returned %d octets:",i
,answerLen2
);
1043 DbdecodeIso15693Answer(answerLen2
,answer2
);
1044 Dbhexdump(answerLen2
,answer2
,true);
1045 if ( *((uint32_t*) answer2
) == 0x07160101 ) break; // exit on NoPageErr
1057 // Simulate an ISO15693 TAG, perform anti-collision and then print any reader commands
1058 // all demodulation performed in arm rather than host. - greg
1059 void SimTagIso15693(uint32_t parameter
, uint8_t *uid
)
1072 FpgaDownloadAndGo(FPGA_BITSTREAM_HF
);
1074 uint8_t *buf
= BigBuf_get_addr() + 4000;
1075 memset(buf
, 0x00, 100);
1077 SetAdcMuxFor(GPIO_MUXSEL_HIPKD
);
1080 // Start from off (no field generated)
1081 FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF
);
1090 answerLen1
= GetIso15693AnswerFromSniff(buf
, 100, &samples
, &elapsed
) ;
1092 if (answerLen1
>=1) // we should do a better check than this
1094 // Build a suitable reponse to the reader INVENTORY cocmmand
1095 // not so obsvious, but in the call to BuildInventoryResponse, the command is copied to the global ToSend buffer used below.
1097 BuildInventoryResponse(uid
);
1099 TransmitTo15693Reader(ToSend
,ToSendMax
, &tsamples
, &wait
);
1102 Dbprintf("%d octets read from reader command: %x %x %x %x %x %x %x %x %x", answerLen1
,
1103 buf
[0], buf
[1], buf
[2], buf
[3],
1104 buf
[4], buf
[5], buf
[6], buf
[7], buf
[8]);
1106 Dbprintf("Simulationg uid: %x %x %x %x %x %x %x %x",
1107 uid
[0], uid
[1], uid
[2], uid
[3],
1108 uid
[4], uid
[5], uid
[6], uid
[7]);
1117 // Since there is no standardized way of reading the AFI out of a tag, we will brute force it
1118 // (some manufactures offer a way to read the AFI, though)
1119 void BruteforceIso15693Afi(uint32_t speed
)
1123 int datalen
=0, recvlen
=0;
1125 Iso15693InitReader();
1127 // first without AFI
1128 // Tags should respond wihtout AFI and with AFI=0 even when AFI is active
1130 data
[0]=ISO15_REQ_SUBCARRIER_SINGLE
| ISO15_REQ_DATARATE_HIGH
|
1131 ISO15_REQ_INVENTORY
| ISO15_REQINV_SLOT1
;
1132 data
[1]=ISO15_CMD_INVENTORY
;
1133 data
[2]=0; // mask length
1134 datalen
=AddCrc(data
,3);
1135 recvlen
=SendDataTag(data
,datalen
,0,speed
,&recv
);
1138 Dbprintf("NoAFI UID=%s",sprintUID(NULL
,&recv
[2]));
1143 data
[0]=ISO15_REQ_SUBCARRIER_SINGLE
| ISO15_REQ_DATARATE_HIGH
|
1144 ISO15_REQ_INVENTORY
| ISO15_REQINV_AFI
| ISO15_REQINV_SLOT1
;
1145 data
[1]=ISO15_CMD_INVENTORY
;
1147 data
[3]=0; // mask length
1149 for (int i
=0;i
<256;i
++) {
1151 datalen
=AddCrc(data
,4);
1152 recvlen
=SendDataTag(data
,datalen
,0,speed
,&recv
);
1155 Dbprintf("AFI=%i UID=%s",i
,sprintUID(NULL
,&recv
[2]));
1158 Dbprintf("AFI Bruteforcing done.");
1162 // Allows to directly send commands to the tag via the client
1163 void DirectTag15693Command(uint32_t datalen
,uint32_t speed
, uint32_t recv
, uint8_t data
[]) {
1166 uint8_t *recvbuf
= BigBuf_get_addr();
1171 Dbhexdump(datalen
,data
,true);
1174 recvlen
=SendDataTag(data
,datalen
,1,speed
,(recv
?&recvbuf
:NULL
));
1178 cmd_send(CMD_ACK
,recvlen
>48?48:recvlen
,0,0,recvbuf
,48);
1183 DbdecodeIso15693Answer(recvlen
,recvbuf
);
1184 Dbhexdump(recvlen
,recvbuf
,true);
1193 // --------------------------------------------------------------------
1194 // -- Misc & deprecated functions
1195 // --------------------------------------------------------------------
1199 // do not use; has a fix UID
1200 static void __attribute__((unused)) BuildSysInfoRequest(uint8_t *uid)
1205 // If we set the Option_Flag in this request, the VICC will respond with the secuirty status of the block
1206 // followed by teh block data
1207 // one sub-carrier, inventory, 1 slot, fast rate
1208 cmd[0] = (1 << 5) | (1 << 1); // no SELECT bit
1209 // System Information command code
1211 // UID may be optionally specified here
1220 cmd[9]= 0xe0; // always e0 (not exactly unique)
1222 crc = Crc(cmd, 10); // the crc needs to be calculated over 2 bytes
1223 cmd[10] = crc & 0xff;
1226 CodeIso15693AsReader(cmd, sizeof(cmd));
1230 // do not use; has a fix UID
1231 static void __attribute__((unused)) BuildReadMultiBlockRequest(uint8_t *uid)
1236 // If we set the Option_Flag in this request, the VICC will respond with the secuirty status of the block
1237 // followed by teh block data
1238 // one sub-carrier, inventory, 1 slot, fast rate
1239 cmd[0] = (1 << 5) | (1 << 1); // no SELECT bit
1240 // READ Multi BLOCK command code
1242 // UID may be optionally specified here
1251 cmd[9]= 0xe0; // always e0 (not exactly unique)
1252 // First Block number to read
1254 // Number of Blocks to read
1255 cmd[11] = 0x2f; // read quite a few
1257 crc = Crc(cmd, 12); // the crc needs to be calculated over 2 bytes
1258 cmd[12] = crc & 0xff;
1261 CodeIso15693AsReader(cmd, sizeof(cmd));
1264 // do not use; has a fix UID
1265 static void __attribute__((unused)) BuildArbitraryRequest(uint8_t *uid,uint8_t CmdCode)
1270 // If we set the Option_Flag in this request, the VICC will respond with the secuirty status of the block
1271 // followed by teh block data
1272 // one sub-carrier, inventory, 1 slot, fast rate
1273 cmd[0] = (1 << 5) | (1 << 1); // no SELECT bit
1274 // READ BLOCK command code
1276 // UID may be optionally specified here
1285 cmd[9]= 0xe0; // always e0 (not exactly unique)
1291 // cmd[13] = 0x00; //Now the CRC
1292 crc = Crc(cmd, 12); // the crc needs to be calculated over 2 bytes
1293 cmd[12] = crc & 0xff;
1296 CodeIso15693AsReader(cmd, sizeof(cmd));
1299 // do not use; has a fix UID
1300 static void __attribute__((unused)) BuildArbitraryCustomRequest(uint8_t uid[], uint8_t CmdCode)
1305 // If we set the Option_Flag in this request, the VICC will respond with the secuirty status of the block
1306 // followed by teh block data
1307 // one sub-carrier, inventory, 1 slot, fast rate
1308 cmd[0] = (1 << 5) | (1 << 1); // no SELECT bit
1309 // READ BLOCK command code
1311 // UID may be optionally specified here
1320 cmd[9]= 0xe0; // always e0 (not exactly unique)
1322 cmd[10] = 0x05; // for custom codes this must be manufcturer code
1326 // cmd[13] = 0x00; //Now the CRC
1327 crc = Crc(cmd, 12); // the crc needs to be calculated over 2 bytes
1328 cmd[12] = crc & 0xff;
1331 CodeIso15693AsReader(cmd, sizeof(cmd));