]>
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 | // Low frequency commands | |
9 | //----------------------------------------------------------------------------- | |
10 | ||
7fe9b0b7 | 11 | #include <stdio.h> |
590f8ff9 | 12 | #include <stdlib.h> |
7fe9b0b7 | 13 | #include <string.h> |
393c3ef9 | 14 | #include <limits.h> |
902cb3c0 | 15 | #include "proxmark3.h" |
7fe9b0b7 | 16 | #include "data.h" |
17 | #include "graph.h" | |
18 | #include "ui.h" | |
19 | #include "cmdparser.h" | |
040a7baa | 20 | #include "cmdmain.h" |
7fe9b0b7 | 21 | #include "cmddata.h" |
31d1caa5 | 22 | #include "util.h" |
7fe9b0b7 | 23 | #include "cmdlf.h" |
24 | #include "cmdlfhid.h" | |
25 | #include "cmdlfti.h" | |
26 | #include "cmdlfem4x.h" | |
db09cb3a | 27 | #include "cmdlfhitag.h" |
54a942b0 | 28 | #include "cmdlft55xx.h" |
29 | #include "cmdlfpcf7931.h" | |
a1f3bb12 | 30 | #include "cmdlfio.h" |
7fe9b0b7 | 31 | |
32 | static int CmdHelp(const char *Cmd); | |
33 | ||
34 | /* send a command before reading */ | |
35 | int CmdLFCommandRead(const char *Cmd) | |
36 | { | |
37 | static char dummy[3]; | |
38 | ||
39 | dummy[0]= ' '; | |
40 | ||
41 | UsbCommand c = {CMD_MOD_THEN_ACQUIRE_RAW_ADC_SAMPLES_125K}; | |
1a07fd51 | 42 | sscanf(Cmd, "%"lli" %"lli" %"lli" %s %s", &c.arg[0], &c.arg[1], &c.arg[2],(char*)(&c.d.asBytes),(char*)(&dummy+1)); |
7fe9b0b7 | 43 | // in case they specified 'h' |
44 | strcpy((char *)&c.d.asBytes + strlen((char *)c.d.asBytes), dummy); | |
45 | SendCommand(&c); | |
46 | return 0; | |
47 | } | |
48 | ||
49 | int CmdFlexdemod(const char *Cmd) | |
50 | { | |
51 | int i; | |
52 | for (i = 0; i < GraphTraceLen; ++i) { | |
53 | if (GraphBuffer[i] < 0) { | |
54 | GraphBuffer[i] = -1; | |
55 | } else { | |
56 | GraphBuffer[i] = 1; | |
57 | } | |
58 | } | |
59 | ||
60 | #define LONG_WAIT 100 | |
61 | int start; | |
62 | for (start = 0; start < GraphTraceLen - LONG_WAIT; start++) { | |
63 | int first = GraphBuffer[start]; | |
64 | for (i = start; i < start + LONG_WAIT; i++) { | |
65 | if (GraphBuffer[i] != first) { | |
66 | break; | |
67 | } | |
68 | } | |
69 | if (i == (start + LONG_WAIT)) { | |
70 | break; | |
71 | } | |
72 | } | |
73 | if (start == GraphTraceLen - LONG_WAIT) { | |
74 | PrintAndLog("nothing to wait for"); | |
75 | return 0; | |
76 | } | |
77 | ||
78 | GraphBuffer[start] = 2; | |
79 | GraphBuffer[start+1] = -2; | |
3fe4ff4f | 80 | uint8_t bits[64] = {0x00}; |
7fe9b0b7 | 81 | |
3fe4ff4f | 82 | int bit, sum; |
7fe9b0b7 | 83 | i = start; |
84 | for (bit = 0; bit < 64; bit++) { | |
3fe4ff4f | 85 | sum = 0; |
86 | for (int j = 0; j < 16; j++) { | |
7fe9b0b7 | 87 | sum += GraphBuffer[i++]; |
88 | } | |
3fe4ff4f | 89 | |
90 | bits[bit] = (sum > 0) ? 1 : 0; | |
91 | ||
7fe9b0b7 | 92 | PrintAndLog("bit %d sum %d", bit, sum); |
93 | } | |
94 | ||
95 | for (bit = 0; bit < 64; bit++) { | |
96 | int j; | |
97 | int sum = 0; | |
98 | for (j = 0; j < 16; j++) { | |
99 | sum += GraphBuffer[i++]; | |
100 | } | |
101 | if (sum > 0 && bits[bit] != 1) { | |
102 | PrintAndLog("oops1 at %d", bit); | |
103 | } | |
104 | if (sum < 0 && bits[bit] != 0) { | |
105 | PrintAndLog("oops2 at %d", bit); | |
106 | } | |
107 | } | |
108 | ||
3fe4ff4f | 109 | // HACK writing back to graphbuffer. |
7fe9b0b7 | 110 | GraphTraceLen = 32*64; |
111 | i = 0; | |
112 | int phase = 0; | |
113 | for (bit = 0; bit < 64; bit++) { | |
3fe4ff4f | 114 | |
115 | phase = (bits[bit] == 0) ? 0 : 1; | |
116 | ||
7fe9b0b7 | 117 | int j; |
118 | for (j = 0; j < 32; j++) { | |
119 | GraphBuffer[i++] = phase; | |
120 | phase = !phase; | |
121 | } | |
122 | } | |
123 | ||
124 | RepaintGraphWindow(); | |
125 | return 0; | |
126 | } | |
a1f3bb12 | 127 | |
7fe9b0b7 | 128 | int CmdIndalaDemod(const char *Cmd) |
129 | { | |
130 | // Usage: recover 64bit UID by default, specify "224" as arg to recover a 224bit UID | |
131 | ||
132 | int state = -1; | |
133 | int count = 0; | |
134 | int i, j; | |
3fe4ff4f | 135 | |
7fe9b0b7 | 136 | // worst case with GraphTraceLen=64000 is < 4096 |
137 | // under normal conditions it's < 2048 | |
3fe4ff4f | 138 | |
7fe9b0b7 | 139 | uint8_t rawbits[4096]; |
140 | int rawbit = 0; | |
141 | int worst = 0, worstPos = 0; | |
d5a72d2f | 142 | // PrintAndLog("Expecting a bit less than %d raw bits", GraphTraceLen / 32); |
7fe9b0b7 | 143 | for (i = 0; i < GraphTraceLen-1; i += 2) { |
144 | count += 1; | |
145 | if ((GraphBuffer[i] > GraphBuffer[i + 1]) && (state != 1)) { | |
146 | if (state == 0) { | |
147 | for (j = 0; j < count - 8; j += 16) { | |
148 | rawbits[rawbit++] = 0; | |
149 | } | |
150 | if ((abs(count - j)) > worst) { | |
151 | worst = abs(count - j); | |
152 | worstPos = i; | |
153 | } | |
154 | } | |
155 | state = 1; | |
156 | count = 0; | |
157 | } else if ((GraphBuffer[i] < GraphBuffer[i + 1]) && (state != 0)) { | |
158 | if (state == 1) { | |
159 | for (j = 0; j < count - 8; j += 16) { | |
160 | rawbits[rawbit++] = 1; | |
161 | } | |
162 | if ((abs(count - j)) > worst) { | |
163 | worst = abs(count - j); | |
164 | worstPos = i; | |
165 | } | |
166 | } | |
167 | state = 0; | |
168 | count = 0; | |
169 | } | |
170 | } | |
3fe4ff4f | 171 | |
d5a72d2f | 172 | if (rawbit>0){ |
173 | PrintAndLog("Recovered %d raw bits, expected: %d", rawbit, GraphTraceLen/32); | |
174 | PrintAndLog("worst metric (0=best..7=worst): %d at pos %d", worst, worstPos); | |
3fe4ff4f | 175 | } else { |
176 | return 0; | |
177 | } | |
178 | ||
7fe9b0b7 | 179 | // Finding the start of a UID |
180 | int uidlen, long_wait; | |
181 | if (strcmp(Cmd, "224") == 0) { | |
182 | uidlen = 224; | |
183 | long_wait = 30; | |
184 | } else { | |
185 | uidlen = 64; | |
186 | long_wait = 29; | |
187 | } | |
3fe4ff4f | 188 | |
7fe9b0b7 | 189 | int start; |
190 | int first = 0; | |
191 | for (start = 0; start <= rawbit - uidlen; start++) { | |
192 | first = rawbits[start]; | |
193 | for (i = start; i < start + long_wait; i++) { | |
194 | if (rawbits[i] != first) { | |
195 | break; | |
196 | } | |
197 | } | |
198 | if (i == (start + long_wait)) { | |
199 | break; | |
200 | } | |
201 | } | |
3fe4ff4f | 202 | |
7fe9b0b7 | 203 | if (start == rawbit - uidlen + 1) { |
204 | PrintAndLog("nothing to wait for"); | |
205 | return 0; | |
206 | } | |
207 | ||
208 | // Inverting signal if needed | |
209 | if (first == 1) { | |
210 | for (i = start; i < rawbit; i++) { | |
211 | rawbits[i] = !rawbits[i]; | |
212 | } | |
213 | } | |
214 | ||
215 | // Dumping UID | |
3fe4ff4f | 216 | uint8_t bits[224] = {0x00}; |
217 | char showbits[225] = {0x00}; | |
7fe9b0b7 | 218 | int bit; |
219 | i = start; | |
220 | int times = 0; | |
3fe4ff4f | 221 | |
7fe9b0b7 | 222 | if (uidlen > rawbit) { |
223 | PrintAndLog("Warning: not enough raw bits to get a full UID"); | |
224 | for (bit = 0; bit < rawbit; bit++) { | |
225 | bits[bit] = rawbits[i++]; | |
226 | // As we cannot know the parity, let's use "." and "/" | |
227 | showbits[bit] = '.' + bits[bit]; | |
228 | } | |
229 | showbits[bit+1]='\0'; | |
230 | PrintAndLog("Partial UID=%s", showbits); | |
231 | return 0; | |
232 | } else { | |
233 | for (bit = 0; bit < uidlen; bit++) { | |
234 | bits[bit] = rawbits[i++]; | |
235 | showbits[bit] = '0' + bits[bit]; | |
236 | } | |
237 | times = 1; | |
238 | } | |
2414f978 | 239 | |
240 | //convert UID to HEX | |
241 | uint32_t uid1, uid2, uid3, uid4, uid5, uid6, uid7; | |
242 | int idx; | |
3fe4ff4f | 243 | uid1 = uid2 = 0; |
244 | ||
2414f978 | 245 | if (uidlen==64){ |
246 | for( idx=0; idx<64; idx++) { | |
247 | if (showbits[idx] == '0') { | |
248 | uid1=(uid1<<1)|(uid2>>31); | |
249 | uid2=(uid2<<1)|0; | |
250 | } else { | |
251 | uid1=(uid1<<1)|(uid2>>31); | |
252 | uid2=(uid2<<1)|1; | |
253 | } | |
254 | } | |
255 | PrintAndLog("UID=%s (%x%08x)", showbits, uid1, uid2); | |
256 | } | |
257 | else { | |
3fe4ff4f | 258 | uid3 = uid4 = uid5 = uid6 = uid7 = 0; |
259 | ||
2414f978 | 260 | for( idx=0; idx<224; idx++) { |
261 | uid1=(uid1<<1)|(uid2>>31); | |
262 | uid2=(uid2<<1)|(uid3>>31); | |
263 | uid3=(uid3<<1)|(uid4>>31); | |
264 | uid4=(uid4<<1)|(uid5>>31); | |
265 | uid5=(uid5<<1)|(uid6>>31); | |
266 | uid6=(uid6<<1)|(uid7>>31); | |
3fe4ff4f | 267 | |
268 | if (showbits[idx] == '0') | |
269 | uid7 = (uid7<<1) | 0; | |
270 | else | |
271 | uid7 = (uid7<<1) | 1; | |
2414f978 | 272 | } |
273 | PrintAndLog("UID=%s (%x%08x%08x%08x%08x%08x%08x)", showbits, uid1, uid2, uid3, uid4, uid5, uid6, uid7); | |
274 | } | |
7fe9b0b7 | 275 | |
0ff9a939 | 276 | // Checking UID against next occurrences |
7fe9b0b7 | 277 | int failed = 0; |
3fe4ff4f | 278 | for (; i + uidlen <= rawbit;) { |
279 | failed = 0; | |
7fe9b0b7 | 280 | for (bit = 0; bit < uidlen; bit++) { |
281 | if (bits[bit] != rawbits[i++]) { | |
282 | failed = 1; | |
283 | break; | |
284 | } | |
285 | } | |
286 | if (failed == 1) { | |
287 | break; | |
288 | } | |
289 | times += 1; | |
290 | } | |
3fe4ff4f | 291 | |
0ff9a939 | 292 | PrintAndLog("Occurrences: %d (expected %d)", times, (rawbit - start) / uidlen); |
7fe9b0b7 | 293 | |
294 | // Remodulating for tag cloning | |
3fe4ff4f | 295 | // HACK: 2015-01-04 this will have an impact on our new way of seening lf commands (demod) |
296 | // since this changes graphbuffer data. | |
7fe9b0b7 | 297 | GraphTraceLen = 32*uidlen; |
298 | i = 0; | |
299 | int phase = 0; | |
300 | for (bit = 0; bit < uidlen; bit++) { | |
301 | if (bits[bit] == 0) { | |
302 | phase = 0; | |
303 | } else { | |
304 | phase = 1; | |
305 | } | |
306 | int j; | |
307 | for (j = 0; j < 32; j++) { | |
308 | GraphBuffer[i++] = phase; | |
309 | phase = !phase; | |
310 | } | |
311 | } | |
312 | ||
313 | RepaintGraphWindow(); | |
d5a72d2f | 314 | return 1; |
7fe9b0b7 | 315 | } |
316 | ||
2414f978 | 317 | int CmdIndalaClone(const char *Cmd) |
318 | { | |
2414f978 | 319 | UsbCommand c; |
3fe4ff4f | 320 | unsigned int uid1, uid2, uid3, uid4, uid5, uid6, uid7; |
321 | ||
322 | uid1 = uid2 = uid3 = uid4 = uid5 = uid6 = uid7 = 0; | |
2414f978 | 323 | int n = 0, i = 0; |
324 | ||
325 | if (strchr(Cmd,'l') != 0) { | |
326 | while (sscanf(&Cmd[i++], "%1x", &n ) == 1) { | |
327 | uid1 = (uid1 << 4) | (uid2 >> 28); | |
328 | uid2 = (uid2 << 4) | (uid3 >> 28); | |
329 | uid3 = (uid3 << 4) | (uid4 >> 28); | |
330 | uid4 = (uid4 << 4) | (uid5 >> 28); | |
331 | uid5 = (uid5 << 4) | (uid6 >> 28); | |
332 | uid6 = (uid6 << 4) | (uid7 >> 28); | |
333 | uid7 = (uid7 << 4) | (n & 0xf); | |
334 | } | |
335 | PrintAndLog("Cloning 224bit tag with UID %x%08x%08x%08x%08x%08x%08x", uid1, uid2, uid3, uid4, uid5, uid6, uid7); | |
336 | c.cmd = CMD_INDALA_CLONE_TAG_L; | |
337 | c.d.asDwords[0] = uid1; | |
338 | c.d.asDwords[1] = uid2; | |
339 | c.d.asDwords[2] = uid3; | |
340 | c.d.asDwords[3] = uid4; | |
341 | c.d.asDwords[4] = uid5; | |
342 | c.d.asDwords[5] = uid6; | |
343 | c.d.asDwords[6] = uid7; | |
3fe4ff4f | 344 | } else { |
2414f978 | 345 | while (sscanf(&Cmd[i++], "%1x", &n ) == 1) { |
346 | uid1 = (uid1 << 4) | (uid2 >> 28); | |
347 | uid2 = (uid2 << 4) | (n & 0xf); | |
348 | } | |
349 | PrintAndLog("Cloning 64bit tag with UID %x%08x", uid1, uid2); | |
350 | c.cmd = CMD_INDALA_CLONE_TAG; | |
351 | c.arg[0] = uid1; | |
352 | c.arg[1] = uid2; | |
353 | } | |
354 | ||
355 | SendCommand(&c); | |
356 | return 0; | |
357 | } | |
358 | ||
31abe49f | 359 | int usage_lf_read() |
f6d9fb17 | 360 | { |
31abe49f | 361 | PrintAndLog("Usage: lf read"); |
f6d9fb17 MHS |
362 | PrintAndLog("Options: "); |
363 | PrintAndLog(" h This help"); | |
31abe49f MHS |
364 | PrintAndLog("This function takes no arguments. "); |
365 | PrintAndLog("Use 'lf config' to set parameters."); | |
366 | return 0; | |
367 | } | |
368 | int usage_lf_snoop() | |
369 | { | |
370 | PrintAndLog("Usage: lf snoop"); | |
371 | PrintAndLog("Options: "); | |
372 | PrintAndLog(" h This help"); | |
373 | PrintAndLog("This function takes no arguments. "); | |
374 | PrintAndLog("Use 'lf config' to set parameters."); | |
375 | return 0; | |
376 | } | |
377 | ||
378 | int usage_lf_config() | |
379 | { | |
380 | PrintAndLog("Usage: lf config [H|<divisor>] [b <bps>] [d <decim>] [a 0|1]"); | |
381 | PrintAndLog("Options: "); | |
382 | PrintAndLog(" h This help"); | |
383 | PrintAndLog(" L Low frequency (125 KHz)"); | |
384 | PrintAndLog(" H High frequency (134 KHz)"); | |
385 | PrintAndLog(" q <divisor> Manually set divisor. 88-> 134KHz, 95-> 125 Hz"); | |
386 | PrintAndLog(" b <bps> Sets resolution of bits per sample. Default (max): 8"); | |
387 | PrintAndLog(" d <decim> Sets decimation. A value of N saves only 1 in N samples. Default: 1"); | |
388 | PrintAndLog(" a [0|1] Averaging - if set, will average the stored sample value when decimating. Default: 1"); | |
389 | PrintAndLog(" t <threshold> Sets trigger threshold. 0 means no threshold"); | |
f6d9fb17 | 390 | PrintAndLog("Examples:"); |
31abe49f | 391 | PrintAndLog(" lf config b 8 L"); |
f6d9fb17 | 392 | PrintAndLog(" Samples at 125KHz, 8bps."); |
31abe49f | 393 | PrintAndLog(" lf config H b 4 d 3"); |
f6d9fb17 MHS |
394 | PrintAndLog(" Samples at 134KHz, averages three samples into one, stored with "); |
395 | PrintAndLog(" a resolution of 4 bits per sample."); | |
31abe49f MHS |
396 | PrintAndLog(" lf read"); |
397 | PrintAndLog(" Performs a read (active field)"); | |
398 | PrintAndLog(" lf snoop"); | |
399 | PrintAndLog(" Performs a snoop (no active field)"); | |
f6d9fb17 MHS |
400 | return 0; |
401 | } | |
31abe49f MHS |
402 | |
403 | int CmdLFSetConfig(const char *Cmd) | |
7fe9b0b7 | 404 | { |
31abe49f MHS |
405 | |
406 | uint8_t divisor = 0;//Frequency divisor | |
407 | uint8_t bps = 0; // Bits per sample | |
408 | uint8_t decimation = 0; //How many to keep | |
409 | bool averaging = 1; // Defaults to true | |
f6d9fb17 | 410 | bool errors = FALSE; |
31abe49f MHS |
411 | int trigger_threshold =-1;//Means no change |
412 | uint8_t unsigned_trigg = 0; | |
f6d9fb17 MHS |
413 | |
414 | uint8_t cmdp =0; | |
31abe49f | 415 | while(param_getchar(Cmd, cmdp) != 0x00) |
f6d9fb17 | 416 | { |
31abe49f MHS |
417 | switch(param_getchar(Cmd, cmdp)) |
418 | { | |
419 | case 'h': | |
420 | return usage_lf_config(); | |
421 | case 'H': | |
422 | divisor = 88; | |
423 | cmdp++; | |
424 | break; | |
425 | case 'L': | |
426 | divisor = 95; | |
427 | cmdp++; | |
428 | break; | |
429 | case 'q': | |
430 | errors |= param_getdec(Cmd,cmdp+1,&divisor); | |
431 | cmdp+=2; | |
432 | break; | |
433 | case 't': | |
434 | errors |= param_getdec(Cmd,cmdp+1,&unsigned_trigg); | |
435 | cmdp+=2; | |
436 | if(!errors) trigger_threshold = unsigned_trigg; | |
437 | break; | |
438 | case 'b': | |
439 | errors |= param_getdec(Cmd,cmdp+1,&bps); | |
440 | cmdp+=2; | |
441 | break; | |
442 | case 'd': | |
443 | errors |= param_getdec(Cmd,cmdp+1,&decimation); | |
444 | cmdp+=2; | |
445 | break; | |
446 | case 'a': | |
447 | averaging = param_getchar(Cmd,cmdp+1) == '1'; | |
448 | cmdp+=2; | |
449 | break; | |
450 | default: | |
451 | PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp)); | |
452 | errors = 1; | |
453 | break; | |
454 | } | |
455 | if(errors) break; | |
f6d9fb17 | 456 | } |
31abe49f | 457 | if(cmdp == 0) |
f6d9fb17 | 458 | { |
31abe49f | 459 | errors = 1;// No args |
f6d9fb17 | 460 | } |
31abe49f | 461 | |
f6d9fb17 MHS |
462 | //Validations |
463 | if(errors) | |
464 | { | |
31abe49f | 465 | return usage_lf_config(); |
f6d9fb17 | 466 | } |
f6d9fb17 | 467 | //Bps is limited to 8, so fits in lower half of arg1 |
31abe49f | 468 | if(bps >> 8) bps = 8; |
f6d9fb17 | 469 | |
31abe49f MHS |
470 | sample_config config = { |
471 | decimation,bps,averaging,divisor,trigger_threshold | |
472 | }; | |
473 | //Averaging is a flag on high-bit of arg[1] | |
474 | UsbCommand c = {CMD_SET_LF_SAMPLING_CONFIG}; | |
475 | memcpy(c.d.asBytes,&config,sizeof(sample_config)); | |
476 | SendCommand(&c); | |
477 | return 0; | |
478 | } | |
f6d9fb17 | 479 | |
7fe9b0b7 | 480 | int CmdLFRead(const char *Cmd) |
481 | { | |
31abe49f MHS |
482 | |
483 | uint8_t cmdp =0; | |
484 | if(param_getchar(Cmd, cmdp) == 'h') | |
485 | { | |
486 | return usage_lf_read(); | |
487 | } | |
f6d9fb17 | 488 | //And ship it to device |
f6d9fb17 | 489 | UsbCommand c = {CMD_ACQUIRE_RAW_ADC_SAMPLES_125K}; |
31abe49f | 490 | SendCommand(&c); |
68008fb5 | 491 | //WaitForResponse(CMD_ACK,NULL); |
492 | if ( !WaitForResponseTimeout(CMD_ACK,NULL,2500) ) { | |
493 | PrintAndLog("command execution time out"); | |
494 | return 1; | |
495 | } | |
496 | ||
31abe49f MHS |
497 | return 0; |
498 | } | |
f6d9fb17 | 499 | |
31abe49f MHS |
500 | int CmdLFSnoop(const char *Cmd) |
501 | { | |
502 | uint8_t cmdp =0; | |
503 | if(param_getchar(Cmd, cmdp) == 'h') | |
504 | { | |
505 | return usage_lf_snoop(); | |
506 | } | |
507 | ||
508 | UsbCommand c = {CMD_LF_SNOOP_RAW_ADC_SAMPLES}; | |
f6d9fb17 MHS |
509 | SendCommand(&c); |
510 | WaitForResponse(CMD_ACK,NULL); | |
511 | return 0; | |
7fe9b0b7 | 512 | } |
513 | ||
514 | static void ChkBitstream(const char *str) | |
515 | { | |
516 | int i; | |
517 | ||
518 | /* convert to bitstream if necessary */ | |
b915fda3 | 519 | for (i = 0; i < (int)(GraphTraceLen / 2); i++){ |
520 | if (GraphBuffer[i] > 1 || GraphBuffer[i] < 0) { | |
7fe9b0b7 | 521 | CmdBitstream(str); |
522 | break; | |
523 | } | |
524 | } | |
525 | } | |
1e090a61 | 526 | //appears to attempt to simulate manchester |
7fe9b0b7 | 527 | int CmdLFSim(const char *Cmd) |
528 | { | |
52ab55ab | 529 | int i,j; |
7fe9b0b7 | 530 | static int gap; |
531 | ||
532 | sscanf(Cmd, "%i", &gap); | |
533 | ||
534 | /* convert to bitstream if necessary */ | |
535 | ChkBitstream(Cmd); | |
536 | ||
52ab55ab | 537 | printf("Sending [%d bytes]", GraphTraceLen); |
538 | for (i = 0; i < GraphTraceLen; i += USB_CMD_DATA_SIZE) { | |
7fe9b0b7 | 539 | UsbCommand c={CMD_DOWNLOADED_SIM_SAMPLES_125K, {i, 0, 0}}; |
52ab55ab | 540 | |
541 | for (j = 0; j < USB_CMD_DATA_SIZE; j++) { | |
7fe9b0b7 | 542 | c.d.asBytes[j] = GraphBuffer[i+j]; |
543 | } | |
544 | SendCommand(&c); | |
902cb3c0 | 545 | WaitForResponse(CMD_ACK,NULL); |
52ab55ab | 546 | printf("."); |
7fe9b0b7 | 547 | } |
548 | ||
52ab55ab | 549 | printf("\n"); |
550 | PrintAndLog("Starting to simulate"); | |
7fe9b0b7 | 551 | UsbCommand c = {CMD_SIMULATE_TAG_125K, {GraphTraceLen, gap, 0}}; |
552 | SendCommand(&c); | |
553 | return 0; | |
554 | } | |
555 | ||
556 | int CmdLFSimBidir(const char *Cmd) | |
557 | { | |
3fe4ff4f | 558 | // Set ADC to twice the carrier for a slight supersampling |
559 | // HACK: not implemented in ARMSRC. | |
560 | PrintAndLog("Not implemented yet."); | |
7fe9b0b7 | 561 | UsbCommand c = {CMD_LF_SIMULATE_BIDIR, {47, 384, 0}}; |
562 | SendCommand(&c); | |
563 | return 0; | |
564 | } | |
565 | ||
566 | /* simulate an LF Manchester encoded tag with specified bitstream, clock rate and inter-id gap */ | |
567 | int CmdLFSimManchester(const char *Cmd) | |
568 | { | |
569 | static int clock, gap; | |
570 | static char data[1024], gapstring[8]; | |
571 | ||
7fe9b0b7 | 572 | sscanf(Cmd, "%i %s %i", &clock, &data[0], &gap); |
573 | ||
7fe9b0b7 | 574 | ClearGraph(0); |
575 | ||
7fe9b0b7 | 576 | for (int i = 0; i < strlen(data) ; ++i) |
577 | AppendGraph(0, clock, data[i]- '0'); | |
578 | ||
7fe9b0b7 | 579 | CmdManchesterMod(""); |
580 | ||
7fe9b0b7 | 581 | RepaintGraphWindow(); |
582 | ||
7fe9b0b7 | 583 | sprintf(&gapstring[0], "%i", gap); |
584 | CmdLFSim(gapstring); | |
585 | return 0; | |
586 | } | |
587 | ||
b014c96d | 588 | |
7fe9b0b7 | 589 | int CmdVchDemod(const char *Cmd) |
590 | { | |
591 | // Is this the entire sync pattern, or does this also include some | |
592 | // data bits that happen to be the same everywhere? That would be | |
593 | // lovely to know. | |
594 | static const int SyncPattern[] = { | |
595 | 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, | |
596 | 1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, | |
597 | 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, | |
598 | 1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, | |
599 | 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, | |
600 | 1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, | |
601 | 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, | |
602 | 1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, | |
603 | 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, | |
604 | 1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, | |
605 | }; | |
606 | ||
607 | // So first, we correlate for the sync pattern, and mark that. | |
608 | int bestCorrel = 0, bestPos = 0; | |
609 | int i; | |
610 | // It does us no good to find the sync pattern, with fewer than | |
611 | // 2048 samples after it... | |
612 | for (i = 0; i < (GraphTraceLen-2048); i++) { | |
613 | int sum = 0; | |
614 | int j; | |
615 | for (j = 0; j < arraylen(SyncPattern); j++) { | |
616 | sum += GraphBuffer[i+j]*SyncPattern[j]; | |
617 | } | |
618 | if (sum > bestCorrel) { | |
619 | bestCorrel = sum; | |
620 | bestPos = i; | |
621 | } | |
622 | } | |
623 | PrintAndLog("best sync at %d [metric %d]", bestPos, bestCorrel); | |
624 | ||
625 | char bits[257]; | |
626 | bits[256] = '\0'; | |
627 | ||
628 | int worst = INT_MAX; | |
fddf220a | 629 | int worstPos = 0; |
7fe9b0b7 | 630 | |
631 | for (i = 0; i < 2048; i += 8) { | |
632 | int sum = 0; | |
633 | int j; | |
634 | for (j = 0; j < 8; j++) { | |
635 | sum += GraphBuffer[bestPos+i+j]; | |
636 | } | |
637 | if (sum < 0) { | |
638 | bits[i/8] = '.'; | |
639 | } else { | |
640 | bits[i/8] = '1'; | |
641 | } | |
642 | if(abs(sum) < worst) { | |
643 | worst = abs(sum); | |
644 | worstPos = i; | |
645 | } | |
646 | } | |
647 | PrintAndLog("bits:"); | |
648 | PrintAndLog("%s", bits); | |
649 | PrintAndLog("worst metric: %d at pos %d", worst, worstPos); | |
650 | ||
651 | if (strcmp(Cmd, "clone")==0) { | |
652 | GraphTraceLen = 0; | |
653 | char *s; | |
654 | for(s = bits; *s; s++) { | |
655 | int j; | |
656 | for(j = 0; j < 16; j++) { | |
657 | GraphBuffer[GraphTraceLen++] = (*s == '1') ? 1 : 0; | |
658 | } | |
659 | } | |
660 | RepaintGraphWindow(); | |
661 | } | |
662 | return 0; | |
663 | } | |
664 | ||
d5a72d2f | 665 | //by marshmellow |
666 | int CmdLFfind(const char *Cmd) | |
667 | { | |
668 | int ans=0; | |
b4fb11ba | 669 | char cmdp = param_getchar(Cmd, 0); |
670 | char testRaw = param_getchar(Cmd, 1); | |
671 | if (strlen(Cmd) > 2 || cmdp == 'h' || cmdp == 'H') { | |
672 | PrintAndLog("Usage: lf search <0|1> [u]"); | |
673 | PrintAndLog(" <use data from Graphbuffer> , if not set, try reading data from tag."); | |
e770c648 | 674 | PrintAndLog(" [Search for Unknown tags] , if not set, reads only known tags."); |
b4fb11ba | 675 | PrintAndLog(""); |
676 | PrintAndLog(" sample: lf search = try reading data from tag & search for known tags"); | |
677 | PrintAndLog(" : lf search 1 = use data from GraphBuffer & search for known tags"); | |
e770c648 | 678 | PrintAndLog(" : lf search u = try reading data from tag & search for known and unknown tags"); |
679 | PrintAndLog(" : lf search 1 u = use data from GraphBuffer & search for known and unknown tags"); | |
680 | ||
b4fb11ba | 681 | return 0; |
682 | } | |
b915fda3 | 683 | |
b4fb11ba | 684 | if (!offline && (cmdp != '1')){ |
d5a72d2f | 685 | ans=CmdLFRead(""); |
84871873 | 686 | ans=CmdSamples("20000"); |
b4fb11ba | 687 | } else if (GraphTraceLen < 1000) { |
688 | PrintAndLog("Data in Graphbuffer was too small."); | |
689 | return 0; | |
d5a72d2f | 690 | } |
e770c648 | 691 | if (cmdp == 'u' || cmdp == 'U') testRaw = 'u'; |
84871873 | 692 | PrintAndLog("NOTE: some demods output possible binary\n if it finds something that looks like a tag"); |
e770c648 | 693 | PrintAndLog("False Positives ARE possible\n"); |
ec75f5c1 | 694 | PrintAndLog("\nChecking for known tags:\n"); |
d5a72d2f | 695 | ans=CmdFSKdemodIO(""); |
84871873 | 696 | if (ans>0) { |
ec75f5c1 | 697 | PrintAndLog("\nValid IO Prox ID Found!"); |
84871873 | 698 | return 1; |
699 | } | |
ec75f5c1 | 700 | ans=CmdFSKdemodPyramid(""); |
1e090a61 | 701 | if (ans>0) { |
ec75f5c1 | 702 | PrintAndLog("\nValid Pyramid ID Found!"); |
1e090a61 | 703 | return 1; |
704 | } | |
ec75f5c1 | 705 | ans=CmdFSKdemodParadox(""); |
1e090a61 | 706 | if (ans>0) { |
ec75f5c1 | 707 | PrintAndLog("\nValid Paradox ID Found!"); |
708 | return 1; | |
709 | } | |
710 | ans=CmdFSKdemodAWID(""); | |
711 | if (ans>0) { | |
712 | PrintAndLog("\nValid AWID ID Found!"); | |
1e090a61 | 713 | return 1; |
714 | } | |
84871873 | 715 | ans=CmdFSKdemodHID(""); |
716 | if (ans>0) { | |
ec75f5c1 | 717 | PrintAndLog("\nValid HID Prox ID Found!"); |
84871873 | 718 | return 1; |
719 | } | |
d5a72d2f | 720 | //add psk and indala |
ec75f5c1 | 721 | ans=CmdIndalaDecode(""); |
84871873 | 722 | if (ans>0) { |
ec75f5c1 | 723 | PrintAndLog("\nValid Indala ID Found!"); |
84871873 | 724 | return 1; |
725 | } | |
e770c648 | 726 | ans=CmdAskEM410xDemod(""); |
84871873 | 727 | if (ans>0) { |
ec75f5c1 | 728 | PrintAndLog("\nValid EM410x ID Found!"); |
84871873 | 729 | return 1; |
730 | } | |
e770c648 | 731 | PrintAndLog("\nNo Known Tags Found!\n"); |
732 | if (testRaw=='u' || testRaw=='U'){ | |
733 | //test unknown tag formats (raw mode) | |
734 | PrintAndLog("\nChecking for Unknown tags:\n"); | |
f3bf15e4 | 735 | ans=CmdDetectClockRate("f"); |
736 | if (ans != 0){ //fsk | |
e770c648 | 737 | ans=CmdFSKrawdemod(""); |
738 | if (ans>0) { | |
739 | PrintAndLog("\nUnknown FSK Modulated Tag Found!"); | |
740 | return 1; | |
b4fb11ba | 741 | } |
e770c648 | 742 | } |
743 | ans=Cmdaskmandemod(""); | |
744 | if (ans>0) { | |
745 | PrintAndLog("\nUnknown ASK Modulated and Manchester encoded Tag Found!"); | |
746 | return 1; | |
b4fb11ba | 747 | } |
e770c648 | 748 | ans=CmdPSK1rawDemod(""); |
749 | if (ans>0) { | |
750 | PrintAndLog("Possible unknown PSK1 Modulated Tag Found above!\n\nCould also be PSK2 - try 'data psk2rawdemod'"); | |
751 | PrintAndLog("\nCould also be PSK3 - [currently not supported]"); | |
752 | PrintAndLog("\nCould also be NRZ - try 'data nrzrawdemod"); | |
753 | return 1; | |
b4fb11ba | 754 | } |
e770c648 | 755 | PrintAndLog("\nNo Data Found!\n"); |
756 | } | |
d5a72d2f | 757 | return 0; |
758 | } | |
759 | ||
7fe9b0b7 | 760 | static command_t CommandTable[] = |
761 | { | |
762 | {"help", CmdHelp, 1, "This help"}, | |
37239a7c | 763 | {"em4x", CmdLFEM4X, 1, "{ EM4X RFIDs... }"}, |
31b3689f | 764 | {"hid", CmdLFHID, 1, "{ HID RFIDs... }"}, |
765 | {"hitag", CmdLFHitag, 1, "{ HITAG RFIDs... }"}, | |
766 | {"io", CmdLFIO, 1, "{ IOPROX RFIDs... }"}, | |
767 | {"pcf7931", CmdLFPCF7931, 1, "{ PCF7931 RFIDs... }"}, | |
768 | {"ti", CmdLFTI, 1, "{ TI RFIDs... }"}, | |
769 | {"t55xx", CmdLFT55XX, 1, "{ T55X7 RFIDs... }"}, | |
770 | ||
31abe49f | 771 | {"config", CmdLFSetConfig, 0, "Set config for LF sampling, bit/sample, decimation, frequency"}, |
31b3689f | 772 | |
773 | {"cmdread", CmdLFCommandRead, 0, "<off period> <'0' period> <'1' period> <command> ['h'] -- Modulate LF reader field to send command before read (all periods in microseconds) (option 'h' for 134)"}, | |
7fe9b0b7 | 774 | {"flexdemod", CmdFlexdemod, 1, "Demodulate samples for FlexPass"}, |
7fe9b0b7 | 775 | {"indalademod", CmdIndalaDemod, 1, "['224'] -- Demodulate samples for Indala 64 bit UID (option '224' for 224 bit)"}, |
083ca3de | 776 | {"indalaclone", CmdIndalaClone, 0, "<UID> ['l']-- Clone Indala to T55x7 (tag must be in antenna)(UID in HEX)(option 'l' for 224 UID"}, |
31abe49f | 777 | {"read", CmdLFRead, 0, "Read 125/134 kHz LF ID-only tag. Do 'lf read h' for help"}, |
b4fb11ba | 778 | {"search", CmdLFfind, 1, "[offline] ['u'] Read and Search for valid known tag (in offline mode it you can load first then search) - 'u' to search for unknown tags"}, |
7fe9b0b7 | 779 | {"sim", CmdLFSim, 0, "[GAP] -- Simulate LF tag from buffer with optional GAP (in microseconds)"}, |
780 | {"simbidir", CmdLFSimBidir, 0, "Simulate LF tag (with bidirectional data transmission between reader and tag)"}, | |
781 | {"simman", CmdLFSimManchester, 0, "<Clock> <Bitstream> [GAP] Simulate arbitrary Manchester LF tag"}, | |
b014c96d | 782 | {"snoop", CmdLFSnoop, 0, "['l'|'h'|<divisor>] [trigger threshold]-- Snoop LF (l:125khz, h:134khz)"}, |
7fe9b0b7 | 783 | {"vchdemod", CmdVchDemod, 1, "['clone'] -- Demodulate samples for VeriChip"}, |
784 | {NULL, NULL, 0, NULL} | |
785 | }; | |
786 | ||
787 | int CmdLF(const char *Cmd) | |
788 | { | |
789 | CmdsParse(CommandTable, Cmd); | |
790 | return 0; | |
791 | } | |
792 | ||
793 | int CmdHelp(const char *Cmd) | |
794 | { | |
795 | CmdsHelp(CommandTable); | |
796 | return 0; | |
797 | } |