]> git.zerfleddert.de Git - proxmark3-svn/blame - client/cmddata.c
CHG: minor code clean up.
[proxmark3-svn] / client / cmddata.c
CommitLineData
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// Data and Graph commands
9//-----------------------------------------------------------------------------
10
7fe9b0b7 11#include <stdio.h>
12#include <stdlib.h>
13#include <string.h>
14#include <limits.h>
902cb3c0 15#include "proxmark3.h"
7fe9b0b7 16#include "data.h"
17#include "ui.h"
18#include "graph.h"
19#include "cmdparser.h"
d51b2eda 20#include "util.h"
7fe9b0b7 21#include "cmdmain.h"
22#include "cmddata.h"
7db5f1ca 23#include "lfdemod.h"
7fe9b0b7 24
25static int CmdHelp(const char *Cmd);
26
27int CmdAmp(const char *Cmd)
28{
29 int i, rising, falling;
30 int max = INT_MIN, min = INT_MAX;
31
32 for (i = 10; i < GraphTraceLen; ++i) {
33 if (GraphBuffer[i] > max)
34 max = GraphBuffer[i];
35 if (GraphBuffer[i] < min)
36 min = GraphBuffer[i];
37 }
38
39 if (max != min) {
40 rising = falling= 0;
41 for (i = 0; i < GraphTraceLen; ++i) {
42 if (GraphBuffer[i + 1] < GraphBuffer[i]) {
43 if (rising) {
44 GraphBuffer[i] = max;
45 rising = 0;
46 }
47 falling = 1;
48 }
49 if (GraphBuffer[i + 1] > GraphBuffer[i]) {
50 if (falling) {
51 GraphBuffer[i] = min;
52 falling = 0;
53 }
54 rising= 1;
55 }
56 }
57 }
58 RepaintGraphWindow();
59 return 0;
60}
61
62/*
63 * Generic command to demodulate ASK.
64 *
65 * Argument is convention: positive or negative (High mod means zero
66 * or high mod means one)
67 *
68 * Updates the Graph trace with 0/1 values
69 *
70 * Arguments:
71 * c : 0 or 1
72 */
2fc2150e 73 //this method is dependant on all highs and lows to be the same(or clipped) this creates issues[marshmellow] it also ignores the clock
7fe9b0b7 74int Cmdaskdemod(const char *Cmd)
75{
76 int i;
77 int c, high = 0, low = 0;
78
79 // TODO: complain if we do not give 2 arguments here !
80 // (AL - this doesn't make sense! we're only using one argument!!!)
81 sscanf(Cmd, "%i", &c);
82
83 /* Detect high and lows and clock */
b3b70669 84 // (AL - clock???)
7fe9b0b7 85 for (i = 0; i < GraphTraceLen; ++i)
86 {
87 if (GraphBuffer[i] > high)
88 high = GraphBuffer[i];
89 else if (GraphBuffer[i] < low)
90 low = GraphBuffer[i];
91 }
eb191de6 92 high=abs(high*.75);
93 low=abs(low*.75);
7fe9b0b7 94 if (c != 0 && c != 1) {
95 PrintAndLog("Invalid argument: %s", Cmd);
96 return 0;
97 }
b3b70669 98 //prime loop
7fe9b0b7 99 if (GraphBuffer[0] > 0) {
100 GraphBuffer[0] = 1-c;
101 } else {
102 GraphBuffer[0] = c;
103 }
104 for (i = 1; i < GraphTraceLen; ++i) {
105 /* Transitions are detected at each peak
106 * Transitions are either:
107 * - we're low: transition if we hit a high
108 * - we're high: transition if we hit a low
109 * (we need to do it this way because some tags keep high or
110 * low for long periods, others just reach the peak and go
111 * down)
112 */
ae2f73c1 113 //[marhsmellow] change == to >= for high and <= for low for fuzz
114 if ((GraphBuffer[i] == high) && (GraphBuffer[i - 1] == c)) {
7fe9b0b7 115 GraphBuffer[i] = 1 - c;
ae2f73c1 116 } else if ((GraphBuffer[i] == low) && (GraphBuffer[i - 1] == (1 - c))){
7fe9b0b7 117 GraphBuffer[i] = c;
118 } else {
119 /* No transition */
120 GraphBuffer[i] = GraphBuffer[i - 1];
121 }
122 }
123 RepaintGraphWindow();
124 return 0;
125}
126
d5a72d2f 127//by marshmellow
128void printBitStream(uint8_t BitStream[], uint32_t bitLen)
129{
2fc2150e 130 uint32_t i = 0;
131 if (bitLen<16) {
132 PrintAndLog("Too few bits found: %d",bitLen);
133 return;
134 }
135 if (bitLen>512) bitLen=512;
2df8c079 136 for (i = 0; i <= (bitLen-16); i+=16) {
2fc2150e 137 PrintAndLog("%i%i%i%i%i%i%i%i%i%i%i%i%i%i%i%i",
138 BitStream[i],
139 BitStream[i+1],
140 BitStream[i+2],
141 BitStream[i+3],
142 BitStream[i+4],
143 BitStream[i+5],
144 BitStream[i+6],
145 BitStream[i+7],
146 BitStream[i+8],
147 BitStream[i+9],
148 BitStream[i+10],
149 BitStream[i+11],
150 BitStream[i+12],
151 BitStream[i+13],
152 BitStream[i+14],
153 BitStream[i+15]);
154 }
155 return;
156}
d5a72d2f 157//by marshmellow
eb191de6 158void printEM410x(uint64_t id)
2fc2150e 159{
eb191de6 160 if (id !=0){
0e74c023 161 uint64_t iii=1;
162 uint64_t id2lo=0; //id2hi=0,
eb191de6 163 uint32_t ii=0;
164 uint32_t i=0;
0e74c023 165 for (ii=5; ii>0;ii--){
2fc2150e 166 for (i=0;i<8;i++){
eb191de6 167 id2lo=(id2lo<<1LL)|((id & (iii<<(i+((ii-1)*8))))>>(i+((ii-1)*8)));
2fc2150e 168 }
169 }
0e74c023 170 //output em id
eb191de6 171 PrintAndLog("EM TAG ID : %010llx", id);
0e74c023 172 PrintAndLog("Unique TAG ID: %010llx", id2lo); //id2hi,
eb191de6 173 PrintAndLog("DEZ 8 : %08lld",id & 0xFFFFFF);
174 PrintAndLog("DEZ 10 : %010lld",id & 0xFFFFFF);
175 PrintAndLog("DEZ 5.5 : %05lld.%05lld",(id>>16LL) & 0xFFFF,(id & 0xFFFF));
176 PrintAndLog("DEZ 3.5A : %03lld.%05lld",(id>>32ll),(id & 0xFFFF));
177 PrintAndLog("DEZ 14/IK2 : %014lld",id);
0e74c023 178 PrintAndLog("DEZ 15/IK3 : %015lld",id2lo);
eb191de6 179 PrintAndLog("Other : %05lld_%03lld_%08lld",(id&0xFFFF),((id>>16LL) & 0xFF),(id & 0xFFFFFF));
180 }
181 return;
182}
183
d5a72d2f 184//by marshmellow
eb191de6 185int CmdEm410xDecode(const char *Cmd)
186{
187 uint64_t id=0;
188 uint8_t BitStream[MAX_GRAPH_TRACE_LEN]={0};
189 uint32_t i=0;
d5a72d2f 190 i=getFromGraphBuf(BitStream);
eb191de6 191 id = Em410xDecode(BitStream,i);
192 printEM410x(id);
d5a72d2f 193 if (id>0) return 1;
2fc2150e 194 return 0;
195}
196
f822a063 197
e888ed8e 198//by marshmellow
eb191de6 199//takes 2 arguments - clock and invert both as integers
200//attempts to demodulate ask while decoding manchester
e888ed8e 201//prints binary found and saves in graphbuffer for further commands
9e6dd4eb 202int Cmdaskmandemod(const char *Cmd)
e888ed8e 203{
eb191de6 204 int invert=0;
205 int clk=0;
206 uint8_t BitStream[MAX_GRAPH_TRACE_LEN]={0};
0e74c023 207 sscanf(Cmd, "%i %i", &clk, &invert);
e888ed8e 208 if (invert != 0 && invert != 1) {
209 PrintAndLog("Invalid argument: %s", Cmd);
210 return 0;
211 }
eb191de6 212 uint32_t BitLen = getFromGraphBuf(BitStream);
f822a063 213 // PrintAndLog("DEBUG: Bitlen from grphbuff: %d",BitLen);
eb191de6 214 int errCnt=0;
215 errCnt = askmandemod(BitStream, &BitLen,&clk,&invert);
f822a063 216 if (errCnt<0){ //if fatal error (or -1)
217 // PrintAndLog("no data found %d, errors:%d, bitlen:%d, clock:%d",errCnt,invert,BitLen,clk);
e888ed8e 218 return 0;
eb191de6 219 }
f822a063 220 if (BitLen<16) return 0;
221 PrintAndLog("\nUsing Clock: %d - Invert: %d - Bits Found: %d",clk,invert,BitLen);
222
d5a72d2f 223 //output
eb191de6 224 if (errCnt>0){
225 PrintAndLog("# Errors during Demoding (shown as 77 in bit stream): %d",errCnt);
e888ed8e 226 }
eb191de6 227 PrintAndLog("ASK/Manchester decoded bitstream:");
228 // Now output the bitstream to the scrollback by line of 16 bits
229 printBitStream(BitStream,BitLen);
230 uint64_t lo =0;
231 lo = Em410xDecode(BitStream,BitLen);
d5a72d2f 232 if (lo>0){
233 //set GraphBuffer for clone or sim command
234 setGraphBuf(BitStream,BitLen);
235 PrintAndLog("EM410x pattern found: ");
236 printEM410x(lo);
ac914e56 237 return 1;
d5a72d2f 238 }
ac914e56 239 //if (BitLen>16) return 1;
eb191de6 240 return 0;
241}
242
243//by marshmellow
d5a72d2f 244//manchester decode
eb191de6 245//stricktly take 10 and 01 and convert to 0 and 1
246int Cmdmandecoderaw(const char *Cmd)
247{
248 int i =0;
249 int errCnt=0;
250 int bitnum=0;
251 uint8_t BitStream[MAX_GRAPH_TRACE_LEN]={0};
252 int high=0,low=0;
253 for (;i<GraphTraceLen;++i){
254 if (GraphBuffer[i]>high) high=GraphBuffer[i];
255 else if(GraphBuffer[i]<low) low=GraphBuffer[i];
256 BitStream[i]=GraphBuffer[i];
257 }
258 if (high>1 || low <0 ){
259 PrintAndLog("Error: please raw demod the wave first then mancheseter raw decode");
260 return 0;
261 }
262 bitnum=i;
d5a72d2f 263 errCnt=manrawdecode(BitStream,&bitnum);
2df8c079 264 if (errCnt>=20){
265 PrintAndLog("Too many errors: %d",errCnt);
266 return 0;
267 }
eb191de6 268 PrintAndLog("Manchester Decoded - # errors:%d - data:",errCnt);
269 printBitStream(BitStream,bitnum);
270 if (errCnt==0){
271 //put back in graphbuffer
2fc2150e 272 ClearGraph(0);
eb191de6 273 for (i=0; i<bitnum;++i){
2fc2150e 274 GraphBuffer[i]=BitStream[i];
eb191de6 275 }
2fc2150e 276 GraphTraceLen=bitnum;
277 RepaintGraphWindow();
eb191de6 278 uint64_t id = 0;
279 id = Em410xDecode(BitStream,i);
280 printEM410x(id);
281 }
d5a72d2f 282 return 1;
283}
284
285//by marshmellow
286//biphase decode
287//take 01 or 10 = 0 and 11 or 00 = 1
288//takes 1 argument "offset" default = 0 if 1 it will shift the decode by one bit
289// since it is not like manchester and doesn't have an incorrect bit pattern we
290// cannot determine if our decode is correct or if it should be shifted by one bit
291// the argument offset allows us to manually shift if the output is incorrect
292// (better would be to demod and decode at the same time so we can distinguish large
293// width waves vs small width waves to help the decode positioning) or askbiphdemod
294int CmdBiphaseDecodeRaw(const char *Cmd)
295{
296 int i = 0;
297 int errCnt=0;
298 int bitnum=0;
299 int offset=0;
300 int high=0, low=0;
301 sscanf(Cmd, "%i", &offset);
302 uint8_t BitStream[MAX_GRAPH_TRACE_LEN]={0};
303 //get graphbuffer & high and low
304 for (;i<GraphTraceLen;++i){
305 if(GraphBuffer[i]>high)high=GraphBuffer[i];
306 else if(GraphBuffer[i]<low)low=GraphBuffer[i];
307 BitStream[i]=GraphBuffer[i];
308 }
309 if (high>1 || low <0){
310 PrintAndLog("Error: please raw demod the wave first then decode");
311 return 0;
312 }
313 bitnum=i;
314 errCnt=BiphaseRawDecode(BitStream,&bitnum, offset);
315 if (errCnt>=20){
316 PrintAndLog("Too many errors attempting to decode: %d",errCnt);
317 return 0;
318 }
319 PrintAndLog("Biphase Decoded using offset: %d - # errors:%d - data:",offset,errCnt);
320 printBitStream(BitStream,bitnum);
321 PrintAndLog("\nif bitstream does not look right try offset=1");
322 return 1;
eb191de6 323}
324
d5a72d2f 325
eb191de6 326//by marshmellow
327//takes 2 arguments - clock and invert both as integers
328//attempts to demodulate ask only
329//prints binary found and saves in graphbuffer for further commands
330int Cmdaskrawdemod(const char *Cmd)
331{
3fe4ff4f 332
eb191de6 333 int invert=0;
334 int clk=0;
335 uint8_t BitStream[MAX_GRAPH_TRACE_LEN]={0};
336 sscanf(Cmd, "%i %i", &clk, &invert);
337 if (invert != 0 && invert != 1) {
338 PrintAndLog("Invalid argument: %s", Cmd);
339 return 0;
340 }
341 int BitLen = getFromGraphBuf(BitStream);
342 int errCnt=0;
3fe4ff4f 343 errCnt = askrawdemod(BitStream, &BitLen, &clk, &invert);
eb191de6 344 if (errCnt==-1){ //throw away static - allow 1 and -1 (in case of threshold command first)
345 PrintAndLog("no data found");
346 return 0;
347 }
f822a063 348 if (BitLen<16) return 0;
349 PrintAndLog("Using Clock: %d - invert: %d - Bits Found: %d",clk,invert,BitLen);
eb191de6 350 //PrintAndLog("Data start pos:%d, lastBit:%d, stop pos:%d, numBits:%d",iii,lastBit,i,bitnum);
351 //move BitStream back to GraphBuffer
3fe4ff4f 352 setGraphBuf(BitStream, BitLen);
353
eb191de6 354 if (errCnt>0){
355 PrintAndLog("# Errors during Demoding (shown as 77 in bit stream): %d",errCnt);
356 }
3fe4ff4f 357
eb191de6 358 PrintAndLog("ASK demoded bitstream:");
3fe4ff4f 359
eb191de6 360 // Now output the bitstream to the scrollback by line of 16 bits
361 printBitStream(BitStream,BitLen);
362
f822a063 363 return 1;
e888ed8e 364}
365
7fe9b0b7 366int CmdAutoCorr(const char *Cmd)
367{
368 static int CorrelBuffer[MAX_GRAPH_TRACE_LEN];
369
370 int window = atoi(Cmd);
371
372 if (window == 0) {
373 PrintAndLog("needs a window");
374 return 0;
375 }
376 if (window >= GraphTraceLen) {
377 PrintAndLog("window must be smaller than trace (%d samples)",
378 GraphTraceLen);
379 return 0;
380 }
381
382 PrintAndLog("performing %d correlations", GraphTraceLen - window);
383
384 for (int i = 0; i < GraphTraceLen - window; ++i) {
385 int sum = 0;
386 for (int j = 0; j < window; ++j) {
387 sum += (GraphBuffer[j]*GraphBuffer[i + j]) / 256;
388 }
389 CorrelBuffer[i] = sum;
390 }
391 GraphTraceLen = GraphTraceLen - window;
392 memcpy(GraphBuffer, CorrelBuffer, GraphTraceLen * sizeof (int));
393
394 RepaintGraphWindow();
395 return 0;
396}
397
398int CmdBitsamples(const char *Cmd)
399{
400 int cnt = 0;
90d74dc2 401 uint8_t got[12288];
402
403 GetFromBigBuf(got,sizeof(got),0);
404 WaitForResponse(CMD_ACK,NULL);
7fe9b0b7 405
90d74dc2 406 for (int j = 0; j < sizeof(got); j++) {
7fe9b0b7 407 for (int k = 0; k < 8; k++) {
90d74dc2 408 if(got[j] & (1 << (7 - k))) {
7fe9b0b7 409 GraphBuffer[cnt++] = 1;
410 } else {
411 GraphBuffer[cnt++] = 0;
412 }
413 }
7fe9b0b7 414 }
415 GraphTraceLen = cnt;
416 RepaintGraphWindow();
417 return 0;
418}
419
420/*
421 * Convert to a bitstream
422 */
423int CmdBitstream(const char *Cmd)
424{
425 int i, j;
426 int bit;
427 int gtl;
428 int clock;
429 int low = 0;
430 int high = 0;
431 int hithigh, hitlow, first;
432
433 /* Detect high and lows and clock */
434 for (i = 0; i < GraphTraceLen; ++i)
435 {
436 if (GraphBuffer[i] > high)
437 high = GraphBuffer[i];
438 else if (GraphBuffer[i] < low)
439 low = GraphBuffer[i];
440 }
441
442 /* Get our clock */
443 clock = GetClock(Cmd, high, 1);
444 gtl = ClearGraph(0);
445
446 bit = 0;
447 for (i = 0; i < (int)(gtl / clock); ++i)
448 {
449 hithigh = 0;
450 hitlow = 0;
451 first = 1;
452 /* Find out if we hit both high and low peaks */
453 for (j = 0; j < clock; ++j)
454 {
455 if (GraphBuffer[(i * clock) + j] == high)
456 hithigh = 1;
457 else if (GraphBuffer[(i * clock) + j] == low)
458 hitlow = 1;
459 /* it doesn't count if it's the first part of our read
460 because it's really just trailing from the last sequence */
461 if (first && (hithigh || hitlow))
462 hithigh = hitlow = 0;
463 else
464 first = 0;
465
466 if (hithigh && hitlow)
467 break;
468 }
469
470 /* If we didn't hit both high and low peaks, we had a bit transition */
471 if (!hithigh || !hitlow)
472 bit ^= 1;
473
474 AppendGraph(0, clock, bit);
7fe9b0b7 475 }
476
477 RepaintGraphWindow();
478 return 0;
479}
480
481int CmdBuffClear(const char *Cmd)
482{
483 UsbCommand c = {CMD_BUFF_CLEAR};
484 SendCommand(&c);
485 ClearGraph(true);
486 return 0;
487}
488
489int CmdDec(const char *Cmd)
490{
491 for (int i = 0; i < (GraphTraceLen / 2); ++i)
492 GraphBuffer[i] = GraphBuffer[i * 2];
493 GraphTraceLen /= 2;
494 PrintAndLog("decimated by 2");
495 RepaintGraphWindow();
496 return 0;
497}
498
499/* Print our clock rate */
d5a72d2f 500// uses data from graphbuffer
7fe9b0b7 501int CmdDetectClockRate(const char *Cmd)
502{
d5a72d2f 503 GetClock("",0,0);
7fe9b0b7 504 return 0;
505}
66707a3b 506
2fc2150e 507//by marshmellow
eb191de6 508//fsk raw demod and print binary
f822a063 509//takes 4 arguments - Clock, invert, rchigh, rclow
510//defaults: clock = 50, invert=0, rchigh=10, rclow=8 (RF/10 RF/8 (fsk2a))
e888ed8e 511int CmdFSKrawdemod(const char *Cmd)
b3b70669 512{
eb191de6 513 //raw fsk demod no manchester decoding no start bit finding just get binary from wave
b3b70669 514 //set defaults
f822a063 515 int rfLen = 50;
516 int invert=0;
517 int fchigh=10;
518 int fclow=8;
b3b70669 519 //set options from parameters entered with the command
f822a063 520 sscanf(Cmd, "%i %i %i %i", &rfLen, &invert, &fchigh, &fclow);
521
b3b70669 522 if (strlen(Cmd)>0 && strlen(Cmd)<=2) {
f822a063 523 //rfLen=param_get8(Cmd, 0); //if rfLen option only is used
b3b70669 524 if (rfLen==1){
525 invert=1; //if invert option only is used
526 rfLen = 50;
527 } else if(rfLen==0) rfLen=50;
528 }
f822a063 529 PrintAndLog("Args invert: %d - Clock:%d - fchigh:%d - fclow: %d",invert,rfLen,fchigh, fclow);
eb191de6 530 uint32_t i=0;
531 uint8_t BitStream[MAX_GRAPH_TRACE_LEN]={0};
532 uint32_t BitLen = getFromGraphBuf(BitStream);
f822a063 533 int size = fskdemod(BitStream,BitLen,(uint8_t)rfLen,(uint8_t)invert,(uint8_t)fchigh,(uint8_t)fclow);
d5a72d2f 534 if (size>0){
535 PrintAndLog("FSK decoded bitstream:");
536 ClearGraph(0);
537 for (i=0;i<size;++i){
538 GraphBuffer[i]=BitStream[i];
539 }
540 GraphTraceLen=size;
541 RepaintGraphWindow();
542
543 // Now output the bitstream to the scrollback by line of 16 bits
544 if(size > (8*32)+2) size = (8*32)+2; //only output a max of 8 blocks of 32 bits most tags will have full bit stream inside that sample size
545 printBitStream(BitStream,size);
546 } else{
547 PrintAndLog("no FSK data found");
eb191de6 548 }
b3b70669 549 return 0;
550}
551
eb191de6 552//by marshmellow (based on existing demod + holiman's refactor)
553//HID Prox demod - FSK RF/50 with preamble of 00011101 (then manchester encoded)
554//print full HID Prox ID and some bit format details if found
b3b70669 555int CmdFSKdemodHID(const char *Cmd)
556{
557 //raw fsk demod no manchester decoding no start bit finding just get binary from wave
b3b70669 558 uint32_t hi2=0, hi=0, lo=0;
559
eb191de6 560 uint8_t BitStream[MAX_GRAPH_TRACE_LEN]={0};
561 uint32_t BitLen = getFromGraphBuf(BitStream);
b3b70669 562 //get binary from fsk wave
eb191de6 563 size_t size = HIDdemodFSK(BitStream,BitLen,&hi2,&hi,&lo);
564 if (size<0){
565 PrintAndLog("Error demoding fsk");
566 return 0;
567 }
d5a72d2f 568 if (hi2==0 && hi==0 && lo==0) return 0;
eb191de6 569 if (hi2 != 0){ //extra large HID tags
570 PrintAndLog("TAG ID: %x%08x%08x (%d)",
571 (unsigned int) hi2, (unsigned int) hi, (unsigned int) lo, (unsigned int) (lo>>1) & 0xFFFF);
d5a72d2f 572 setGraphBuf(BitStream,BitLen);
573 return 1;
eb191de6 574 }
575 else { //standard HID tags <38 bits
576 //Dbprintf("TAG ID: %x%08x (%d)",(unsigned int) hi, (unsigned int) lo, (unsigned int) (lo>>1) & 0xFFFF); //old print cmd
d5a72d2f 577 uint8_t fmtLen = 0;
eb191de6 578 uint32_t fc = 0;
579 uint32_t cardnum = 0;
580 if (((hi>>5)&1)==1){//if bit 38 is set then < 37 bit format is used
581 uint32_t lo2=0;
582 lo2=(((hi & 15) << 12) | (lo>>20)); //get bits 21-37 to check for format len bit
583 uint8_t idx3 = 1;
584 while(lo2>1){ //find last bit set to 1 (format len bit)
585 lo2=lo2>>1;
586 idx3++;
b3b70669 587 }
d5a72d2f 588 fmtLen =idx3+19;
eb191de6 589 fc =0;
590 cardnum=0;
d5a72d2f 591 if(fmtLen==26){
eb191de6 592 cardnum = (lo>>1)&0xFFFF;
593 fc = (lo>>17)&0xFF;
594 }
d5a72d2f 595 if(fmtLen==37){
eb191de6 596 cardnum = (lo>>1)&0x7FFFF;
597 fc = ((hi&0xF)<<12)|(lo>>20);
598 }
d5a72d2f 599 if(fmtLen==34){
eb191de6 600 cardnum = (lo>>1)&0xFFFF;
601 fc= ((hi&1)<<15)|(lo>>17);
602 }
d5a72d2f 603 if(fmtLen==35){
eb191de6 604 cardnum = (lo>>1)&0xFFFFF;
605 fc = ((hi&1)<<11)|(lo>>21);
b3b70669 606 }
b3b70669 607 }
eb191de6 608 else { //if bit 38 is not set then 37 bit format is used
d5a72d2f 609 fmtLen= 37;
eb191de6 610 fc =0;
611 cardnum=0;
d5a72d2f 612 if(fmtLen==37){
eb191de6 613 cardnum = (lo>>1)&0x7FFFF;
614 fc = ((hi&0xF)<<12)|(lo>>20);
615 }
616 }
617 PrintAndLog("TAG ID: %x%08x (%d) - Format Len: %dbit - FC: %d - Card: %d",
618 (unsigned int) hi, (unsigned int) lo, (unsigned int) (lo>>1) & 0xFFFF,
d5a72d2f 619 (unsigned int) fmtLen, (unsigned int) fc, (unsigned int) cardnum);
620 setGraphBuf(BitStream,BitLen);
621 return 1;
b3b70669 622 }
b3b70669 623 return 0;
624}
625
2fc2150e 626//by marshmellow
eb191de6 627//IO-Prox demod - FSK RF/64 with preamble of 000000001
628//print ioprox ID and some format details
b3b70669 629int CmdFSKdemodIO(const char *Cmd)
630{
631 //raw fsk demod no manchester decoding no start bit finding just get binary from wave
632 //set defaults
eb191de6 633 int idx=0;
d5a72d2f 634 //something in graphbuffer
635 if (GraphTraceLen < 65) return 0;
eb191de6 636 uint8_t BitStream[MAX_GRAPH_TRACE_LEN]={0};
637 uint32_t BitLen = getFromGraphBuf(BitStream);
638 //get binary from fsk wave
d5a72d2f 639 // PrintAndLog("DEBUG: got buff");
eb191de6 640 idx = IOdemodFSK(BitStream,BitLen);
641 if (idx<0){
d5a72d2f 642 //PrintAndLog("Error demoding fsk");
eb191de6 643 return 0;
644 }
d5a72d2f 645 // PrintAndLog("DEBUG: Got IOdemodFSK");
eb191de6 646 if (idx==0){
d5a72d2f 647 //PrintAndLog("IO Prox Data not found - FSK Data:");
648 //if (BitLen > 92) printBitStream(BitStream,92);
649 return 0;
b3b70669 650 }
b3b70669 651 //Index map
652 //0 10 20 30 40 50 60
653 //| | | | | | |
654 //01234567 8 90123456 7 89012345 6 78901234 5 67890123 4 56789012 3 45678901 23
655 //-----------------------------------------------------------------------------
656 //00000000 0 11110000 1 facility 1 version* 1 code*one 1 code*two 1 ???????? 11
657 //
658 //XSF(version)facility:codeone+codetwo (raw)
659 //Handle the data
d5a72d2f 660 if (idx+64>BitLen) return 0;
eb191de6 661 PrintAndLog("%d%d%d%d%d%d%d%d %d",BitStream[idx], BitStream[idx+1], BitStream[idx+2], BitStream[idx+3], BitStream[idx+4], BitStream[idx+5], BitStream[idx+6], BitStream[idx+7], BitStream[idx+8]);
662 PrintAndLog("%d%d%d%d%d%d%d%d %d",BitStream[idx+9], BitStream[idx+10], BitStream[idx+11],BitStream[idx+12],BitStream[idx+13],BitStream[idx+14],BitStream[idx+15],BitStream[idx+16],BitStream[idx+17]);
f822a063 663 PrintAndLog("%d%d%d%d%d%d%d%d %d facility",BitStream[idx+18], BitStream[idx+19], BitStream[idx+20],BitStream[idx+21],BitStream[idx+22],BitStream[idx+23],BitStream[idx+24],BitStream[idx+25],BitStream[idx+26]);
664 PrintAndLog("%d%d%d%d%d%d%d%d %d version",BitStream[idx+27], BitStream[idx+28], BitStream[idx+29],BitStream[idx+30],BitStream[idx+31],BitStream[idx+32],BitStream[idx+33],BitStream[idx+34],BitStream[idx+35]);
665 PrintAndLog("%d%d%d%d%d%d%d%d %d code1",BitStream[idx+36], BitStream[idx+37], BitStream[idx+38],BitStream[idx+39],BitStream[idx+40],BitStream[idx+41],BitStream[idx+42],BitStream[idx+43],BitStream[idx+44]);
666 PrintAndLog("%d%d%d%d%d%d%d%d %d code2",BitStream[idx+45], BitStream[idx+46], BitStream[idx+47],BitStream[idx+48],BitStream[idx+49],BitStream[idx+50],BitStream[idx+51],BitStream[idx+52],BitStream[idx+53]);
667 PrintAndLog("%d%d%d%d%d%d%d%d %d%d checksum",BitStream[idx+54],BitStream[idx+55],BitStream[idx+56],BitStream[idx+57],BitStream[idx+58],BitStream[idx+59],BitStream[idx+60],BitStream[idx+61],BitStream[idx+62],BitStream[idx+63]);
eb191de6 668
669 uint32_t code = bytebits_to_byte(BitStream+idx,32);
670 uint32_t code2 = bytebits_to_byte(BitStream+idx+32,32);
f822a063 671 uint8_t version = bytebits_to_byte(BitStream+idx+27,8); //14,4
672 uint8_t facilitycode = bytebits_to_byte(BitStream+idx+18,8) ;
eb191de6 673 uint16_t number = (bytebits_to_byte(BitStream+idx+36,8)<<8)|(bytebits_to_byte(BitStream+idx+45,8)); //36,9
674
f822a063 675 PrintAndLog("XSF(%02d)%02x:%05d (%08x%08x)",version,facilitycode,number,code,code2);
d5a72d2f 676 setGraphBuf(BitStream,BitLen);
677 return 1;
b3b70669 678}
e888ed8e 679int CmdFSKdemod(const char *Cmd) //old CmdFSKdemod needs updating
7fe9b0b7 680{
681 static const int LowTone[] = {
682 1, 1, 1, 1, 1, -1, -1, -1, -1, -1,
683 1, 1, 1, 1, 1, -1, -1, -1, -1, -1,
684 1, 1, 1, 1, 1, -1, -1, -1, -1, -1,
685 1, 1, 1, 1, 1, -1, -1, -1, -1, -1,
686 1, 1, 1, 1, 1, -1, -1, -1, -1, -1
687 };
688 static const int HighTone[] = {
689 1, 1, 1, 1, 1, -1, -1, -1, -1,
690 1, 1, 1, 1, -1, -1, -1, -1,
691 1, 1, 1, 1, -1, -1, -1, -1,
692 1, 1, 1, 1, -1, -1, -1, -1,
693 1, 1, 1, 1, -1, -1, -1, -1,
694 1, 1, 1, 1, -1, -1, -1, -1, -1,
695 };
696
697 int lowLen = sizeof (LowTone) / sizeof (int);
698 int highLen = sizeof (HighTone) / sizeof (int);
b3b70669 699 int convLen = (highLen > lowLen) ? highLen : lowLen; //if highlen > lowLen then highlen else lowlen
7fe9b0b7 700 uint32_t hi = 0, lo = 0;
701
702 int i, j;
703 int minMark = 0, maxMark = 0;
b3b70669 704
7fe9b0b7 705 for (i = 0; i < GraphTraceLen - convLen; ++i) {
706 int lowSum = 0, highSum = 0;
707
708 for (j = 0; j < lowLen; ++j) {
709 lowSum += LowTone[j]*GraphBuffer[i+j];
710 }
711 for (j = 0; j < highLen; ++j) {
712 highSum += HighTone[j] * GraphBuffer[i + j];
713 }
714 lowSum = abs(100 * lowSum / lowLen);
715 highSum = abs(100 * highSum / highLen);
716 GraphBuffer[i] = (highSum << 16) | lowSum;
717 }
718
719 for(i = 0; i < GraphTraceLen - convLen - 16; ++i) {
720 int lowTot = 0, highTot = 0;
721 // 10 and 8 are f_s divided by f_l and f_h, rounded
722 for (j = 0; j < 10; ++j) {
723 lowTot += (GraphBuffer[i+j] & 0xffff);
724 }
725 for (j = 0; j < 8; j++) {
726 highTot += (GraphBuffer[i + j] >> 16);
727 }
728 GraphBuffer[i] = lowTot - highTot;
729 if (GraphBuffer[i] > maxMark) maxMark = GraphBuffer[i];
730 if (GraphBuffer[i] < minMark) minMark = GraphBuffer[i];
731 }
732
733 GraphTraceLen -= (convLen + 16);
734 RepaintGraphWindow();
735
b3b70669 736 // Find bit-sync (3 lo followed by 3 high) (HID ONLY)
7fe9b0b7 737 int max = 0, maxPos = 0;
738 for (i = 0; i < 6000; ++i) {
739 int dec = 0;
740 for (j = 0; j < 3 * lowLen; ++j) {
741 dec -= GraphBuffer[i + j];
742 }
743 for (; j < 3 * (lowLen + highLen ); ++j) {
744 dec += GraphBuffer[i + j];
745 }
746 if (dec > max) {
747 max = dec;
748 maxPos = i;
749 }
750 }
751
752 // place start of bit sync marker in graph
753 GraphBuffer[maxPos] = maxMark;
754 GraphBuffer[maxPos + 1] = minMark;
755
756 maxPos += j;
757
758 // place end of bit sync marker in graph
759 GraphBuffer[maxPos] = maxMark;
760 GraphBuffer[maxPos+1] = minMark;
761
762 PrintAndLog("actual data bits start at sample %d", maxPos);
763 PrintAndLog("length %d/%d", highLen, lowLen);
764
3fe4ff4f 765 uint8_t bits[46] = {0x00};
7fe9b0b7 766
767 // find bit pairs and manchester decode them
768 for (i = 0; i < arraylen(bits) - 1; ++i) {
769 int dec = 0;
770 for (j = 0; j < lowLen; ++j) {
771 dec -= GraphBuffer[maxPos + j];
772 }
773 for (; j < lowLen + highLen; ++j) {
774 dec += GraphBuffer[maxPos + j];
775 }
776 maxPos += j;
777 // place inter bit marker in graph
778 GraphBuffer[maxPos] = maxMark;
779 GraphBuffer[maxPos + 1] = minMark;
780
781 // hi and lo form a 64 bit pair
782 hi = (hi << 1) | (lo >> 31);
783 lo = (lo << 1);
784 // store decoded bit as binary (in hi/lo) and text (in bits[])
785 if(dec < 0) {
786 bits[i] = '1';
787 lo |= 1;
788 } else {
789 bits[i] = '0';
790 }
791 }
792 PrintAndLog("bits: '%s'", bits);
793 PrintAndLog("hex: %08x %08x", hi, lo);
794 return 0;
795}
e888ed8e 796
7fe9b0b7 797int CmdGrid(const char *Cmd)
798{
799 sscanf(Cmd, "%i %i", &PlotGridX, &PlotGridY);
7ddb9900 800 PlotGridXdefault= PlotGridX;
801 PlotGridYdefault= PlotGridY;
7fe9b0b7 802 RepaintGraphWindow();
803 return 0;
804}
805
806int CmdHexsamples(const char *Cmd)
807{
4961e292 808 int i, j;
7fe9b0b7 809 int requested = 0;
810 int offset = 0;
4961e292 811 char string_buf[25];
812 char* string_ptr = string_buf;
90d74dc2 813 uint8_t got[40000];
4961e292 814
815 sscanf(Cmd, "%i %i", &requested, &offset);
90d74dc2 816
4961e292 817 /* if no args send something */
818 if (requested == 0) {
90d74dc2 819 requested = 8;
820 }
90d74dc2 821 if (offset + requested > sizeof(got)) {
822 PrintAndLog("Tried to read past end of buffer, <bytes> + <offset> > 40000");
4961e292 823 return 0;
824 }
90d74dc2 825
4961e292 826 GetFromBigBuf(got,requested,offset);
90d74dc2 827 WaitForResponse(CMD_ACK,NULL);
828
4961e292 829 i = 0;
830 for (j = 0; j < requested; j++) {
831 i++;
832 string_ptr += sprintf(string_ptr, "%02x ", got[j]);
833 if (i == 8) {
834 *(string_ptr - 1) = '\0'; // remove the trailing space
835 PrintAndLog("%s", string_buf);
836 string_buf[0] = '\0';
837 string_ptr = string_buf;
838 i = 0;
839 }
840 if (j == requested - 1 && string_buf[0] != '\0') { // print any remaining bytes
841 *(string_ptr - 1) = '\0';
842 PrintAndLog("%s", string_buf);
843 string_buf[0] = '\0';
844 }
7fe9b0b7 845 }
846 return 0;
847}
848
7fe9b0b7 849int CmdHide(const char *Cmd)
850{
851 HideGraphWindow();
852 return 0;
853}
854
855int CmdHpf(const char *Cmd)
856{
857 int i;
858 int accum = 0;
859
860 for (i = 10; i < GraphTraceLen; ++i)
861 accum += GraphBuffer[i];
862 accum /= (GraphTraceLen - 10);
863 for (i = 0; i < GraphTraceLen; ++i)
864 GraphBuffer[i] -= accum;
865
866 RepaintGraphWindow();
867 return 0;
868}
869
8d183c53 870int CmdSamples(const char *Cmd)
7fe9b0b7 871{
3fe4ff4f 872 uint8_t got[40000] = {0x00};
873
874 int n = strtol(Cmd, NULL, 0);
875 if (n == 0)
876 n = 20000;
877
878 if (n > sizeof(got))
879 n = sizeof(got);
a2847518 880
3fe4ff4f 881 PrintAndLog("Reading %d samples from device memory\n", n);
90d74dc2 882 GetFromBigBuf(got,n,0);
a2847518 883 WaitForResponse(CMD_ACK,NULL);
3fe4ff4f 884 for (int j = 0; j < n; ++j) {
885 GraphBuffer[j] = ((int)got[j]) - 128;
7fe9b0b7 886 }
90d74dc2 887 GraphTraceLen = n;
7fe9b0b7 888 RepaintGraphWindow();
889 return 0;
890}
891
d6a120a2
MHS
892int CmdTuneSamples(const char *Cmd)
893{
d91a31f9 894 int timeout = 0;
895 printf("\nMeasuring antenna characteristics, please wait...");
896
897 UsbCommand c = {CMD_MEASURE_ANTENNA_TUNING};
898 SendCommand(&c);
899
900 UsbCommand resp;
901 while(!WaitForResponseTimeout(CMD_MEASURED_ANTENNA_TUNING,&resp,1000)) {
902 timeout++;
903 printf(".");
904 if (timeout > 7) {
905 PrintAndLog("\nNo response from Proxmark. Aborting...");
906 return 1;
907 }
908 }
909
910 int peakv, peakf;
911 int vLf125, vLf134, vHf;
912 vLf125 = resp.arg[0] & 0xffff;
913 vLf134 = resp.arg[0] >> 16;
914 vHf = resp.arg[1] & 0xffff;;
915 peakf = resp.arg[2] & 0xffff;
916 peakv = resp.arg[2] >> 16;
917 PrintAndLog("");
918 PrintAndLog("# LF antenna: %5.2f V @ 125.00 kHz", vLf125/1000.0);
919 PrintAndLog("# LF antenna: %5.2f V @ 134.00 kHz", vLf134/1000.0);
920 PrintAndLog("# LF optimal: %5.2f V @%9.2f kHz", peakv/1000.0, 12000.0/(peakf+1));
921 PrintAndLog("# HF antenna: %5.2f V @ 13.56 MHz", vHf/1000.0);
922 if (peakv<2000)
923 PrintAndLog("# Your LF antenna is unusable.");
924 else if (peakv<10000)
925 PrintAndLog("# Your LF antenna is marginal.");
926 if (vHf<2000)
927 PrintAndLog("# Your HF antenna is unusable.");
928 else if (vHf<5000)
929 PrintAndLog("# Your HF antenna is marginal.");
930
931 for (int i = 0; i < 256; i++) {
932 GraphBuffer[i] = resp.d.asBytes[i] - 128;
d5a72d2f 933 }
934
935 PrintAndLog("Done! Divisor 89 is 134khz, 95 is 125khz.\n");
936 PrintAndLog("\n");
d91a31f9 937 GraphTraceLen = 256;
938 ShowGraphWindow();
939
d5a72d2f 940 return 0;
d6a120a2
MHS
941}
942
7fe9b0b7 943int CmdLoad(const char *Cmd)
944{
c6f1fb9d 945 FILE *f = fopen(Cmd, "r");
7fe9b0b7 946 if (!f) {
c6f1fb9d 947 PrintAndLog("couldn't open '%s'", Cmd);
7fe9b0b7 948 return 0;
949 }
950
951 GraphTraceLen = 0;
952 char line[80];
953 while (fgets(line, sizeof (line), f)) {
954 GraphBuffer[GraphTraceLen] = atoi(line);
955 GraphTraceLen++;
956 }
957 fclose(f);
958 PrintAndLog("loaded %d samples", GraphTraceLen);
959 RepaintGraphWindow();
960 return 0;
961}
962
963int CmdLtrim(const char *Cmd)
964{
965 int ds = atoi(Cmd);
966
967 for (int i = ds; i < GraphTraceLen; ++i)
968 GraphBuffer[i-ds] = GraphBuffer[i];
969 GraphTraceLen -= ds;
970
971 RepaintGraphWindow();
972 return 0;
973}
9ec1416a 974int CmdRtrim(const char *Cmd)
975{
976 int ds = atoi(Cmd);
977
978 GraphTraceLen = ds;
979
980 RepaintGraphWindow();
981 return 0;
982}
7fe9b0b7 983
984/*
985 * Manchester demodulate a bitstream. The bitstream needs to be already in
986 * the GraphBuffer as 0 and 1 values
987 *
988 * Give the clock rate as argument in order to help the sync - the algorithm
989 * resyncs at each pulse anyway.
990 *
991 * Not optimized by any means, this is the 1st time I'm writing this type of
992 * routine, feel free to improve...
993 *
994 * 1st argument: clock rate (as number of samples per clock rate)
995 * Typical values can be 64, 32, 128...
996 */
997int CmdManchesterDemod(const char *Cmd)
998{
999 int i, j, invert= 0;
1000 int bit;
1001 int clock;
fddf220a 1002 int lastval = 0;
7fe9b0b7 1003 int low = 0;
1004 int high = 0;
1005 int hithigh, hitlow, first;
1006 int lc = 0;
1007 int bitidx = 0;
1008 int bit2idx = 0;
1009 int warnings = 0;
1010
1011 /* check if we're inverting output */
c6f1fb9d 1012 if (*Cmd == 'i')
7fe9b0b7 1013 {
1014 PrintAndLog("Inverting output");
1015 invert = 1;
fffad860 1016 ++Cmd;
7fe9b0b7 1017 do
1018 ++Cmd;
1019 while(*Cmd == ' '); // in case a 2nd argument was given
1020 }
1021
1022 /* Holds the decoded bitstream: each clock period contains 2 bits */
1023 /* later simplified to 1 bit after manchester decoding. */
1024 /* Add 10 bits to allow for noisy / uncertain traces without aborting */
1025 /* int BitStream[GraphTraceLen*2/clock+10]; */
1026
1027 /* But it does not work if compiling on WIndows: therefore we just allocate a */
1028 /* large array */
90e278d3 1029 uint8_t BitStream[MAX_GRAPH_TRACE_LEN] = {0};
7fe9b0b7 1030
1031 /* Detect high and lows */
1032 for (i = 0; i < GraphTraceLen; i++)
1033 {
1034 if (GraphBuffer[i] > high)
1035 high = GraphBuffer[i];
1036 else if (GraphBuffer[i] < low)
1037 low = GraphBuffer[i];
1038 }
1039
1040 /* Get our clock */
1041 clock = GetClock(Cmd, high, 1);
1042
1043 int tolerance = clock/4;
1044
1045 /* Detect first transition */
1046 /* Lo-Hi (arbitrary) */
1047 /* skip to the first high */
1048 for (i= 0; i < GraphTraceLen; i++)
1049 if (GraphBuffer[i] == high)
1050 break;
1051 /* now look for the first low */
1052 for (; i < GraphTraceLen; i++)
1053 {
1054 if (GraphBuffer[i] == low)
1055 {
1056 lastval = i;
1057 break;
1058 }
1059 }
1060
1061 /* If we're not working with 1/0s, demod based off clock */
1062 if (high != 1)
1063 {
1064 bit = 0; /* We assume the 1st bit is zero, it may not be
1065 * the case: this routine (I think) has an init problem.
1066 * Ed.
1067 */
1068 for (; i < (int)(GraphTraceLen / clock); i++)
1069 {
1070 hithigh = 0;
1071 hitlow = 0;
1072 first = 1;
1073
1074 /* Find out if we hit both high and low peaks */
1075 for (j = 0; j < clock; j++)
1076 {
1077 if (GraphBuffer[(i * clock) + j] == high)
1078 hithigh = 1;
1079 else if (GraphBuffer[(i * clock) + j] == low)
1080 hitlow = 1;
1081
1082 /* it doesn't count if it's the first part of our read
1083 because it's really just trailing from the last sequence */
1084 if (first && (hithigh || hitlow))
1085 hithigh = hitlow = 0;
1086 else
1087 first = 0;
1088
1089 if (hithigh && hitlow)
1090 break;
1091 }
1092
1093 /* If we didn't hit both high and low peaks, we had a bit transition */
1094 if (!hithigh || !hitlow)
1095 bit ^= 1;
1096
1097 BitStream[bit2idx++] = bit ^ invert;
1098 }
1099 }
1100
1101 /* standard 1/0 bitstream */
1102 else
1103 {
1104
1105 /* Then detect duration between 2 successive transitions */
1106 for (bitidx = 1; i < GraphTraceLen; i++)
1107 {
1108 if (GraphBuffer[i-1] != GraphBuffer[i])
1109 {
b3b70669 1110 lc = i-lastval;
1111 lastval = i;
1112
1113 // Error check: if bitidx becomes too large, we do not
1114 // have a Manchester encoded bitstream or the clock is really
1115 // wrong!
1116 if (bitidx > (GraphTraceLen*2/clock+8) ) {
1117 PrintAndLog("Error: the clock you gave is probably wrong, aborting.");
1118 return 0;
1119 }
1120 // Then switch depending on lc length:
1121 // Tolerance is 1/4 of clock rate (arbitrary)
1122 if (abs(lc-clock/2) < tolerance) {
1123 // Short pulse : either "1" or "0"
1124 BitStream[bitidx++]=GraphBuffer[i-1];
1125 } else if (abs(lc-clock) < tolerance) {
1126 // Long pulse: either "11" or "00"
1127 BitStream[bitidx++]=GraphBuffer[i-1];
1128 BitStream[bitidx++]=GraphBuffer[i-1];
1129 } else {
7fe9b0b7 1130 // Error
1131 warnings++;
b3b70669 1132 PrintAndLog("Warning: Manchester decode error for pulse width detection.");
1133 PrintAndLog("(too many of those messages mean either the stream is not Manchester encoded, or clock is wrong)");
7fe9b0b7 1134
1135 if (warnings > 10)
1136 {
1137 PrintAndLog("Error: too many detection errors, aborting.");
1138 return 0;
1139 }
1140 }
1141 }
1142 }
1143
1144 // At this stage, we now have a bitstream of "01" ("1") or "10" ("0"), parse it into final decoded bitstream
1145 // Actually, we overwrite BitStream with the new decoded bitstream, we just need to be careful
1146 // to stop output at the final bitidx2 value, not bitidx
1147 for (i = 0; i < bitidx; i += 2) {
1148 if ((BitStream[i] == 0) && (BitStream[i+1] == 1)) {
1149 BitStream[bit2idx++] = 1 ^ invert;
b3b70669 1150 } else if ((BitStream[i] == 1) && (BitStream[i+1] == 0)) {
1151 BitStream[bit2idx++] = 0 ^ invert;
1152 } else {
1153 // We cannot end up in this state, this means we are unsynchronized,
1154 // move up 1 bit:
1155 i++;
7fe9b0b7 1156 warnings++;
b3b70669 1157 PrintAndLog("Unsynchronized, resync...");
1158 PrintAndLog("(too many of those messages mean the stream is not Manchester encoded)");
7fe9b0b7 1159
1160 if (warnings > 10)
1161 {
1162 PrintAndLog("Error: too many decode errors, aborting.");
1163 return 0;
1164 }
1165 }
1166 }
1167 }
1168
1169 PrintAndLog("Manchester decoded bitstream");
1170 // Now output the bitstream to the scrollback by line of 16 bits
1171 for (i = 0; i < (bit2idx-16); i+=16) {
1172 PrintAndLog("%i %i %i %i %i %i %i %i %i %i %i %i %i %i %i %i",
1173 BitStream[i],
1174 BitStream[i+1],
1175 BitStream[i+2],
1176 BitStream[i+3],
1177 BitStream[i+4],
1178 BitStream[i+5],
1179 BitStream[i+6],
1180 BitStream[i+7],
1181 BitStream[i+8],
1182 BitStream[i+9],
1183 BitStream[i+10],
1184 BitStream[i+11],
1185 BitStream[i+12],
1186 BitStream[i+13],
1187 BitStream[i+14],
1188 BitStream[i+15]);
1189 }
1190 return 0;
1191}
1192
1193/* Modulate our data into manchester */
1194int CmdManchesterMod(const char *Cmd)
1195{
1196 int i, j;
1197 int clock;
1198 int bit, lastbit, wave;
1199
1200 /* Get our clock */
1201 clock = GetClock(Cmd, 0, 1);
1202
1203 wave = 0;
1204 lastbit = 1;
1205 for (i = 0; i < (int)(GraphTraceLen / clock); i++)
1206 {
1207 bit = GraphBuffer[i * clock] ^ 1;
1208
1209 for (j = 0; j < (int)(clock/2); j++)
1210 GraphBuffer[(i * clock) + j] = bit ^ lastbit ^ wave;
1211 for (j = (int)(clock/2); j < clock; j++)
1212 GraphBuffer[(i * clock) + j] = bit ^ lastbit ^ wave ^ 1;
1213
1214 /* Keep track of how we start our wave and if we changed or not this time */
1215 wave ^= bit ^ lastbit;
1216 lastbit = bit;
1217 }
1218
1219 RepaintGraphWindow();
1220 return 0;
1221}
1222
1223int CmdNorm(const char *Cmd)
1224{
1225 int i;
1226 int max = INT_MIN, min = INT_MAX;
1227
1228 for (i = 10; i < GraphTraceLen; ++i) {
1229 if (GraphBuffer[i] > max)
1230 max = GraphBuffer[i];
1231 if (GraphBuffer[i] < min)
1232 min = GraphBuffer[i];
1233 }
1234
1235 if (max != min) {
1236 for (i = 0; i < GraphTraceLen; ++i) {
1237 GraphBuffer[i] = (GraphBuffer[i] - ((max + min) / 2)) * 1000 /
1238 (max - min);
1239 }
1240 }
1241 RepaintGraphWindow();
1242 return 0;
1243}
1244
1245int CmdPlot(const char *Cmd)
1246{
1247 ShowGraphWindow();
1248 return 0;
1249}
1250
1251int CmdSave(const char *Cmd)
1252{
1253 FILE *f = fopen(Cmd, "w");
1254 if(!f) {
1255 PrintAndLog("couldn't open '%s'", Cmd);
1256 return 0;
1257 }
1258 int i;
1259 for (i = 0; i < GraphTraceLen; i++) {
1260 fprintf(f, "%d\n", GraphBuffer[i]);
1261 }
1262 fclose(f);
1263 PrintAndLog("saved to '%s'", Cmd);
1264 return 0;
1265}
1266
1267int CmdScale(const char *Cmd)
1268{
1269 CursorScaleFactor = atoi(Cmd);
1270 if (CursorScaleFactor == 0) {
1271 PrintAndLog("bad, can't have zero scale");
1272 CursorScaleFactor = 1;
1273 }
1274 RepaintGraphWindow();
1275 return 0;
1276}
1277
1278int CmdThreshold(const char *Cmd)
1279{
1280 int threshold = atoi(Cmd);
1281
1282 for (int i = 0; i < GraphTraceLen; ++i) {
1283 if (GraphBuffer[i] >= threshold)
1284 GraphBuffer[i] = 1;
1285 else
7bb9d33e 1286 GraphBuffer[i] = -1;
7fe9b0b7 1287 }
1288 RepaintGraphWindow();
1289 return 0;
1290}
1291
d51b2eda
MHS
1292int CmdDirectionalThreshold(const char *Cmd)
1293{
1294 int8_t upThres = param_get8(Cmd, 0);
1295 int8_t downThres = param_get8(Cmd, 1);
1296
1297 printf("Applying Up Threshold: %d, Down Threshold: %d\n", upThres, downThres);
1298
1299 int lastValue = GraphBuffer[0];
1300 GraphBuffer[0] = 0; // Will be changed at the end, but init 0 as we adjust to last samples value if no threshold kicks in.
1301
1302 for (int i = 1; i < GraphTraceLen; ++i) {
1303 // Apply first threshold to samples heading up
1304 if (GraphBuffer[i] >= upThres && GraphBuffer[i] > lastValue)
1305 {
1306 lastValue = GraphBuffer[i]; // Buffer last value as we overwrite it.
1307 GraphBuffer[i] = 1;
1308 }
1309 // Apply second threshold to samples heading down
1310 else if (GraphBuffer[i] <= downThres && GraphBuffer[i] < lastValue)
1311 {
1312 lastValue = GraphBuffer[i]; // Buffer last value as we overwrite it.
1313 GraphBuffer[i] = -1;
1314 }
1315 else
1316 {
1317 lastValue = GraphBuffer[i]; // Buffer last value as we overwrite it.
1318 GraphBuffer[i] = GraphBuffer[i-1];
1319
1320 }
1321 }
1322 GraphBuffer[0] = GraphBuffer[1]; // Aline with first edited sample.
1323 RepaintGraphWindow();
1324 return 0;
1325}
1326
7fe9b0b7 1327int CmdZerocrossings(const char *Cmd)
1328{
1329 // Zero-crossings aren't meaningful unless the signal is zero-mean.
1330 CmdHpf("");
1331
1332 int sign = 1;
1333 int zc = 0;
1334 int lastZc = 0;
1335
1336 for (int i = 0; i < GraphTraceLen; ++i) {
1337 if (GraphBuffer[i] * sign >= 0) {
1338 // No change in sign, reproduce the previous sample count.
1339 zc++;
1340 GraphBuffer[i] = lastZc;
1341 } else {
1342 // Change in sign, reset the sample count.
1343 sign = -sign;
1344 GraphBuffer[i] = lastZc;
1345 if (sign > 0) {
1346 lastZc = zc;
1347 zc = 0;
1348 }
1349 }
1350 }
1351
1352 RepaintGraphWindow();
1353 return 0;
1354}
1355
1356static command_t CommandTable[] =
1357{
1358 {"help", CmdHelp, 1, "This help"},
1359 {"amp", CmdAmp, 1, "Amplify peaks"},
57c69556 1360 {"askdemod", Cmdaskdemod, 1, "<0 or 1> -- Attempt to demodulate simple ASK tags"},
3fe4ff4f 1361 {"askmandemod", Cmdaskmandemod, 1, "[clock] [invert <0|1>] -- Attempt to demodulate ASK/Manchester tags and output binary"},
1362 {"askrawdemod", Cmdaskrawdemod, 1, "[clock] [invert <0|1>] -- Attempt to demodulate ASK tags and output binary"},
7fe9b0b7 1363 {"autocorr", CmdAutoCorr, 1, "<window length> -- Autocorrelation over window"},
d5a72d2f 1364 {"biphaserawdecode",CmdBiphaseDecodeRaw,1,"[offset] Biphase decode binary stream already in graph buffer (offset = bit to start decode from)"},
7fe9b0b7 1365 {"bitsamples", CmdBitsamples, 0, "Get raw samples as bitstring"},
1366 {"bitstream", CmdBitstream, 1, "[clock rate] -- Convert waveform into a bitstream"},
1367 {"buffclear", CmdBuffClear, 1, "Clear sample buffer and graph window"},
1368 {"dec", CmdDec, 1, "Decimate samples"},
d5a72d2f 1369 {"detectaskclock",CmdDetectClockRate, 1, "Detect ASK clock rate"},
e888ed8e 1370 {"fskdemod", CmdFSKdemod, 1, "Demodulate graph window as a HID FSK"},
1371 {"fskhiddemod", CmdFSKdemodHID, 1, "Demodulate graph window as a HID FSK using raw"},
1372 {"fskiodemod", CmdFSKdemodIO, 1, "Demodulate graph window as an IO Prox FSK using raw"},
9ec1416a 1373 {"fskrawdemod", CmdFSKrawdemod, 1, "[clock rate] [invert] [rchigh] [rclow] Demodulate graph window from FSK to binary (clock = 50)(invert = 1 or 0)(rchigh = 10)(rclow=8)"},
7fe9b0b7 1374 {"grid", CmdGrid, 1, "<x> <y> -- overlay grid on graph window, use zero value to turn off either"},
90d74dc2 1375 {"hexsamples", CmdHexsamples, 0, "<bytes> [<offset>] -- Dump big buffer as hex bytes"},
7fe9b0b7 1376 {"hide", CmdHide, 1, "Hide graph window"},
1377 {"hpf", CmdHpf, 1, "Remove DC offset from trace"},
7fe9b0b7 1378 {"load", CmdLoad, 1, "<filename> -- Load trace (to graph window"},
1379 {"ltrim", CmdLtrim, 1, "<samples> -- Trim samples from left of trace"},
9ec1416a 1380 {"rtrim", CmdRtrim, 1, "<location to end trace> -- Trim samples from right of trace"},
7fe9b0b7 1381 {"mandemod", CmdManchesterDemod, 1, "[i] [clock rate] -- Manchester demodulate binary stream (option 'i' to invert output)"},
eb191de6 1382 {"manrawdecode", Cmdmandecoderaw, 1, "Manchester decode binary stream already in graph buffer"},
7fe9b0b7 1383 {"manmod", CmdManchesterMod, 1, "[clock rate] -- Manchester modulate a binary stream"},
1384 {"norm", CmdNorm, 1, "Normalize max/min to +/-500"},
7ddb9900 1385 {"plot", CmdPlot, 1, "Show graph window (hit 'h' in window for keystroke help)"},
90d74dc2 1386 {"samples", CmdSamples, 0, "[512 - 40000] -- Get raw samples for graph window"},
d6a120a2 1387 {"tune", CmdTuneSamples, 0, "Get hw tune samples for graph window"},
7fe9b0b7 1388 {"save", CmdSave, 1, "<filename> -- Save trace (from graph window)"},
1389 {"scale", CmdScale, 1, "<int> -- Set cursor display scale"},
dbf444a1 1390 {"threshold", CmdThreshold, 1, "<threshold> -- Maximize/minimize every value in the graph window depending on threshold"},
7fe9b0b7 1391 {"zerocrossings", CmdZerocrossings, 1, "Count time between zero-crossings"},
d51b2eda 1392 {"dirthreshold", CmdDirectionalThreshold, 1, "<thres up> <thres down> -- Max rising higher up-thres/ Min falling lower down-thres, keep rest as prev."},
7fe9b0b7 1393 {NULL, NULL, 0, NULL}
1394};
1395
1396int CmdData(const char *Cmd)
1397{
1398 CmdsParse(CommandTable, Cmd);
1399 return 0;
1400}
1401
1402int CmdHelp(const char *Cmd)
1403{
1404 CmdsHelp(CommandTable);
1405 return 0;
1406}
Impressum, Datenschutz