]>
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 | //----------------------------------------------------------------------------- | |
7fe9b0b7 | 10 | #include "cmdlf.h" |
7fe9b0b7 | 11 | static int CmdHelp(const char *Cmd); |
12 | ||
f82894ba | 13 | int usage_lf_cmdread(void) { |
9276e859 | 14 | PrintAndLog("Usage: lf cmdread d <delay period> z <zero period> o <one period> c <cmdbytes> [H]"); |
d0724780 | 15 | PrintAndLog("Options:"); |
0de8e387 | 16 | PrintAndLog(" h This help"); |
05164399 | 17 | PrintAndLog(" L Low frequency (125 KHz)"); |
18 | PrintAndLog(" H High frequency (134 KHz)"); | |
d0724780 | 19 | PrintAndLog(" d <delay> delay OFF period, (decimal)"); |
20 | PrintAndLog(" z <zero> time period ZERO, (decimal)"); | |
21 | PrintAndLog(" o <one> time period ONE, (decimal)"); | |
22 | PrintAndLog(" c <cmd> Command bytes (in ones and zeros)"); | |
9276e859 | 23 | PrintAndLog(" ************* All periods in microseconds (ms)"); |
0de8e387 | 24 | PrintAndLog("Examples:"); |
9276e859 | 25 | PrintAndLog(" lf cmdread d 80 z 100 o 200 c 11000"); |
26 | PrintAndLog(" lf cmdread d 80 z 100 o 100 c 11000 H"); | |
0de8e387 | 27 | return 0; |
28 | } | |
f82894ba | 29 | int usage_lf_read(void){ |
30 | PrintAndLog("Usage: lf read [h] [s]"); | |
d0724780 | 31 | PrintAndLog("Options:"); |
f82894ba | 32 | PrintAndLog(" h This help"); |
33 | PrintAndLog(" s silent run no printout"); | |
34 | PrintAndLog("This function takes no arguments. "); | |
35 | PrintAndLog("Use 'lf config' to set parameters."); | |
36 | return 0; | |
37 | } | |
38 | int usage_lf_snoop(void) { | |
39 | PrintAndLog("Usage: lf snoop"); | |
d0724780 | 40 | PrintAndLog("Options:"); |
f82894ba | 41 | PrintAndLog(" h This help"); |
42 | PrintAndLog("This function takes no arguments. "); | |
43 | PrintAndLog("Use 'lf config' to set parameters."); | |
44 | return 0; | |
45 | } | |
46 | int usage_lf_config(void) { | |
d0724780 | 47 | PrintAndLog("Usage: lf config [h] [H|<divisor>] [b <bps>] [d <decim>] [a 0|1]"); |
48 | PrintAndLog("Options:"); | |
f82894ba | 49 | PrintAndLog(" h This help"); |
50 | PrintAndLog(" L Low frequency (125 KHz)"); | |
51 | PrintAndLog(" H High frequency (134 KHz)"); | |
52 | PrintAndLog(" q <divisor> Manually set divisor. 88-> 134KHz, 95-> 125 Hz"); | |
53 | PrintAndLog(" b <bps> Sets resolution of bits per sample. Default (max): 8"); | |
54 | PrintAndLog(" d <decim> Sets decimation. A value of N saves only 1 in N samples. Default: 1"); | |
55 | PrintAndLog(" a [0|1] Averaging - if set, will average the stored sample value when decimating. Default: 1"); | |
56 | PrintAndLog(" t <threshold> Sets trigger threshold. 0 means no threshold (range: 0-128)"); | |
57 | PrintAndLog("Examples:"); | |
58 | PrintAndLog(" lf config b 8 L"); | |
59 | PrintAndLog(" Samples at 125KHz, 8bps."); | |
60 | PrintAndLog(" lf config H b 4 d 3"); | |
61 | PrintAndLog(" Samples at 134KHz, averages three samples into one, stored with "); | |
62 | PrintAndLog(" a resolution of 4 bits per sample."); | |
63 | PrintAndLog(" lf read"); | |
64 | PrintAndLog(" Performs a read (active field)"); | |
65 | PrintAndLog(" lf snoop"); | |
66 | PrintAndLog(" Performs a snoop (no active field)"); | |
67 | return 0; | |
68 | } | |
69 | int usage_lf_simfsk(void) { | |
5cc88edf | 70 | PrintAndLog("Usage: lf simfsk [c <clock>] [i] [H <fcHigh>] [L <fcLow>] [d <hexdata>]"); |
d0724780 | 71 | PrintAndLog("Options:"); |
5cc88edf | 72 | PrintAndLog(" h This help"); |
73 | PrintAndLog(" c <clock> Manually set clock - can autodetect if using DemodBuffer"); | |
74 | PrintAndLog(" i invert data"); | |
75 | PrintAndLog(" H <fcHigh> Manually set the larger Field Clock"); | |
76 | PrintAndLog(" L <fcLow> Manually set the smaller Field Clock"); | |
77 | //PrintAndLog(" s TBD- -to enable a gap between playback repetitions - default: no gap"); | |
78 | PrintAndLog(" d <hexdata> Data to sim as hex - omit to sim from DemodBuffer"); | |
79 | PrintAndLog("\n NOTE: if you set one clock manually set them all manually"); | |
80 | return 0; | |
f82894ba | 81 | } |
82 | int usage_lf_simask(void) { | |
5cc88edf | 83 | PrintAndLog("Usage: lf simask [c <clock>] [i] [b|m|r] [s] [d <raw hex to sim>]"); |
d0724780 | 84 | PrintAndLog("Options:"); |
5cc88edf | 85 | PrintAndLog(" h This help"); |
86 | PrintAndLog(" c <clock> Manually set clock - can autodetect if using DemodBuffer"); | |
87 | PrintAndLog(" i invert data"); | |
88 | PrintAndLog(" b sim ask/biphase"); | |
89 | PrintAndLog(" m sim ask/manchester - Default"); | |
90 | PrintAndLog(" r sim ask/raw"); | |
6c68b84a | 91 | PrintAndLog(" s add t55xx Sequence Terminator gap - default: no gaps (only manchester)"); |
5cc88edf | 92 | PrintAndLog(" d <hexdata> Data to sim as hex - omit to sim from DemodBuffer"); |
93 | return 0; | |
f82894ba | 94 | } |
95 | int usage_lf_simpsk(void) { | |
5cc88edf | 96 | PrintAndLog("Usage: lf simpsk [1|2|3] [c <clock>] [i] [r <carrier>] [d <raw hex to sim>]"); |
d0724780 | 97 | PrintAndLog("Options:"); |
5cc88edf | 98 | PrintAndLog(" h This help"); |
99 | PrintAndLog(" c <clock> Manually set clock - can autodetect if using DemodBuffer"); | |
100 | PrintAndLog(" i invert data"); | |
101 | PrintAndLog(" 1 set PSK1 (default)"); | |
102 | PrintAndLog(" 2 set PSK2"); | |
103 | PrintAndLog(" 3 set PSK3"); | |
104 | PrintAndLog(" r <carrier> 2|4|8 are valid carriers: default = 2"); | |
105 | PrintAndLog(" d <hexdata> Data to sim as hex - omit to sim from DemodBuffer"); | |
106 | return 0; | |
f82894ba | 107 | } |
70459879 | 108 | int usage_lf_find(void){ |
d0724780 | 109 | PrintAndLog("Usage: lf search [h] <0|1> [u]"); |
70459879 | 110 | PrintAndLog(""); |
d0724780 | 111 | PrintAndLog("Options:"); |
112 | PrintAndLog(" h This help"); | |
113 | PrintAndLog(" <0|1> Use data from Graphbuffer, if not set, try reading data from tag."); | |
114 | PrintAndLog(" u Search for Unknown tags, if not set, reads only known tags."); | |
115 | PrintAndLog("Examples:"); | |
116 | PrintAndLog(" lf search = try reading data from tag & search for known tags"); | |
117 | PrintAndLog(" lf search 1 = use data from GraphBuffer & search for known tags"); | |
118 | PrintAndLog(" lf search u = try reading data from tag & search for known and unknown tags"); | |
119 | PrintAndLog(" lf search 1 u = use data from GraphBuffer & search for known and unknown tags"); | |
70459879 | 120 | return 0; |
121 | } | |
122 | ||
0de8e387 | 123 | |
a739812e | 124 | /* send a LF command before reading */ |
d0724780 | 125 | int CmdLFCommandRead(const char *Cmd) { |
95522869 | 126 | |
0de8e387 | 127 | bool errors = FALSE; |
d0724780 | 128 | bool useHighFreq = FALSE; |
129 | uint16_t one = 0, zero = 0; | |
9276e859 | 130 | uint8_t cmdp = 0; |
d0724780 | 131 | UsbCommand c = {CMD_MOD_THEN_ACQUIRE_RAW_ADC_SAMPLES_125K, {0,0,0}}; |
132 | ||
9276e859 | 133 | while(param_getchar(Cmd, cmdp) != 0x00) { |
d0724780 | 134 | switch(param_getchar(Cmd, cmdp)) { |
0de8e387 | 135 | case 'h': |
136 | return usage_lf_cmdread(); | |
137 | case 'H': | |
d0724780 | 138 | useHighFreq = TRUE; |
0de8e387 | 139 | cmdp++; |
140 | break; | |
9276e859 | 141 | case 'L': |
142 | cmdp++; | |
143 | break; | |
144 | case 'c': | |
9f52c9db | 145 | param_getstr(Cmd, cmdp+1, (char *)&c.d.asBytes); |
9276e859 | 146 | cmdp+=2; |
147 | break; | |
148 | case 'd': | |
149 | c.arg[0] = param_get32ex(Cmd, cmdp+1, 0, 10); | |
150 | cmdp+=2; | |
151 | break; | |
152 | case 'z': | |
d0724780 | 153 | zero = param_get32ex(Cmd, cmdp+1, 0, 10) & 0xFFFF; |
9276e859 | 154 | cmdp+=2; |
155 | break; | |
156 | case 'o': | |
d0724780 | 157 | one = param_get32ex(Cmd, cmdp+1, 0, 10) & 0xFFFF; |
0de8e387 | 158 | cmdp+=2; |
159 | break; | |
160 | default: | |
161 | PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp)); | |
162 | errors = 1; | |
163 | break; | |
164 | } | |
165 | if(errors) break; | |
166 | } | |
167 | // No args | |
d0724780 | 168 | if (cmdp == 0) errors = TRUE; |
7fe9b0b7 | 169 | |
0de8e387 | 170 | //Validations |
9276e859 | 171 | if (errors) return usage_lf_cmdread(); |
e98572a1 | 172 | |
d0724780 | 173 | // zero and one lengths |
fd9212e1 | 174 | c.arg[1] = (uint32_t)(zero << 16 | one); |
d0724780 | 175 | |
176 | // add frequency 125 or 134 | |
177 | c.arg[2] = useHighFreq; | |
7fe9b0b7 | 178 | |
0de8e387 | 179 | clearCommandBuffer(); |
180 | SendCommand(&c); | |
181 | return 0; | |
7fe9b0b7 | 182 | } |
183 | ||
184 | int CmdFlexdemod(const char *Cmd) | |
185 | { | |
af179266 | 186 | #define LONG_WAIT 100 |
187 | int i, j, start, bit, sum; | |
188 | int phase = 0; | |
189 | ||
190 | for (i = 0; i < GraphTraceLen; ++i) | |
191 | GraphBuffer[i] = (GraphBuffer[i] < 0) ? -1 : 1; | |
192 | ||
193 | for (start = 0; start < GraphTraceLen - LONG_WAIT; start++) { | |
194 | int first = GraphBuffer[start]; | |
195 | for (i = start; i < start + LONG_WAIT; i++) { | |
196 | if (GraphBuffer[i] != first) { | |
197 | break; | |
198 | } | |
199 | } | |
200 | if (i == (start + LONG_WAIT)) | |
201 | break; | |
202 | } | |
203 | ||
204 | if (start == GraphTraceLen - LONG_WAIT) { | |
205 | PrintAndLog("nothing to wait for"); | |
206 | return 0; | |
207 | } | |
208 | ||
209 | GraphBuffer[start] = 2; | |
210 | GraphBuffer[start+1] = -2; | |
3fe4ff4f | 211 | uint8_t bits[64] = {0x00}; |
7fe9b0b7 | 212 | |
af179266 | 213 | i = start; |
214 | for (bit = 0; bit < 64; bit++) { | |
3fe4ff4f | 215 | sum = 0; |
216 | for (int j = 0; j < 16; j++) { | |
af179266 | 217 | sum += GraphBuffer[i++]; |
218 | } | |
3fe4ff4f | 219 | bits[bit] = (sum > 0) ? 1 : 0; |
af179266 | 220 | PrintAndLog("bit %d sum %d", bit, sum); |
221 | } | |
3fe4ff4f | 222 | |
af179266 | 223 | for (bit = 0; bit < 64; bit++) { |
224 | sum = 0; | |
225 | for (j = 0; j < 16; j++) | |
226 | sum += GraphBuffer[i++]; | |
227 | ||
228 | if (sum > 0 && bits[bit] != 1) PrintAndLog("oops1 at %d", bit); | |
229 | ||
230 | if (sum < 0 && bits[bit] != 0) PrintAndLog("oops2 at %d", bit); | |
231 | ||
232 | } | |
7fe9b0b7 | 233 | |
3fe4ff4f | 234 | // HACK writing back to graphbuffer. |
af179266 | 235 | GraphTraceLen = 32*64; |
236 | i = 0; | |
237 | for (bit = 0; bit < 64; bit++) { | |
238 | ||
3fe4ff4f | 239 | phase = (bits[bit] == 0) ? 0 : 1; |
240 | ||
af179266 | 241 | for (j = 0; j < 32; j++) { |
242 | GraphBuffer[i++] = phase; | |
243 | phase = !phase; | |
244 | } | |
245 | } | |
246 | RepaintGraphWindow(); | |
247 | return 0; | |
7fe9b0b7 | 248 | } |
a1f3bb12 | 249 | |
7fe9b0b7 | 250 | int CmdIndalaDemod(const char *Cmd) |
251 | { | |
eb911aa8 | 252 | // PSK1, Bitrate 32, |
253 | ||
70459879 | 254 | // Usage: recover 64bit UID by default, specify "224" as arg to recover a 224bit UID |
70459879 | 255 | int state = -1; |
256 | int count = 0; | |
257 | int i, j; | |
258 | ||
259 | // worst case with GraphTraceLen=64000 is < 4096 | |
260 | // under normal conditions it's < 2048 | |
70459879 | 261 | uint8_t rawbits[4096]; |
af179266 | 262 | |
263 | int rawbit = 0, worst = 0, worstPos = 0; | |
70459879 | 264 | // PrintAndLog("Expecting a bit less than %d raw bits", GraphTraceLen / 32); |
6426f6ba | 265 | |
266 | // loop through raw signal - since we know it is psk1 rf/32 fc/2 skip every other value (+=2) | |
70459879 | 267 | for (i = 0; i < GraphTraceLen-1; i += 2) { |
268 | count += 1; | |
269 | if ((GraphBuffer[i] > GraphBuffer[i + 1]) && (state != 1)) { | |
6426f6ba | 270 | // appears redundant - marshmellow |
70459879 | 271 | if (state == 0) { |
272 | for (j = 0; j < count - 8; j += 16) { | |
273 | rawbits[rawbit++] = 0; | |
274 | } | |
275 | if ((abs(count - j)) > worst) { | |
276 | worst = abs(count - j); | |
277 | worstPos = i; | |
278 | } | |
279 | } | |
280 | state = 1; | |
281 | count = 0; | |
282 | } else if ((GraphBuffer[i] < GraphBuffer[i + 1]) && (state != 0)) { | |
6426f6ba | 283 | //appears redundant |
70459879 | 284 | if (state == 1) { |
285 | for (j = 0; j < count - 8; j += 16) { | |
286 | rawbits[rawbit++] = 1; | |
287 | } | |
288 | if ((abs(count - j)) > worst) { | |
289 | worst = abs(count - j); | |
290 | worstPos = i; | |
291 | } | |
292 | } | |
293 | state = 0; | |
294 | count = 0; | |
295 | } | |
296 | } | |
297 | ||
298 | if ( rawbit>0 ){ | |
299 | PrintAndLog("Recovered %d raw bits, expected: %d", rawbit, GraphTraceLen/32); | |
300 | PrintAndLog("worst metric (0=best..7=worst): %d at pos %d", worst, worstPos); | |
3fe4ff4f | 301 | } else { |
302 | return 0; | |
303 | } | |
304 | ||
70459879 | 305 | // Finding the start of a UID |
306 | int uidlen, long_wait; | |
307 | if (strcmp(Cmd, "224") == 0) { | |
308 | uidlen = 224; | |
309 | long_wait = 30; | |
310 | } else { | |
311 | uidlen = 64; | |
312 | long_wait = 29; | |
313 | } | |
3fe4ff4f | 314 | |
70459879 | 315 | int start; |
316 | int first = 0; | |
317 | for (start = 0; start <= rawbit - uidlen; start++) { | |
318 | first = rawbits[start]; | |
319 | for (i = start; i < start + long_wait; i++) { | |
320 | if (rawbits[i] != first) { | |
321 | break; | |
322 | } | |
323 | } | |
324 | if (i == (start + long_wait)) { | |
325 | break; | |
326 | } | |
327 | } | |
3fe4ff4f | 328 | |
70459879 | 329 | if (start == rawbit - uidlen + 1) { |
330 | PrintAndLog("nothing to wait for"); | |
331 | return 0; | |
332 | } | |
7fe9b0b7 | 333 | |
70459879 | 334 | // Inverting signal if needed |
335 | if (first == 1) { | |
336 | for (i = start; i < rawbit; i++) { | |
337 | rawbits[i] = !rawbits[i]; | |
338 | } | |
339 | } | |
7fe9b0b7 | 340 | |
70459879 | 341 | // Dumping UID |
3fe4ff4f | 342 | uint8_t bits[224] = {0x00}; |
343 | char showbits[225] = {0x00}; | |
70459879 | 344 | int bit; |
345 | i = start; | |
346 | int times = 0; | |
3fe4ff4f | 347 | |
70459879 | 348 | if (uidlen > rawbit) { |
349 | PrintAndLog("Warning: not enough raw bits to get a full UID"); | |
350 | for (bit = 0; bit < rawbit; bit++) { | |
351 | bits[bit] = rawbits[i++]; | |
352 | // As we cannot know the parity, let's use "." and "/" | |
353 | showbits[bit] = '.' + bits[bit]; | |
354 | } | |
355 | showbits[bit+1]='\0'; | |
356 | PrintAndLog("Partial UID=%s", showbits); | |
357 | return 0; | |
358 | } else { | |
359 | for (bit = 0; bit < uidlen; bit++) { | |
360 | bits[bit] = rawbits[i++]; | |
361 | showbits[bit] = '0' + bits[bit]; | |
362 | } | |
363 | times = 1; | |
364 | } | |
2414f978 | 365 | |
70459879 | 366 | //convert UID to HEX |
367 | uint32_t uid1, uid2, uid3, uid4, uid5, uid6, uid7; | |
368 | int idx; | |
3fe4ff4f | 369 | uid1 = uid2 = 0; |
370 | ||
70459879 | 371 | if (uidlen==64){ |
372 | for( idx=0; idx<64; idx++) { | |
373 | if (showbits[idx] == '0') { | |
374 | uid1 = (uid1<<1) | (uid2>>31); | |
375 | uid2 = (uid2<<1) | 0; | |
376 | } else { | |
377 | uid1 = (uid1<<1) | (uid2>>31); | |
378 | uid2 = (uid2<<1) | 1; | |
379 | } | |
380 | } | |
381 | PrintAndLog("UID=%s (%x%08x)", showbits, uid1, uid2); | |
382 | } else { | |
3fe4ff4f | 383 | uid3 = uid4 = uid5 = uid6 = uid7 = 0; |
384 | ||
70459879 | 385 | for( idx=0; idx<224; idx++) { |
386 | uid1 = (uid1<<1) | (uid2>>31); | |
387 | uid2 = (uid2<<1) | (uid3>>31); | |
388 | uid3 = (uid3<<1) | (uid4>>31); | |
389 | uid4 = (uid4<<1) | (uid5>>31); | |
390 | uid5 = (uid5<<1) | (uid6>>31); | |
391 | uid6 = (uid6<<1) | (uid7>>31); | |
392 | ||
3fe4ff4f | 393 | if (showbits[idx] == '0') |
394 | uid7 = (uid7<<1) | 0; | |
395 | else | |
396 | uid7 = (uid7<<1) | 1; | |
70459879 | 397 | } |
398 | PrintAndLog("UID=%s (%x%08x%08x%08x%08x%08x%08x)", showbits, uid1, uid2, uid3, uid4, uid5, uid6, uid7); | |
399 | } | |
7fe9b0b7 | 400 | |
70459879 | 401 | // Checking UID against next occurrences |
402 | int failed = 0; | |
3fe4ff4f | 403 | for (; i + uidlen <= rawbit;) { |
404 | failed = 0; | |
70459879 | 405 | for (bit = 0; bit < uidlen; bit++) { |
406 | if (bits[bit] != rawbits[i++]) { | |
407 | failed = 1; | |
408 | break; | |
409 | } | |
410 | } | |
411 | if (failed == 1) { | |
412 | break; | |
413 | } | |
414 | times += 1; | |
415 | } | |
3fe4ff4f | 416 | |
70459879 | 417 | PrintAndLog("Occurrences: %d (expected %d)", times, (rawbit - start) / uidlen); |
7fe9b0b7 | 418 | |
70459879 | 419 | // Remodulating for tag cloning |
3fe4ff4f | 420 | // HACK: 2015-01-04 this will have an impact on our new way of seening lf commands (demod) |
421 | // since this changes graphbuffer data. | |
70459879 | 422 | GraphTraceLen = 32 * uidlen; |
423 | i = 0; | |
424 | int phase = 0; | |
425 | for (bit = 0; bit < uidlen; bit++) { | |
426 | phase = (bits[bit] == 0) ? 0 : 1; | |
427 | int j; | |
428 | for (j = 0; j < 32; j++) { | |
429 | GraphBuffer[i++] = phase; | |
430 | phase = !phase; | |
431 | } | |
432 | } | |
7fe9b0b7 | 433 | |
70459879 | 434 | RepaintGraphWindow(); |
435 | return 1; | |
7fe9b0b7 | 436 | } |
437 | ||
af179266 | 438 | int CmdIndalaClone(const char *Cmd){ |
439 | UsbCommand c; | |
3fe4ff4f | 440 | unsigned int uid1, uid2, uid3, uid4, uid5, uid6, uid7; |
441 | ||
442 | uid1 = uid2 = uid3 = uid4 = uid5 = uid6 = uid7 = 0; | |
af179266 | 443 | int n = 0, i = 0; |
444 | ||
445 | if (strchr(Cmd,'l') != 0) { | |
446 | while (sscanf(&Cmd[i++], "%1x", &n ) == 1) { | |
447 | uid1 = (uid1 << 4) | (uid2 >> 28); | |
448 | uid2 = (uid2 << 4) | (uid3 >> 28); | |
449 | uid3 = (uid3 << 4) | (uid4 >> 28); | |
450 | uid4 = (uid4 << 4) | (uid5 >> 28); | |
451 | uid5 = (uid5 << 4) | (uid6 >> 28); | |
452 | uid6 = (uid6 << 4) | (uid7 >> 28); | |
453 | uid7 = (uid7 << 4) | (n & 0xf); | |
454 | } | |
455 | PrintAndLog("Cloning 224bit tag with UID %x%08x%08x%08x%08x%08x%08x", uid1, uid2, uid3, uid4, uid5, uid6, uid7); | |
456 | c.cmd = CMD_INDALA_CLONE_TAG_L; | |
457 | c.d.asDwords[0] = uid1; | |
458 | c.d.asDwords[1] = uid2; | |
459 | c.d.asDwords[2] = uid3; | |
460 | c.d.asDwords[3] = uid4; | |
461 | c.d.asDwords[4] = uid5; | |
462 | c.d.asDwords[5] = uid6; | |
463 | c.d.asDwords[6] = uid7; | |
3fe4ff4f | 464 | } else { |
af179266 | 465 | while (sscanf(&Cmd[i++], "%1x", &n ) == 1) { |
466 | uid1 = (uid1 << 4) | (uid2 >> 28); | |
467 | uid2 = (uid2 << 4) | (n & 0xf); | |
468 | } | |
469 | PrintAndLog("Cloning 64bit tag with UID %x%08x", uid1, uid2); | |
470 | c.cmd = CMD_INDALA_CLONE_TAG; | |
471 | c.arg[0] = uid1; | |
472 | c.arg[1] = uid2; | |
473 | } | |
2414f978 | 474 | |
a126332a | 475 | clearCommandBuffer(); |
af179266 | 476 | SendCommand(&c); |
477 | return 0; | |
2414f978 | 478 | } |
479 | ||
af179266 | 480 | int CmdLFSetConfig(const char *Cmd) { |
31abe49f MHS |
481 | uint8_t divisor = 0;//Frequency divisor |
482 | uint8_t bps = 0; // Bits per sample | |
483 | uint8_t decimation = 0; //How many to keep | |
484 | bool averaging = 1; // Defaults to true | |
f6d9fb17 | 485 | bool errors = FALSE; |
5cc88edf | 486 | int trigger_threshold = -1;//Means no change |
31abe49f | 487 | uint8_t unsigned_trigg = 0; |
f6d9fb17 | 488 | |
5cc88edf | 489 | uint8_t cmdp = 0; |
af179266 | 490 | while(param_getchar(Cmd, cmdp) != 0x00) { |
491 | switch(param_getchar(Cmd, cmdp)) { | |
31abe49f MHS |
492 | case 'h': |
493 | return usage_lf_config(); | |
494 | case 'H': | |
495 | divisor = 88; | |
496 | cmdp++; | |
497 | break; | |
498 | case 'L': | |
499 | divisor = 95; | |
500 | cmdp++; | |
501 | break; | |
502 | case 'q': | |
503 | errors |= param_getdec(Cmd,cmdp+1,&divisor); | |
504 | cmdp+=2; | |
505 | break; | |
506 | case 't': | |
507 | errors |= param_getdec(Cmd,cmdp+1,&unsigned_trigg); | |
508 | cmdp+=2; | |
509 | if(!errors) trigger_threshold = unsigned_trigg; | |
510 | break; | |
511 | case 'b': | |
512 | errors |= param_getdec(Cmd,cmdp+1,&bps); | |
513 | cmdp+=2; | |
514 | break; | |
515 | case 'd': | |
516 | errors |= param_getdec(Cmd,cmdp+1,&decimation); | |
517 | cmdp+=2; | |
518 | break; | |
519 | case 'a': | |
520 | averaging = param_getchar(Cmd,cmdp+1) == '1'; | |
521 | cmdp+=2; | |
522 | break; | |
523 | default: | |
524 | PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp)); | |
525 | errors = 1; | |
526 | break; | |
527 | } | |
528 | if(errors) break; | |
f6d9fb17 | 529 | } |
5cc88edf | 530 | |
531 | // No args | |
532 | if (cmdp == 0) errors = 1; | |
31abe49f | 533 | |
f6d9fb17 | 534 | //Validations |
5cc88edf | 535 | if (errors) return usage_lf_config(); |
536 | ||
f6d9fb17 | 537 | //Bps is limited to 8, so fits in lower half of arg1 |
5cc88edf | 538 | if (bps >> 4) bps = 8; |
539 | ||
540 | sample_config config = { decimation, bps, averaging, divisor, trigger_threshold }; | |
f6d9fb17 | 541 | |
31abe49f MHS |
542 | //Averaging is a flag on high-bit of arg[1] |
543 | UsbCommand c = {CMD_SET_LF_SAMPLING_CONFIG}; | |
544 | memcpy(c.d.asBytes,&config,sizeof(sample_config)); | |
a126332a | 545 | clearCommandBuffer(); |
31abe49f MHS |
546 | SendCommand(&c); |
547 | return 0; | |
548 | } | |
f6d9fb17 | 549 | |
af179266 | 550 | int CmdLFRead(const char *Cmd) { |
1fbf8956 | 551 | bool arg1 = false; |
f82894ba | 552 | uint8_t cmdp = param_getchar(Cmd, 0); |
553 | ||
554 | if ( cmdp == 'h' || cmdp == 'H') return usage_lf_read(); | |
555 | ||
556 | //suppress print | |
557 | if ( cmdp == 's' || cmdp == 'S') arg1 = true; | |
558 | ||
1fbf8956 | 559 | UsbCommand c = {CMD_ACQUIRE_RAW_ADC_SAMPLES_125K, {arg1,0,0}}; |
f82894ba | 560 | clearCommandBuffer(); |
31abe49f | 561 | SendCommand(&c); |
68008fb5 | 562 | if ( !WaitForResponseTimeout(CMD_ACK,NULL,2500) ) { |
563 | PrintAndLog("command execution time out"); | |
564 | return 1; | |
565 | } | |
31abe49f MHS |
566 | return 0; |
567 | } | |
f6d9fb17 | 568 | |
af179266 | 569 | int CmdLFSnoop(const char *Cmd) { |
f82894ba | 570 | uint8_t cmdp = param_getchar(Cmd, 0); |
571 | if(cmdp == 'h' || cmdp == 'H') return usage_lf_snoop(); | |
572 | ||
31abe49f | 573 | UsbCommand c = {CMD_LF_SNOOP_RAW_ADC_SAMPLES}; |
f82894ba | 574 | clearCommandBuffer(); |
f6d9fb17 MHS |
575 | SendCommand(&c); |
576 | WaitForResponse(CMD_ACK,NULL); | |
577 | return 0; | |
7fe9b0b7 | 578 | } |
579 | ||
af179266 | 580 | static void ChkBitstream(const char *str) { |
581 | // convert to bitstream if necessary | |
582 | for (int i = 0; i < (int)(GraphTraceLen / 2); i++){ | |
b915fda3 | 583 | if (GraphBuffer[i] > 1 || GraphBuffer[i] < 0) { |
af179266 | 584 | CmdGetBitStream(""); |
585 | break; | |
586 | } | |
587 | } | |
7fe9b0b7 | 588 | } |
2767fc02 | 589 | //Attempt to simulate any wave in buffer (one bit per output sample) |
590 | // converts GraphBuffer to bitstream (based on zero crossings) if needed. | |
af179266 | 591 | int CmdLFSim(const char *Cmd) { |
f82894ba | 592 | int i,j; |
593 | static int gap; | |
7fe9b0b7 | 594 | |
f82894ba | 595 | sscanf(Cmd, "%i", &gap); |
7fe9b0b7 | 596 | |
2767fc02 | 597 | // convert to bitstream if necessary |
f82894ba | 598 | ChkBitstream(Cmd); |
7fe9b0b7 | 599 | |
d115f9a4 | 600 | if (g_debugMode) |
ed28bbe5 | 601 | printf("DEBUG: Sending [%d bytes]\n", GraphTraceLen); |
d115f9a4 | 602 | |
2767fc02 | 603 | //can send only 512 bits at a time (1 byte sent per bit...) |
f82894ba | 604 | for (i = 0; i < GraphTraceLen; i += USB_CMD_DATA_SIZE) { |
605 | UsbCommand c = {CMD_DOWNLOADED_SIM_SAMPLES_125K, {i, 0, 0}}; | |
7fe9b0b7 | 606 | |
f82894ba | 607 | for (j = 0; j < USB_CMD_DATA_SIZE; j++) { |
608 | c.d.asBytes[j] = GraphBuffer[i+j]; | |
609 | } | |
610 | clearCommandBuffer(); | |
611 | SendCommand(&c); | |
015e3b81 | 612 | WaitForResponse(CMD_ACK, NULL); |
f82894ba | 613 | printf("."); |
614 | } | |
abd6112f | 615 | |
ed28bbe5 | 616 | PrintAndLog("Starting to simulate"); |
d115f9a4 | 617 | |
f82894ba | 618 | UsbCommand c = {CMD_SIMULATE_TAG_125K, {GraphTraceLen, gap, 0}}; |
619 | clearCommandBuffer(); | |
620 | SendCommand(&c); | |
621 | return 0; | |
872e3d4d | 622 | } |
712ebfa6 | 623 | |
6c283951 | 624 | // by marshmellow - sim fsk data given clock, fcHigh, fcLow, invert |
abd6112f | 625 | // - allow pull data from DemodBuffer |
626 | int CmdLFfskSim(const char *Cmd) | |
627 | { | |
2767fc02 | 628 | //might be able to autodetect FCs and clock from Graphbuffer if using demod buffer |
629 | // otherwise will need FChigh, FClow, Clock, and bitstream | |
6c283951 | 630 | uint8_t fcHigh = 0, fcLow = 0, clk = 0; |
631 | uint8_t invert = 0; | |
632 | bool errors = FALSE; | |
633 | char hexData[32] = {0x00}; // store entered hex data | |
634 | uint8_t data[255] = {0x00}; | |
635 | int dataLen = 0; | |
636 | uint8_t cmdp = 0; | |
637 | ||
af179266 | 638 | while(param_getchar(Cmd, cmdp) != 0x00) { |
639 | switch(param_getchar(Cmd, cmdp)){ | |
6c283951 | 640 | case 'h': |
641 | return usage_lf_simfsk(); | |
642 | case 'i': | |
643 | invert = 1; | |
644 | cmdp++; | |
645 | break; | |
646 | case 'c': | |
647 | errors |= param_getdec(Cmd, cmdp+1, &clk); | |
648 | cmdp += 2; | |
649 | break; | |
650 | case 'H': | |
651 | errors |= param_getdec(Cmd, cmdp+1, &fcHigh); | |
652 | cmdp += 2; | |
653 | break; | |
654 | case 'L': | |
655 | errors |= param_getdec(Cmd, cmdp+1, &fcLow); | |
656 | cmdp += 2; | |
657 | break; | |
658 | //case 's': | |
659 | // separator = 1; | |
660 | // cmdp++; | |
661 | // break; | |
662 | case 'd': | |
663 | dataLen = param_getstr(Cmd, cmdp+1, hexData); | |
664 | if (dataLen == 0) | |
665 | errors = TRUE; | |
666 | else | |
667 | dataLen = hextobinarray((char *)data, hexData); | |
668 | ||
669 | if (dataLen == 0) errors = TRUE; | |
670 | if (errors) PrintAndLog ("Error getting hex data"); | |
671 | cmdp+=2; | |
672 | break; | |
673 | default: | |
674 | PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp)); | |
675 | errors = TRUE; | |
676 | break; | |
677 | } | |
678 | if(errors) break; | |
679 | } | |
680 | ||
681 | // No args | |
682 | if(cmdp == 0 && DemodBufferLen == 0) | |
683 | errors = TRUE; | |
872e3d4d | 684 | |
6c283951 | 685 | //Validations |
686 | if(errors) return usage_lf_simfsk(); | |
687 | ||
688 | if (dataLen == 0){ //using DemodBuffer | |
689 | if (clk == 0 || fcHigh == 0 || fcLow == 0){ //manual settings must set them all | |
690 | uint8_t ans = fskClocks(&fcHigh, &fcLow, &clk, 0); | |
691 | if (ans==0){ | |
692 | if (!fcHigh) fcHigh = 10; | |
693 | if (!fcLow) fcLow = 8; | |
694 | if (!clk) clk = 50; | |
695 | } | |
696 | } | |
697 | } else { | |
698 | setDemodBuf(data, dataLen, 0); | |
699 | } | |
2767fc02 | 700 | |
701 | //default if not found | |
6c283951 | 702 | if (clk == 0) clk = 50; |
703 | if (fcHigh == 0) fcHigh = 10; | |
704 | if (fcLow == 0) fcLow = 8; | |
abd6112f | 705 | |
6c283951 | 706 | uint16_t arg1, arg2; |
707 | arg1 = fcHigh << 8 | fcLow; | |
708 | arg2 = invert << 8 | clk; | |
709 | size_t size = DemodBufferLen; | |
710 | if (size > USB_CMD_DATA_SIZE) { | |
711 | PrintAndLog("DemodBuffer too long for current implementation - length: %d - max: %d", size, USB_CMD_DATA_SIZE); | |
712 | size = USB_CMD_DATA_SIZE; | |
713 | } | |
714 | UsbCommand c = {CMD_FSK_SIM_TAG, {arg1, arg2, size}}; | |
5658e82e | 715 | |
6c283951 | 716 | memcpy(c.d.asBytes, DemodBuffer, size); |
a126332a | 717 | clearCommandBuffer(); |
6c283951 | 718 | SendCommand(&c); |
719 | return 0; | |
abd6112f | 720 | } |
721 | ||
722 | // by marshmellow - sim ask data given clock, invert, manchester or raw, separator | |
723 | // - allow pull data from DemodBuffer | |
724 | int CmdLFaskSim(const char *Cmd) | |
725 | { | |
6c283951 | 726 | // autodetect clock from Graphbuffer if using demod buffer |
2767fc02 | 727 | // needs clock, invert, manchester/raw as m or r, separator as s, and bitstream |
6c283951 | 728 | uint8_t encoding = 1, separator = 0, clk = 0, invert = 0; |
07291f87 | 729 | bool errors = FALSE; |
730 | char hexData[32] = {0x00}; | |
731 | uint8_t data[255]= {0x00}; // store entered hex data | |
732 | int dataLen = 0; | |
733 | uint8_t cmdp = 0; | |
734 | ||
735 | while(param_getchar(Cmd, cmdp) != 0x00) { | |
736 | switch(param_getchar(Cmd, cmdp)) { | |
ed28bbe5 | 737 | case 'H': |
07291f87 | 738 | case 'h': return usage_lf_simask(); |
739 | case 'i': | |
740 | invert = 1; | |
741 | cmdp++; | |
742 | break; | |
743 | case 'c': | |
6c283951 | 744 | errors |= param_getdec(Cmd, cmdp+1, &clk); |
745 | cmdp += 2; | |
07291f87 | 746 | break; |
747 | case 'b': | |
6c283951 | 748 | encoding = 2; //biphase |
07291f87 | 749 | cmdp++; |
750 | break; | |
751 | case 'm': | |
6c283951 | 752 | encoding = 1; //manchester |
07291f87 | 753 | cmdp++; |
754 | break; | |
755 | case 'r': | |
6c283951 | 756 | encoding = 0; //raw |
07291f87 | 757 | cmdp++; |
758 | break; | |
759 | case 's': | |
6c283951 | 760 | separator = 1; |
07291f87 | 761 | cmdp++; |
762 | break; | |
763 | case 'd': | |
764 | dataLen = param_getstr(Cmd, cmdp+1, hexData); | |
6c283951 | 765 | if (dataLen == 0) |
07291f87 | 766 | errors = TRUE; |
767 | else | |
768 | dataLen = hextobinarray((char *)data, hexData); | |
769 | ||
6c283951 | 770 | if (dataLen == 0) errors = TRUE; |
07291f87 | 771 | if (errors) PrintAndLog ("Error getting hex data, datalen: %d", dataLen); |
6c283951 | 772 | cmdp += 2; |
07291f87 | 773 | break; |
774 | default: | |
775 | PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp)); | |
776 | errors = TRUE; | |
777 | break; | |
778 | } | |
779 | if(errors) break; | |
780 | } | |
6c283951 | 781 | |
782 | // No args | |
07291f87 | 783 | if(cmdp == 0 && DemodBufferLen == 0) |
6c283951 | 784 | errors = TRUE; |
abd6112f | 785 | |
07291f87 | 786 | //Validations |
787 | if(errors) return usage_lf_simask(); | |
788 | ||
789 | if (dataLen == 0){ //using DemodBuffer | |
790 | if (clk == 0) | |
791 | clk = GetAskClock("0", false, false); | |
792 | } else { | |
793 | setDemodBuf(data, dataLen, 0); | |
794 | } | |
795 | if (clk == 0) clk = 64; | |
ed28bbe5 | 796 | if (encoding == 0) clk >>= 2; //askraw needs to double the clock speed |
07291f87 | 797 | |
798 | size_t size = DemodBufferLen; | |
799 | ||
800 | if (size > USB_CMD_DATA_SIZE) { | |
801 | PrintAndLog("DemodBuffer too long for current implementation - length: %d - max: %d", size, USB_CMD_DATA_SIZE); | |
802 | size = USB_CMD_DATA_SIZE; | |
803 | } | |
804 | ||
805 | PrintAndLog("preparing to sim ask data: %d bits", size); | |
806 | ||
807 | uint16_t arg1, arg2; | |
808 | arg1 = clk << 8 | encoding; | |
809 | arg2 = invert << 8 | separator; | |
810 | ||
811 | UsbCommand c = {CMD_ASK_SIM_TAG, {arg1, arg2, size}}; | |
812 | memcpy(c.d.asBytes, DemodBuffer, size); | |
a126332a | 813 | clearCommandBuffer(); |
07291f87 | 814 | SendCommand(&c); |
815 | return 0; | |
abd6112f | 816 | } |
817 | ||
872e3d4d | 818 | // by marshmellow - sim psk data given carrier, clock, invert |
819 | // - allow pull data from DemodBuffer or parameters | |
af179266 | 820 | int CmdLFpskSim(const char *Cmd) { |
821 | //might be able to autodetect FC and clock from Graphbuffer if using demod buffer | |
822 | //will need carrier, Clock, and bitstream | |
823 | uint8_t carrier=0, clk=0; | |
824 | uint8_t invert=0; | |
825 | bool errors = FALSE; | |
826 | char hexData[32] = {0x00}; // store entered hex data | |
827 | uint8_t data[255] = {0x00}; | |
828 | int dataLen = 0; | |
829 | uint8_t cmdp = 0; | |
830 | uint8_t pskType = 1; | |
831 | ||
832 | while(param_getchar(Cmd, cmdp) != 0x00) { | |
833 | switch(param_getchar(Cmd, cmdp)) { | |
834 | case 'h': | |
835 | return usage_lf_simpsk(); | |
836 | case 'i': | |
837 | invert = 1; | |
838 | cmdp++; | |
839 | break; | |
840 | case 'c': | |
841 | errors |= param_getdec(Cmd,cmdp+1,&clk); | |
842 | cmdp +=2; | |
843 | break; | |
844 | case 'r': | |
845 | errors |= param_getdec(Cmd,cmdp+1,&carrier); | |
846 | cmdp += 2; | |
847 | break; | |
848 | case '1': | |
849 | pskType = 1; | |
850 | cmdp++; | |
851 | break; | |
852 | case '2': | |
853 | pskType = 2; | |
854 | cmdp++; | |
855 | break; | |
856 | case '3': | |
857 | pskType = 3; | |
858 | cmdp++; | |
859 | break; | |
860 | case 'd': | |
861 | dataLen = param_getstr(Cmd, cmdp+1, hexData); | |
862 | if (dataLen == 0) | |
863 | errors = TRUE; | |
864 | else | |
865 | dataLen = hextobinarray((char *)data, hexData); | |
866 | ||
867 | if (dataLen == 0) errors = TRUE; | |
868 | if (errors) PrintAndLog ("Error getting hex data"); | |
869 | cmdp+=2; | |
870 | break; | |
871 | default: | |
872 | PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp)); | |
873 | errors = TRUE; | |
874 | break; | |
875 | } | |
876 | if (errors) break; | |
877 | } | |
878 | // No args | |
879 | if (cmdp == 0 && DemodBufferLen == 0) | |
880 | errors = TRUE; | |
881 | ||
882 | //Validations | |
883 | if (errors) return usage_lf_simpsk(); | |
884 | ||
885 | if (dataLen == 0){ //using DemodBuffer | |
886 | PrintAndLog("Getting Clocks"); | |
887 | ||
888 | if (clk==0) clk = GetPskClock("", FALSE, FALSE); | |
889 | PrintAndLog("clk: %d",clk); | |
890 | ||
891 | if (!carrier) carrier = GetPskCarrier("", FALSE, FALSE); | |
892 | PrintAndLog("carrier: %d", carrier); | |
893 | ||
894 | } else { | |
895 | setDemodBuf(data, dataLen, 0); | |
896 | } | |
897 | ||
898 | if (clk <= 0) clk = 32; | |
899 | ||
900 | if (carrier == 0) carrier = 2; | |
78f5b1a7 | 901 | |
af179266 | 902 | if (pskType != 1){ |
903 | if (pskType == 2){ | |
904 | //need to convert psk2 to psk1 data before sim | |
905 | psk2TOpsk1(DemodBuffer, DemodBufferLen); | |
906 | } else { | |
907 | PrintAndLog("Sorry, PSK3 not yet available"); | |
908 | } | |
909 | } | |
910 | uint16_t arg1, arg2; | |
911 | arg1 = clk << 8 | carrier; | |
912 | arg2 = invert; | |
913 | size_t size = DemodBufferLen; | |
914 | if (size > USB_CMD_DATA_SIZE) { | |
915 | PrintAndLog("DemodBuffer too long for current implementation - length: %d - max: %d", size, USB_CMD_DATA_SIZE); | |
916 | size = USB_CMD_DATA_SIZE; | |
917 | } | |
918 | UsbCommand c = {CMD_PSK_SIM_TAG, {arg1, arg2, size}}; | |
919 | PrintAndLog("DEBUG: Sending DemodBuffer Length: %d", size); | |
920 | memcpy(c.d.asBytes, DemodBuffer, size); | |
921 | clearCommandBuffer(); | |
922 | SendCommand(&c); | |
923 | return 0; | |
872e3d4d | 924 | } |
abd6112f | 925 | |
af179266 | 926 | int CmdLFSimBidir(const char *Cmd) { |
927 | // Set ADC to twice the carrier for a slight supersampling | |
928 | // HACK: not implemented in ARMSRC. | |
929 | PrintAndLog("Not implemented yet."); | |
930 | UsbCommand c = {CMD_LF_SIMULATE_BIDIR, {47, 384, 0}}; | |
931 | SendCommand(&c); | |
932 | return 0; | |
7fe9b0b7 | 933 | } |
934 | ||
af179266 | 935 | int CmdVchDemod(const char *Cmd) { |
936 | // Is this the entire sync pattern, or does this also include some | |
937 | // data bits that happen to be the same everywhere? That would be | |
938 | // lovely to know. | |
939 | static const int SyncPattern[] = { | |
940 | 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, | |
941 | 1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, | |
942 | 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, | |
943 | 1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, | |
944 | 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, | |
945 | 1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, | |
946 | 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, | |
947 | 1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, | |
948 | 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, | |
949 | 1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, | |
950 | }; | |
951 | ||
952 | // So first, we correlate for the sync pattern, and mark that. | |
953 | int bestCorrel = 0, bestPos = 0; | |
954 | int i, j, sum = 0; | |
955 | ||
956 | // It does us no good to find the sync pattern, with fewer than 2048 samples after it. | |
957 | ||
958 | for (i = 0; i < (GraphTraceLen - 2048); i++) { | |
959 | for (j = 0; j < ARRAYLEN(SyncPattern); j++) { | |
960 | sum += GraphBuffer[i+j] * SyncPattern[j]; | |
961 | } | |
962 | if (sum > bestCorrel) { | |
963 | bestCorrel = sum; | |
964 | bestPos = i; | |
965 | } | |
966 | } | |
967 | PrintAndLog("best sync at %d [metric %d]", bestPos, bestCorrel); | |
968 | ||
969 | char bits[257]; | |
970 | bits[256] = '\0'; | |
971 | ||
972 | int worst = INT_MAX, worstPos = 0; | |
973 | ||
974 | for (i = 0; i < 2048; i += 8) { | |
975 | sum = 0; | |
976 | for (j = 0; j < 8; j++) | |
977 | sum += GraphBuffer[bestPos+i+j]; | |
978 | ||
979 | if (sum < 0) | |
980 | bits[i/8] = '.'; | |
981 | else | |
982 | bits[i/8] = '1'; | |
983 | ||
984 | if(abs(sum) < worst) { | |
985 | worst = abs(sum); | |
986 | worstPos = i; | |
987 | } | |
988 | } | |
989 | PrintAndLog("bits:"); | |
990 | PrintAndLog("%s", bits); | |
991 | PrintAndLog("worst metric: %d at pos %d", worst, worstPos); | |
992 | ||
993 | // clone | |
994 | if (strcmp(Cmd, "clone")==0) { | |
995 | GraphTraceLen = 0; | |
996 | char *s; | |
997 | for(s = bits; *s; s++) { | |
998 | for(j = 0; j < 16; j++) { | |
999 | GraphBuffer[GraphTraceLen++] = (*s == '1') ? 1 : 0; | |
1000 | } | |
1001 | } | |
1002 | RepaintGraphWindow(); | |
1003 | } | |
1004 | return 0; | |
7fe9b0b7 | 1005 | } |
1006 | ||
d5a72d2f | 1007 | //by marshmellow |
e9a92fe2 | 1008 | int CmdLFfind(const char *Cmd) { |
1009 | int ans = 0; | |
1010 | char cmdp = param_getchar(Cmd, 0); | |
1011 | char testRaw = param_getchar(Cmd, 1); | |
1012 | if (strlen(Cmd) > 3 || cmdp == 'h' || cmdp == 'H') return usage_lf_find(); | |
1013 | ||
1014 | if (!offline && (cmdp != '1')){ | |
1015 | CmdLFRead("s"); | |
eb911aa8 | 1016 | getSamples("30000", TRUE); |
e9a92fe2 | 1017 | } else if (GraphTraceLen < 1000) { |
1018 | PrintAndLog("Data in Graphbuffer was too small."); | |
1019 | return 0; | |
1020 | } | |
1021 | if (cmdp == 'u' || cmdp == 'U') testRaw = 'u'; | |
13d77ef9 | 1022 | |
c3c12b55 | 1023 | // if ( justNoise(GraphBuffer, GraphTraceLen) ) { |
1024 | // PrintAndLog("Signal looks just like noise. Quitting."); | |
1025 | // return 0; | |
1026 | // } | |
1027 | ||
e9a92fe2 | 1028 | PrintAndLog("NOTE: some demods output possible binary\n if it finds something that looks like a tag"); |
1029 | PrintAndLog("False Positives ARE possible\n"); | |
1030 | PrintAndLog("\nChecking for known tags:\n"); | |
13d77ef9 | 1031 | |
e9a92fe2 | 1032 | ans=CmdFSKdemodIO(""); |
1033 | if (ans>0) { | |
6c283951 | 1034 | PrintAndLog("\nValid IO Prox ID Found!"); |
1035 | return 1; | |
e9a92fe2 | 1036 | } |
e9a92fe2 | 1037 | ans=CmdFSKdemodPyramid(""); |
1038 | if (ans>0) { | |
6c283951 | 1039 | PrintAndLog("\nValid Pyramid ID Found!"); |
1040 | return 1; | |
e9a92fe2 | 1041 | } |
e9a92fe2 | 1042 | ans=CmdFSKdemodParadox(""); |
1043 | if (ans>0) { | |
6c283951 | 1044 | PrintAndLog("\nValid Paradox ID Found!"); |
1045 | return 1; | |
e9a92fe2 | 1046 | } |
e9a92fe2 | 1047 | ans=CmdFSKdemodAWID(""); |
1048 | if (ans>0) { | |
6c283951 | 1049 | PrintAndLog("\nValid AWID ID Found!"); |
1050 | return 1; | |
e9a92fe2 | 1051 | } |
e9a92fe2 | 1052 | ans=CmdFSKdemodHID(""); |
1053 | if (ans>0) { | |
6c283951 | 1054 | PrintAndLog("\nValid HID Prox ID Found!"); |
1055 | return 1; | |
e9a92fe2 | 1056 | } |
e9a92fe2 | 1057 | ans=CmdAskEM410xDemod(""); |
1058 | if (ans>0) { | |
6c283951 | 1059 | PrintAndLog("\nValid EM410x ID Found!"); |
1060 | return 1; | |
e9a92fe2 | 1061 | } |
e9a92fe2 | 1062 | ans=CmdG_Prox_II_Demod(""); |
1063 | if (ans>0) { | |
6c283951 | 1064 | PrintAndLog("\nValid Guardall G-Prox II ID Found!"); |
1065 | return 1; | |
e9a92fe2 | 1066 | } |
ad6219fc | 1067 | ans=CmdFDXBdemodBI(""); |
1068 | if (ans>0) { | |
1069 | PrintAndLog("\nValid FDX-B ID Found!"); | |
1070 | return 1; | |
1071 | } | |
23f0a7d8 | 1072 | ans=EM4x50Read("", false); |
1073 | if (ans>0) { | |
1074 | PrintAndLog("\nValid EM4x50 ID Found!"); | |
1075 | return 1; | |
1076 | } | |
70459879 | 1077 | ans=CmdVikingDemod(""); |
1078 | if (ans>0) { | |
1079 | PrintAndLog("\nValid Viking ID Found!"); | |
1080 | return 1; | |
1081 | } | |
6426f6ba | 1082 | ans=CmdIndalaDecode(""); |
1083 | if (ans>0) { | |
1084 | PrintAndLog("\nValid Indala ID Found!"); | |
1085 | return 1; | |
1086 | } | |
411105e0 | 1087 | ans=CmdPSKNexWatch(""); |
1088 | if (ans>0) { | |
1089 | PrintAndLog("\nValid NexWatch ID Found!"); | |
1090 | return 1; | |
1091 | } | |
6c283951 | 1092 | ans=CmdJablotronDemod(""); |
1093 | if (ans>0) { | |
1094 | PrintAndLog("\nValid Jablotron ID Found!"); | |
1095 | return 1; | |
1096 | } | |
c71f4da9 | 1097 | ans=CmdLFNedapDemod(""); |
96faed21 | 1098 | if (ans>0) { |
1099 | PrintAndLog("\nValid NEDAP ID Found!"); | |
1100 | return 1; | |
1101 | } | |
eb911aa8 | 1102 | ans=CmdVisa2kDemod(""); |
1103 | if (ans>0) { | |
1104 | PrintAndLog("\nValid Visa2000 ID Found!"); | |
1105 | return 1; | |
1106 | } | |
e9a92fe2 | 1107 | // TIdemod? |
1108 | ||
411105e0 | 1109 | |
e9a92fe2 | 1110 | PrintAndLog("\nNo Known Tags Found!\n"); |
1111 | if (testRaw=='u' || testRaw=='U'){ | |
1112 | //test unknown tag formats (raw mode) | |
1113 | PrintAndLog("\nChecking for Unknown tags:\n"); | |
1114 | ans=AutoCorrelate(4000, FALSE, FALSE); | |
251d07db | 1115 | |
e9a92fe2 | 1116 | if (ans > 0) { |
251d07db | 1117 | |
e9a92fe2 | 1118 | PrintAndLog("Possible Auto Correlation of %d repeating samples",ans); |
251d07db | 1119 | |
e9a92fe2 | 1120 | if ( ans % 8 == 0) { |
1121 | int bytes = (ans / 8); | |
1122 | PrintAndLog("Possible %d bytes", bytes); | |
1123 | int blocks = 0; | |
1124 | if ( bytes % 2 == 0) { | |
1125 | blocks = (bytes / 2); | |
1126 | PrintAndLog("Possible 2 blocks, width %d", blocks); | |
1127 | } | |
1128 | if ( bytes % 4 == 0) { | |
1129 | blocks = (bytes / 4); | |
1130 | PrintAndLog("Possible 4 blocks, width %d", blocks); | |
1131 | } | |
1132 | if ( bytes % 8 == 0) { | |
1133 | blocks = (bytes / 8); | |
1134 | PrintAndLog("Possible 8 blocks, width %d", blocks); | |
1135 | } | |
1136 | if ( bytes % 16 == 0) { | |
1137 | blocks = (bytes / 16); | |
1138 | PrintAndLog("Possible 16 blocks, width %d", blocks); | |
1139 | } | |
251d07db | 1140 | } |
e9a92fe2 | 1141 | } |
1142 | ||
1143 | ans=GetFskClock("",FALSE,FALSE); | |
1144 | if (ans != 0){ //fsk | |
1145 | ans=FSKrawDemod("",TRUE); | |
1146 | if (ans>0) { | |
1147 | PrintAndLog("\nUnknown FSK Modulated Tag Found!"); | |
1148 | return 1; | |
251d07db | 1149 | } |
1150 | } | |
05164399 | 1151 | bool st = TRUE; |
1152 | ans=ASKDemod_ext("0 0 0",TRUE,FALSE,1,&st); | |
70459879 | 1153 | if (ans>0) { |
e9a92fe2 | 1154 | PrintAndLog("\nUnknown ASK Modulated and Manchester encoded Tag Found!"); |
1155 | PrintAndLog("\nif it does not look right it could instead be ASK/Biphase - try 'data rawdemod ab'"); | |
1156 | return 1; | |
1157 | } | |
1158 | ||
1159 | ans=CmdPSK1rawDemod(""); | |
1160 | if (ans>0) { | |
1161 | PrintAndLog("Possible unknown PSK1 Modulated Tag Found above!\n\nCould also be PSK2 - try 'data rawdemod p2'"); | |
1162 | PrintAndLog("\nCould also be PSK3 - [currently not supported]"); | |
1163 | PrintAndLog("\nCould also be NRZ - try 'data nrzrawdemod"); | |
70459879 | 1164 | return 1; |
1165 | } | |
e9a92fe2 | 1166 | PrintAndLog("\nNo Data Found!\n"); |
1167 | } | |
1168 | return 0; | |
d5a72d2f | 1169 | } |
1170 | ||
7fe9b0b7 | 1171 | static command_t CommandTable[] = |
1172 | { | |
c2731f37 | 1173 | {"help", CmdHelp, 1, "This help"}, |
9276e859 | 1174 | {"awid", CmdLFAWID, 1, "{ AWID RFIDs... }"}, |
c2731f37 | 1175 | {"em4x", CmdLFEM4X, 1, "{ EM4X RFIDs... }"}, |
50564be0 | 1176 | {"guard", CmdLFGuard, 1, "{ Guardall RFIDs... }"}, |
c2731f37 | 1177 | {"hid", CmdLFHID, 1, "{ HID RFIDs... }"}, |
1178 | {"hitag", CmdLFHitag, 1, "{ HITAG RFIDs... }"}, | |
eb911aa8 | 1179 | // {"indala", CmdLFIndala, 1, "{ Indala RFIDs... }"}, |
5a6e19e6 | 1180 | {"io", CmdLFIO, 1, "{ IOPROX RFIDs... }"}, |
6c283951 | 1181 | {"jablotron", CmdLFJablotron, 1, "{ JABLOTRON RFIDs... }"}, |
56bbb25a | 1182 | {"nedap", CmdLFNedap, 1, "{ NEDAP RFIDs... }"}, |
c2731f37 | 1183 | {"pcf7931", CmdLFPCF7931, 1, "{ PCF7931 RFIDs... }"}, |
5a6e19e6 | 1184 | {"presco", CmdLFPresco, 1, "{ Presco RFIDs... }"}, |
4b3655e7 | 1185 | {"pyramid", CmdLFPyramid, 1, "{ Farpointe/Pyramid RFIDs... }"}, |
c2731f37 | 1186 | {"ti", CmdLFTI, 1, "{ TI RFIDs... }"}, |
05164399 | 1187 | {"t55xx", CmdLFT55XX, 1, "{ T55xx RFIDs... }"}, |
c2731f37 | 1188 | {"viking", CmdLFViking, 1, "{ Viking RFIDs... }"}, |
eb911aa8 | 1189 | {"visa2000", CmdLFVisa2k, 1, "{ Visa2000 RFIDs... }"}, |
c2731f37 | 1190 | {"config", CmdLFSetConfig, 0, "Set config for LF sampling, bit/sample, decimation, frequency"}, |
c2731f37 | 1191 | {"cmdread", CmdLFCommandRead, 0, "<off period> <'0' period> <'1' period> <command> ['h' 134] \n\t\t-- Modulate LF reader field to send command before read (all periods in microseconds)"}, |
1192 | {"flexdemod", CmdFlexdemod, 1, "Demodulate samples for FlexPass"}, | |
1193 | {"indalademod", CmdIndalaDemod, 1, "['224'] -- Demodulate samples for Indala 64 bit UID (option '224' for 224 bit)"}, | |
1194 | {"indalaclone", CmdIndalaClone, 0, "<UID> ['l']-- Clone Indala to T55x7 (tag must be in antenna)(UID in HEX)(option 'l' for 224 UID"}, | |
1195 | {"read", CmdLFRead, 0, "['s' silent] Read 125/134 kHz LF ID-only tag. Do 'lf read h' for help"}, | |
1196 | {"search", CmdLFfind, 1, "[offline] ['u'] Read and Search for valid known tag (in offline mode it you can load first then search) \n\t\t-- 'u' to search for unknown tags"}, | |
1197 | {"sim", CmdLFSim, 0, "[GAP] -- Simulate LF tag from buffer with optional GAP (in microseconds)"}, | |
1198 | {"simask", CmdLFaskSim, 0, "[clock] [invert <1|0>] [biphase/manchester/raw <'b'|'m'|'r'>] [msg separator 's'] [d <hexdata>] \n\t\t-- Simulate LF ASK tag from demodbuffer or input"}, | |
1199 | {"simfsk", CmdLFfskSim, 0, "[c <clock>] [i] [H <fcHigh>] [L <fcLow>] [d <hexdata>] \n\t\t-- Simulate LF FSK tag from demodbuffer or input"}, | |
1200 | {"simpsk", CmdLFpskSim, 0, "[1|2|3] [c <clock>] [i] [r <carrier>] [d <raw hex to sim>] \n\t\t-- Simulate LF PSK tag from demodbuffer or input"}, | |
1201 | {"simbidir", CmdLFSimBidir, 0, "Simulate LF tag (with bidirectional data transmission between reader and tag)"}, | |
05164399 | 1202 | {"snoop", CmdLFSnoop, 0, "['l'|'h'|<divisor>] [trigger threshold]-- Snoop LF (l:125khz, h:134khz)"}, |
c2731f37 | 1203 | {"vchdemod", CmdVchDemod, 1, "['clone'] -- Demodulate samples for VeriChip"}, |
1204 | {NULL, NULL, 0, NULL} | |
7fe9b0b7 | 1205 | }; |
1206 | ||
4c36581b | 1207 | int CmdLF(const char *Cmd) { |
1208 | clearCommandBuffer(); | |
1209 | CmdsParse(CommandTable, Cmd); | |
1210 | return 0; | |
7fe9b0b7 | 1211 | } |
1212 | ||
4c36581b | 1213 | int CmdHelp(const char *Cmd) { |
1214 | CmdsHelp(CommandTable); | |
1215 | return 0; | |
7fe9b0b7 | 1216 | } |