cvs.zerfleddert.de Git - proxmark3-svn/blob - armsrc/hfsnoop.c

   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 {
  10         int n = BigBuf_max_traceLen() / sizeof(uint16_t); // take all memory
  11
  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);
  22                         dest = dest + 1;
  23                 }
  24         }
  25         //Resetting Frame mode (First set in fpgaloader.c)
  26         AT91C_BASE_SSC->SSC_RFMR = SSC_FRAME_MODE_BITS_IN_WORD(8) | AT91C_SSC_MSBF | SSC_FRAME_MODE_WORDS_PER_TRANSFER(0);
  27 }
  28
  29 void HfSnoop(int samplesToSkip, int triggersToSkip)
  30 {
  31         Dbprintf("Skipping first %d sample pairs, Skipping %d triggers.\n", samplesToSkip, triggersToSkip);
  32         bool trigger_cnt;
  33         LED_D_ON();
  34         // Select correct configs
  35         FpgaDownloadAndGo(FPGA_BITSTREAM_HF);
  36         // Set up the synchronous serial port
  37         FpgaSetupSsc();
  38         // connect Demodulated Signal to ADC:
  39         SetAdcMuxFor(GPIO_MUXSEL_HIPKD);
  40         FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_SNOOP);
  41         SpinDelay(100);
  42
  43         BigBuf_free();
  44         BigBuf_Clear();
  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                         {
  57                                 if (++trigger_cnt > triggersToSkip) {
  58                                 break;
  59                         }
  60                 }
  61         }
  62         }
  63
  64         if(!BUTTON_PRESS()) {
  65                 int waitcount = samplesToSkip; // lets wait 40000 ticks of pck0
  66                 while(waitcount != 0) {
  67                         if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_RXRDY)) {
  68                                 waitcount--;
  69                         }
  70                 }
  71                 optimizedSnoop();
  72                 Dbprintf("Trigger kicked! Value: %d, Dumping Samples Hispeed now.", r);
  73         }
  74
  75         DbpString("HF Snoop end");
  76         FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF);
  77         LED_D_OFF();
  78 }
  79