git.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 #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(FPGA_MAJOR_MODE_HF_SNOOP);
  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