]> git.zerfleddert.de Git - proxmark3-svn/blame - armsrc/appmain.c
remove old comment
[proxmark3-svn] / armsrc / appmain.c
CommitLineData
15c4dc5a 1//-----------------------------------------------------------------------------
15c4dc5a 2// Jonathan Westhues, Mar 2006
3// Edits by Gerhard de Koning Gans, Sep 2007 (##)
bd20f8f4 4//
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
7// the license.
8//-----------------------------------------------------------------------------
9// The main application code. This is the first thing called after start.c
10// executes.
15c4dc5a 11//-----------------------------------------------------------------------------
12
902cb3c0 13#include "usb_cdc.h"
14#include "cmd.h"
15
e30c654b 16#include "proxmark3.h"
15c4dc5a 17#include "apps.h"
f7e3ed82 18#include "util.h"
9ab7a6c7 19#include "printf.h"
20#include "string.h"
31d1caa5 21
9ab7a6c7 22#include <stdarg.h>
f7e3ed82 23
15c4dc5a 24#include "legicrf.h"
d19929cb 25#include <hitag2.h>
31abe49f 26#include "lfsampling.h"
3000dc4e 27#include "BigBuf.h"
c89274cc 28#include "mifareutil.h"
d10e08ae 29#include "pcf7931.h"
15c4dc5a 30#ifdef WITH_LCD
902cb3c0 31 #include "LCD.h"
15c4dc5a 32#endif
33
e46fe044
CY
34// Craig Young - 14a stand-alone code
35#ifdef WITH_ISO14443a_StandAlone
36 #include "iso14443a.h"
37#endif
38
15c4dc5a 39#define abs(x) ( ((x)<0) ? -(x) : (x) )
40
41//=============================================================================
42// A buffer where we can queue things up to be sent through the FPGA, for
43// any purpose (fake tag, as reader, whatever). We go MSB first, since that
44// is the order in which they go out on the wire.
45//=============================================================================
46
6a1f2d82 47#define TOSEND_BUFFER_SIZE (9*MAX_FRAME_SIZE + 1 + 1 + 2) // 8 data bits and 1 parity bit per payload byte, 1 correction bit, 1 SOC bit, 2 EOC bits
48uint8_t ToSend[TOSEND_BUFFER_SIZE];
15c4dc5a 49int ToSendMax;
50static int ToSendBit;
51struct common_area common_area __attribute__((section(".commonarea")));
52
15c4dc5a 53void ToSendReset(void)
54{
55 ToSendMax = -1;
56 ToSendBit = 8;
57}
58
59void ToSendStuffBit(int b)
60{
61 if(ToSendBit >= 8) {
62 ToSendMax++;
63 ToSend[ToSendMax] = 0;
64 ToSendBit = 0;
65 }
66
67 if(b) {
68 ToSend[ToSendMax] |= (1 << (7 - ToSendBit));
69 }
70
71 ToSendBit++;
72
6a1f2d82 73 if(ToSendMax >= sizeof(ToSend)) {
15c4dc5a 74 ToSendBit = 0;
75 DbpString("ToSendStuffBit overflowed!");
76 }
77}
78
79//=============================================================================
80// Debug print functions, to go out over USB, to the usual PC-side client.
81//=============================================================================
82
83void DbpString(char *str)
84{
9440213d 85 byte_t len = strlen(str);
86 cmd_send(CMD_DEBUG_PRINT_STRING,len,0,0,(byte_t*)str,len);
15c4dc5a 87}
88
89#if 0
90void DbpIntegers(int x1, int x2, int x3)
91{
902cb3c0 92 cmd_send(CMD_DEBUG_PRINT_INTEGERS,x1,x2,x3,0,0);
15c4dc5a 93}
94#endif
95
96void Dbprintf(const char *fmt, ...) {
97// should probably limit size here; oh well, let's just use a big buffer
98 char output_string[128];
99 va_list ap;
100
101 va_start(ap, fmt);
102 kvsprintf(fmt, output_string, 10, ap);
103 va_end(ap);
e30c654b 104
15c4dc5a 105 DbpString(output_string);
106}
107
9455b51c 108// prints HEX & ASCII
d19929cb 109void Dbhexdump(int len, uint8_t *d, bool bAsci) {
9455b51c 110 int l=0,i;
111 char ascii[9];
d19929cb 112
9455b51c 113 while (len>0) {
114 if (len>8) l=8;
115 else l=len;
116
117 memcpy(ascii,d,l);
d19929cb 118 ascii[l]=0;
9455b51c 119
120 // filter safe ascii
d19929cb 121 for (i=0;i<l;i++)
9455b51c 122 if (ascii[i]<32 || ascii[i]>126) ascii[i]='.';
d19929cb 123
124 if (bAsci) {
125 Dbprintf("%-8s %*D",ascii,l,d," ");
126 } else {
127 Dbprintf("%*D",l,d," ");
128 }
129
9455b51c 130 len-=8;
131 d+=8;
132 }
133}
134
15c4dc5a 135//-----------------------------------------------------------------------------
136// Read an ADC channel and block till it completes, then return the result
137// in ADC units (0 to 1023). Also a routine to average 32 samples and
138// return that.
139//-----------------------------------------------------------------------------
140static int ReadAdc(int ch)
141{
f7e3ed82 142 uint32_t d;
15c4dc5a 143
144 AT91C_BASE_ADC->ADC_CR = AT91C_ADC_SWRST;
145 AT91C_BASE_ADC->ADC_MR =
3b692427 146 ADC_MODE_PRESCALE(63 /* was 32 */) | // ADC_CLK = MCK / ((63+1) * 2) = 48MHz / 128 = 375kHz
147 ADC_MODE_STARTUP_TIME(1 /* was 16 */) | // Startup Time = (1+1) * 8 / ADC_CLK = 16 / 375kHz = 42,7us Note: must be > 20us
148 ADC_MODE_SAMPLE_HOLD_TIME(15 /* was 8 */); // Sample & Hold Time SHTIM = 15 / ADC_CLK = 15 / 375kHz = 40us
149
150 // Note: ADC_MODE_PRESCALE and ADC_MODE_SAMPLE_HOLD_TIME are set to the maximum allowed value.
151 // Both AMPL_LO and AMPL_HI are very high impedance (10MOhm) outputs, the input capacitance of the ADC is 12pF (typical). This results in a time constant
152 // of RC = 10MOhm * 12pF = 120us. Even after the maximum configurable sample&hold time of 40us the input capacitor will not be fully charged.
153 //
154 // The maths are:
155 // If there is a voltage v_in at the input, the voltage v_cap at the capacitor (this is what we are measuring) will be
156 //
157 // v_cap = v_in * (1 - exp(-RC/SHTIM)) = v_in * (1 - exp(-3)) = v_in * 0,95 (i.e. an error of 5%)
158 //
159 // Note: with the "historic" values in the comments above, the error was 34% !!!
160
15c4dc5a 161 AT91C_BASE_ADC->ADC_CHER = ADC_CHANNEL(ch);
162
163 AT91C_BASE_ADC->ADC_CR = AT91C_ADC_START;
3b692427 164
15c4dc5a 165 while(!(AT91C_BASE_ADC->ADC_SR & ADC_END_OF_CONVERSION(ch)))
166 ;
167 d = AT91C_BASE_ADC->ADC_CDR[ch];
168
169 return d;
170}
171
9ca155ba 172int AvgAdc(int ch) // was static - merlok
15c4dc5a 173{
174 int i;
175 int a = 0;
176
177 for(i = 0; i < 32; i++) {
178 a += ReadAdc(ch);
179 }
180
181 return (a + 15) >> 5;
182}
183
184void MeasureAntennaTuning(void)
185{
2bdd68c3 186 uint8_t LF_Results[256];
9f693930 187 int i, adcval = 0, peak = 0, peakv = 0, peakf = 0; //ptr = 0
15c4dc5a 188 int vLf125 = 0, vLf134 = 0, vHf = 0; // in mV
189
2bdd68c3 190 LED_B_ON();
15c4dc5a 191
192/*
193 * Sweeps the useful LF range of the proxmark from
194 * 46.8kHz (divisor=255) to 600kHz (divisor=19) and
195 * read the voltage in the antenna, the result left
196 * in the buffer is a graph which should clearly show
197 * the resonating frequency of your LF antenna
198 * ( hopefully around 95 if it is tuned to 125kHz!)
199 */
d19929cb 200
7cc204bf 201 FpgaDownloadAndGo(FPGA_BITSTREAM_LF);
b014c96d 202 FpgaWriteConfWord(FPGA_MAJOR_MODE_LF_ADC | FPGA_LF_ADC_READER_FIELD);
2bdd68c3 203 for (i=255; i>=19; i--) {
d19929cb 204 WDT_HIT();
15c4dc5a 205 FpgaSendCommand(FPGA_CMD_SET_DIVISOR, i);
206 SpinDelay(20);
3b692427 207 adcval = ((MAX_ADC_LF_VOLTAGE * AvgAdc(ADC_CHAN_LF)) >> 10);
15c4dc5a 208 if (i==95) vLf125 = adcval; // voltage at 125Khz
209 if (i==89) vLf134 = adcval; // voltage at 134Khz
210
2bdd68c3 211 LF_Results[i] = adcval>>8; // scale int to fit in byte for graphing purposes
212 if(LF_Results[i] > peak) {
15c4dc5a 213 peakv = adcval;
2bdd68c3 214 peak = LF_Results[i];
15c4dc5a 215 peakf = i;
9f693930 216 //ptr = i;
15c4dc5a 217 }
218 }
219
2bdd68c3 220 for (i=18; i >= 0; i--) LF_Results[i] = 0;
221
222 LED_A_ON();
15c4dc5a 223 // Let the FPGA drive the high-frequency antenna around 13.56 MHz.
7cc204bf 224 FpgaDownloadAndGo(FPGA_BITSTREAM_HF);
15c4dc5a 225 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_RX_XCORR);
226 SpinDelay(20);
3b692427 227 vHf = (MAX_ADC_HF_VOLTAGE * AvgAdc(ADC_CHAN_HF)) >> 10;
15c4dc5a 228
3b692427 229 cmd_send(CMD_MEASURED_ANTENNA_TUNING, vLf125 | (vLf134<<16), vHf, peakf | (peakv<<16), LF_Results, 256);
d19929cb 230 FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF);
2bdd68c3 231 LED_A_OFF();
232 LED_B_OFF();
233 return;
15c4dc5a 234}
235
236void MeasureAntennaTuningHf(void)
237{
238 int vHf = 0; // in mV
239
240 DbpString("Measuring HF antenna, press button to exit");
241
3b692427 242 // Let the FPGA drive the high-frequency antenna around 13.56 MHz.
243 FpgaDownloadAndGo(FPGA_BITSTREAM_HF);
244 FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_RX_XCORR);
245
15c4dc5a 246 for (;;) {
15c4dc5a 247 SpinDelay(20);
3b692427 248 vHf = (MAX_ADC_HF_VOLTAGE * AvgAdc(ADC_CHAN_HF)) >> 10;
e30c654b 249
15c4dc5a 250 Dbprintf("%d mV",vHf);
251 if (BUTTON_PRESS()) break;
252 }
253 DbpString("cancelled");
3b692427 254
255 FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF);
256
15c4dc5a 257}
258
259
15c4dc5a 260void ReadMem(int addr)
261{
f7e3ed82 262 const uint8_t *data = ((uint8_t *)addr);
15c4dc5a 263
264 Dbprintf("%x: %02x %02x %02x %02x %02x %02x %02x %02x",
265 addr, data[0], data[1], data[2], data[3], data[4], data[5], data[6], data[7]);
266}
267
268/* osimage version information is linked in */
269extern struct version_information version_information;
270/* bootrom version information is pointed to from _bootphase1_version_pointer */
0fa01ec7 271extern char *_bootphase1_version_pointer, _flash_start, _flash_end, _bootrom_start, _bootrom_end, __data_src_start__;
15c4dc5a 272void SendVersion(void)
273{
8e074056 274 char temp[USB_CMD_DATA_SIZE]; /* Limited data payload in USB packets */
275 char VersionString[USB_CMD_DATA_SIZE] = { '\0' };
e30c654b 276
277 /* Try to find the bootrom version information. Expect to find a pointer at
15c4dc5a 278 * symbol _bootphase1_version_pointer, perform slight sanity checks on the
279 * pointer, then use it.
280 */
281 char *bootrom_version = *(char**)&_bootphase1_version_pointer;
282 if( bootrom_version < &_flash_start || bootrom_version >= &_flash_end ) {
8e074056 283 strcat(VersionString, "bootrom version information appears invalid\n");
15c4dc5a 284 } else {
285 FormatVersionInformation(temp, sizeof(temp), "bootrom: ", bootrom_version);
8e074056 286 strncat(VersionString, temp, sizeof(VersionString) - strlen(VersionString) - 1);
15c4dc5a 287 }
e30c654b 288
15c4dc5a 289 FormatVersionInformation(temp, sizeof(temp), "os: ", &version_information);
8e074056 290 strncat(VersionString, temp, sizeof(VersionString) - strlen(VersionString) - 1);
e30c654b 291
e6153040 292 FpgaGatherVersion(FPGA_BITSTREAM_LF, temp, sizeof(temp));
8e074056 293 strncat(VersionString, temp, sizeof(VersionString) - strlen(VersionString) - 1);
e6153040 294 FpgaGatherVersion(FPGA_BITSTREAM_HF, temp, sizeof(temp));
8e074056 295 strncat(VersionString, temp, sizeof(VersionString) - strlen(VersionString) - 1);
0fa01ec7 296
e6153040 297 // Send Chip ID and used flash memory
0fa01ec7 298 uint32_t text_and_rodata_section_size = (uint32_t)&__data_src_start__ - (uint32_t)&_flash_start;
299 uint32_t compressed_data_section_size = common_area.arg1;
8e074056 300 cmd_send(CMD_ACK, *(AT91C_DBGU_CIDR), text_and_rodata_section_size + compressed_data_section_size, 0, VersionString, strlen(VersionString));
15c4dc5a 301}
302
bfb01844 303// measure the USB Speed by sending SpeedTestBufferSize bytes to client and measuring the elapsed time.
304// Note: this mimics GetFromBigbuf(), i.e. we have the overhead of the UsbCommand structure included.
67b7d6fa 305void printUSBSpeed(void)
bfb01844 306{
307 Dbprintf("USB Speed:");
67b7d6fa 308 Dbprintf(" Sending USB packets to client...");
bfb01844 309
67b7d6fa 310 #define USB_SPEED_TEST_MIN_TIME 1500 // in milliseconds
bfb01844 311 uint8_t *test_data = BigBuf_get_addr();
67b7d6fa 312 uint32_t end_time;
bfb01844 313
67b7d6fa 314 uint32_t start_time = end_time = GetTickCount();
315 uint32_t bytes_transferred = 0;
316
bfb01844 317 LED_B_ON();
67b7d6fa 318 while(end_time < start_time + USB_SPEED_TEST_MIN_TIME) {
319 cmd_send(CMD_DOWNLOADED_RAW_ADC_SAMPLES_125K, 0, USB_CMD_DATA_SIZE, 0, test_data, USB_CMD_DATA_SIZE);
320 end_time = GetTickCount();
321 bytes_transferred += USB_CMD_DATA_SIZE;
bfb01844 322 }
323 LED_B_OFF();
324
67b7d6fa 325 Dbprintf(" Time elapsed: %dms", end_time - start_time);
326 Dbprintf(" Bytes transferred: %d", bytes_transferred);
327 Dbprintf(" USB Transfer Speed PM3 -> Client = %d Bytes/s",
328 1000 * bytes_transferred / (end_time - start_time));
bfb01844 329
330}
331
c89274cc
CY
332/**
333 * Prints runtime information about the PM3.
334**/
67b7d6fa 335void SendStatus(void)
c89274cc
CY
336{
337 BigBuf_print_status();
338 Fpga_print_status();
339 printConfig(); //LF Sampling config
67b7d6fa 340 printUSBSpeed();
c89274cc
CY
341 Dbprintf("Various");
342 Dbprintf(" MF_DBGLEVEL......%d", MF_DBGLEVEL);
343 Dbprintf(" ToSendMax........%d",ToSendMax);
344 Dbprintf(" ToSendBit........%d",ToSendBit);
bfb01844 345
346 cmd_send(CMD_ACK,1,0,0,0,0);
c89274cc 347}
15c4dc5a 348
86a83668 349#if defined(WITH_ISO14443a_StandAlone) || defined(WITH_LF)
15c4dc5a 350
15c4dc5a 351#define OPTS 2
352
86a83668
MHS
353void StandAloneMode()
354{
355 DbpString("Stand-alone mode! No PC necessary.");
15c4dc5a 356 // Oooh pretty -- notify user we're in elite samy mode now
357 LED(LED_RED, 200);
358 LED(LED_ORANGE, 200);
359 LED(LED_GREEN, 200);
360 LED(LED_ORANGE, 200);
361 LED(LED_RED, 200);
362 LED(LED_ORANGE, 200);
363 LED(LED_GREEN, 200);
364 LED(LED_ORANGE, 200);
365 LED(LED_RED, 200);
366
86a83668
MHS
367}
368
369#endif
370
371
372
373#ifdef WITH_ISO14443a_StandAlone
374void StandAloneMode14a()
375{
376 StandAloneMode();
377 FpgaDownloadAndGo(FPGA_BITSTREAM_HF);
378
15c4dc5a 379 int selected = 0;
c89274cc 380 int playing = 0, iGotoRecord = 0, iGotoClone = 0;
86a83668
MHS
381 int cardRead[OPTS] = {0};
382 uint8_t readUID[10] = {0};
383 uint32_t uid_1st[OPTS]={0};
384 uint32_t uid_2nd[OPTS]={0};
c89274cc
CY
385 uint32_t uid_tmp1 = 0;
386 uint32_t uid_tmp2 = 0;
387 iso14a_card_select_t hi14a_card[OPTS];
15c4dc5a 388
15c4dc5a 389 LED(selected + 1, 0);
390
391 for (;;)
392 {
6e82300d 393 usb_poll();
86a83668 394 WDT_HIT();
15c4dc5a 395 SpinDelay(300);
396
c89274cc 397 if (iGotoRecord == 1 || cardRead[selected] == 0)
15c4dc5a 398 {
c89274cc 399 iGotoRecord = 0;
15c4dc5a 400 LEDsoff();
401 LED(selected + 1, 0);
402 LED(LED_RED2, 0);
403
404 // record
86a83668 405 Dbprintf("Enabling iso14443a reader mode for [Bank: %u]...", selected);
15c4dc5a 406 /* need this delay to prevent catching some weird data */
407 SpinDelay(500);
86a83668
MHS
408 /* Code for reading from 14a tag */
409 uint8_t uid[10] ={0};
410 uint32_t cuid;
411 iso14443a_setup(FPGA_HF_ISO14443A_READER_MOD);
15c4dc5a 412
86a83668
MHS
413 for ( ; ; )
414 {
415 WDT_HIT();
c89274cc
CY
416 if (BUTTON_PRESS()) {
417 if (cardRead[selected]) {
418 Dbprintf("Button press detected -- replaying card in bank[%d]", selected);
419 break;
420 }
421 else if (cardRead[(selected+1)%OPTS]) {
422 Dbprintf("Button press detected but no card in bank[%d] so playing from bank[%d]", selected, (selected+1)%OPTS);
423 selected = (selected+1)%OPTS;
424 break; // playing = 1;
425 }
426 else {
427 Dbprintf("Button press detected but no stored tag to play. (Ignoring button)");
428 SpinDelay(300);
429 }
430 }
431 if (!iso14443a_select_card(uid, &hi14a_card[selected], &cuid))
86a83668
MHS
432 continue;
433 else
434 {
435 Dbprintf("Read UID:"); Dbhexdump(10,uid,0);
436 memcpy(readUID,uid,10*sizeof(uint8_t));
c89274cc 437 uint8_t *dst = (uint8_t *)&uid_tmp1;
86a83668
MHS
438 // Set UID byte order
439 for (int i=0; i<4; i++)
440 dst[i] = uid[3-i];
c89274cc 441 dst = (uint8_t *)&uid_tmp2;
86a83668
MHS
442 for (int i=0; i<4; i++)
443 dst[i] = uid[7-i];
c89274cc
CY
444 if (uid_1st[(selected+1)%OPTS] == uid_tmp1 && uid_2nd[(selected+1)%OPTS] == uid_tmp2) {
445 Dbprintf("Card selected has same UID as what is stored in the other bank. Skipping.");
446 }
447 else {
448 if (uid_tmp2) {
449 Dbprintf("Bank[%d] received a 7-byte UID",selected);
450 uid_1st[selected] = (uid_tmp1)>>8;
451 uid_2nd[selected] = (uid_tmp1<<24) + (uid_tmp2>>8);
452 }
453 else {
454 Dbprintf("Bank[%d] received a 4-byte UID",selected);
455 uid_1st[selected] = uid_tmp1;
456 uid_2nd[selected] = uid_tmp2;
457 }
458 break;
459 }
86a83668
MHS
460 }
461 }
c89274cc
CY
462 Dbprintf("ATQA = %02X%02X",hi14a_card[selected].atqa[0],hi14a_card[selected].atqa[1]);
463 Dbprintf("SAK = %02X",hi14a_card[selected].sak);
86a83668
MHS
464 LEDsoff();
465 LED(LED_GREEN, 200);
466 LED(LED_ORANGE, 200);
467 LED(LED_GREEN, 200);
468 LED(LED_ORANGE, 200);
15c4dc5a 469
470 LEDsoff();
471 LED(selected + 1, 0);
15c4dc5a 472
c89274cc
CY
473 // Next state is replay:
474 playing = 1;
3fe4ff4f 475
86a83668 476 cardRead[selected] = 1;
86a83668 477 }
c89274cc
CY
478 /* MF Classic UID clone */
479 else if (iGotoClone==1)
3fe4ff4f 480 {
c89274cc
CY
481 iGotoClone=0;
482 LEDsoff();
483 LED(selected + 1, 0);
484 LED(LED_ORANGE, 250);
3fe4ff4f 485
3fe4ff4f 486
c89274cc
CY
487 // record
488 Dbprintf("Preparing to Clone card [Bank: %x]; uid: %08x", selected, uid_1st[selected]);
3fe4ff4f 489
c89274cc
CY
490 // wait for button to be released
491 while(BUTTON_PRESS())
492 {
493 // Delay cloning until card is in place
494 WDT_HIT();
495 }
496 Dbprintf("Starting clone. [Bank: %u]", selected);
497 // need this delay to prevent catching some weird data
498 SpinDelay(500);
499 // Begin clone function here:
500 /* Example from client/mifarehost.c for commanding a block write for "magic Chinese" cards:
501 UsbCommand c = {CMD_MIFARE_CSETBLOCK, {wantWipe, params & (0xFE | (uid == NULL ? 0:1)), blockNo}};
502 memcpy(c.d.asBytes, data, 16);
503 SendCommand(&c);
504
505 Block read is similar:
506 UsbCommand c = {CMD_MIFARE_CGETBLOCK, {params, 0, blockNo}};
507 We need to imitate that call with blockNo 0 to set a uid.
508
509 The get and set commands are handled in this file:
510 // Work with "magic Chinese" card
511 case CMD_MIFARE_CSETBLOCK:
512 MifareCSetBlock(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
513 break;
514 case CMD_MIFARE_CGETBLOCK:
515 MifareCGetBlock(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
516 break;
517
518 mfCSetUID provides example logic for UID set workflow:
519 -Read block0 from card in field with MifareCGetBlock()
520 -Configure new values without replacing reserved bytes
521 memcpy(block0, uid, 4); // Copy UID bytes from byte array
522 // Mifare UID BCC
523 block0[4] = block0[0]^block0[1]^block0[2]^block0[3]; // BCC on byte 5
524 Bytes 5-7 are reserved SAK and ATQA for mifare classic
525 -Use mfCSetBlock(0, block0, oldUID, wantWipe, CSETBLOCK_SINGLE_OPER) to write it
526 */
527 uint8_t oldBlock0[16] = {0}, newBlock0[16] = {0}, testBlock0[16] = {0};
528 // arg0 = Flags == CSETBLOCK_SINGLE_OPER=0x1F, arg1=returnSlot, arg2=blockNo
529 MifareCGetBlock(0x3F, 1, 0, oldBlock0);
530 if (oldBlock0[0] == 0 && oldBlock0[0] == oldBlock0[1] && oldBlock0[1] == oldBlock0[2] && oldBlock0[2] == oldBlock0[3]) {
531 Dbprintf("No changeable tag detected. Returning to replay mode for bank[%d]", selected);
532 playing = 1;
533 }
534 else {
535 Dbprintf("UID from target tag: %02X%02X%02X%02X", oldBlock0[0],oldBlock0[1],oldBlock0[2],oldBlock0[3]);
536 memcpy(newBlock0,oldBlock0,16);
537 // Copy uid_1st for bank (2nd is for longer UIDs not supported if classic)
538
539 newBlock0[0] = uid_1st[selected]>>24;
540 newBlock0[1] = 0xFF & (uid_1st[selected]>>16);
541 newBlock0[2] = 0xFF & (uid_1st[selected]>>8);
542 newBlock0[3] = 0xFF & (uid_1st[selected]);
543 newBlock0[4] = newBlock0[0]^newBlock0[1]^newBlock0[2]^newBlock0[3];
544 // arg0 = needWipe, arg1 = workFlags, arg2 = blockNo, datain
545 MifareCSetBlock(0, 0xFF,0, newBlock0);
546 MifareCGetBlock(0x3F, 1, 0, testBlock0);
547 if (memcmp(testBlock0,newBlock0,16)==0)
548 {
549 DbpString("Cloned successfull!");
550 cardRead[selected] = 0; // Only if the card was cloned successfully should we clear it
3fe4ff4f 551 playing = 0;
c89274cc
CY
552 iGotoRecord = 1;
553 selected = (selected+1) % OPTS;
554 }
555 else {
556 Dbprintf("Clone failed. Back to replay mode on bank[%d]", selected);
557 playing = 1;
558 }
559 }
560 LEDsoff();
561 LED(selected + 1, 0);
15c4dc5a 562
86a83668 563 }
15c4dc5a 564 // Change where to record (or begin playing)
c89274cc 565 else if (playing==1) // button_pressed == BUTTON_SINGLE_CLICK && cardRead[selected])
15c4dc5a 566 {
15c4dc5a 567 LEDsoff();
568 LED(selected + 1, 0);
569
570 // Begin transmitting
571 if (playing)
572 {
573 LED(LED_GREEN, 0);
574 DbpString("Playing");
c89274cc
CY
575 for ( ; ; ) {
576 WDT_HIT();
577 int button_action = BUTTON_HELD(1000);
578 if (button_action == 0) { // No button action, proceed with sim
579 uint8_t data[512] = {0}; // in case there is a read command received we shouldn't break
86a83668 580 Dbprintf("Simulating ISO14443a tag with uid[0]: %08x, uid[1]: %08x [Bank: %u]", uid_1st[selected],uid_2nd[selected],selected);
c89274cc
CY
581 if (hi14a_card[selected].sak == 8 && hi14a_card[selected].atqa[0] == 4 && hi14a_card[selected].atqa[1] == 0) {
582 DbpString("Mifare Classic");
583 SimulateIso14443aTag(1,uid_1st[selected], uid_2nd[selected], data); // Mifare Classic
584 }
585 else if (hi14a_card[selected].sak == 0 && hi14a_card[selected].atqa[0] == 0x44 && hi14a_card[selected].atqa[1] == 0) {
586 DbpString("Mifare Ultralight");
587 SimulateIso14443aTag(2,uid_1st[selected],uid_2nd[selected],data); // Mifare Ultralight
588 }
589 else if (hi14a_card[selected].sak == 20 && hi14a_card[selected].atqa[0] == 0x44 && hi14a_card[selected].atqa[1] == 3) {
590 DbpString("Mifare DESFire");
591 SimulateIso14443aTag(3,uid_1st[selected],uid_2nd[selected],data); // Mifare DESFire
592 }
593 else {
594 Dbprintf("Unrecognized tag type -- defaulting to Mifare Classic emulation");
595 SimulateIso14443aTag(1,uid_1st[selected], uid_2nd[selected], data);
596 }
597 }
598 else if (button_action == BUTTON_SINGLE_CLICK) {
599 selected = (selected + 1) % OPTS;
600 Dbprintf("Done playing. Switching to record mode on bank %d",selected);
601 iGotoRecord = 1;
602 break;
15c4dc5a 603 }
c89274cc
CY
604 else if (button_action == BUTTON_HOLD) {
605 Dbprintf("Playtime over. Begin cloning...");
606 iGotoClone = 1;
607 break;
608 }
609 WDT_HIT();
610 }
15c4dc5a 611
612 /* We pressed a button so ignore it here with a delay */
613 SpinDelay(300);
15c4dc5a 614 LEDsoff();
615 LED(selected + 1, 0);
616 }
617 else
618 while(BUTTON_PRESS())
619 WDT_HIT();
620 }
621 }
622}
86a83668
MHS
623#elif WITH_LF
624// samy's sniff and repeat routine
625void SamyRun()
e46fe044 626{
86a83668
MHS
627 StandAloneMode();
628 FpgaDownloadAndGo(FPGA_BITSTREAM_LF);
e46fe044 629
86a83668 630 int high[OPTS], low[OPTS];
15c4dc5a 631 int selected = 0;
632 int playing = 0;
3fe4ff4f 633 int cardRead = 0;
15c4dc5a 634
635 // Turn on selected LED
636 LED(selected + 1, 0);
637
638 for (;;)
639 {
6e82300d 640 usb_poll();
86a83668 641 WDT_HIT();
15c4dc5a 642
643 // Was our button held down or pressed?
644 int button_pressed = BUTTON_HELD(1000);
645 SpinDelay(300);
646
647 // Button was held for a second, begin recording
3fe4ff4f 648 if (button_pressed > 0 && cardRead == 0)
15c4dc5a 649 {
650 LEDsoff();
651 LED(selected + 1, 0);
652 LED(LED_RED2, 0);
653
654 // record
655 DbpString("Starting recording");
656
657 // wait for button to be released
658 while(BUTTON_PRESS())
659 WDT_HIT();
660
661 /* need this delay to prevent catching some weird data */
662 SpinDelay(500);
663
664 CmdHIDdemodFSK(1, &high[selected], &low[selected], 0);
665 Dbprintf("Recorded %x %x %x", selected, high[selected], low[selected]);
666
667 LEDsoff();
668 LED(selected + 1, 0);
669 // Finished recording
670
671 // If we were previously playing, set playing off
672 // so next button push begins playing what we recorded
673 playing = 0;
3fe4ff4f 674
675 cardRead = 1;
676
677 }
678
679 else if (button_pressed > 0 && cardRead == 1)
680 {
681 LEDsoff();
682 LED(selected + 1, 0);
683 LED(LED_ORANGE, 0);
684
685 // record
686 Dbprintf("Cloning %x %x %x", selected, high[selected], low[selected]);
687
688 // wait for button to be released
689 while(BUTTON_PRESS())
690 WDT_HIT();
691
692 /* need this delay to prevent catching some weird data */
693 SpinDelay(500);
694
695 CopyHIDtoT55x7(high[selected], low[selected], 0, 0);
696 Dbprintf("Cloned %x %x %x", selected, high[selected], low[selected]);
697
698 LEDsoff();
699 LED(selected + 1, 0);
700 // Finished recording
701
702 // If we were previously playing, set playing off
703 // so next button push begins playing what we recorded
704 playing = 0;
705
706 cardRead = 0;
707
15c4dc5a 708 }
709
710 // Change where to record (or begin playing)
711 else if (button_pressed)
712 {
713 // Next option if we were previously playing
714 if (playing)
715 selected = (selected + 1) % OPTS;
716 playing = !playing;
717
718 LEDsoff();
719 LED(selected + 1, 0);
720
721 // Begin transmitting
722 if (playing)
723 {
724 LED(LED_GREEN, 0);
725 DbpString("Playing");
726 // wait for button to be released
727 while(BUTTON_PRESS())
728 WDT_HIT();
729 Dbprintf("%x %x %x", selected, high[selected], low[selected]);
730 CmdHIDsimTAG(high[selected], low[selected], 0);
731 DbpString("Done playing");
732 if (BUTTON_HELD(1000) > 0)
733 {
734 DbpString("Exiting");
735 LEDsoff();
736 return;
737 }
738
739 /* We pressed a button so ignore it here with a delay */
740 SpinDelay(300);
741
742 // when done, we're done playing, move to next option
743 selected = (selected + 1) % OPTS;
744 playing = !playing;
745 LEDsoff();
746 LED(selected + 1, 0);
747 }
748 else
749 while(BUTTON_PRESS())
750 WDT_HIT();
751 }
752 }
753}
15c4dc5a 754
e46fe044 755#endif
15c4dc5a 756/*
757OBJECTIVE
758Listen and detect an external reader. Determine the best location
759for the antenna.
760
761INSTRUCTIONS:
762Inside the ListenReaderField() function, there is two mode.
763By default, when you call the function, you will enter mode 1.
764If you press the PM3 button one time, you will enter mode 2.
765If you press the PM3 button a second time, you will exit the function.
766
767DESCRIPTION OF MODE 1:
768This mode just listens for an external reader field and lights up green
769for HF and/or red for LF. This is the original mode of the detectreader
770function.
771
772DESCRIPTION OF MODE 2:
773This mode will visually represent, using the LEDs, the actual strength of the
774current compared to the maximum current detected. Basically, once you know
775what kind of external reader is present, it will help you spot the best location to place
776your antenna. You will probably not get some good results if there is a LF and a HF reader
777at the same place! :-)
778
779LIGHT SCHEME USED:
780*/
781static const char LIGHT_SCHEME[] = {
782 0x0, /* ---- | No field detected */
783 0x1, /* X--- | 14% of maximum current detected */
784 0x2, /* -X-- | 29% of maximum current detected */
785 0x4, /* --X- | 43% of maximum current detected */
786 0x8, /* ---X | 57% of maximum current detected */
787 0xC, /* --XX | 71% of maximum current detected */
788 0xE, /* -XXX | 86% of maximum current detected */
789 0xF, /* XXXX | 100% of maximum current detected */
790};
791static const int LIGHT_LEN = sizeof(LIGHT_SCHEME)/sizeof(LIGHT_SCHEME[0]);
792
793void ListenReaderField(int limit)
794{
3b692427 795 int lf_av, lf_av_new, lf_baseline= 0, lf_max;
796 int hf_av, hf_av_new, hf_baseline= 0, hf_max;
15c4dc5a 797 int mode=1, display_val, display_max, i;
798
3b692427 799#define LF_ONLY 1
800#define HF_ONLY 2
801#define REPORT_CHANGE 10 // report new values only if they have changed at least by REPORT_CHANGE
802
803
804 // switch off FPGA - we don't want to measure our own signal
805 FpgaDownloadAndGo(FPGA_BITSTREAM_HF);
806 FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF);
15c4dc5a 807
808 LEDsoff();
809
3b692427 810 lf_av = lf_max = AvgAdc(ADC_CHAN_LF);
15c4dc5a 811
812 if(limit != HF_ONLY) {
3b692427 813 Dbprintf("LF 125/134kHz Baseline: %dmV", (MAX_ADC_LF_VOLTAGE * lf_av) >> 10);
15c4dc5a 814 lf_baseline = lf_av;
815 }
816
3b692427 817 hf_av = hf_max = AvgAdc(ADC_CHAN_HF);
15c4dc5a 818
819 if (limit != LF_ONLY) {
3b692427 820 Dbprintf("HF 13.56MHz Baseline: %dmV", (MAX_ADC_HF_VOLTAGE * hf_av) >> 10);
15c4dc5a 821 hf_baseline = hf_av;
822 }
823
824 for(;;) {
825 if (BUTTON_PRESS()) {
826 SpinDelay(500);
827 switch (mode) {
828 case 1:
829 mode=2;
830 DbpString("Signal Strength Mode");
831 break;
832 case 2:
833 default:
834 DbpString("Stopped");
835 LEDsoff();
836 return;
837 break;
838 }
839 }
840 WDT_HIT();
841
842 if (limit != HF_ONLY) {
3b692427 843 if(mode == 1) {
844 if (abs(lf_av - lf_baseline) > REPORT_CHANGE)
845 LED_D_ON();
846 else
847 LED_D_OFF();
15c4dc5a 848 }
e30c654b 849
3b692427 850 lf_av_new = AvgAdc(ADC_CHAN_LF);
15c4dc5a 851 // see if there's a significant change
3b692427 852 if(abs(lf_av - lf_av_new) > REPORT_CHANGE) {
853 Dbprintf("LF 125/134kHz Field Change: %5dmV", (MAX_ADC_LF_VOLTAGE * lf_av_new) >> 10);
15c4dc5a 854 lf_av = lf_av_new;
855 if (lf_av > lf_max)
856 lf_max = lf_av;
15c4dc5a 857 }
858 }
859
860 if (limit != LF_ONLY) {
861 if (mode == 1){
3b692427 862 if (abs(hf_av - hf_baseline) > REPORT_CHANGE)
863 LED_B_ON();
864 else
865 LED_B_OFF();
15c4dc5a 866 }
e30c654b 867
3b692427 868 hf_av_new = AvgAdc(ADC_CHAN_HF);
15c4dc5a 869 // see if there's a significant change
3b692427 870 if(abs(hf_av - hf_av_new) > REPORT_CHANGE) {
871 Dbprintf("HF 13.56MHz Field Change: %5dmV", (MAX_ADC_HF_VOLTAGE * hf_av_new) >> 10);
15c4dc5a 872 hf_av = hf_av_new;
873 if (hf_av > hf_max)
874 hf_max = hf_av;
15c4dc5a 875 }
876 }
e30c654b 877
15c4dc5a 878 if(mode == 2) {
879 if (limit == LF_ONLY) {
880 display_val = lf_av;
881 display_max = lf_max;
882 } else if (limit == HF_ONLY) {
883 display_val = hf_av;
884 display_max = hf_max;
885 } else { /* Pick one at random */
886 if( (hf_max - hf_baseline) > (lf_max - lf_baseline) ) {
887 display_val = hf_av;
888 display_max = hf_max;
889 } else {
890 display_val = lf_av;
891 display_max = lf_max;
892 }
893 }
894 for (i=0; i<LIGHT_LEN; i++) {
895 if (display_val >= ((display_max/LIGHT_LEN)*i) && display_val <= ((display_max/LIGHT_LEN)*(i+1))) {
896 if (LIGHT_SCHEME[i] & 0x1) LED_C_ON(); else LED_C_OFF();
897 if (LIGHT_SCHEME[i] & 0x2) LED_A_ON(); else LED_A_OFF();
898 if (LIGHT_SCHEME[i] & 0x4) LED_B_ON(); else LED_B_OFF();
899 if (LIGHT_SCHEME[i] & 0x8) LED_D_ON(); else LED_D_OFF();
900 break;
901 }
902 }
903 }
904 }
905}
906
f7e3ed82 907void UsbPacketReceived(uint8_t *packet, int len)
15c4dc5a 908{
909 UsbCommand *c = (UsbCommand *)packet;
15c4dc5a 910
902cb3c0 911// Dbprintf("received %d bytes, with command: 0x%04x and args: %d %d %d",len,c->cmd,c->arg[0],c->arg[1],c->arg[2]);
912
15c4dc5a 913 switch(c->cmd) {
914#ifdef WITH_LF
31abe49f
MHS
915 case CMD_SET_LF_SAMPLING_CONFIG:
916 setSamplingConfig((sample_config *) c->d.asBytes);
917 break;
15c4dc5a 918 case CMD_ACQUIRE_RAW_ADC_SAMPLES_125K:
1fbf8956 919 cmd_send(CMD_ACK,SampleLF(c->arg[0]),0,0,0,0);
15c4dc5a 920 break;
15c4dc5a 921 case CMD_MOD_THEN_ACQUIRE_RAW_ADC_SAMPLES_125K:
922 ModThenAcquireRawAdcSamples125k(c->arg[0],c->arg[1],c->arg[2],c->d.asBytes);
923 break;
b014c96d 924 case CMD_LF_SNOOP_RAW_ADC_SAMPLES:
31abe49f 925 cmd_send(CMD_ACK,SnoopLF(),0,0,0,0);
b014c96d 926 break;
7e67e42f 927 case CMD_HID_DEMOD_FSK:
3fe4ff4f 928 CmdHIDdemodFSK(c->arg[0], 0, 0, 1);
7e67e42f 929 break;
930 case CMD_HID_SIM_TAG:
3fe4ff4f 931 CmdHIDsimTAG(c->arg[0], c->arg[1], 1);
7e67e42f 932 break;
abd6112f 933 case CMD_FSK_SIM_TAG:
934 CmdFSKsimTAG(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
935 break;
936 case CMD_ASK_SIM_TAG:
937 CmdASKsimTag(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
938 break;
872e3d4d 939 case CMD_PSK_SIM_TAG:
940 CmdPSKsimTag(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
941 break;
942 case CMD_HID_CLONE_TAG:
1c611bbd 943 CopyHIDtoT55x7(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes[0]);
7e67e42f 944 break;
a1f3bb12 945 case CMD_IO_DEMOD_FSK:
3fe4ff4f 946 CmdIOdemodFSK(c->arg[0], 0, 0, 1);
a1f3bb12 947 break;
3fe4ff4f 948 case CMD_IO_CLONE_TAG:
9f669cb2 949 CopyIOtoT55x7(c->arg[0], c->arg[1]);
a1f3bb12 950 break;
66707a3b 951 case CMD_EM410X_DEMOD:
952 CmdEM410xdemod(c->arg[0], 0, 0, 1);
953 break;
2d4eae76 954 case CMD_EM410X_WRITE_TAG:
955 WriteEM410x(c->arg[0], c->arg[1], c->arg[2]);
956 break;
7e67e42f 957 case CMD_READ_TI_TYPE:
958 ReadTItag();
959 break;
960 case CMD_WRITE_TI_TYPE:
961 WriteTItag(c->arg[0],c->arg[1],c->arg[2]);
962 break;
963 case CMD_SIMULATE_TAG_125K:
31d1caa5 964 LED_A_ON();
7e67e42f 965 SimulateTagLowFrequency(c->arg[0], c->arg[1], 1);
31d1caa5 966 LED_A_OFF();
7e67e42f 967 break;
968 case CMD_LF_SIMULATE_BIDIR:
969 SimulateTagLowFrequencyBidir(c->arg[0], c->arg[1]);
970 break;
3fe4ff4f 971 case CMD_INDALA_CLONE_TAG:
2414f978 972 CopyIndala64toT55x7(c->arg[0], c->arg[1]);
973 break;
3fe4ff4f 974 case CMD_INDALA_CLONE_TAG_L:
2414f978 975 CopyIndala224toT55x7(c->d.asDwords[0], c->d.asDwords[1], c->d.asDwords[2], c->d.asDwords[3], c->d.asDwords[4], c->d.asDwords[5], c->d.asDwords[6]);
976 break;
1c611bbd 977 case CMD_T55XX_READ_BLOCK:
8e99ec25 978 T55xxReadBlock(c->arg[0], c->arg[1], c->arg[2]);
1c611bbd 979 break;
980 case CMD_T55XX_WRITE_BLOCK:
981 T55xxWriteBlock(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes[0]);
982 break;
be2d41b7 983 case CMD_T55XX_WAKEUP:
984 T55xxWakeUp(c->arg[0]);
1c611bbd 985 break;
66837a03 986 case CMD_T55XX_RESET_READ:
987 T55xxResetRead();
988 break;
3fe4ff4f 989 case CMD_PCF7931_READ:
1c611bbd 990 ReadPCF7931();
1c611bbd 991 break;
dc4300ba 992 case CMD_PCF7931_WRITE:
d10e08ae 993 WritePCF7931(c->d.asBytes[0],c->d.asBytes[1],c->d.asBytes[2],c->d.asBytes[3],c->d.asBytes[4],c->d.asBytes[5],c->d.asBytes[6], c->d.asBytes[9], c->d.asBytes[7]-128,c->d.asBytes[8]-128, c->arg[0], c->arg[1], c->arg[2]);
dc4300ba 994 break;
1c611bbd 995 case CMD_EM4X_READ_WORD:
996 EM4xReadWord(c->arg[1], c->arg[2],c->d.asBytes[0]);
997 break;
998 case CMD_EM4X_WRITE_WORD:
999 EM4xWriteWord(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes[0]);
1000 break;
dbf6e824
CY
1001 case CMD_AWID_DEMOD_FSK: // Set realtime AWID demodulation
1002 CmdAWIDdemodFSK(c->arg[0], 0, 0, 1);
7cfc777b 1003 break;
15c4dc5a 1004#endif
1005
d19929cb 1006#ifdef WITH_HITAG
1007 case CMD_SNOOP_HITAG: // Eavesdrop Hitag tag, args = type
1008 SnoopHitag(c->arg[0]);
1009 break;
1010 case CMD_SIMULATE_HITAG: // Simulate Hitag tag, args = memory content
1011 SimulateHitagTag((bool)c->arg[0],(byte_t*)c->d.asBytes);
1012 break;
1013 case CMD_READER_HITAG: // Reader for Hitag tags, args = type and function
1014 ReaderHitag((hitag_function)c->arg[0],(hitag_data*)c->d.asBytes);
1015 break;
1016#endif
f168b263 1017
15c4dc5a 1018#ifdef WITH_ISO15693
1019 case CMD_ACQUIRE_RAW_ADC_SAMPLES_ISO_15693:
1020 AcquireRawAdcSamplesIso15693();
1021 break;
9455b51c 1022 case CMD_RECORD_RAW_ADC_SAMPLES_ISO_15693:
1023 RecordRawAdcSamplesIso15693();
1024 break;
1025
1026 case CMD_ISO_15693_COMMAND:
1027 DirectTag15693Command(c->arg[0],c->arg[1],c->arg[2],c->d.asBytes);
1028 break;
1029
1030 case CMD_ISO_15693_FIND_AFI:
1031 BruteforceIso15693Afi(c->arg[0]);
1032 break;
1033
1034 case CMD_ISO_15693_DEBUG:
1035 SetDebugIso15693(c->arg[0]);
1036 break;
15c4dc5a 1037
15c4dc5a 1038 case CMD_READER_ISO_15693:
1039 ReaderIso15693(c->arg[0]);
1040 break;
7e67e42f 1041 case CMD_SIMTAG_ISO_15693:
3fe4ff4f 1042 SimTagIso15693(c->arg[0], c->d.asBytes);
7e67e42f 1043 break;
15c4dc5a 1044#endif
1045
7e67e42f 1046#ifdef WITH_LEGICRF
1047 case CMD_SIMULATE_TAG_LEGIC_RF:
1048 LegicRfSimulate(c->arg[0], c->arg[1], c->arg[2]);
1049 break;
3612a8a8 1050
7e67e42f 1051 case CMD_WRITER_LEGIC_RF:
1052 LegicRfWriter(c->arg[1], c->arg[0]);
1053 break;
3612a8a8 1054
15c4dc5a 1055 case CMD_READER_LEGIC_RF:
1056 LegicRfReader(c->arg[0], c->arg[1]);
1057 break;
15c4dc5a 1058#endif
1059
1060#ifdef WITH_ISO14443b
15c4dc5a 1061 case CMD_READ_SRI512_TAG:
51d4f6f1 1062 ReadSTMemoryIso14443b(0x0F);
15c4dc5a 1063 break;
7e67e42f 1064 case CMD_READ_SRIX4K_TAG:
51d4f6f1 1065 ReadSTMemoryIso14443b(0x7F);
7e67e42f 1066 break;
132a0217 1067 case CMD_SNOOP_ISO_14443B:
51d4f6f1 1068 SnoopIso14443b();
7e67e42f 1069 break;
132a0217 1070 case CMD_SIMULATE_TAG_ISO_14443B:
51d4f6f1 1071 SimulateIso14443bTag();
7e67e42f 1072 break;
7cf3ef20 1073 case CMD_ISO_14443B_COMMAND:
1074 SendRawCommand14443B(c->arg[0],c->arg[1],c->arg[2],c->d.asBytes);
1075 break;
15c4dc5a 1076#endif
1077
1078#ifdef WITH_ISO14443a
7e67e42f 1079 case CMD_SNOOP_ISO_14443a:
5cd9ec01 1080 SnoopIso14443a(c->arg[0]);
7e67e42f 1081 break;
15c4dc5a 1082 case CMD_READER_ISO_14443a:
902cb3c0 1083 ReaderIso14443a(c);
15c4dc5a 1084 break;
7e67e42f 1085 case CMD_SIMULATE_TAG_ISO_14443a:
28afbd2b 1086 SimulateIso14443aTag(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes); // ## Simulate iso14443a tag - pass tag type & UID
7e67e42f 1087 break;
3fe4ff4f 1088
5acd09bd 1089 case CMD_EPA_PACE_COLLECT_NONCE:
902cb3c0 1090 EPA_PACE_Collect_Nonce(c);
5acd09bd 1091 break;
3bb07d96
FM
1092 case CMD_EPA_PACE_REPLAY:
1093 EPA_PACE_Replay(c);
1094 break;
7e67e42f 1095
15c4dc5a 1096 case CMD_READER_MIFARE:
f168b263 1097 ReaderMifare(c->arg[0]);
15c4dc5a 1098 break;
20f9a2a1
M
1099 case CMD_MIFARE_READBL:
1100 MifareReadBlock(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
1101 break;
981bd429 1102 case CMD_MIFAREU_READBL:
f168b263 1103 MifareUReadBlock(c->arg[0],c->arg[1], c->d.asBytes);
981bd429 1104 break;
8258f409 1105 case CMD_MIFAREUC_AUTH:
1106 MifareUC_Auth(c->arg[0],c->d.asBytes);
a631936e 1107 break;
981bd429 1108 case CMD_MIFAREU_READCARD:
75377d29 1109 MifareUReadCard(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
117d9ec2 1110 break;
f168b263 1111 case CMD_MIFAREUC_SETPWD:
1112 MifareUSetPwd(c->arg[0], c->d.asBytes);
1113 break;
20f9a2a1
M
1114 case CMD_MIFARE_READSC:
1115 MifareReadSector(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
1116 break;
1117 case CMD_MIFARE_WRITEBL:
1118 MifareWriteBlock(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
1119 break;
4973f23d 1120 //case CMD_MIFAREU_WRITEBL_COMPAT:
1121 //MifareUWriteBlockCompat(c->arg[0], c->d.asBytes);
1122 //break;
981bd429 1123 case CMD_MIFAREU_WRITEBL:
4973f23d 1124 MifareUWriteBlock(c->arg[0], c->arg[1], c->d.asBytes);
f168b263 1125 break;
20f9a2a1
M
1126 case CMD_MIFARE_NESTED:
1127 MifareNested(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
f397b5cc
M
1128 break;
1129 case CMD_MIFARE_CHKKEYS:
1130 MifareChkKeys(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
20f9a2a1
M
1131 break;
1132 case CMD_SIMULATE_MIFARE_CARD:
1133 Mifare1ksim(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
1134 break;
8556b852
M
1135
1136 // emulator
1137 case CMD_MIFARE_SET_DBGMODE:
1138 MifareSetDbgLvl(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
1139 break;
1140 case CMD_MIFARE_EML_MEMCLR:
1141 MifareEMemClr(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
1142 break;
1143 case CMD_MIFARE_EML_MEMSET:
1144 MifareEMemSet(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
1145 break;
1146 case CMD_MIFARE_EML_MEMGET:
1147 MifareEMemGet(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
1148 break;
1149 case CMD_MIFARE_EML_CARDLOAD:
1150 MifareECardLoad(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
0675f200
M
1151 break;
1152
1153 // Work with "magic Chinese" card
3fe4ff4f 1154 case CMD_MIFARE_CSETBLOCK:
0675f200 1155 MifareCSetBlock(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
545a1f38 1156 break;
3fe4ff4f 1157 case CMD_MIFARE_CGETBLOCK:
545a1f38 1158 MifareCGetBlock(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
8556b852 1159 break;
3fe4ff4f 1160 case CMD_MIFARE_CIDENT:
1161 MifareCIdent();
1162 break;
b62a5a84
M
1163
1164 // mifare sniffer
1165 case CMD_MIFARE_SNIFFER:
5cd9ec01 1166 SniffMifare(c->arg[0]);
b62a5a84 1167 break;
a631936e 1168
20f9a2a1
M
1169#endif
1170
7e67e42f 1171#ifdef WITH_ICLASS
cee5a30d 1172 // Makes use of ISO14443a FPGA Firmware
1173 case CMD_SNOOP_ICLASS:
1174 SnoopIClass();
1175 break;
1e262141 1176 case CMD_SIMULATE_TAG_ICLASS:
ff7bb4ef 1177 SimulateIClass(c->arg[0], c->arg[1], c->arg[2], c->d.asBytes);
1e262141 1178 break;
1179 case CMD_READER_ICLASS:
1180 ReaderIClass(c->arg[0]);
1181 break;
c3963755 1182 case CMD_READER_ICLASS_REPLAY:
aa53efc3 1183 ReaderIClass_Replay(c->arg[0], c->d.asBytes);
c3963755 1184 break;
aa53efc3 1185 case CMD_ICLASS_EML_MEMSET:
e80aeb96
MHS
1186 emlSet(c->d.asBytes,c->arg[0], c->arg[1]);
1187 break;
aa53efc3 1188 case CMD_ICLASS_WRITEBLOCK:
3ac22ee1 1189 iClass_WriteBlock(c->arg[0], c->d.asBytes);
1190 break;
1191 case CMD_ICLASS_READCHECK: // auth step 1
1192 iClass_ReadCheck(c->arg[0], c->arg[1]);
aa53efc3 1193 break;
1194 case CMD_ICLASS_READBLOCK:
3ac22ee1 1195 iClass_ReadBlk(c->arg[0]);
aa53efc3 1196 break;
3ac22ee1 1197 case CMD_ICLASS_AUTHENTICATION: //check
aa53efc3 1198 iClass_Authentication(c->d.asBytes);
1199 break;
1200 case CMD_ICLASS_DUMP:
3ac22ee1 1201 iClass_Dump(c->arg[0], c->arg[1]);
aa53efc3 1202 break;
1203 case CMD_ICLASS_CLONE:
3ac22ee1 1204 iClass_Clone(c->arg[0], c->arg[1], c->d.asBytes);
aa53efc3 1205 break;
cee5a30d 1206#endif
0472d76d 1207#ifdef WITH_HFSNOOP
1208 case CMD_HF_SNIFFER:
1209 HfSnoop(c->arg[0], c->arg[1]);
1210 break;
1211#endif
cee5a30d 1212
7e67e42f 1213 case CMD_BUFF_CLEAR:
117d9ec2 1214 BigBuf_Clear();
15c4dc5a 1215 break;
15c4dc5a 1216
1217 case CMD_MEASURE_ANTENNA_TUNING:
1218 MeasureAntennaTuning();
1219 break;
1220
1221 case CMD_MEASURE_ANTENNA_TUNING_HF:
1222 MeasureAntennaTuningHf();
1223 break;
1224
1225 case CMD_LISTEN_READER_FIELD:
1226 ListenReaderField(c->arg[0]);
1227 break;
1228
15c4dc5a 1229 case CMD_FPGA_MAJOR_MODE_OFF: // ## FPGA Control
1230 FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF);
1231 SpinDelay(200);
1232 LED_D_OFF(); // LED D indicates field ON or OFF
1233 break;
1234
1c611bbd 1235 case CMD_DOWNLOAD_RAW_ADC_SAMPLES_125K:
902cb3c0 1236
1c611bbd 1237 LED_B_ON();
117d9ec2 1238 uint8_t *BigBuf = BigBuf_get_addr();
1c611bbd 1239 for(size_t i=0; i<c->arg[1]; i += USB_CMD_DATA_SIZE) {
1240 size_t len = MIN((c->arg[1] - i),USB_CMD_DATA_SIZE);
3000dc4e 1241 cmd_send(CMD_DOWNLOADED_RAW_ADC_SAMPLES_125K,i,len,BigBuf_get_traceLen(),BigBuf+c->arg[0]+i,len);
1c611bbd 1242 }
1243 // Trigger a finish downloading signal with an ACK frame
3000dc4e 1244 cmd_send(CMD_ACK,1,0,BigBuf_get_traceLen(),getSamplingConfig(),sizeof(sample_config));
d3b1f4e4 1245 LED_B_OFF();
1c611bbd 1246 break;
15c4dc5a 1247
1248 case CMD_DOWNLOADED_SIM_SAMPLES_125K: {
117d9ec2 1249 uint8_t *b = BigBuf_get_addr();
3fe4ff4f 1250 memcpy(b+c->arg[0], c->d.asBytes, USB_CMD_DATA_SIZE);
1c611bbd 1251 cmd_send(CMD_ACK,0,0,0,0,0);
1252 break;
1253 }
15c4dc5a 1254 case CMD_READ_MEM:
1255 ReadMem(c->arg[0]);
1256 break;
1257
1258 case CMD_SET_LF_DIVISOR:
7cc204bf 1259 FpgaDownloadAndGo(FPGA_BITSTREAM_LF);
15c4dc5a 1260 FpgaSendCommand(FPGA_CMD_SET_DIVISOR, c->arg[0]);
1261 break;
1262
1263 case CMD_SET_ADC_MUX:
1264 switch(c->arg[0]) {
1265 case 0: SetAdcMuxFor(GPIO_MUXSEL_LOPKD); break;
1266 case 1: SetAdcMuxFor(GPIO_MUXSEL_LORAW); break;
1267 case 2: SetAdcMuxFor(GPIO_MUXSEL_HIPKD); break;
1268 case 3: SetAdcMuxFor(GPIO_MUXSEL_HIRAW); break;
1269 }
1270 break;
1271
1272 case CMD_VERSION:
1273 SendVersion();
1274 break;
c89274cc 1275 case CMD_STATUS:
67b7d6fa 1276 SendStatus();
c89274cc
CY
1277 break;
1278 case CMD_PING:
1279 cmd_send(CMD_ACK,0,0,0,0,0);
1280 break;
15c4dc5a 1281#ifdef WITH_LCD
1282 case CMD_LCD_RESET:
1283 LCDReset();
1284 break;
1285 case CMD_LCD:
1286 LCDSend(c->arg[0]);
1287 break;
1288#endif
1289 case CMD_SETUP_WRITE:
1290 case CMD_FINISH_WRITE:
1c611bbd 1291 case CMD_HARDWARE_RESET:
1292 usb_disable();
15c4dc5a 1293 SpinDelay(1000);
1294 SpinDelay(1000);
1295 AT91C_BASE_RSTC->RSTC_RCR = RST_CONTROL_KEY | AT91C_RSTC_PROCRST;
1296 for(;;) {
1297 // We're going to reset, and the bootrom will take control.
1298 }
1c611bbd 1299 break;
15c4dc5a 1300
1c611bbd 1301 case CMD_START_FLASH:
15c4dc5a 1302 if(common_area.flags.bootrom_present) {
1303 common_area.command = COMMON_AREA_COMMAND_ENTER_FLASH_MODE;
1304 }
1c611bbd 1305 usb_disable();
15c4dc5a 1306 AT91C_BASE_RSTC->RSTC_RCR = RST_CONTROL_KEY | AT91C_RSTC_PROCRST;
1307 for(;;);
1c611bbd 1308 break;
e30c654b 1309
15c4dc5a 1310 case CMD_DEVICE_INFO: {
902cb3c0 1311 uint32_t dev_info = DEVICE_INFO_FLAG_OSIMAGE_PRESENT | DEVICE_INFO_FLAG_CURRENT_MODE_OS;
1312 if(common_area.flags.bootrom_present) dev_info |= DEVICE_INFO_FLAG_BOOTROM_PRESENT;
1c611bbd 1313 cmd_send(CMD_DEVICE_INFO,dev_info,0,0,0,0);
1314 break;
1315 }
1316 default:
15c4dc5a 1317 Dbprintf("%s: 0x%04x","unknown command:",c->cmd);
1c611bbd 1318 break;
15c4dc5a 1319 }
1320}
1321
1322void __attribute__((noreturn)) AppMain(void)
1323{
1324 SpinDelay(100);
9e8255d4 1325 clear_trace();
15c4dc5a 1326 if(common_area.magic != COMMON_AREA_MAGIC || common_area.version != 1) {
1327 /* Initialize common area */
1328 memset(&common_area, 0, sizeof(common_area));
1329 common_area.magic = COMMON_AREA_MAGIC;
1330 common_area.version = 1;
1331 }
1332 common_area.flags.osimage_present = 1;
1333
1334 LED_D_OFF();
1335 LED_C_OFF();
1336 LED_B_OFF();
1337 LED_A_OFF();
1338
3fe4ff4f 1339 // Init USB device
902cb3c0 1340 usb_enable();
15c4dc5a 1341
1342 // The FPGA gets its clock from us from PCK0 output, so set that up.
1343 AT91C_BASE_PIOA->PIO_BSR = GPIO_PCK0;
1344 AT91C_BASE_PIOA->PIO_PDR = GPIO_PCK0;
1345 AT91C_BASE_PMC->PMC_SCER = AT91C_PMC_PCK0;
1346 // PCK0 is PLL clock / 4 = 96Mhz / 4 = 24Mhz
1347 AT91C_BASE_PMC->PMC_PCKR[0] = AT91C_PMC_CSS_PLL_CLK |
0472d76d 1348 AT91C_PMC_PRES_CLK_4; // 4 for 24Mhz pck0, 2 for 48 MHZ pck0
15c4dc5a 1349 AT91C_BASE_PIOA->PIO_OER = GPIO_PCK0;
1350
1351 // Reset SPI
1352 AT91C_BASE_SPI->SPI_CR = AT91C_SPI_SWRST;
1353 // Reset SSC
1354 AT91C_BASE_SSC->SSC_CR = AT91C_SSC_SWRST;
1355
1356 // Load the FPGA image, which we have stored in our flash.
7cc204bf 1357 // (the HF version by default)
1358 FpgaDownloadAndGo(FPGA_BITSTREAM_HF);
15c4dc5a 1359
9ca155ba 1360 StartTickCount();
902cb3c0 1361
15c4dc5a 1362#ifdef WITH_LCD
15c4dc5a 1363 LCDInit();
15c4dc5a 1364#endif
1365
902cb3c0 1366 byte_t rx[sizeof(UsbCommand)];
1367 size_t rx_len;
1368
15c4dc5a 1369 for(;;) {
902cb3c0 1370 if (usb_poll()) {
1371 rx_len = usb_read(rx,sizeof(UsbCommand));
1372 if (rx_len) {
1373 UsbPacketReceived(rx,rx_len);
1374 }
1375 }
15c4dc5a 1376 WDT_HIT();
1377
1378#ifdef WITH_LF
e46fe044 1379#ifndef WITH_ISO14443a_StandAlone
15c4dc5a 1380 if (BUTTON_HELD(1000) > 0)
1381 SamyRun();
e46fe044
CY
1382#endif
1383#endif
1384#ifdef WITH_ISO14443a
1385#ifdef WITH_ISO14443a_StandAlone
1386 if (BUTTON_HELD(1000) > 0)
1387 StandAloneMode14a();
1388#endif
15c4dc5a 1389#endif
1390 }
1391}
Impressum, Datenschutz