]> git.zerfleddert.de Git - proxmark3-svn/blob - client/cmdlfindala.c
remove warning about non-static init...
[proxmark3-svn] / client / cmdlfindala.c
1 //-----------------------------------------------------------------------------
2 //
3 // This code is licensed to you under the terms of the GNU GPL, version 2 or,
4 // at your option, any later version. See the LICENSE.txt file for the text of
5 // the license.
6 //-----------------------------------------------------------------------------
7 // Low frequency Indala commands
8 // PSK1, rf/32, 64 or 224 bits (known)
9 //-----------------------------------------------------------------------------
10
11 #include <stdio.h>
12 #include <string.h>
13 #include "cmdlfindala.h"
14 #include "proxmark3.h"
15 #include "ui.h"
16 #include "graph.h"
17 #include "cmdparser.h"
18 #include "cmddata.h" //for g_debugMode, demodbuff cmds
19 #include "lfdemod.h" //for indala26decode
20 #include "util.h" //for sprint_bin_break
21 #include "cmdlf.h" //for CmdLFRead
22 #include "cmdmain.h" //for clearCommandBuffer
23
24 static int CmdHelp(const char *Cmd);
25
26 // Indala 26 bit decode
27 // by marshmellow
28 // optional arguments - same as PSKDemod (clock & invert & maxerr)
29 int CmdIndalaDecode(const char *Cmd) {
30 int ans;
31 if (strlen(Cmd)>0) {
32 ans = PSKDemod(Cmd, 0);
33 } else { //default to RF/32
34 ans = PSKDemod("32", 0);
35 }
36
37 if (!ans) {
38 if (g_debugMode) PrintAndLog("Error1: %i",ans);
39 return 0;
40 }
41 uint8_t invert=0;
42 size_t size = DemodBufferLen;
43 int startIdx = indala26decode(DemodBuffer, &size, &invert);
44 if (startIdx < 0 || size > 224) {
45 if (g_debugMode) PrintAndLog("Error2: %i",startIdx);
46 return -1;
47 }
48 setDemodBuf(DemodBuffer, size, (size_t)startIdx);
49 setClockGrid(g_DemodClock, g_DemodStartIdx + (startIdx*g_DemodClock));
50 if (invert)
51 if (g_debugMode)
52 PrintAndLog("Had to invert bits");
53
54 PrintAndLog("BitLen: %d",DemodBufferLen);
55 //convert UID to HEX
56 uint32_t uid1, uid2, uid3, uid4, uid5, uid6, uid7;
57 uid1=bytebits_to_byte(DemodBuffer,32);
58 uid2=bytebits_to_byte(DemodBuffer+32,32);
59 if (DemodBufferLen==64) {
60 PrintAndLog("Indala UID=%s (%x%08x)", sprint_bin_break(DemodBuffer,DemodBufferLen,16), uid1, uid2);
61 } else if (DemodBufferLen==224) {
62 uid3=bytebits_to_byte(DemodBuffer+64,32);
63 uid4=bytebits_to_byte(DemodBuffer+96,32);
64 uid5=bytebits_to_byte(DemodBuffer+128,32);
65 uid6=bytebits_to_byte(DemodBuffer+160,32);
66 uid7=bytebits_to_byte(DemodBuffer+192,32);
67 PrintAndLog("Indala UID=%s (%x%08x%08x%08x%08x%08x%08x)",
68 sprint_bin_break(DemodBuffer,DemodBufferLen,16), uid1, uid2, uid3, uid4, uid5, uid6, uid7);
69 }
70 if (g_debugMode) {
71 PrintAndLog("DEBUG: printing demodbuffer:");
72 printDemodBuff();
73 }
74 return 1;
75 }
76
77 int CmdIndalaRead(const char *Cmd) {
78 lf_read(true, 30000);
79 return CmdIndalaDecode("");
80 }
81
82 // older alternative indala demodulate (has some positives and negatives)
83 // returns false positives more often - but runs against more sets of samples
84 // poor psk signal can be difficult to demod this approach might succeed when the other fails
85 // but the other appears to currently be more accurate than this approach most of the time.
86 int CmdIndalaDemod(const char *Cmd) {
87 // Usage: recover 64bit UID by default, specify "224" as arg to recover a 224bit UID
88
89 int state = -1;
90 int count = 0;
91 int i, j;
92
93 // worst case with GraphTraceLen=64000 is < 4096
94 // under normal conditions it's < 2048
95
96 uint8_t rawbits[4096];
97 int rawbit = 0;
98 int worst = 0, worstPos = 0;
99 // PrintAndLog("Expecting a bit less than %d raw bits", GraphTraceLen / 32);
100
101 // loop through raw signal - since we know it is psk1 rf/32 fc/2 skip every other value (+=2)
102 for (i = 0; i < GraphTraceLen-1; i += 2) {
103 count += 1;
104 if ((GraphBuffer[i] > GraphBuffer[i + 1]) && (state != 1)) {
105 // appears redundant - marshmellow
106 if (state == 0) {
107 for (j = 0; j < count - 8; j += 16) {
108 rawbits[rawbit++] = 0;
109 }
110 if ((abs(count - j)) > worst) {
111 worst = abs(count - j);
112 worstPos = i;
113 }
114 }
115 state = 1;
116 count = 0;
117 } else if ((GraphBuffer[i] < GraphBuffer[i + 1]) && (state != 0)) {
118 //appears redundant
119 if (state == 1) {
120 for (j = 0; j < count - 8; j += 16) {
121 rawbits[rawbit++] = 1;
122 }
123 if ((abs(count - j)) > worst) {
124 worst = abs(count - j);
125 worstPos = i;
126 }
127 }
128 state = 0;
129 count = 0;
130 }
131 }
132
133 if (rawbit>0){
134 PrintAndLog("Recovered %d raw bits, expected: %d", rawbit, GraphTraceLen/32);
135 PrintAndLog("worst metric (0=best..7=worst): %d at pos %d", worst, worstPos);
136 } else {
137 return 0;
138 }
139
140 // Finding the start of a UID
141 int uidlen, long_wait;
142 if (strcmp(Cmd, "224") == 0) {
143 uidlen = 224;
144 long_wait = 30;
145 } else {
146 uidlen = 64;
147 long_wait = 29;
148 }
149
150 int start;
151 int first = 0;
152 for (start = 0; start <= rawbit - uidlen; start++) {
153 first = rawbits[start];
154 for (i = start; i < start + long_wait; i++) {
155 if (rawbits[i] != first) {
156 break;
157 }
158 }
159 if (i == (start + long_wait)) {
160 break;
161 }
162 }
163
164 if (start == rawbit - uidlen + 1) {
165 PrintAndLog("nothing to wait for");
166 return 0;
167 }
168
169 // Inverting signal if needed
170 if (first == 1) {
171 for (i = start; i < rawbit; i++) {
172 rawbits[i] = !rawbits[i];
173 }
174 }
175
176 // Dumping UID
177 uint8_t bits[224] = {0x00};
178 char showbits[225] = {0x00};
179 int bit;
180 i = start;
181 int times = 0;
182
183 if (uidlen > rawbit) {
184 PrintAndLog("Warning: not enough raw bits to get a full UID");
185 for (bit = 0; bit < rawbit; bit++) {
186 bits[bit] = rawbits[i++];
187 // As we cannot know the parity, let's use "." and "/"
188 showbits[bit] = '.' + bits[bit];
189 }
190 showbits[bit+1]='\0';
191 PrintAndLog("Partial UID=%s", showbits);
192 return 0;
193 } else {
194 for (bit = 0; bit < uidlen; bit++) {
195 bits[bit] = rawbits[i++];
196 showbits[bit] = '0' + bits[bit];
197 }
198 times = 1;
199 }
200
201 //convert UID to HEX
202 uint32_t uid1, uid2, uid3, uid4, uid5, uid6, uid7;
203 int idx;
204 uid1 = uid2 = 0;
205
206 if (uidlen==64){
207 for( idx=0; idx<64; idx++) {
208 if (showbits[idx] == '0') {
209 uid1=(uid1<<1)|(uid2>>31);
210 uid2=(uid2<<1)|0;
211 } else {
212 uid1=(uid1<<1)|(uid2>>31);
213 uid2=(uid2<<1)|1;
214 }
215 }
216 PrintAndLog("UID=%s (%x%08x)", showbits, uid1, uid2);
217 }
218 else {
219 uid3 = uid4 = uid5 = uid6 = uid7 = 0;
220
221 for( idx=0; idx<224; idx++) {
222 uid1=(uid1<<1)|(uid2>>31);
223 uid2=(uid2<<1)|(uid3>>31);
224 uid3=(uid3<<1)|(uid4>>31);
225 uid4=(uid4<<1)|(uid5>>31);
226 uid5=(uid5<<1)|(uid6>>31);
227 uid6=(uid6<<1)|(uid7>>31);
228
229 if (showbits[idx] == '0')
230 uid7 = (uid7<<1) | 0;
231 else
232 uid7 = (uid7<<1) | 1;
233 }
234 PrintAndLog("UID=%s (%x%08x%08x%08x%08x%08x%08x)", showbits, uid1, uid2, uid3, uid4, uid5, uid6, uid7);
235 }
236
237 // Checking UID against next occurrences
238 int failed = 0;
239 for (; i + uidlen <= rawbit;) {
240 failed = 0;
241 for (bit = 0; bit < uidlen; bit++) {
242 if (bits[bit] != rawbits[i++]) {
243 failed = 1;
244 break;
245 }
246 }
247 if (failed == 1) {
248 break;
249 }
250 times += 1;
251 }
252
253 PrintAndLog("Occurrences: %d (expected %d)", times, (rawbit - start) / uidlen);
254
255 // Remodulating for tag cloning
256 // HACK: 2015-01-04 this will have an impact on our new way of seening lf commands (demod)
257 // since this changes graphbuffer data.
258 GraphTraceLen = 32*uidlen;
259 i = 0;
260 int phase = 0;
261 for (bit = 0; bit < uidlen; bit++) {
262 if (bits[bit] == 0) {
263 phase = 0;
264 } else {
265 phase = 1;
266 }
267 int j;
268 for (j = 0; j < 32; j++) {
269 GraphBuffer[i++] = phase;
270 phase = !phase;
271 }
272 }
273
274 RepaintGraphWindow();
275 return 1;
276 }
277
278 int CmdIndalaClone(const char *Cmd) {
279 UsbCommand c;
280 unsigned int uid1, uid2, uid3, uid4, uid5, uid6, uid7;
281
282 uid1 = uid2 = uid3 = uid4 = uid5 = uid6 = uid7 = 0;
283 int n = 0, i = 0;
284
285 if (strchr(Cmd,'l') != 0) {
286 while (sscanf(&Cmd[i++], "%1x", &n ) == 1) {
287 uid1 = (uid1 << 4) | (uid2 >> 28);
288 uid2 = (uid2 << 4) | (uid3 >> 28);
289 uid3 = (uid3 << 4) | (uid4 >> 28);
290 uid4 = (uid4 << 4) | (uid5 >> 28);
291 uid5 = (uid5 << 4) | (uid6 >> 28);
292 uid6 = (uid6 << 4) | (uid7 >> 28);
293 uid7 = (uid7 << 4) | (n & 0xf);
294 }
295 PrintAndLog("Cloning 224bit tag with UID %x%08x%08x%08x%08x%08x%08x", uid1, uid2, uid3, uid4, uid5, uid6, uid7);
296 c.cmd = CMD_INDALA_CLONE_TAG_L;
297 c.d.asDwords[0] = uid1;
298 c.d.asDwords[1] = uid2;
299 c.d.asDwords[2] = uid3;
300 c.d.asDwords[3] = uid4;
301 c.d.asDwords[4] = uid5;
302 c.d.asDwords[5] = uid6;
303 c.d.asDwords[6] = uid7;
304 } else {
305 while (sscanf(&Cmd[i++], "%1x", &n ) == 1) {
306 uid1 = (uid1 << 4) | (uid2 >> 28);
307 uid2 = (uid2 << 4) | (n & 0xf);
308 }
309 PrintAndLog("Cloning 64bit tag with UID %x%08x", uid1, uid2);
310 c.cmd = CMD_INDALA_CLONE_TAG;
311 c.arg[0] = uid1;
312 c.arg[1] = uid2;
313 }
314
315 clearCommandBuffer();
316 SendCommand(&c);
317 return 0;
318 }
319
320 static command_t CommandTable[] = {
321 {"help", CmdHelp, 1, "This help"},
322 {"demod", CmdIndalaDecode, 1, "[clock] [invert<0|1>] -- Demodulate an indala tag (PSK1) from GraphBuffer (args optional)"},
323 {"read", CmdIndalaRead, 0, "Read an Indala Prox tag from the antenna"},
324 {"clone", CmdIndalaClone, 0, "<UID> ['l']-- Clone Indala to T55x7 (tag must be on antenna)(UID in HEX)(option 'l' for 224 UID"},
325 {"altdemod", CmdIndalaDemod, 1, "['224'] -- Alternative method to Demodulate samples for Indala 64 bit UID (option '224' for 224 bit)"},
326 //{"sim", CmdIndalaSim, 0, "<ID> -- indala tag simulator"},
327 {NULL, NULL, 0, NULL}
328 };
329
330 int CmdLFINDALA(const char *Cmd) {
331 CmdsParse(CommandTable, Cmd);
332 return 0;
333 }
334
335 int CmdHelp(const char *Cmd) {
336 CmdsHelp(CommandTable);
337 return 0;
338 }
Impressum, Datenschutz