X-Git-Url: http://cvs.zerfleddert.de/cgi-bin/gitweb.cgi/proxmark3-svn/blobdiff_plain/be6250d31b5cc1ebb9ab0bece84c6691220a8e0d..0472d76de484018f2d11425417f3078a08a2e3d3:/armsrc/hfsnoop.c?ds=sidebyside

diff --git a/armsrc/hfsnoop.c b/armsrc/hfsnoop.c
new file mode 100644
index 00000000..5338bd0d
--- /dev/null
+++ b/armsrc/hfsnoop.c
@@ -0,0 +1,74 @@
+#include "proxmark3.h"
+#include "apps.h"
+#include "BigBuf.h"
+#include "util.h"
+
+static void RAMFUNC optimizedSnoop(void);
+
+static void RAMFUNC optimizedSnoop(void)
+{
+	BigBuf_free();
+	int n = BigBuf_max_traceLen() / sizeof(uint16_t); // take all memory
+        
+	uint16_t *dest = (uint16_t *)BigBuf_get_addr();
+	uint16_t *destend = dest + n;
+
+	AT91C_BASE_SSC->SSC_RFMR = SSC_FRAME_MODE_BITS_IN_WORD(16); // Setting Frame mode, 16 bits per word
+	// Reading data loop
+	while(dest <= destend)
+	{
+		if(AT91C_BASE_SSC->SSC_SR & AT91C_SSC_RXRDY)
+		{
+			*dest = (uint16_t)(AT91C_BASE_SSC->SSC_RHR);
+			dest = dest + 1;
+		}
+	}
+	//Resetting Frame mode (First set in fpgaloader.c)
+	AT91C_BASE_SSC->SSC_RFMR = SSC_FRAME_MODE_BITS_IN_WORD(8) | AT91C_SSC_MSBF | SSC_FRAME_MODE_WORDS_PER_TRANSFER(0); 
+}
+
+void HfSnoop(int samplesToSkip, int triggersToSkip)
+{
+	Dbprintf("Skipping first %d sample pairs, Skipping %d triggers.\n", samplesToSkip, triggersToSkip);
+	bool trigger_cnt;
+	LED_D_OFF();
+	// Select correct configs
+	FpgaDownloadAndGo(FPGA_BITSTREAM_HF);
+	// Set up the synchronous serial port
+	FpgaSetupSsc();
+	// connect Demodulated Signal to ADC:
+	SetAdcMuxFor(GPIO_MUXSEL_HIPKD);
+	FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_SNOOP);
+	SpinDelay(100);
+
+	AT91C_BASE_SSC->SSC_RFMR = SSC_FRAME_MODE_BITS_IN_WORD(16); // Setting Frame Mode For better performance on high speed data transfer.
+  
+	trigger_cnt = 0;
+	uint16_t r;
+	for(;;) {
+		if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_RXRDY)) {
+			r = (uint16_t)AT91C_BASE_SSC->SSC_RHR;
+			if (!(trigger_cnt == triggersToSkip) && ( (r >> 8) >= 240))
+			{
+				Dbprintf("Trigger kicked! Value: %d.", r >> 8);
+				trigger_cnt++;
+				break;
+			}
+		}
+	}
+	Dbprintf("Trigger kicked! Value: %d, Dumping Samples Hispeed now.", r >> 8);
+	int waitcount = samplesToSkip; // lets wait 40000 ticks of pck0
+	while(waitcount != 0) {
+		if(AT91C_BASE_SSC->SSC_SR & (AT91C_SSC_RXRDY)) {
+			waitcount--;
+		}
+	}
+
+	// Snooooop!!!
+	optimizedSnoop();
+
+	DbpString("Done.");
+	FpgaWriteConfWord(FPGA_MAJOR_MODE_OFF);
+	LED_D_OFF();
+}
+