]>
Commit | Line | Data |
---|---|---|
a553f267 | 1 | //----------------------------------------------------------------------------- |
2 | // Copyright (C) 2010 iZsh <izsh at fail0verflow.com> | |
3 | // | |
4 | // This code is licensed to you under the terms of the GNU GPL, version 2 or, | |
5 | // at your option, any later version. See the LICENSE.txt file for the text of | |
6 | // the license. | |
7 | //----------------------------------------------------------------------------- | |
8 | // Graph utilities | |
9 | //----------------------------------------------------------------------------- | |
10 | ||
7fe9b0b7 | 11 | #include <stdio.h> |
a1557c4c | 12 | #include <stdbool.h> |
7fe9b0b7 | 13 | #include <string.h> |
14 | #include "ui.h" | |
15 | #include "graph.h" | |
d5a72d2f | 16 | #include "lfdemod.h" |
7fe9b0b7 | 17 | |
18 | int GraphBuffer[MAX_GRAPH_TRACE_LEN]; | |
19 | int GraphTraceLen; | |
20 | ||
21 | /* write a bit to the graph */ | |
22 | void AppendGraph(int redraw, int clock, int bit) | |
23 | { | |
24 | int i; | |
25 | ||
26 | for (i = 0; i < (int)(clock / 2); ++i) | |
27 | GraphBuffer[GraphTraceLen++] = bit ^ 1; | |
7fe9b0b7 | 28 | |
7fe9b0b7 | 29 | for (i = (int)(clock / 2); i < clock; ++i) |
30 | GraphBuffer[GraphTraceLen++] = bit; | |
31 | ||
32 | if (redraw) | |
33 | RepaintGraphWindow(); | |
34 | } | |
35 | ||
c12512e9 | 36 | // clear out our graph window |
7fe9b0b7 | 37 | int ClearGraph(int redraw) |
38 | { | |
39 | int gtl = GraphTraceLen; | |
52ab55ab | 40 | memset(GraphBuffer, 0x00, GraphTraceLen); |
41 | ||
7fe9b0b7 | 42 | GraphTraceLen = 0; |
43 | ||
44 | if (redraw) | |
45 | RepaintGraphWindow(); | |
46 | ||
47 | return gtl; | |
48 | } | |
49 | ||
c12512e9 | 50 | // DETECT CLOCK NOW IN LFDEMOD.C |
7fe9b0b7 | 51 | |
ba1a299c | 52 | void setGraphBuf(uint8_t *buff, size_t size) |
d5a72d2f | 53 | { |
a1557c4c | 54 | if ( buff == NULL ) return; |
55 | ||
56 | uint16_t i = 0; | |
57 | if ( size > MAX_GRAPH_TRACE_LEN ) | |
58 | size = MAX_GRAPH_TRACE_LEN; | |
d5a72d2f | 59 | ClearGraph(0); |
60 | for (; i < size; ++i){ | |
ba1a299c | 61 | GraphBuffer[i]=buff[i]-128; |
d5a72d2f | 62 | } |
63 | GraphTraceLen=size; | |
64 | RepaintGraphWindow(); | |
65 | return; | |
66 | } | |
ba1a299c | 67 | size_t getFromGraphBuf(uint8_t *buff) |
d5a72d2f | 68 | { |
a1557c4c | 69 | if ( buff == NULL ) return -1; |
70 | ||
d5a72d2f | 71 | uint32_t i; |
f822a063 | 72 | for (i=0;i<GraphTraceLen;++i){ |
73 | if (GraphBuffer[i]>127) GraphBuffer[i]=127; //trim | |
74 | if (GraphBuffer[i]<-127) GraphBuffer[i]=-127; //trim | |
d5a72d2f | 75 | buff[i]=(uint8_t)(GraphBuffer[i]+128); |
f822a063 | 76 | } |
d5a72d2f | 77 | return i; |
78 | } | |
c12512e9 | 79 | // Get or auto-detect clock rate |
7fe9b0b7 | 80 | int GetClock(const char *str, int peak, int verbose) |
81 | { | |
82 | int clock; | |
7fe9b0b7 | 83 | sscanf(str, "%i", &clock); |
84 | if (!strcmp(str, "")) | |
85 | clock = 0; | |
86 | ||
c12512e9 | 87 | // Auto-detect clock |
7fe9b0b7 | 88 | if (!clock) |
89 | { | |
d5a72d2f | 90 | uint8_t grph[MAX_GRAPH_TRACE_LEN]={0}; |
ba1a299c | 91 | size_t size = getFromGraphBuf(grph); |
a1557c4c | 92 | if ( size < 0 ) { |
93 | PrintAndLog("Failed to copy from graphbuffer"); | |
94 | return -1; | |
95 | } | |
d5a72d2f | 96 | clock = DetectASKClock(grph,size,0); |
c12512e9 | 97 | // Only print this message if we're not looping something |
0e74c023 | 98 | if (!verbose){ |
7fe9b0b7 | 99 | PrintAndLog("Auto-detected clock rate: %d", clock); |
0e74c023 | 100 | } |
7fe9b0b7 | 101 | return clock; |
102 | } | |
ba1a299c | 103 | |
a1557c4c | 104 | // A simple test to see if there is any data inside Graphbuffer. |
105 | bool HasGraphData(){ | |
106 | ||
107 | if ( GraphTraceLen <= 0) { | |
108 | PrintAndLog("No data available, try reading something first"); | |
109 | return false; | |
110 | } | |
111 | return true; | |
112 | } | |
113 | ||
114 | // Detect high and lows in Grapbuffer. | |
115 | // Only loops the first 256 values. | |
116 | void DetectHighLowInGraph(int *high, int *low, bool addFuzz) { | |
117 | ||
118 | uint8_t loopMax = 255; | |
119 | if ( loopMax > GraphTraceLen) | |
120 | loopMax = GraphTraceLen; | |
121 | ||
122 | for (uint8_t i = 0; i < loopMax; ++i) { | |
123 | if (GraphBuffer[i] > *high) | |
124 | *high = GraphBuffer[i]; | |
125 | else if (GraphBuffer[i] < *low) | |
126 | *low = GraphBuffer[i]; | |
127 | } | |
128 | ||
129 | //12% fuzz in case highs and lows aren't clipped | |
130 | if (addFuzz) { | |
131 | *high = (int)(*high * .88); | |
132 | *low = (int)(*low * .88); | |
133 | } | |
134 | } | |
135 | ||
4118b74d | 136 | int GetNRZpskClock(const char *str, int peak, int verbose) |
137 | { | |
ba1a299c | 138 | int clock; |
ba1a299c | 139 | sscanf(str, "%i", &clock); |
140 | if (!strcmp(str, "")) | |
141 | clock = 0; | |
142 | ||
143 | // Auto-detect clock | |
144 | if (!clock) | |
145 | { | |
146 | uint8_t grph[MAX_GRAPH_TRACE_LEN]={0}; | |
d6d20c54 | 147 | size_t size = getFromGraphBuf(grph); |
148 | clock = DetectpskNRZClock(grph,size,0); | |
ba1a299c | 149 | // Only print this message if we're not looping something |
150 | if (!verbose){ | |
151 | PrintAndLog("Auto-detected clock rate: %d", clock); | |
ba1a299c | 152 | } |
153 | } | |
154 | return clock; | |
a1557c4c | 155 | } |