]>
cvs.zerfleddert.de Git - proxmark3-svn/blob - client/cmdlfem4x.c
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 // Low frequency EM4x commands
9 //-----------------------------------------------------------------------------
11 #include "cmdlfem4x.h"
13 uint64_t g_em410xid
= 0;
15 static int CmdHelp(const char *Cmd
);
17 int CmdEMdemodASK(const char *Cmd
)
19 char cmdp
= param_getchar(Cmd
, 0);
20 uint8_t findone
= (cmdp
== '1') ? 1 : 0;
21 UsbCommand c
= {CMD_EM410X_DEMOD
, {findone
, 0, 0}};
26 /* Read the ID of an EM410x tag.
28 * 1111 1111 1 <-- standard non-repeatable header
29 * XXXX [row parity bit] <-- 10 rows of 5 bits for our 40 bit tag ID
31 * CCCC <-- each bit here is parity for the 10 bits above in corresponding column
32 * 0 <-- stop bit, end of tag
34 int CmdEM410xRead(const char *Cmd
)
39 if(!AskEm410xDemod("", &hi
, &lo
, false)) return 0;
40 PrintAndLog("EM410x pattern found: ");
43 PrintAndLog ("EM410x XL pattern found");
51 int usage_lf_em410x_sim(void) {
52 PrintAndLog("Simulating EM410x tag");
54 PrintAndLog("Usage: lf em4x em410xsim [h] <uid> <clock>");
55 PrintAndLog("Options:");
56 PrintAndLog(" h - this help");
57 PrintAndLog(" uid - uid (10 HEX symbols)");
58 PrintAndLog(" clock - clock (32|64) (optional)");
59 PrintAndLog("samples:");
60 PrintAndLog(" lf em4x em410xsim 0F0368568B");
61 PrintAndLog(" lf em4x em410xsim 0F0368568B 32");
65 // emulate an EM410X tag
66 int CmdEM410xSim(const char *Cmd
)
68 int i
, n
, j
, binary
[4], parity
[4];
69 uint8_t uid
[5] = {0x00};
71 char cmdp
= param_getchar(Cmd
, 0);
72 if (cmdp
== 'h' || cmdp
== 'H') return usage_lf_em410x_sim();
74 /* clock is 64 in EM410x tags */
77 if (param_gethex(Cmd
, 0, uid
, 10)) {
78 PrintAndLog("UID must include 10 HEX symbols");
82 param_getdec(Cmd
, 1, &clock
);
84 PrintAndLog("Starting simulating UID %02X%02X%02X%02X%02X clock: %d", uid
[0],uid
[1],uid
[2],uid
[3],uid
[4],clock
);
85 PrintAndLog("Press pm3-button to about simulation");
90 /* write 9 start bits */
91 for (i
= 0; i
< 9; i
++)
92 AppendGraph(0, clock
, 1);
94 /* for each hex char */
95 parity
[0] = parity
[1] = parity
[2] = parity
[3] = 0;
96 for (i
= 0; i
< 10; i
++)
98 /* read each hex char */
99 sscanf(&Cmd
[i
], "%1x", &n
);
100 for (j
= 3; j
>= 0; j
--, n
/= 2)
103 /* append each bit */
104 AppendGraph(0, clock
, binary
[0]);
105 AppendGraph(0, clock
, binary
[1]);
106 AppendGraph(0, clock
, binary
[2]);
107 AppendGraph(0, clock
, binary
[3]);
109 /* append parity bit */
110 AppendGraph(0, clock
, binary
[0] ^ binary
[1] ^ binary
[2] ^ binary
[3]);
112 /* keep track of column parity */
113 parity
[0] ^= binary
[0];
114 parity
[1] ^= binary
[1];
115 parity
[2] ^= binary
[2];
116 parity
[3] ^= binary
[3];
120 AppendGraph(0, clock
, parity
[0]);
121 AppendGraph(0, clock
, parity
[1]);
122 AppendGraph(0, clock
, parity
[2]);
123 AppendGraph(0, clock
, parity
[3]);
126 AppendGraph(1, clock
, 0);
128 CmdLFSim("0"); //240 start_gap.
132 /* Function is equivalent of lf read + data samples + em410xread
133 * looped until an EM410x tag is detected
135 * Why is CmdSamples("16000")?
136 * TBD: Auto-grow sample size based on detected sample rate. IE: If the
137 * rate gets lower, then grow the number of samples
138 * Changed by martin, 4000 x 4 = 16000,
139 * see http://www.proxmark.org/forum/viewtopic.php?pid=7235#p7235
141 int CmdEM410xWatch(const char *Cmd
)
145 printf("\naborted via keyboard!\n");
150 getSamples("8201",true); //capture enough to get 2 complete preambles (4096*2+9)
151 } while (!CmdEM410xRead(""));
156 //currently only supports manchester modulations
158 int CmdEM410xWatchnSpoof(const char *Cmd
)
160 // loops if the captured ID was in XL-format.
162 PrintAndLog("# Replaying captured ID: %llu", g_em410xid
);
167 int CmdEM410xWrite(const char *Cmd
)
169 uint64_t id
= 0xFFFFFFFFFFFFFFFF; // invalid id value
170 int card
= 0xFF; // invalid card value
171 uint32_t clock
= 0; // invalid clock value
173 sscanf(Cmd
, "%" PRIx64
" %d %d", &id
, &card
, &clock
);
176 if (id
== 0xFFFFFFFFFFFFFFFF) {
177 PrintAndLog("Error! ID is required.\n");
180 if (id
>= 0x10000000000) {
181 PrintAndLog("Error! Given EM410x ID is longer than 40 bits.\n");
187 PrintAndLog("Error! Card type required.\n");
191 PrintAndLog("Error! Bad card type selected.\n");
200 // Allowed clock rates: 16, 32, 40 and 64
201 if ((clock
!= 16) && (clock
!= 32) && (clock
!= 64) && (clock
!= 40)) {
202 PrintAndLog("Error! Clock rate %d not valid. Supported clock rates are 16, 32, 40 and 64.\n", clock
);
207 PrintAndLog("Writing %s tag with UID 0x%010" PRIx64
" (clock rate: %d)", "T55x7", id
, clock
);
208 // NOTE: We really should pass the clock in as a separate argument, but to
209 // provide for backwards-compatibility for older firmware, and to avoid
210 // having to add another argument to CMD_EM410X_WRITE_TAG, we just store
211 // the clock rate in bits 8-15 of the card value
212 card
= (card
& 0xFF) | ((clock
<< 8) & 0xFF00);
213 } else if (card
== 0) {
214 PrintAndLog("Writing %s tag with UID 0x%010" PRIx64
, "T5555", id
, clock
);
215 card
= (card
& 0xFF) | ((clock
<< 8) & 0xFF00);
217 PrintAndLog("Error! Bad card type selected.\n");
221 UsbCommand c
= {CMD_EM410X_WRITE_TAG
, {card
, (uint32_t)(id
>> 32), (uint32_t)id
}};
226 bool EM_EndParityTest(uint8_t *BitStream
, size_t size
, uint8_t rows
, uint8_t cols
, uint8_t pType
)
228 if (rows
*cols
>size
) return false;
230 //assume last col is a parity and do not test
231 for (uint8_t colNum
= 0; colNum
< cols
-1; colNum
++) {
232 for (uint8_t rowNum
= 0; rowNum
< rows
; rowNum
++) {
233 colP
^= BitStream
[(rowNum
*cols
)+colNum
];
235 if (colP
!= pType
) return false;
240 bool EM_ByteParityTest(uint8_t *BitStream
, size_t size
, uint8_t rows
, uint8_t cols
, uint8_t pType
)
242 if (rows
*cols
>size
) return false;
244 //assume last row is a parity row and do not test
245 for (uint8_t rowNum
= 0; rowNum
< rows
-1; rowNum
++) {
246 for (uint8_t colNum
= 0; colNum
< cols
; colNum
++) {
247 rowP
^= BitStream
[(rowNum
*cols
)+colNum
];
249 if (rowP
!= pType
) return false;
254 uint32_t OutputEM4x50_Block(uint8_t *BitStream
, size_t size
, bool verbose
, bool pTest
)
256 if (size
<45) return 0;
258 uint32_t code
= bytebits_to_byte(BitStream
,8);
259 code
= code
<<8 | bytebits_to_byte(BitStream
+9,8);
260 code
= code
<<8 | bytebits_to_byte(BitStream
+18,8);
261 code
= code
<<8 | bytebits_to_byte(BitStream
+27,8);
263 if (verbose
|| g_debugMode
){
264 for (uint8_t i
= 0; i
<5; i
++){
265 if (i
== 4) PrintAndLog(""); //parity byte spacer
266 PrintAndLog("%d%d%d%d%d%d%d%d %d -> 0x%02x",
276 bytebits_to_byte(BitStream
+i
*9,8)
280 PrintAndLog("Parity Passed");
282 PrintAndLog("Parity Failed");
286 /* Read the transmitted data of an EM4x50 tag
289 * XXXXXXXX [row parity bit (even)] <- 8 bits plus parity
290 * XXXXXXXX [row parity bit (even)] <- 8 bits plus parity
291 * XXXXXXXX [row parity bit (even)] <- 8 bits plus parity
292 * XXXXXXXX [row parity bit (even)] <- 8 bits plus parity
293 * CCCCCCCC <- column parity bits
295 * LW <- Listen Window
297 * This pattern repeats for every block of data being transmitted.
298 * Transmission starts with two Listen Windows (LW - a modulated
299 * pattern of 320 cycles each (32/32/128/64/64)).
301 * Note that this data may or may not be the UID. It is whatever data
302 * is stored in the blocks defined in the control word First and Last
303 * Word Read values. UID is stored in block 32.
305 //completed by Marshmellow
306 int EM4x50Read(const char *Cmd
, bool verbose
)
309 char buf[30] = {0x00};
313 uint8_t bitRate[8] = {8,16,32,40,50,64,100,128};
314 DemodBufferLen = 0x00;
315 snprintf(cmdStr, sizeof(buf),"%d %d 1", bitRate[config.bitrate], config.inverted );
316 ans = ASKDemod_ext(cmdStr, FALSE, FALSE, 1, &ST);
317 snprintf(cmdStr, sizeof(buf),"0 %d %d 1", bitRate[config.bitrate], config.inverted );
318 ans = ASKbiphaseDemod(cmdStr, FALSE);
321 uint8_t fndClk
[] = {8,16,32,40,50,64,128};
325 int i
, j
, startblock
, skip
, block
, start
, end
, low
, high
, minClk
;
326 bool complete
= false;
327 int tmpbuff
[MAX_GRAPH_TRACE_LEN
/ 64];
333 memset(tmpbuff
, 0, MAX_GRAPH_TRACE_LEN
/ 64);
335 // get user entry if any
336 sscanf(Cmd
, "%i %i", &clk
, &invert
);
338 // save GraphBuffer - to restore it later
341 // first get high and low values
342 for (i
= 0; i
< GraphTraceLen
; i
++) {
343 if (GraphBuffer
[i
] > high
)
344 high
= GraphBuffer
[i
];
345 else if (GraphBuffer
[i
] < low
)
346 low
= GraphBuffer
[i
];
352 // get to first full low to prime loop and skip incomplete first pulse
353 while ((GraphBuffer
[i
] < high
) && (i
< GraphTraceLen
))
355 while ((GraphBuffer
[i
] > low
) && (i
< GraphTraceLen
))
359 // populate tmpbuff buffer with pulse lengths
360 while (i
< GraphTraceLen
) {
361 // measure from low to low
362 while ((GraphBuffer
[i
] > low
) && (i
< GraphTraceLen
))
365 while ((GraphBuffer
[i
] < high
) && (i
< GraphTraceLen
))
367 while ((GraphBuffer
[i
] > low
) && (i
< GraphTraceLen
))
369 if (j
>=(MAX_GRAPH_TRACE_LEN
/64)) {
372 tmpbuff
[j
++]= i
- start
;
373 if (i
-start
< minClk
&& i
< GraphTraceLen
) {
379 for (uint8_t clkCnt
= 0; clkCnt
<7; clkCnt
++) {
380 tol
= fndClk
[clkCnt
]/8;
381 if (minClk
>= fndClk
[clkCnt
]-tol
&& minClk
<= fndClk
[clkCnt
]+1) {
387 PrintAndLog("ERROR: EM4x50 - didn't find a clock");
392 // look for data start - should be 2 pairs of LW (pulses of clk*3,clk*2)
394 for (i
= 0; i
< j
- 4 ; ++i
) {
396 if (tmpbuff
[i
] >= clk
*3-tol
&& tmpbuff
[i
] <= clk
*3+tol
) //3 clocks
397 if (tmpbuff
[i
+1] >= clk
*2-tol
&& tmpbuff
[i
+1] <= clk
*2+tol
) //2 clocks
398 if (tmpbuff
[i
+2] >= clk
*3-tol
&& tmpbuff
[i
+2] <= clk
*3+tol
) //3 clocks
399 if (tmpbuff
[i
+3] >= clk
-tol
) //1.5 to 2 clocks - depends on bit following
407 // skip over the remainder of LW
408 skip
+= tmpbuff
[i
+1] + tmpbuff
[i
+2] + clk
;
409 if (tmpbuff
[i
+3]>clk
)
410 phaseoff
= tmpbuff
[i
+3]-clk
;
413 // now do it again to find the end
415 for (i
+= 3; i
< j
- 4 ; ++i
) {
417 if (tmpbuff
[i
] >= clk
*3-tol
&& tmpbuff
[i
] <= clk
*3+tol
) //3 clocks
418 if (tmpbuff
[i
+1] >= clk
*2-tol
&& tmpbuff
[i
+1] <= clk
*2+tol
) //2 clocks
419 if (tmpbuff
[i
+2] >= clk
*3-tol
&& tmpbuff
[i
+2] <= clk
*3+tol
) //3 clocks
420 if (tmpbuff
[i
+3] >= clk
-tol
) //1.5 to 2 clocks - depends on bit following
428 if (verbose
|| g_debugMode
) {
430 PrintAndLog("\nNote: one block = 50 bits (32 data, 12 parity, 6 marker)");
432 PrintAndLog("No data found!, clock tried:%d",clk
);
433 PrintAndLog("Try again with more samples.");
434 PrintAndLog(" or after a 'data askedge' command to clean up the read");
437 } else if (start
< 0) return 0;
439 snprintf(tmp2
, sizeof(tmp2
),"%d %d 1000 %d", clk
, invert
, clk
*47);
440 // get rid of leading crap
441 snprintf(tmp
, sizeof(tmp
), "%i", skip
);
444 bool AllPTest
= true;
445 // now work through remaining buffer printing out data blocks
449 if (verbose
|| g_debugMode
) PrintAndLog("\nBlock %i:", block
);
452 // look for LW before start of next block
453 for ( ; i
< j
- 4 ; ++i
) {
455 if (tmpbuff
[i
] >= clk
*3-tol
&& tmpbuff
[i
] <= clk
*3+tol
)
456 if (tmpbuff
[i
+1] >= clk
-tol
)
459 if (i
>= j
-4) break; //next LW not found
461 if (tmpbuff
[i
+1]>clk
)
462 phaseoff
= tmpbuff
[i
+1]-clk
;
466 if (ASKDemod(tmp2
, false, false, 1) < 1) {
470 //set DemodBufferLen to just one block
471 DemodBufferLen
= skip
/clk
;
473 pTest
= EM_ByteParityTest(DemodBuffer
,DemodBufferLen
,5,9,0);
474 pTest
&= EM_EndParityTest(DemodBuffer
,DemodBufferLen
,5,9,0);
477 Code
[block
] = OutputEM4x50_Block(DemodBuffer
,DemodBufferLen
,verbose
, pTest
);
478 if (g_debugMode
) PrintAndLog("\nskipping %d samples, bits:%d", skip
, skip
/clk
);
479 //skip to start of next block
480 snprintf(tmp
,sizeof(tmp
),"%i",skip
);
483 if (i
>= end
) break; //in case chip doesn't output 6 blocks
486 if (verbose
|| g_debugMode
|| AllPTest
){
488 PrintAndLog("*** Warning!");
489 PrintAndLog("Partial data - no end found!");
490 PrintAndLog("Try again with more samples.");
492 PrintAndLog("Found data at sample: %i - using clock: %i", start
, clk
);
494 for (block
=0; block
< end
; block
++){
495 PrintAndLog("Block %d: %08x",block
,Code
[block
]);
498 PrintAndLog("Parities Passed");
500 PrintAndLog("Parities Failed");
501 PrintAndLog("Try cleaning the read samples with 'data askedge'");
505 //restore GraphBuffer
507 return (int)AllPTest
;
510 int CmdEM4x50Read(const char *Cmd
) {
511 return EM4x50Read(Cmd
, true);
514 int usage_lf_em_read(void) {
515 PrintAndLog("Read EM4x50. Tag must be on antenna. ");
517 PrintAndLog("Usage: lf em readword [h] <address> <pwd>");
518 PrintAndLog("Options:");
519 PrintAndLog(" h - this help");
520 PrintAndLog(" address - memory address to read. (0-15)");
521 PrintAndLog(" pwd - password (hex) (optional)");
522 PrintAndLog("samples:");
523 PrintAndLog(" lf em readword 1");
524 PrintAndLog(" lf em readword 1 11223344");
527 int CmdReadWord(const char *Cmd
) {
530 uint8_t ctmp
= param_getchar(Cmd
, 0);
531 if ( strlen(Cmd
) == 0 || ctmp
== 'H' || ctmp
== 'h' ) return usage_lf_em_read();
533 addr
= param_get8ex(Cmd
, 0, -1, 10);
534 pwd
= param_get32ex(Cmd
, 1, -1, 16);
536 if ( (addr
> 15) || (addr
< 0 ) || ( addr
== -1) ) {
537 PrintAndLog("Address must be between 0 and 15");
541 PrintAndLog("Reading address %d", addr
);
544 PrintAndLog("Reading address %d | password %08X", addr
, pwd
);
547 UsbCommand c
= {CMD_EM4X_READ_WORD
, {addr
, pwd
, usePwd
}};
548 clearCommandBuffer();
551 if (!WaitForResponseTimeout(CMD_ACK
, &resp
, 2500)){
552 PrintAndLog("Command timed out");
556 //uint8_t got[12288];
558 GetFromBigBuf(got
, sizeof(got
), 0);
559 if ( !WaitForResponseTimeout(CMD_ACK
, NULL
, 8000) ) {
560 PrintAndLog("command execution time out");
563 setGraphBuf(got
, sizeof(got
));
567 int usage_lf_em_write(void) {
568 PrintAndLog("Write EM4x50. Tag must be on antenna. ");
570 PrintAndLog("Usage: lf em writeword [h] <address> <data> <pwd>");
571 PrintAndLog("Options:");
572 PrintAndLog(" h - this help");
573 PrintAndLog(" address - memory address to write to. (0-15)");
574 PrintAndLog(" data - data to write (hex)");
575 PrintAndLog(" pwd - password (hex) (optional)");
576 PrintAndLog("samples:");
577 PrintAndLog(" lf em writeword 1");
578 PrintAndLog(" lf em writeword 1 deadc0de 11223344");
581 int CmdWriteWord(const char *Cmd
) {
582 uint8_t ctmp
= param_getchar(Cmd
, 0);
583 if ( strlen(Cmd
) == 0 || ctmp
== 'H' || ctmp
== 'h' ) return usage_lf_em_write();
587 int addr
= 16; // default to invalid address
588 int data
= 0xFFFFFFFF; // default to blank data
589 int pwd
= 0xFFFFFFFF; // default to blank password
591 addr
= param_get8ex(Cmd
, 0, -1, 10);
592 data
= param_get32ex(Cmd
, 1, -1, 16);
593 pwd
= param_get32ex(Cmd
, 2, -1, 16);
596 if ( (addr
> 15) || (addr
< 0 ) || ( addr
== -1) ) {
597 PrintAndLog("Address must be between 0 and 15");
601 PrintAndLog("Writing address %d data %08X", addr
, data
);
604 PrintAndLog("Writing address %d data %08X using password %08X", addr
, data
, pwd
);
607 uint16_t flag
= (addr
<< 8 ) | usePwd
;
609 UsbCommand c
= {CMD_EM4X_WRITE_WORD
, {flag
, data
, pwd
}};
610 clearCommandBuffer();
613 if (!WaitForResponseTimeout(CMD_ACK
, &resp
, 1000)){
614 PrintAndLog("Error occurred, device did not respond during write operation.");
620 static command_t CommandTable
[] = {
621 {"help", CmdHelp
, 1, "This help"},
622 {"em410xdemod", CmdEMdemodASK
, 0, "[findone] -- Extract ID from EM410x tag (option 0 for continuous loop, 1 for only 1 tag)"},
623 {"em410xread", CmdEM410xRead
, 1, "[clock rate] -- Extract ID from EM410x tag in GraphBuffer"},
624 {"em410xsim", CmdEM410xSim
, 0, "<UID> -- Simulate EM410x tag"},
625 {"em410xwatch", CmdEM410xWatch
, 0, "['h'] -- Watches for EM410x 125/134 kHz tags (option 'h' for 134)"},
626 {"em410xspoof", CmdEM410xWatchnSpoof
, 0, "['h'] --- Watches for EM410x 125/134 kHz tags, and replays them. (option 'h' for 134)" },
627 {"em410xwrite", CmdEM410xWrite
, 0, "<UID> <'0' T5555> <'1' T55x7> [clock rate] -- Write EM410x UID to T5555(Q5) or T55x7 tag, optionally setting clock rate"},
628 {"em4x50read", CmdEM4x50Read
, 1, "Extract data from EM4x50 tag"},
629 {"readword", CmdReadWord
, 1, "Read EM4xxx data"},
630 {"writeword", CmdWriteWord
, 1, "Write EM4xxx data"},
631 {NULL
, NULL
, 0, NULL
}
634 int CmdLFEM4X(const char *Cmd
) {
635 clearCommandBuffer();
636 CmdsParse(CommandTable
, Cmd
);
640 int CmdHelp(const char *Cmd
) {
641 CmdsHelp(CommandTable
);