]> git.zerfleddert.de Git - proxmark3-svn/blame - client/cmdlft55xx.c
chg: the inital modification of t55xx commands to use Marshmellows new demod functions.
[proxmark3-svn] / client / cmdlft55xx.c
CommitLineData
54a942b0 1//-----------------------------------------------------------------------------\r
2//\r
3// This code is licensed to you under the terms of the GNU GPL, version 2 or,\r
4// at your option, any later version. See the LICENSE.txt file for the text of\r
5// the license.\r
6//-----------------------------------------------------------------------------\r
7// Low frequency T55xx commands\r
8//-----------------------------------------------------------------------------\r
9\r
10#include <stdio.h>\r
11#include <string.h>\r
12#include <inttypes.h>\r
54a942b0 13#include "proxmark3.h"\r
14#include "ui.h"\r
15#include "graph.h"\r
f38a1528 16#include "cmdmain.h"\r
54a942b0 17#include "cmdparser.h"\r
18#include "cmddata.h"\r
19#include "cmdlf.h"\r
20#include "cmdlft55xx.h"\r
f38a1528 21#include "util.h"\r
22#include "data.h"\r
c4e3b1b6 23#include "lfdemod.h"\r
54a942b0 24\r
8d0a3e87 25#define LF_TRACE_BUFF_SIZE 20000 // 32 x 32 x 10 (32 bit times numofblock (7), times clock skip..)\r
c6be64da 26#define LF_BITSSTREAM_LEN 1000 // more then 1000 bits shouldn't happend.. 8block * 4 bytes * 8bits = \r
54a942b0 27\r
4ecde0e1 28int usage_t55xx_rd(){\r
29 PrintAndLog("Usage: lf t55xx rd <block> <password>");\r
30 PrintAndLog(" <block>, block number to read. Between 0-7");\r
31 PrintAndLog(" <password>, OPTIONAL password (8 hex characters)");\r
32 PrintAndLog("");\r
33 PrintAndLog(" sample: lf t55xx rd 0 = try reading data from block 0");\r
34 PrintAndLog(" : lf t55xx rd 0 feedbeef = try reading data from block 0 using password");\r
35 PrintAndLog("");\r
36 return 0;\r
37}\r
38int usage_t55xx_wr(){\r
39 PrintAndLog("Usage: lf t55xx wr <block> <data> [password]");\r
40 PrintAndLog(" <block>, block number to read. Between 0-7");\r
41 PrintAndLog(" <data>, 4 bytes of data to write (8 hex characters)");\r
42 PrintAndLog(" [password], OPTIONAL password 4bytes (8 hex characters)");\r
43 PrintAndLog("");\r
44 PrintAndLog(" sample: lf t55xx wd 3 11223344 = try writing data 11223344 to block 3");\r
45 PrintAndLog(" : lf t55xx wd 3 11223344 feedbeef = try writing data 11223344 to block 3 using password feedbeef");\r
46 PrintAndLog("");\r
47 return 0;\r
48}\r
49int usage_t55xx_trace() {\r
50 PrintAndLog("Usage: lf t55xx trace [graph buffer data]");\r
51 PrintAndLog(" [graph buffer data], if set, use Graphbuffer otherwise read data from tag.");\r
52 PrintAndLog("");\r
53 PrintAndLog(" sample: lf t55xx trace");\r
54 PrintAndLog(" : lf t55xx trace 1");\r
55 PrintAndLog("");\r
56 return 0;\r
57}\r
58int usage_t55xx_info() {\r
59 PrintAndLog("Usage: lf t55xx info [graph buffer data]");\r
60 PrintAndLog(" [graph buffer data], if set, use Graphbuffer otherwise read data from tag.");\r
61 PrintAndLog("");\r
62 PrintAndLog(" sample: lf t55xx info");\r
63 PrintAndLog(" : lf t55xx info 1");\r
64 PrintAndLog("");\r
65 return 0;\r
66}\r
4ecde0e1 67int usage_t55xx_dump(){\r
68 PrintAndLog("Usage: lf t55xx dump <password>");\r
69 PrintAndLog(" <password>, OPTIONAL password 4bytes (8 hex characters)");\r
70 PrintAndLog("");\r
71 PrintAndLog(" sample: lf t55xx dump");\r
72 PrintAndLog(" : lf t55xx dump feedbeef");\r
73 PrintAndLog("");\r
74 return 0;\r
75}\r
0310364d 76\r
4ecde0e1 77static int CmdHelp(const char *Cmd);\r
c4e3b1b6 78\r
54a942b0 79int CmdReadBlk(const char *Cmd)\r
80{\r
c4e3b1b6 81 int invert = 0;\r
82 int clk = 0;\r
c6be64da 83 int block = -1;\r
4ecde0e1 84 int password = 0xFFFFFFFF; //default to blank Block 7\r
385f3987 85 int errCnt;\r
86 size_t bitlen;\r
4ecde0e1 87 int maxErr = 100;\r
0310364d 88 //uint8_t askAmp = 0;\r
385f3987 89 uint32_t blockData;\r
c4e3b1b6 90 uint8_t bits[MAX_GRAPH_TRACE_LEN] = {0x00};\r
385f3987 91 \r
c4e3b1b6 92 \r
4ecde0e1 93 char cmdp = param_getchar(Cmd, 0);\r
94 if (cmdp == 'h' || cmdp == 'H') {\r
95 usage_t55xx_rd();\r
96 return 0;\r
97 }\r
54a942b0 98\r
4ecde0e1 99 int res = sscanf(Cmd, "%d %x", &block, &password);\r
54a942b0 100\r
4ecde0e1 101 if ( res < 1 || res > 2 ){\r
102 usage_t55xx_rd();\r
103 return 1;\r
104 }\r
105 \r
106 if ((block < 0) | (block > 7)) {\r
b44e5233 107 PrintAndLog("Block must be between 0 and 7");\r
108 return 1;\r
4ecde0e1 109 } \r
54a942b0 110\r
4ecde0e1 111 UsbCommand c = {CMD_T55XX_READ_BLOCK, {0, block, 0}};\r
112 c.d.asBytes[0] = 0x0; \r
54a942b0 113\r
4ecde0e1 114 //Password mode\r
115 if ( res == 2 ) {\r
116 c.arg[2] = password;\r
117 c.d.asBytes[0] = 0x1; \r
c4e3b1b6 118 }\r
54a942b0 119\r
b44e5233 120 SendCommand(&c);\r
c4e3b1b6 121 if ( !WaitForResponseTimeout(CMD_ACK,NULL,1500) ) {\r
122 PrintAndLog("command execution time out");\r
385f3987 123 return 2;\r
c4e3b1b6 124 }\r
f38a1528 125 \r
385f3987 126 CmdSamples("12000");\r
a501c82b 127\r
385f3987 128 bitlen = getFromGraphBuf(bits);\r
c4e3b1b6 129 \r
0310364d 130 //errCnt = askrawdemod(bits, &bitlen, &clk, &invert, maxErr, askAmp);\r
131 errCnt = askmandemod(bits, &bitlen, &clk, &invert, maxErr);\r
c4e3b1b6 132 \r
133 //throw away static - allow 1 and -1 (in case of threshold command first)\r
134 if ( errCnt == -1 || bitlen < 16 ){ \r
135 PrintAndLog("no data found");\r
136 if (g_debugMode) \r
137 PrintAndLog("errCnt: %d, bitlen: %d, clk: %d, invert: %d", errCnt, bitlen, clk, invert);\r
385f3987 138 return 3;\r
a501c82b 139 }\r
c4e3b1b6 140 if (g_debugMode) \r
141 PrintAndLog("Using Clock: %d - invert: %d - Bits Found: %d", clk, invert, bitlen);\r
142\r
143 //move bits back to DemodBuffer\r
144 setDemodBuf(bits, bitlen, 0);\r
145 printBitStream(bits,bitlen);\r
385f3987 146 \r
147 // bits has the manchester encoded data.\r
148 errCnt = manrawdecode(bits, &bitlen); \r
149 if ( errCnt == -1 || bitlen < 16 ){ \r
150 PrintAndLog("no data found");\r
151 if (g_debugMode) \r
152 PrintAndLog("errCnt: %d, bitlen: %d, clk: %d, invert: %d", errCnt, bitlen, clk, invert);\r
153 return 4;\r
154 }\r
155\r
0310364d 156 blockData = PackBits(1, 32, bits);\r
385f3987 157\r
158 if ( block < 0)\r
0310364d 159 PrintAndLog(" Decoded : 0x%08X %s", blockData, sprint_bin(bits+1,32) );\r
385f3987 160 else\r
0310364d 161 PrintAndLog(" Block %d : 0x%08X %s", block, blockData, sprint_bin(bits+1,32) );\r
385f3987 162 \r
c4e3b1b6 163 return 0;\r
54a942b0 164}\r
165\r
54a942b0 166int CmdWriteBlk(const char *Cmd)\r
54a942b0 167{\r
4ecde0e1 168 int block = 8; //default to invalid block\r
169 int data = 0xFFFFFFFF; //default to blank Block \r
170 int password = 0xFFFFFFFF; //default to blank Block 7\r
171 \r
172 char cmdp = param_getchar(Cmd, 0);\r
173 if (cmdp == 'h' || cmdp == 'H') {\r
174 usage_t55xx_wr();\r
175 return 0;\r
176 }\r
177 \r
178 int res = sscanf(Cmd, "%d %x %x",&block, &data, &password);\r
179 \r
180 if ( res < 2 || res > 3) {\r
181 usage_t55xx_wr();\r
182 return 1;\r
183 }\r
54a942b0 184\r
4ecde0e1 185 if (block > 7) {\r
b44e5233 186 PrintAndLog("Block must be between 0 and 7");\r
187 return 1;\r
f38a1528 188 }\r
4ecde0e1 189 \r
190 UsbCommand c = {CMD_T55XX_WRITE_BLOCK, {data, block, 0}};\r
191 c.d.asBytes[0] = 0x0; \r
54a942b0 192\r
4ecde0e1 193 if (res == 2) {\r
194 PrintAndLog("Writing block %d data %08X", block, data);\r
195 } else {\r
196 //Password mode\r
197 c.arg[2] = password;\r
198 c.d.asBytes[0] = 0x1; \r
199 PrintAndLog("Writing block %d data %08X password %08X", block, data, password);\r
200 }\r
201 \r
202 SendCommand(&c);\r
203 return 0;\r
54a942b0 204}\r
205\r
206int CmdReadTrace(const char *Cmd)\r
207{\r
0310364d 208 int invert = 0;\r
209 int clk = 0;\r
210 int errCnt;\r
211 size_t bitlen;\r
212 int maxErr = 100;\r
213 uint8_t bits[MAX_GRAPH_TRACE_LEN] = {0x00};\r
f38a1528 214\r
0310364d 215 char cmdp = param_getchar(Cmd, 0);\r
216 \r
fbceacc5 217 if (strlen(Cmd) > 1 || cmdp == 'h' || cmdp == 'H') {\r
4ecde0e1 218 usage_t55xx_trace();\r
fbceacc5 219 return 0;\r
220 }\r
f38a1528 221\r
fbceacc5 222 if ( strlen(Cmd)==0){\r
c4e3b1b6 223 \r
fbceacc5 224 UsbCommand c = {CMD_T55XX_READ_TRACE, {0, 0, 0}};\r
225 SendCommand(&c);\r
226 WaitForResponse(CMD_ACK, NULL);\r
f38a1528 227\r
0310364d 228 CmdSamples("12000");\r
f38a1528 229 }\r
f38a1528 230 \r
0310364d 231 bitlen = getFromGraphBuf(bits);\r
232\r
233 //errCnt = askrawdemod(bits, &bitlen, &clk, &invert, maxErr, askAmp);\r
234 errCnt = askmandemod(bits, &bitlen, &clk, &invert, maxErr);\r
f38a1528 235 \r
0310364d 236 //throw away static - allow 1 and -1 (in case of threshold command first)\r
237 if ( errCnt == -1 || bitlen < 16 ){ \r
238 PrintAndLog("no data found");\r
239 if (g_debugMode) \r
240 PrintAndLog("errCnt: %d, bitlen: %d, clk: %d, invert: %d", errCnt, bitlen, clk, invert);\r
241 return 3;\r
242 }\r
243 if (g_debugMode) \r
244 PrintAndLog("Using Clock: %d - invert: %d - Bits Found: %d", clk, invert, bitlen);\r
245\r
246 //move bits back to DemodBuffer\r
247 setDemodBuf(bits, bitlen, 0);\r
248 \r
249 // bits has the manchester encoded data.\r
250 errCnt = manrawdecode(bits, &bitlen); \r
251 if ( errCnt == -1 || bitlen < 16 ){ \r
252 PrintAndLog("no data found");\r
253 if (g_debugMode) \r
254 PrintAndLog("errCnt: %d, bitlen: %d, clk: %d, invert: %d", errCnt, bitlen, clk, invert);\r
255 return 4;\r
256 }\r
257\r
f6c18637 258 RepaintGraphWindow();\r
b44e5233 259\r
f6c18637 260 uint8_t si = 5;\r
0310364d 261 uint32_t bl0 = PackBits(si, 32, bits);\r
262 uint32_t bl1 = PackBits(si+32, 32, bits);\r
f6c18637 263 \r
0310364d 264 uint32_t acl = PackBits(si, 8, bits); si += 8;\r
265 uint32_t mfc = PackBits(si, 8, bits); si += 8;\r
266 uint32_t cid = PackBits(si, 5, bits); si += 5;\r
267 uint32_t icr = PackBits(si, 3, bits); si += 3;\r
268 uint32_t year = PackBits(si, 4, bits); si += 4;\r
269 uint32_t quarter = PackBits(si, 2, bits); si += 2;\r
270 uint32_t lotid = PackBits(si, 12, bits); si += 12;\r
271 uint32_t wafer = PackBits(si, 5, bits); si += 5;\r
272 uint32_t dw = PackBits(si, 15, bits); \r
f6c18637 273 \r
274 PrintAndLog("");\r
275 PrintAndLog("-- T55xx Trace Information ----------------------------------");\r
276 PrintAndLog("-------------------------------------------------------------");\r
277 PrintAndLog(" ACL Allocation class (ISO/IEC 15963-1) : 0x%02X (%d)", acl, acl);\r
278 PrintAndLog(" MFC Manufacturer ID (ISO/IEC 7816-6) : 0x%02X (%d)", mfc, mfc);\r
279 PrintAndLog(" CID : 0x%02X (%d)", cid, cid);\r
280 PrintAndLog(" ICR IC Revision : %d",icr );\r
281 PrintAndLog(" Manufactured");\r
282 PrintAndLog(" Year/Quarter : %d/%d",2000+year, quarter );\r
77376577 283 PrintAndLog(" Lot ID : %d", lotid );\r
f6c18637 284 PrintAndLog(" Wafer number : %d", wafer);\r
285 PrintAndLog(" Die Number : %d", dw);\r
286 PrintAndLog("-------------------------------------------------------------");\r
77376577 287 PrintAndLog(" Raw Data - Page 1");\r
0310364d 288 PrintAndLog(" Block 0 : 0x%08X %s", bl0, sprint_bin(bits+5,32) );\r
289 PrintAndLog(" Block 0 : 0x%08X %s", bl1, sprint_bin(bits+37,32) );\r
f6c18637 290 PrintAndLog("-------------------------------------------------------------");\r
291 /*\r
292 TRACE - BLOCK O\r
293 Bits Definition HEX\r
294 1-8 ACL Allocation class (ISO/IEC 15963-1) 0xE0 \r
295 9-16 MFC Manufacturer ID (ISO/IEC 7816-6) 0x15 Atmel Corporation\r
296 17-21 CID 0x1 = Atmel ATA5577M1 0x2 = Atmel ATA5577M2 \r
297 22-24 ICR IC revision\r
298 25-28 YEAR (BCD encoded) 9 (= 2009)\r
299 29-30 QUARTER 1,2,3,4 \r
77376577 300 31-32 LOT ID\r
f6c18637 301 \r
302 TRACE - BLOCK 1\r
77376577 303 1-12 LOT ID \r
f6c18637 304 13-17 Wafer number\r
305 18-32 DW, die number sequential\r
306 */\r
307 \r
308 return 0;\r
309}\r
f38a1528 310\r
f6c18637 311int CmdInfo(const char *Cmd){\r
312 /*\r
313 Page 0 Block 0 Configuration data.\r
314 Normal mode\r
315 Extended mode\r
316 */\r
fbceacc5 317 char cmdp = param_getchar(Cmd, 0);\r
318\r
319 if (strlen(Cmd) > 1 || cmdp == 'h' || cmdp == 'H') {\r
4ecde0e1 320 usage_t55xx_info();\r
fbceacc5 321 return 0;\r
4ecde0e1 322 } else {\r
fbceacc5 323 CmdReadBlk("0");\r
081151ea 324 } \r
fbceacc5 325\r
c6be64da 326 uint8_t bits[LF_BITSSTREAM_LEN] = {0x00};\r
8d0a3e87 327\r
328 manchester_decode(GraphBuffer, LF_TRACE_BUFF_SIZE, bits, LF_BITSSTREAM_LEN);\r
f6c18637 329 \r
330 uint8_t si = 5;\r
8d0a3e87 331 uint32_t bl0 = PackBits(si, 32, bits);\r
f6c18637 332 \r
8d0a3e87 333 uint32_t safer = PackBits(si, 4, bits); si += 4; \r
334 uint32_t resv = PackBits(si, 7, bits); si += 7;\r
335 uint32_t dbr = PackBits(si, 3, bits); si += 3;\r
336 uint32_t extend = PackBits(si, 1, bits); si += 1;\r
337 uint32_t datamodulation = PackBits(si, 5, bits); si += 5;\r
338 uint32_t pskcf = PackBits(si, 2, bits); si += 2;\r
339 uint32_t aor = PackBits(si, 1, bits); si += 1; \r
340 uint32_t otp = PackBits(si, 1, bits); si += 1; \r
341 uint32_t maxblk = PackBits(si, 3, bits); si += 3;\r
342 uint32_t pwd = PackBits(si, 1, bits); si += 1; \r
343 uint32_t sst = PackBits(si, 1, bits); si += 1; \r
344 uint32_t fw = PackBits(si, 1, bits); si += 1;\r
345 uint32_t inv = PackBits(si, 1, bits); si += 1; \r
346 uint32_t por = PackBits(si, 1, bits); si += 1;\r
b44e5233 347 \r
f6c18637 348 PrintAndLog("");\r
99a71418 349 PrintAndLog("-- T55xx Configuration & Tag Information --------------------");\r
f6c18637 350 PrintAndLog("-------------------------------------------------------------");\r
351 PrintAndLog(" Safer key : %s", GetSaferStr(safer));\r
352 PrintAndLog(" reserved : %d", resv);\r
353 PrintAndLog(" Data bit rate : %s", GetBitRateStr(dbr));\r
354 PrintAndLog(" eXtended mode : %s", (extend) ? "Yes - Warning":"No");\r
355 PrintAndLog(" Modulation : %s", GetModulationStr(datamodulation) );\r
356 PrintAndLog(" PSK clock freq : %d", pskcf);\r
357 PrintAndLog(" AOR - Answer on Request : %s", (aor) ? "Yes":"No");\r
358 PrintAndLog(" OTP - One Time Pad : %s", (otp) ? "Yes - Warning":"No" );\r
359 PrintAndLog(" Max block : %d", maxblk);\r
360 PrintAndLog(" Password mode : %s", (pwd) ? "Yes":"No");\r
361 PrintAndLog(" Sequence Start Terminator : %s", (sst) ? "Yes":"No");\r
362 PrintAndLog(" Fast Write : %s", (fw) ? "Yes":"No");\r
363 PrintAndLog(" Inverse data : %s", (inv) ? "Yes":"No");\r
364 PrintAndLog(" POR-Delay : %s", (por) ? "Yes":"No");\r
365 PrintAndLog("-------------------------------------------------------------");\r
77376577 366 PrintAndLog(" Raw Data - Page 0");\r
8d0a3e87 367 PrintAndLog(" Block 0 : 0x%08X %s", bl0, sprint_bin(bits+5,32) );\r
f6c18637 368 PrintAndLog("-------------------------------------------------------------");\r
369 \r
370 return 0;\r
371}\r
372\r
77376577 373int CmdDump(const char *Cmd){\r
374\r
4ecde0e1 375 char s[20] = {0x00};\r
77376577 376 uint8_t pwd[4] = {0x00};\r
54a942b0 377\r
4ecde0e1 378 char cmdp = param_getchar(Cmd, 0);\r
149aeada 379 if ( cmdp == 'h' || cmdp == 'H') {\r
4ecde0e1 380 usage_t55xx_dump();\r
77376577 381 return 0;\r
382 }\r
4ecde0e1 383\r
384 bool hasPwd = ( strlen(Cmd) > 0); \r
77376577 385 if ( hasPwd ){\r
2ae8a312 386 if (param_gethex(Cmd, 0, pwd, 8)) {\r
387 PrintAndLog("password must include 8 HEX symbols");\r
c4e3b1b6 388 return 1;\r
77376577 389 }\r
390 }\r
a501c82b 391 \r
77376577 392 for ( int i = 0; i <8; ++i){\r
149aeada 393 memset(s,0,sizeof(s));\r
77376577 394 if ( hasPwd ) {\r
c6be64da 395 sprintf(s,"%d %02x%02x%02x%02x", i, pwd[0],pwd[1],pwd[2],pwd[3]);\r
77376577 396 } else {\r
397 sprintf(s,"%d", i);\r
77376577 398 }\r
4ecde0e1 399 CmdReadBlk(s);\r
77376577 400 }\r
401 return 0;\r
402}\r
403\r
7bd30f12 404int CmdIceFsk(const char *Cmd){\r
c6be64da 405\r
406 if (!HasGraphData()) return 0;\r
407\r
7bd30f12 408 iceFsk3(GraphBuffer, LF_TRACE_BUFF_SIZE);\r
7bd30f12 409 RepaintGraphWindow();\r
410 return 0;\r
411}\r
fbceacc5 412int CmdIceManchester(const char *Cmd){\r
72e930ef 413 ManchesterDemod( -1);\r
414 return 0;\r
415}\r
c6be64da 416int ManchesterDemod(int blockNum){\r
fbceacc5 417\r
c6be64da 418 if (!HasGraphData()) return 0;\r
419 \r
081151ea 420 uint8_t sizebyte = 32;\r
a501c82b 421 // the value 5 was selected during empirical studies of the decoded data. Some signal noise to skip.\r
081151ea 422 uint8_t offset = 5;\r
fbceacc5 423 uint32_t blockData;\r
c6be64da 424 uint8_t bits[LF_BITSSTREAM_LEN] = {0x00};\r
fbceacc5 425 uint8_t * bitstream = bits;\r
426 \r
8d0a3e87 427 manchester_decode(GraphBuffer, LF_TRACE_BUFF_SIZE, bits, LF_BITSSTREAM_LEN); \r
8d0a3e87 428 blockData = PackBits(offset, sizebyte, bits);\r
72e930ef 429\r
081151ea 430 if ( blockNum < 0)\r
431 PrintAndLog(" Decoded : 0x%08X %s", blockData, sprint_bin(bitstream+offset,sizebyte) );\r
432 else\r
433 PrintAndLog(" Block %d : 0x%08X %s", blockNum, blockData, sprint_bin(bitstream+offset,sizebyte) );\r
434 \r
fbceacc5 435 return 0;\r
436} \r
7bd30f12 437\r
f6c18637 438char * GetBitRateStr(uint32_t id){\r
439 static char buf[40];\r
440 char *retStr = buf;\r
441 switch (id){\r
442 case 0: \r
443 sprintf(retStr,"%d - RF/8",id);\r
444 break;\r
445 case 1:\r
446 sprintf(retStr,"%d - RF/16",id);\r
447 break;\r
448 case 2: \r
449 sprintf(retStr,"%d - RF/32",id);\r
450 break;\r
451 case 3:\r
452 sprintf(retStr,"%d - RF/40",id);\r
453 break;\r
454 case 4:\r
455 sprintf(retStr,"%d - RF/50",id);\r
456 break;\r
457 case 5:\r
458 sprintf(retStr,"%d - RF/64",id);\r
459 break;\r
460 case 6:\r
461 sprintf(retStr,"%d - RF/100",id);\r
462 break;\r
463 case 7:\r
464 sprintf(retStr,"%d - RF/128",id);\r
465 break;\r
466 default:\r
467 sprintf(retStr,"%d - (Unknown)",id);\r
468 break;\r
469 }\r
470\r
471 return buf;\r
472}\r
473\r
f6c18637 474char * GetSaferStr(uint32_t id){\r
475 static char buf[40];\r
476 char *retStr = buf;\r
477 \r
478 sprintf(retStr,"%d",id);\r
479 if (id == 6) {\r
480 sprintf(retStr,"%d - pasdwd",id);\r
481 }\r
482 if (id == 9 ){\r
483 sprintf(retStr,"%d - testmode ",id);\r
484 }\r
485 \r
486 return buf;\r
487}\r
488char * GetModulationStr( uint32_t id){\r
489 static char buf[40];\r
490 char *retStr = buf;\r
491 \r
492 switch (id){\r
493 case 0: \r
7bd30f12 494 sprintf(retStr,"%d - DIRECT (ASK/NRZ)",id);\r
f6c18637 495 break;\r
496 case 1:\r
497 sprintf(retStr,"%d - PSK 1 phase change when input changes",id);\r
498 break;\r
499 case 2: \r
500 sprintf(retStr,"%d - PSK 2 phase change on bitclk if input high",id);\r
501 break;\r
502 case 3:\r
503 sprintf(retStr,"%d - PSK 3 phase change on rising edge of input",id);\r
504 break;\r
505 case 4:\r
506 sprintf(retStr,"%d - FSK 1 RF/8 RF/5",id);\r
507 break;\r
508 case 5:\r
509 sprintf(retStr,"%d - FSK 2 RF/8 RF/10",id);\r
510 break;\r
511 case 6:\r
512 sprintf(retStr,"%d - FSK 1a RF/5 RF/8",id);\r
513 break;\r
514 case 7:\r
515 sprintf(retStr,"%d - FSK 2a RF/10 RF/8",id);\r
516 break;\r
517 case 8:\r
518 sprintf(retStr,"%d - Manschester",id);\r
519 break;\r
520 case 16:\r
521 sprintf(retStr,"%d - Biphase",id);\r
522 break;\r
523 case 17:\r
524 sprintf(retStr,"%d - Reserved",id);\r
525 break;\r
526 default:\r
527 sprintf(retStr,"0x%02X (Unknown)",id);\r
528 break;\r
529 }\r
530 return buf;\r
531}\r
532\r
533\r
534uint32_t PackBits(uint8_t start, uint8_t len, uint8_t* bits){\r
535 \r
536 int i = start;\r
537 int j = len-1;\r
3bc3598e 538 if (len > 32) {\r
539 return 0;\r
540 }\r
f6c18637 541 uint32_t tmp = 0;\r
542 for (; j >= 0; --j, ++i){\r
543 tmp |= bits[i] << j;\r
544 }\r
545 return tmp;\r
54a942b0 546}\r
547\r
548static command_t CommandTable[] =\r
549{\r
b44e5233 550 {"help", CmdHelp, 1, "This help"},\r
4ecde0e1 551 {"rd", CmdReadBlk, 0, "<block> [password] -- Read T55xx block data (page 0) [optional password]"},\r
552 {"wr", CmdWriteBlk, 0, "<block> <data> [password] -- Write T55xx block data (page 0) [optional password]"},\r
a61b4976 553 {"trace", CmdReadTrace, 0, "[1] Read T55xx traceability data (page 1/ blk 0-1)"},\r
554 {"info", CmdInfo, 0, "[1] Read T55xx configuration data (page 0/ blk 0)"},\r
4ecde0e1 555 {"dump", CmdDump, 0, "[password] Dump T55xx card block 0-7. [optional password]"},\r
72e930ef 556 {"man", CmdIceManchester, 0, "Manchester demod (with SST)"},\r
54a942b0 557 {NULL, NULL, 0, NULL}\r
558};\r
559\r
560int CmdLFT55XX(const char *Cmd)\r
561{\r
562 CmdsParse(CommandTable, Cmd);\r
563 return 0;\r
564}\r
565\r
566int CmdHelp(const char *Cmd)\r
567{\r
568 CmdsHelp(CommandTable);\r
569 return 0;\r
570}\r
Impressum, Datenschutz