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