]>
cvs.zerfleddert.de Git - proxmark3-svn/blob - client/cmddata.c
265b0ed740414696b531a5fcec76044c45c39865
1 //-----------------------------------------------------------------------------
2 // Copyright (C) 2010 iZsh <izsh at fail0verflow.com>
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
7 //-----------------------------------------------------------------------------
8 // Data and Graph commands
9 //-----------------------------------------------------------------------------
15 #include "proxmark3.h"
19 #include "cmdparser.h"
23 static int CmdHelp(const char *Cmd
);
25 int CmdAmp(const char *Cmd
)
27 int i
, rising
, falling
;
28 int max
= INT_MIN
, min
= INT_MAX
;
30 for (i
= 10; i
< GraphTraceLen
; ++i
) {
31 if (GraphBuffer
[i
] > max
)
33 if (GraphBuffer
[i
] < min
)
39 for (i
= 0; i
< GraphTraceLen
; ++i
) {
40 if (GraphBuffer
[i
+ 1] < GraphBuffer
[i
]) {
47 if (GraphBuffer
[i
+ 1] > GraphBuffer
[i
]) {
61 * Generic command to demodulate ASK.
63 * Argument is convention: positive or negative (High mod means zero
64 * or high mod means one)
66 * Updates the Graph trace with 0/1 values
71 int Cmdaskdemod(const char *Cmd
)
74 int c
, high
= 0, low
= 0;
76 // TODO: complain if we do not give 2 arguments here !
77 // (AL - this doesn't make sense! we're only using one argument!!!)
78 sscanf(Cmd
, "%i", &c
);
80 /* Detect high and lows and clock */
82 for (i
= 0; i
< GraphTraceLen
; ++i
)
84 if (GraphBuffer
[i
] > high
)
85 high
= GraphBuffer
[i
];
86 else if (GraphBuffer
[i
] < low
)
89 if (c
!= 0 && c
!= 1) {
90 PrintAndLog("Invalid argument: %s", Cmd
);
94 if (GraphBuffer
[0] > 0) {
99 for (i
= 1; i
< GraphTraceLen
; ++i
) {
100 /* Transitions are detected at each peak
101 * Transitions are either:
102 * - we're low: transition if we hit a high
103 * - we're high: transition if we hit a low
104 * (we need to do it this way because some tags keep high or
105 * low for long periods, others just reach the peak and go
108 if ((GraphBuffer
[i
] == high
) && (GraphBuffer
[i
- 1] == c
)) {
109 GraphBuffer
[i
] = 1 - c
;
110 } else if ((GraphBuffer
[i
] == low
) && (GraphBuffer
[i
- 1] == (1 - c
))){
114 GraphBuffer
[i
] = GraphBuffer
[i
- 1];
117 RepaintGraphWindow();
121 int CmdAutoCorr(const char *Cmd
)
123 static int CorrelBuffer
[MAX_GRAPH_TRACE_LEN
];
125 int window
= atoi(Cmd
);
128 PrintAndLog("needs a window");
131 if (window
>= GraphTraceLen
) {
132 PrintAndLog("window must be smaller than trace (%d samples)",
137 PrintAndLog("performing %d correlations", GraphTraceLen
- window
);
139 for (int i
= 0; i
< GraphTraceLen
- window
; ++i
) {
141 for (int j
= 0; j
< window
; ++j
) {
142 sum
+= (GraphBuffer
[j
]*GraphBuffer
[i
+ j
]) / 256;
144 CorrelBuffer
[i
] = sum
;
146 GraphTraceLen
= GraphTraceLen
- window
;
147 memcpy(GraphBuffer
, CorrelBuffer
, GraphTraceLen
* sizeof (int));
149 RepaintGraphWindow();
153 int CmdBitsamples(const char *Cmd
)
158 GetFromBigBuf(got
,sizeof(got
),0);
159 WaitForResponse(CMD_ACK
,NULL
);
161 for (int j
= 0; j
< sizeof(got
); j
++) {
162 for (int k
= 0; k
< 8; k
++) {
163 if(got
[j
] & (1 << (7 - k
))) {
164 GraphBuffer
[cnt
++] = 1;
166 GraphBuffer
[cnt
++] = 0;
171 RepaintGraphWindow();
176 * Convert to a bitstream
178 int CmdBitstream(const char *Cmd
)
186 int hithigh
, hitlow
, first
;
188 /* Detect high and lows and clock */
189 for (i
= 0; i
< GraphTraceLen
; ++i
)
191 if (GraphBuffer
[i
] > high
)
192 high
= GraphBuffer
[i
];
193 else if (GraphBuffer
[i
] < low
)
194 low
= GraphBuffer
[i
];
198 clock
= GetClock(Cmd
, high
, 1);
202 for (i
= 0; i
< (int)(gtl
/ clock
); ++i
)
207 /* Find out if we hit both high and low peaks */
208 for (j
= 0; j
< clock
; ++j
)
210 if (GraphBuffer
[(i
* clock
) + j
] == high
)
212 else if (GraphBuffer
[(i
* clock
) + j
] == low
)
214 /* it doesn't count if it's the first part of our read
215 because it's really just trailing from the last sequence */
216 if (first
&& (hithigh
|| hitlow
))
217 hithigh
= hitlow
= 0;
221 if (hithigh
&& hitlow
)
225 /* If we didn't hit both high and low peaks, we had a bit transition */
226 if (!hithigh
|| !hitlow
)
229 AppendGraph(0, clock
, bit
);
230 // for (j = 0; j < (int)(clock/2); j++)
231 // GraphBuffer[(i * clock) + j] = bit ^ 1;
232 // for (j = (int)(clock/2); j < clock; j++)
233 // GraphBuffer[(i * clock) + j] = bit;
236 RepaintGraphWindow();
240 int CmdBuffClear(const char *Cmd
)
242 UsbCommand c
= {CMD_BUFF_CLEAR
};
248 int CmdDec(const char *Cmd
)
250 for (int i
= 0; i
< (GraphTraceLen
/ 2); ++i
)
251 GraphBuffer
[i
] = GraphBuffer
[i
* 2];
253 PrintAndLog("decimated by 2");
254 RepaintGraphWindow();
258 /* Print our clock rate */
259 int CmdDetectClockRate(const char *Cmd
)
261 int clock
= DetectClock(0);
262 PrintAndLog("Auto-detected clock rate: %d", clock
);
266 int CmdFSKdemod(const char *Cmd
)
268 static const int LowTone
[] = {
269 1, 1, 1, 1, 1, -1, -1, -1, -1, -1,
270 1, 1, 1, 1, 1, -1, -1, -1, -1, -1,
271 1, 1, 1, 1, 1, -1, -1, -1, -1, -1,
272 1, 1, 1, 1, 1, -1, -1, -1, -1, -1,
273 1, 1, 1, 1, 1, -1, -1, -1, -1, -1
275 static const int HighTone
[] = {
276 1, 1, 1, 1, 1, -1, -1, -1, -1,
277 1, 1, 1, 1, -1, -1, -1, -1,
278 1, 1, 1, 1, -1, -1, -1, -1,
279 1, 1, 1, 1, -1, -1, -1, -1,
280 1, 1, 1, 1, -1, -1, -1, -1,
281 1, 1, 1, 1, -1, -1, -1, -1, -1,
284 int lowLen
= sizeof (LowTone
) / sizeof (int);
285 int highLen
= sizeof (HighTone
) / sizeof (int);
286 int convLen
= (highLen
> lowLen
) ? highLen
: lowLen
;
287 uint32_t hi
= 0, lo
= 0;
290 int minMark
= 0, maxMark
= 0;
292 for (i
= 0; i
< GraphTraceLen
- convLen
; ++i
) {
293 int lowSum
= 0, highSum
= 0;
295 for (j
= 0; j
< lowLen
; ++j
) {
296 lowSum
+= LowTone
[j
]*GraphBuffer
[i
+j
];
298 for (j
= 0; j
< highLen
; ++j
) {
299 highSum
+= HighTone
[j
] * GraphBuffer
[i
+ j
];
301 lowSum
= abs(100 * lowSum
/ lowLen
);
302 highSum
= abs(100 * highSum
/ highLen
);
303 GraphBuffer
[i
] = (highSum
<< 16) | lowSum
;
306 for(i
= 0; i
< GraphTraceLen
- convLen
- 16; ++i
) {
307 int lowTot
= 0, highTot
= 0;
308 // 10 and 8 are f_s divided by f_l and f_h, rounded
309 for (j
= 0; j
< 10; ++j
) {
310 lowTot
+= (GraphBuffer
[i
+j
] & 0xffff);
312 for (j
= 0; j
< 8; j
++) {
313 highTot
+= (GraphBuffer
[i
+ j
] >> 16);
315 GraphBuffer
[i
] = lowTot
- highTot
;
316 if (GraphBuffer
[i
] > maxMark
) maxMark
= GraphBuffer
[i
];
317 if (GraphBuffer
[i
] < minMark
) minMark
= GraphBuffer
[i
];
320 GraphTraceLen
-= (convLen
+ 16);
321 RepaintGraphWindow();
323 // Find bit-sync (3 lo followed by 3 high)
324 int max
= 0, maxPos
= 0;
325 for (i
= 0; i
< 6000; ++i
) {
327 for (j
= 0; j
< 3 * lowLen
; ++j
) {
328 dec
-= GraphBuffer
[i
+ j
];
330 for (; j
< 3 * (lowLen
+ highLen
); ++j
) {
331 dec
+= GraphBuffer
[i
+ j
];
339 // place start of bit sync marker in graph
340 GraphBuffer
[maxPos
] = maxMark
;
341 GraphBuffer
[maxPos
+ 1] = minMark
;
345 // place end of bit sync marker in graph
346 GraphBuffer
[maxPos
] = maxMark
;
347 GraphBuffer
[maxPos
+1] = minMark
;
349 PrintAndLog("actual data bits start at sample %d", maxPos
);
350 PrintAndLog("length %d/%d", highLen
, lowLen
);
353 bits
[sizeof(bits
)-1] = '\0';
355 // find bit pairs and manchester decode them
356 for (i
= 0; i
< arraylen(bits
) - 1; ++i
) {
358 for (j
= 0; j
< lowLen
; ++j
) {
359 dec
-= GraphBuffer
[maxPos
+ j
];
361 for (; j
< lowLen
+ highLen
; ++j
) {
362 dec
+= GraphBuffer
[maxPos
+ j
];
365 // place inter bit marker in graph
366 GraphBuffer
[maxPos
] = maxMark
;
367 GraphBuffer
[maxPos
+ 1] = minMark
;
369 // hi and lo form a 64 bit pair
370 hi
= (hi
<< 1) | (lo
>> 31);
372 // store decoded bit as binary (in hi/lo) and text (in bits[])
380 PrintAndLog("bits: '%s'", bits
);
381 PrintAndLog("hex: %08x %08x", hi
, lo
);
385 int CmdGrid(const char *Cmd
)
387 sscanf(Cmd
, "%i %i", &PlotGridX
, &PlotGridY
);
388 PlotGridXdefault
= PlotGridX
;
389 PlotGridYdefault
= PlotGridY
;
390 RepaintGraphWindow();
394 int CmdHexsamples(const char *Cmd
)
400 char* string_ptr
= string_buf
;
403 sscanf(Cmd
, "%i %i", &requested
, &offset
);
405 /* if no args send something */
406 if (requested
== 0) {
409 if (offset
+ requested
> sizeof(got
)) {
410 PrintAndLog("Tried to read past end of buffer, <bytes> + <offset> > 40000");
414 GetFromBigBuf(got
,requested
,offset
);
415 WaitForResponse(CMD_ACK
,NULL
);
418 for (j
= 0; j
< requested
; j
++) {
420 string_ptr
+= sprintf(string_ptr
, "%02x ", got
[j
]);
422 *(string_ptr
- 1) = '\0'; // remove the trailing space
423 PrintAndLog("%s", string_buf
);
424 string_buf
[0] = '\0';
425 string_ptr
= string_buf
;
428 if (j
== requested
- 1 && string_buf
[0] != '\0') { // print any remaining bytes
429 *(string_ptr
- 1) = '\0';
430 PrintAndLog("%s", string_buf
);
431 string_buf
[0] = '\0';
437 int CmdHide(const char *Cmd
)
443 int CmdHpf(const char *Cmd
)
448 for (i
= 10; i
< GraphTraceLen
; ++i
)
449 accum
+= GraphBuffer
[i
];
450 accum
/= (GraphTraceLen
- 10);
451 for (i
= 0; i
< GraphTraceLen
; ++i
)
452 GraphBuffer
[i
] -= accum
;
454 RepaintGraphWindow();
458 int CmdSamples(const char *Cmd
)
464 n
= strtol(Cmd
, NULL
, 0);
466 if (n
> sizeof(got
)) n
= sizeof(got
);
468 PrintAndLog("Reading %d samples\n", n
);
469 GetFromBigBuf(got
,n
,0);
470 WaitForResponse(CMD_ACK
,NULL
);
471 for (int j
= 0; j
< n
; j
++) {
472 GraphBuffer
[cnt
++] = ((int)got
[j
]) - 128;
475 PrintAndLog("Done!\n");
477 RepaintGraphWindow();
481 int CmdLoad(const char *Cmd
)
483 FILE *f
= fopen(Cmd
, "r");
485 PrintAndLog("couldn't open '%s'", Cmd
);
491 while (fgets(line
, sizeof (line
), f
)) {
492 GraphBuffer
[GraphTraceLen
] = atoi(line
);
496 PrintAndLog("loaded %d samples", GraphTraceLen
);
497 RepaintGraphWindow();
501 int CmdLtrim(const char *Cmd
)
505 for (int i
= ds
; i
< GraphTraceLen
; ++i
)
506 GraphBuffer
[i
-ds
] = GraphBuffer
[i
];
509 RepaintGraphWindow();
514 * Manchester demodulate a bitstream. The bitstream needs to be already in
515 * the GraphBuffer as 0 and 1 values
517 * Give the clock rate as argument in order to help the sync - the algorithm
518 * resyncs at each pulse anyway.
520 * Not optimized by any means, this is the 1st time I'm writing this type of
521 * routine, feel free to improve...
523 * 1st argument: clock rate (as number of samples per clock rate)
524 * Typical values can be 64, 32, 128...
526 int CmdManchesterDemod(const char *Cmd
)
534 int hithigh
, hitlow
, first
;
540 /* check if we're inverting output */
543 PrintAndLog("Inverting output");
548 while(*Cmd
== ' '); // in case a 2nd argument was given
551 /* Holds the decoded bitstream: each clock period contains 2 bits */
552 /* later simplified to 1 bit after manchester decoding. */
553 /* Add 10 bits to allow for noisy / uncertain traces without aborting */
554 /* int BitStream[GraphTraceLen*2/clock+10]; */
556 /* But it does not work if compiling on WIndows: therefore we just allocate a */
558 uint8_t BitStream
[MAX_GRAPH_TRACE_LEN
];
560 /* Detect high and lows */
561 for (i
= 0; i
< GraphTraceLen
; i
++)
563 if (GraphBuffer
[i
] > high
)
564 high
= GraphBuffer
[i
];
565 else if (GraphBuffer
[i
] < low
)
566 low
= GraphBuffer
[i
];
570 clock
= GetClock(Cmd
, high
, 1);
572 int tolerance
= clock
/4;
574 /* Detect first transition */
575 /* Lo-Hi (arbitrary) */
576 /* skip to the first high */
577 for (i
= 0; i
< GraphTraceLen
; i
++)
578 if (GraphBuffer
[i
] == high
)
580 /* now look for the first low */
581 for (; i
< GraphTraceLen
; i
++)
583 if (GraphBuffer
[i
] == low
)
590 /* If we're not working with 1/0s, demod based off clock */
593 bit
= 0; /* We assume the 1st bit is zero, it may not be
594 * the case: this routine (I think) has an init problem.
597 for (; i
< (int)(GraphTraceLen
/ clock
); i
++)
603 /* Find out if we hit both high and low peaks */
604 for (j
= 0; j
< clock
; j
++)
606 if (GraphBuffer
[(i
* clock
) + j
] == high
)
608 else if (GraphBuffer
[(i
* clock
) + j
] == low
)
611 /* it doesn't count if it's the first part of our read
612 because it's really just trailing from the last sequence */
613 if (first
&& (hithigh
|| hitlow
))
614 hithigh
= hitlow
= 0;
618 if (hithigh
&& hitlow
)
622 /* If we didn't hit both high and low peaks, we had a bit transition */
623 if (!hithigh
|| !hitlow
)
626 BitStream
[bit2idx
++] = bit
^ invert
;
630 /* standard 1/0 bitstream */
634 /* Then detect duration between 2 successive transitions */
635 for (bitidx
= 1; i
< GraphTraceLen
; i
++)
637 if (GraphBuffer
[i
-1] != GraphBuffer
[i
])
642 // Error check: if bitidx becomes too large, we do not
643 // have a Manchester encoded bitstream or the clock is really
645 if (bitidx
> (GraphTraceLen
*2/clock
+8) ) {
646 PrintAndLog("Error: the clock you gave is probably wrong, aborting.");
649 // Then switch depending on lc length:
650 // Tolerance is 1/4 of clock rate (arbitrary)
651 if (abs(lc
-clock
/2) < tolerance
) {
652 // Short pulse : either "1" or "0"
653 BitStream
[bitidx
++]=GraphBuffer
[i
-1];
654 } else if (abs(lc
-clock
) < tolerance
) {
655 // Long pulse: either "11" or "00"
656 BitStream
[bitidx
++]=GraphBuffer
[i
-1];
657 BitStream
[bitidx
++]=GraphBuffer
[i
-1];
661 PrintAndLog("Warning: Manchester decode error for pulse width detection.");
662 PrintAndLog("(too many of those messages mean either the stream is not Manchester encoded, or clock is wrong)");
666 PrintAndLog("Error: too many detection errors, aborting.");
673 // At this stage, we now have a bitstream of "01" ("1") or "10" ("0"), parse it into final decoded bitstream
674 // Actually, we overwrite BitStream with the new decoded bitstream, we just need to be careful
675 // to stop output at the final bitidx2 value, not bitidx
676 for (i
= 0; i
< bitidx
; i
+= 2) {
677 if ((BitStream
[i
] == 0) && (BitStream
[i
+1] == 1)) {
678 BitStream
[bit2idx
++] = 1 ^ invert
;
679 } else if ((BitStream
[i
] == 1) && (BitStream
[i
+1] == 0)) {
680 BitStream
[bit2idx
++] = 0 ^ invert
;
682 // We cannot end up in this state, this means we are unsynchronized,
686 PrintAndLog("Unsynchronized, resync...");
687 PrintAndLog("(too many of those messages mean the stream is not Manchester encoded)");
691 PrintAndLog("Error: too many decode errors, aborting.");
698 PrintAndLog("Manchester decoded bitstream");
699 // Now output the bitstream to the scrollback by line of 16 bits
700 for (i
= 0; i
< (bit2idx
-16); i
+=16) {
701 PrintAndLog("%i %i %i %i %i %i %i %i %i %i %i %i %i %i %i %i",
722 /* Modulate our data into manchester */
723 int CmdManchesterMod(const char *Cmd
)
727 int bit
, lastbit
, wave
;
730 clock
= GetClock(Cmd
, 0, 1);
734 for (i
= 0; i
< (int)(GraphTraceLen
/ clock
); i
++)
736 bit
= GraphBuffer
[i
* clock
] ^ 1;
738 for (j
= 0; j
< (int)(clock
/2); j
++)
739 GraphBuffer
[(i
* clock
) + j
] = bit
^ lastbit
^ wave
;
740 for (j
= (int)(clock
/2); j
< clock
; j
++)
741 GraphBuffer
[(i
* clock
) + j
] = bit
^ lastbit
^ wave
^ 1;
743 /* Keep track of how we start our wave and if we changed or not this time */
744 wave
^= bit
^ lastbit
;
748 RepaintGraphWindow();
752 int CmdNorm(const char *Cmd
)
755 int max
= INT_MIN
, min
= INT_MAX
;
757 for (i
= 10; i
< GraphTraceLen
; ++i
) {
758 if (GraphBuffer
[i
] > max
)
759 max
= GraphBuffer
[i
];
760 if (GraphBuffer
[i
] < min
)
761 min
= GraphBuffer
[i
];
765 for (i
= 0; i
< GraphTraceLen
; ++i
) {
766 GraphBuffer
[i
] = (GraphBuffer
[i
] - ((max
+ min
) / 2)) * 1000 /
770 RepaintGraphWindow();
774 int CmdPlot(const char *Cmd
)
780 int CmdSave(const char *Cmd
)
782 FILE *f
= fopen(Cmd
, "w");
784 PrintAndLog("couldn't open '%s'", Cmd
);
788 for (i
= 0; i
< GraphTraceLen
; i
++) {
789 fprintf(f
, "%d\n", GraphBuffer
[i
]);
792 PrintAndLog("saved to '%s'", Cmd
);
796 int CmdScale(const char *Cmd
)
798 CursorScaleFactor
= atoi(Cmd
);
799 if (CursorScaleFactor
== 0) {
800 PrintAndLog("bad, can't have zero scale");
801 CursorScaleFactor
= 1;
803 RepaintGraphWindow();
807 int CmdThreshold(const char *Cmd
)
809 int threshold
= atoi(Cmd
);
811 for (int i
= 0; i
< GraphTraceLen
; ++i
) {
812 if (GraphBuffer
[i
] >= threshold
)
817 RepaintGraphWindow();
821 int CmdZerocrossings(const char *Cmd
)
823 // Zero-crossings aren't meaningful unless the signal is zero-mean.
830 for (int i
= 0; i
< GraphTraceLen
; ++i
) {
831 if (GraphBuffer
[i
] * sign
>= 0) {
832 // No change in sign, reproduce the previous sample count.
834 GraphBuffer
[i
] = lastZc
;
836 // Change in sign, reset the sample count.
838 GraphBuffer
[i
] = lastZc
;
846 RepaintGraphWindow();
850 static command_t CommandTable
[] =
852 {"help", CmdHelp
, 1, "This help"},
853 {"amp", CmdAmp
, 1, "Amplify peaks"},
854 {"askdemod", Cmdaskdemod
, 1, "<0|1> -- Attempt to demodulate simple ASK tags"},
855 {"autocorr", CmdAutoCorr
, 1, "<window length> -- Autocorrelation over window"},
856 {"bitsamples", CmdBitsamples
, 0, "Get raw samples as bitstring"},
857 {"bitstream", CmdBitstream
, 1, "[clock rate] -- Convert waveform into a bitstream"},
858 {"buffclear", CmdBuffClear
, 1, "Clear sample buffer and graph window"},
859 {"dec", CmdDec
, 1, "Decimate samples"},
860 {"detectclock", CmdDetectClockRate
, 1, "Detect clock rate"},
861 {"fskdemod", CmdFSKdemod
, 1, "Demodulate graph window as a HID FSK"},
862 {"grid", CmdGrid
, 1, "<x> <y> -- overlay grid on graph window, use zero value to turn off either"},
863 {"hexsamples", CmdHexsamples
, 0, "<bytes> [<offset>] -- Dump big buffer as hex bytes"},
864 {"hide", CmdHide
, 1, "Hide graph window"},
865 {"hpf", CmdHpf
, 1, "Remove DC offset from trace"},
866 {"load", CmdLoad
, 1, "<filename> -- Load trace (to graph window"},
867 {"ltrim", CmdLtrim
, 1, "<samples> -- Trim samples from left of trace"},
868 {"mandemod", CmdManchesterDemod
, 1, "[i] [clock rate] -- Manchester demodulate binary stream (option 'i' to invert output)"},
869 {"manmod", CmdManchesterMod
, 1, "[clock rate] -- Manchester modulate a binary stream"},
870 {"norm", CmdNorm
, 1, "Normalize max/min to +/-500"},
871 {"plot", CmdPlot
, 1, "Show graph window (hit 'h' in window for keystroke help)"},
872 {"samples", CmdSamples
, 0, "[512 - 40000] -- Get raw samples for graph window"},
873 {"save", CmdSave
, 1, "<filename> -- Save trace (from graph window)"},
874 {"scale", CmdScale
, 1, "<int> -- Set cursor display scale"},
875 {"threshold", CmdThreshold
, 1, "<threshold> -- Maximize/minimize every value in the graph window depending on threshold"},
876 {"zerocrossings", CmdZerocrossings
, 1, "Count time between zero-crossings"},
877 {NULL
, NULL
, 0, NULL
}
880 int CmdData(const char *Cmd
)
882 CmdsParse(CommandTable
, Cmd
);
886 int CmdHelp(const char *Cmd
)
888 CmdsHelp(CommandTable
);