#include <string.h>
#include "ui.h"
#include "graph.h"
+#include "lfdemod.h"
int GraphBuffer[MAX_GRAPH_TRACE_LEN];
int GraphTraceLen;
/*
* Detect clock rate
*/
-int DetectClock(int peak)
+ //decommissioned - has difficulty detecting rf/32
+/*
+int DetectClockOld(int peak)
{
int i;
int clock = 0xFFFF;
int lastpeak = 0;
- /* Detect peak if we don't have one */
+ // Detect peak if we don't have one
if (!peak)
for (i = 0; i < GraphTraceLen; ++i)
if (GraphBuffer[i] > peak)
peak = GraphBuffer[i];
+ // peak=(int)(peak*.75);
for (i = 1; i < GraphTraceLen; ++i)
{
- /* If this is the beginning of a peak */
- if (GraphBuffer[i - 1] != GraphBuffer[i] && GraphBuffer[i] == peak)
+ // If this is the beginning of a peak
+ if (GraphBuffer[i - 1] != GraphBuffer[i] && GraphBuffer[i] >= peak)
{
- /* Find lowest difference between peaks */
+ // Find lowest difference between peaks
if (lastpeak && i - lastpeak < clock)
clock = i - lastpeak;
lastpeak = i;
return clock;
}
+*/
+/*
+NOW IN LFDEMOD.C
+// by marshmellow
+// not perfect especially with lower clocks or VERY good antennas (heavy wave clipping)
+// maybe somehow adjust peak trimming value based on samples to fix?
+int DetectASKClock(int peak)
+{
+ int i=0;
+ int low=0;
+ int clk[]={16,32,40,50,64,100,128,256};
+ int loopCnt = 256;
+ if (GraphTraceLen<loopCnt) loopCnt = GraphTraceLen;
+ if (!peak){
+ for (i=0;i<loopCnt;++i){
+ if(GraphBuffer[i]>peak){
+ peak = GraphBuffer[i];
+ }
+ if(GraphBuffer[i]<low){
+ low = GraphBuffer[i];
+ }
+ }
+ peak=(int)(peak*.75);
+ low= (int)(low*.75);
+ }
+ int ii;
+ int clkCnt;
+ int tol = 0;
+ int bestErr=1000;
+ int errCnt[]={0,0,0,0,0,0,0,0};
+ for(clkCnt=0; clkCnt<6;++clkCnt){
+ if (clk[clkCnt]==32){
+ tol=1;
+ }else{
+ tol=0;
+ }
+ bestErr=1000;
+ for (ii=0; ii<loopCnt; ++ii){
+ if ((GraphBuffer[ii]>=peak) || (GraphBuffer[ii]<=low)){
+ errCnt[clkCnt]=0;
+ for (i=0; i<((int)(GraphTraceLen/clk[clkCnt])-1); ++i){
+ if (GraphBuffer[ii+(i*clk[clkCnt])]>=peak || GraphBuffer[ii+(i*clk[clkCnt])]<=low){
+ }else if(GraphBuffer[ii+(i*clk[clkCnt])-tol]>=peak || GraphBuffer[ii+(i*clk[clkCnt])-tol]<=low){
+ }else if(GraphBuffer[ii+(i*clk[clkCnt])+tol]>=peak || GraphBuffer[ii+(i*clk[clkCnt])+tol]<=low){
+ }else{ //error no peak detected
+ errCnt[clkCnt]++;
+ }
+ }
+ if(errCnt[clkCnt]==0) return clk[clkCnt];
+ if(errCnt[clkCnt]<bestErr) bestErr=errCnt[clkCnt];
+ }
+ }
+ }
+ int iii=0;
+ int best=0;
+ for (iii=0; iii<6;++iii){
+ if (errCnt[iii]<errCnt[best]){
+ best = iii;
+ }
+ }
+ // PrintAndLog("DEBUG: clkCnt: %d, ii: %d, i: %d peak: %d, low: %d, errcnt: %d, errCnt64: %d",clkCnt,ii,i,peak,low,errCnt[best],errCnt[4]);
+ return clk[best];
+}
+*/
+void setGraphBuf(uint8_t *buff,int size)
+{
+ int i=0;
+ ClearGraph(0);
+ for (; i < size; ++i){
+ GraphBuffer[i]=buff[i];
+ }
+ GraphTraceLen=size;
+ RepaintGraphWindow();
+ return;
+}
+int getFromGraphBuf(uint8_t *buff)
+{
+ uint32_t i;
+ for (i=0;i<GraphTraceLen;++i){
+ if (GraphBuffer[i]>127) GraphBuffer[i]=127; //trim
+ if (GraphBuffer[i]<-127) GraphBuffer[i]=-127; //trim
+ buff[i]=(uint8_t)(GraphBuffer[i]+128);
+ }
+ return i;
+}
/* Get or auto-detect clock rate */
int GetClock(const char *str, int peak, int verbose)
{
int clock;
-
+// int clock2;
sscanf(str, "%i", &clock);
if (!strcmp(str, ""))
clock = 0;
/* Auto-detect clock */
if (!clock)
{
- clock = DetectClock(peak);
+ uint8_t grph[MAX_GRAPH_TRACE_LEN]={0};
+ int size = getFromGraphBuf(grph);
+ clock = DetectASKClock(grph,size,0);
+ //clock2 = DetectClock2(peak);
/* Only print this message if we're not looping something */
- if (!verbose)
+ if (!verbose){
PrintAndLog("Auto-detected clock rate: %d", clock);
+ //PrintAndLog("clock2: %d",clock2);
+ }
}
return clock;