1 //-----------------------------------------------------------------------------
2 // Jonathan Westhues, Aug 2005
3 // Gerhard de Koning Gans, April 2008, May 2011
5 // This code is licensed to you under the terms of the GNU GPL, version 2 or,
6 // at your option, any later version. See the LICENSE.txt file for the text of
8 //-----------------------------------------------------------------------------
9 // Definitions internal to the app source.
10 //-----------------------------------------------------------------------------
17 #include <sys/types.h>
24 #include "../include/common.h"
25 #include "../include/hitag2.h"
26 #include "../include/mifare.h"
28 //#include <openssl/des.h>
29 //#include <openssl/aes.h>
33 #include "../common/desfire.h"
34 #include "../common/crc32.h"
35 //#include "desfire_crypto.h"
36 //#include "desfire_key.h"
39 // The large multi-purpose buffer, typically used to hold A/D samples,
40 // maybe processed in some way.
41 uint32_t BigBuf
[10000];
42 // BIG CHANGE - UNDERSTAND THIS BEFORE WE COMMIT
43 #define TRACE_OFFSET 0
44 #define TRACE_SIZE 3000
45 #define RECV_CMD_OFFSET 3032
46 #define RECV_CMD_SIZE 64
47 #define RECV_RES_OFFSET 3096
48 #define RECV_RES_SIZE 64
49 #define DMA_BUFFER_OFFSET 3160
50 #define DMA_BUFFER_SIZE 4096
51 #define FREE_BUFFER_OFFSET 7256
52 #define FREE_BUFFER_SIZE 2744
54 extern const uint8_t OddByteParity
[256];
55 extern uint8_t *trace
; // = (uint8_t *) BigBuf;
56 extern int traceLen
; // = 0;
57 extern int rsamples
; // = 0;
58 extern int tracing
; // = TRUE;
59 extern uint8_t trigger
;
61 // This may be used (sparingly) to declare a function to be copied to
62 // and executed from RAM
63 #define RAMFUNC __attribute((long_call, section(".ramfunc")))
66 void ReadMem(int addr
);
67 void __attribute__((noreturn
)) AppMain(void);
69 //void DbpIntegers(int a, int b, int c);
70 void DbpString(char *str
);
71 void Dbprintf(const char *fmt
, ...);
72 void Dbhexdump(int len
, uint8_t *d
, bool bAsci
);
76 void ToSendStuffBit(int b
);
77 void ToSendReset(void);
78 void ListenReaderField(int limit
);
79 void AcquireRawAdcSamples125k(int at134khz
);
80 void SnoopLFRawAdcSamples(int divisor
, int trigger_threshold
);
81 void DoAcquisition125k(int trigger_threshold
);
83 extern uint8_t ToSend
[];
84 extern uint32_t BigBuf
[];
87 void FpgaSendCommand(uint16_t cmd
, uint16_t v
);
88 void FpgaWriteConfWord(uint8_t v
);
89 void FpgaDownloadAndGo(int bitstream_version
);
90 int FpgaGatherBitstreamVersion();
91 void FpgaGatherVersion(char *dst
, int len
);
92 void FpgaSetupSsc(void);
93 void SetupSpi(int mode
);
94 bool FpgaSetupSscDma(uint8_t *buf
, int len
);
95 #define FpgaDisableSscDma(void) AT91C_BASE_PDC_SSC->PDC_PTCR = AT91C_PDC_RXTDIS;
96 #define FpgaEnableSscDma(void) AT91C_BASE_PDC_SSC->PDC_PTCR = AT91C_PDC_RXTEN;
97 void SetAdcMuxFor(uint32_t whichGpio
);
99 // Definitions for the FPGA commands.
100 #define FPGA_CMD_SET_CONFREG (1<<12)
101 #define FPGA_CMD_SET_DIVISOR (2<<12)
102 #define FPGA_CMD_SET_USER_BYTE1 (3<<12)
103 // Definitions for the FPGA configuration word.
105 #define FPGA_MAJOR_MODE_LF_ADC (0<<5)
106 #define FPGA_MAJOR_MODE_LF_EDGE_DETECT (1<<5)
107 #define FPGA_MAJOR_MODE_LF_PASSTHRU (2<<5)
109 #define FPGA_MAJOR_MODE_HF_READER_TX (0<<5)
110 #define FPGA_MAJOR_MODE_HF_READER_RX_XCORR (1<<5)
111 #define FPGA_MAJOR_MODE_HF_SIMULATOR (2<<5)
112 #define FPGA_MAJOR_MODE_HF_ISO14443A (3<<5)
114 #define FPGA_MAJOR_MODE_OFF (7<<5)
115 // Options for LF_ADC
116 #define FPGA_LF_ADC_READER_FIELD (1<<0)
117 // Options for LF_EDGE_DETECT
118 #define FPGA_CMD_SET_EDGE_DETECT_THRESHOLD FPGA_CMD_SET_USER_BYTE1
119 #define FPGA_LF_EDGE_DETECT_READER_FIELD (1<<0)
120 #define FPGA_LF_EDGE_DETECT_TOGGLE_MODE (1<<1)
121 // Options for the HF reader, tx to tag
122 #define FPGA_HF_READER_TX_SHALLOW_MOD (1<<0)
123 // Options for the HF reader, correlating against rx from tag
124 #define FPGA_HF_READER_RX_XCORR_848_KHZ (1<<0)
125 #define FPGA_HF_READER_RX_XCORR_SNOOP (1<<1)
126 #define FPGA_HF_READER_RX_XCORR_QUARTER_FREQ (1<<2)
127 // Options for the HF simulated tag, how to modulate
128 #define FPGA_HF_SIMULATOR_NO_MODULATION (0<<0)
129 #define FPGA_HF_SIMULATOR_MODULATE_BPSK (1<<0)
130 #define FPGA_HF_SIMULATOR_MODULATE_212K (2<<0)
131 #define FPGA_HF_SIMULATOR_MODULATE_424K (4<<0)
132 // Options for ISO14443A
133 #define FPGA_HF_ISO14443A_SNIFFER (0<<0)
134 #define FPGA_HF_ISO14443A_TAGSIM_LISTEN (1<<0)
135 #define FPGA_HF_ISO14443A_TAGSIM_MOD (2<<0)
136 #define FPGA_HF_ISO14443A_READER_LISTEN (3<<0)
137 #define FPGA_HF_ISO14443A_READER_MOD (4<<0)
140 void AcquireRawAdcSamples125k(int divisor
);
141 void ModThenAcquireRawAdcSamples125k(int delay_off
,int period_0
,int period_1
,uint8_t *command
);
142 void ReadTItag(void);
143 void WriteTItag(uint32_t idhi
, uint32_t idlo
, uint16_t crc
);
144 void AcquireTiType(void);
145 void AcquireRawBitsTI(void);
146 void SimulateTagLowFrequency(int period
, int gap
, int ledcontrol
);
147 void CmdHIDsimTAG(int hi
, int lo
, int ledcontrol
);
148 void CmdHIDdemodFSK(int findone
, int *high
, int *low
, int ledcontrol
);
149 void CmdIOdemodFSK(int findone
, int *high
, int *low
, int ledcontrol
);
150 void CopyIOtoT55x7(uint32_t hi
, uint32_t lo
, uint8_t longFMT
); // Clone an ioProx card to T5557/T5567
151 void SimulateTagLowFrequencyBidir(int divisor
, int max_bitlen
);
152 void CopyHIDtoT55x7(uint32_t hi2
, uint32_t hi
, uint32_t lo
, uint8_t longFMT
); // Clone an HID card to T5557/T5567
153 void WriteEM410x(uint32_t card
, uint32_t id_hi
, uint32_t id_lo
);
154 void CopyIndala64toT55x7(int hi
, int lo
); // Clone Indala 64-bit tag by UID to T55x7
155 void CopyIndala224toT55x7(int uid1
, int uid2
, int uid3
, int uid4
, int uid5
, int uid6
, int uid7
); // Clone Indala 224-bit tag by UID to T55x7
156 void T55xxWriteBlock(uint32_t Data
, uint32_t Block
, uint32_t Pwd
, uint8_t PwdMode
);
157 void T55xxReadBlock(uint32_t Block
, uint32_t Pwd
, uint8_t PwdMode
);
158 void T55xxReadTrace(void);
159 int DemodPCF7931(uint8_t **outBlocks
);
160 int IsBlock0PCF7931(uint8_t *Block
);
161 int IsBlock1PCF7931(uint8_t *Block
);
163 void EM4xReadWord(uint8_t Address
, uint32_t Pwd
, uint8_t PwdMode
);
164 void EM4xWriteWord(uint32_t Data
, uint8_t Address
, uint32_t Pwd
, uint8_t PwdMode
);
167 void SimulateIso14443Tag(void);
168 void AcquireRawAdcSamplesIso14443(uint32_t parameter
);
169 void ReadSTMemoryIso14443(uint32_t);
170 void RAMFUNC
SnoopIso14443(void);
171 void SendRawCommand14443B(uint32_t, uint32_t, uint8_t, uint8_t[]);
174 void RAMFUNC
SnoopIso14443a(uint8_t param
);
175 void SimulateIso14443aTag(int tagType
, int uid_1st
, int uid_2nd
, byte_t
* data
);
176 void ReaderIso14443a(UsbCommand
* c
);
177 // Also used in iclass.c
178 bool RAMFUNC
LogTrace(const uint8_t * btBytes
, uint8_t iLen
, uint32_t iSamples
, uint32_t dwParity
, bool readerToTag
);
179 uint32_t GetParity(const uint8_t * pbtCmd
, int iLen
);
180 void iso14a_set_trigger(bool enable
);
181 void iso14a_clear_trace();
182 void iso14a_set_tracing(bool enable
);
183 void RAMFUNC
SniffMifare(uint8_t param
);
186 void EPA_PACE_Collect_Nonce(UsbCommand
* c
);
189 void ReaderMifare(bool first_try
);
190 int32_t dist_nt(uint32_t nt1
, uint32_t nt2
);
191 void MifareReadBlock(uint8_t arg0
, uint8_t arg1
, uint8_t arg2
, uint8_t *data
);
192 void MifareUReadBlock(uint8_t arg0
,uint8_t *datain
);
193 void MifareUC_Auth1(uint8_t arg0
, uint8_t *datain
);
194 void MifareUC_Auth2(uint32_t arg0
, uint8_t *datain
);
195 void MifareUReadCard(uint8_t arg0
,int Pages
,uint8_t *datain
);
196 void MifareReadSector(uint8_t arg0
, uint8_t arg1
, uint8_t arg2
, uint8_t *datain
);
197 void MifareWriteBlock(uint8_t arg0
, uint8_t arg1
, uint8_t arg2
, uint8_t *datain
);
198 void MifareUWriteBlock(uint8_t arg0
,uint8_t *datain
);
199 void MifareUWriteBlock_Special(uint8_t arg0
,uint8_t *datain
);
200 void MifareNested(uint32_t arg0
, uint32_t arg1
, uint32_t arg2
, uint8_t *datain
);
201 void MifareChkKeys(uint8_t arg0
, uint8_t arg1
, uint8_t arg2
, uint8_t *datain
);
202 void Mifare1ksim(uint8_t arg0
, uint8_t arg1
, uint8_t arg2
, uint8_t *datain
);
203 void MifareSetDbgLvl(uint32_t arg0
, uint32_t arg1
, uint32_t arg2
, uint8_t *datain
);
204 void MifareEMemClr(uint32_t arg0
, uint32_t arg1
, uint32_t arg2
, uint8_t *datain
);
205 void MifareEMemSet(uint32_t arg0
, uint32_t arg1
, uint32_t arg2
, uint8_t *datain
);
206 void MifareEMemGet(uint32_t arg0
, uint32_t arg1
, uint32_t arg2
, uint8_t *datain
);
207 void MifareECardLoad(uint32_t arg0
, uint32_t arg1
, uint32_t arg2
, uint8_t *datain
);
208 void MifareCSetBlock(uint32_t arg0
, uint32_t arg1
, uint32_t arg2
, uint8_t *datain
); // Work with "magic Chinese" card
209 void MifareCGetBlock(uint32_t arg0
, uint32_t arg1
, uint32_t arg2
, uint8_t *datain
);
212 void MifareDesfireGetInformation();
213 void MifareDES_Auth1(uint8_t arg0
,uint8_t arg1
,uint8_t arg2
, uint8_t *datain
);
214 void MifareDES_Auth2(uint32_t arg0
, uint8_t *datain
);
215 int mifare_des_auth2(uint32_t uid
, uint8_t *key
, uint8_t *blockData
);
216 void ReaderMifareDES(uint32_t param
, uint32_t param2
, uint8_t * datain
);
217 int SendDesfireCommand(enum DESFIRE_CMD desfire_cmd
, uint8_t *dataout
, uint8_t fromscratch
);
218 uint8_t* CreateAPDU( uint8_t *datain
, size_t len
);
223 desfirekey_t
Desfire_des_key_new (const uint8_t value
[8]);
224 desfirekey_t
Desfire_3des_key_new (const uint8_t value
[16]);
225 desfirekey_t
Desfire_des_key_new_with_version (const uint8_t value
[8]);
226 desfirekey_t
Desfire_3des_key_new_with_version (const uint8_t value
[16]);
227 desfirekey_t
Desfire_3k3des_key_new (const uint8_t value
[24]);
228 desfirekey_t
Desfire_3k3des_key_new_with_version (const uint8_t value
[24]);
229 desfirekey_t
Desfire_aes_key_new (const uint8_t value
[16]);
230 desfirekey_t
Desfire_aes_key_new_with_version (const uint8_t value
[16], uint8_t version
);
231 uint8_t Desfire_key_get_version (desfirekey_t key
);
232 void Desfire_key_set_version (desfirekey_t key
, uint8_t version
);
233 desfirekey_t
Desfire_session_key_new (const uint8_t rnda
[], const uint8_t rndb
[], desfirekey_t authkey
);
236 void *mifare_cryto_preprocess_data (desfiretag_t tag
, void *data
, size_t *nbytes
, off_t offset
, int communication_settings
);
237 void *mifare_cryto_postprocess_data (desfiretag_t tag
, void *data
, ssize_t
*nbytes
, int communication_settings
);
238 void mifare_cypher_single_block (desfirekey_t key
, uint8_t *data
, uint8_t *ivect
, MifareCryptoDirection direction
, MifareCryptoOperation operation
, size_t block_size
);
239 void mifare_cypher_blocks_chained (desfiretag_t tag
, desfirekey_t key
, uint8_t *ivect
, uint8_t *data
, size_t data_size
, MifareCryptoDirection direction
, MifareCryptoOperation operation
);
240 size_t key_block_size (const desfirekey_t key
);
241 size_t padded_data_length (const size_t nbytes
, const size_t block_size
);
242 size_t maced_data_length (const desfirekey_t key
, const size_t nbytes
);
243 size_t enciphered_data_length (const desfiretag_t tag
, const size_t nbytes
, int communication_settings
);
244 void cmac_generate_subkeys (desfirekey_t key
);
245 void cmac (const desfirekey_t key
, uint8_t *ivect
, const uint8_t *data
, size_t len
, uint8_t *cmac
);
253 void RecordRawAdcSamplesIso15693(void);
254 void AcquireRawAdcSamplesIso15693(void);
255 void ReaderIso15693(uint32_t parameter
); // Simulate an ISO15693 reader - greg
256 void SimTagIso15693(uint32_t parameter
); // simulate an ISO15693 tag - greg
257 void BruteforceIso15693Afi(uint32_t speed
); // find an AFI of a tag - atrox
258 void DirectTag15693Command(uint32_t datalen
,uint32_t speed
, uint32_t recv
, uint8_t data
[]); // send arbitrary commands from CLI - atrox
259 void SetDebugIso15693(uint32_t flag
);
262 void RAMFUNC
SnoopIClass(void);
263 void SimulateIClass(uint32_t arg0
, uint32_t arg1
, uint32_t arg2
, uint8_t *datain
);
264 void ReaderIClass(uint8_t arg0
);
265 void ReaderIClass_Replay(uint8_t arg0
,uint8_t *MAC
);
266 void IClass_iso14443A_GetPublic(uint8_t arg0
);
269 void SnoopHitag(uint32_t type
);
270 void SimulateHitagTag(bool tag_mem_supplied
, byte_t
* data
);
271 void ReaderHitag(hitag_function htf
, hitag_data
* htd
);
274 bool cmd_receive(UsbCommand
* cmd
);
275 bool cmd_send(uint32_t cmd
, uint32_t arg0
, uint32_t arg1
, uint32_t arg2
, void* data
, size_t len
);