]>
Commit | Line | Data |
---|---|---|
0472d76d | 1 | #include "proxmark3.h" |
2 | #include "apps.h" | |
3 | #include "BigBuf.h" | |
4 | #include "util.h" | |
5 | ||
6 | static void RAMFUNC optimizedSnoop(void); | |
7 | ||
8 | static void RAMFUNC optimizedSnoop(void) | |
9 | { | |
0472d76d | 10 | int n = BigBuf_max_traceLen() / sizeof(uint16_t); // take all memory |
031311c7 | 11 | |
0472d76d | 12 | uint16_t *dest = (uint16_t *)BigBuf_get_addr(); |
13 | uint16_t *destend = dest + n; | |
14 | ||
15 | AT91C_BASE_SSC->SSC_RFMR = SSC_FRAME_MODE_BITS_IN_WORD(16); // Setting Frame mode, 16 bits per word | |
16 | // Reading data loop | |
17 | while(dest <= destend) | |
18 | { | |
19 | if(AT91C_BASE_SSC->SSC_SR & AT91C_SSC_RXRDY) | |
20 | { | |
21 | *dest = (uint16_t)(AT91C_BASE_SSC->SSC_RHR); | |
06ed826c | 22 | dest++; |
0472d76d | 23 | } |
24 | } | |
25 | //Resetting Frame mode (First set in fpgaloader.c) | |
031311c7 | 26 | AT91C_BASE_SSC->SSC_RFMR = SSC_FRAME_MODE_BITS_IN_WORD(8) | AT91C_SSC_MSBF | SSC_FRAME_MODE_WORDS_PER_TRANSFER(0); |
0472d76d | 27 | } |
28 | ||
29 | void HfSnoop(int samplesToSkip, int triggersToSkip) | |
30 | { | |
06ed826c I |
31 | BigBuf_free(); BigBuf_Clear(); |
32 | ||
33 | Dbprintf("Skipping first %d sample pairs, Skipping %d triggers.\n", samplesToSkip, triggersToSkip); | |
c87c4521 | 34 | int trigger_cnt; |
031311c7 | 35 | LED_D_ON(); |
0472d76d | 36 | // Select correct configs |
37 | FpgaDownloadAndGo(FPGA_BITSTREAM_HF); | |
38 | // Set up the synchronous serial port | |
39 | FpgaSetupSsc(); | |
40 | // connect Demodulated Signal to ADC: | |
41 | SetAdcMuxFor(GPIO_MUXSEL_HIPKD); | |
42 | FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_SNOOP); | |
43 | SpinDelay(100); | |
44 | ||
45 | AT91C_BASE_SSC->SSC_RFMR = SSC_FRAME_MODE_BITS_IN_WORD(16); // Setting Frame Mode For better performance on high speed data transfer. | |
031311c7 | 46 | |
0472d76d | 47 | trigger_cnt = 0; |
031311c7 | 48 | uint16_t r = 0; |
06ed826c | 49 | while(!BUTTON_PRESS() && !usb_poll_validate_length()) { |
031311c7 | 50 | WDT_HIT(); |
0472d76d | 51 | if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_RXRDY)) { |
52 | r = (uint16_t)AT91C_BASE_SSC->SSC_RHR; | |
5d0e1901 | 53 | r = MAX(r & 0xff, r >> 8); |
06ed826c I |
54 | if (r >= 240) { |
55 | if (++trigger_cnt > triggersToSkip) | |
5d0e1901 | 56 | break; |
031311c7 | 57 | } |
0472d76d | 58 | } |
59 | } | |
5d0e1901 | 60 | |
031311c7 | 61 | if(!BUTTON_PRESS()) { |
031311c7 | 62 | int waitcount = samplesToSkip; // lets wait 40000 ticks of pck0 |
63 | while(waitcount != 0) { | |
06ed826c | 64 | if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_RXRDY)) |
031311c7 | 65 | waitcount--; |
0472d76d | 66 | } |
031311c7 | 67 | optimizedSnoop(); |
5d0e1901 | 68 | Dbprintf("Trigger kicked! Value: %d, Dumping Samples Hispeed now.", r); |
031311c7 | 69 | } |
0472d76d | 70 | |
031311c7 | 71 | DbpString("HF Snoop end"); |
0472d76d | 72 | FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF); |
73 | LED_D_OFF(); | |
74 | } | |
75 |