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