]>
git.zerfleddert.de Git - proxmark3-svn/blob - client/cmdlfjablotron.c
1 //-----------------------------------------------------------------------------
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
6 //-----------------------------------------------------------------------------
7 // Low frequency Presco tag commands
8 //-----------------------------------------------------------------------------
10 #include "cmdlfjablotron.h"
12 static int CmdHelp(const char *Cmd
);
14 int usage_lf_jablotron_clone(void){
15 PrintAndLog("clone a Jablotron tag to a T55x7 tag.");
16 PrintAndLog("Usage: lf jablotron clone [h] <card ID> <Q5>");
17 PrintAndLog("Options:");
18 PrintAndLog(" h : This help");
19 PrintAndLog(" <card ID> : jablotron card ID");
20 PrintAndLog(" <Q5> : specify write to Q5 (t5555 instead of t55x7)");
22 PrintAndLog("Sample: lf jablotron clone 112233");
26 int usage_lf_jablotron_sim(void) {
27 PrintAndLog("Enables simulation of jablotron card with specified card number.");
28 PrintAndLog("Simulation runs until the button is pressed or another USB command is issued.");
30 PrintAndLog("Usage: lf jablotron sim [h] <card ID>");
31 PrintAndLog("Options:");
32 PrintAndLog(" h : This help");
33 PrintAndLog(" <card ID> : jablotron card ID");
35 PrintAndLog("Sample: lf jablotron sim 112233");
39 static uint8_t jablontron_chksum(uint8_t *bits
){
41 for (int i
=16; i
< 56; i
+= 8) {
42 chksum
+= bytebits_to_byte(bits
+i
,8);
48 int getJablotronBits(uint64_t fullcode
, uint8_t *bits
) {
50 num_to_bytebits(0xFFFF, 16, bits
);
53 num_to_bytebits(fullcode
, 40, bits
+16);
56 uint8_t chksum
= jablontron_chksum(bits
);
57 num_to_bytebits(chksum
, 8, bits
+56);
61 static uint64_t getJablontronCardId( uint64_t rawcode
){
63 uint8_t bytes
[] = {0,0,0,0,0};
64 num_to_bytes(rawcode
, 5, bytes
);
65 for ( int i
= 4, j
= 0; i
> -1; --i
, j
+= 2 ) {
66 id
+= NIBBLE_LOW( bytes
[i
] ) * (int)pow(10,j
);
67 id
+= NIBBLE_HIGH( bytes
[i
] ) * (int)pow(10,j
+1);
72 //see ASKDemod for what args are accepted
73 int CmdJablotronDemod(const char *Cmd
) {
75 //Differential Biphase / di-phase (inverted biphase)
76 //get binary from ask wave
77 if (!ASKbiphaseDemod("0 64 1 0", FALSE
)) {
78 if (g_debugMode
) PrintAndLog("Error Jablotron: ASKbiphaseDemod failed");
81 size_t size
= DemodBufferLen
;
82 int ans
= JablotronDemod(DemodBuffer
, &size
);
86 // PrintAndLog("DEBUG: Error - not enough samples");
88 PrintAndLog("DEBUG: Error - Jablotron too few bits found");
89 // else if (ans == -2)
90 // PrintAndLog("DEBUG: Error - problem during ASK/Biphase demod");
92 PrintAndLog("DEBUG: Error - Jablotron Size not correct: %d", size
);
94 PrintAndLog("DEBUG: Error - Jablotron preamble not found");
96 PrintAndLog("DEBUG: Error - Jablotron checksum failed");
98 PrintAndLog("DEBUG: Error - ans: %d", ans
);
103 setDemodBuf(DemodBuffer
+ans
, 64, 0);
106 uint32_t raw1
= bytebits_to_byte(DemodBuffer
, 32);
107 uint32_t raw2
= bytebits_to_byte(DemodBuffer
+32, 32);
109 uint64_t rawid
= bytebits_to_byte(DemodBuffer
+16, 40);
110 uint64_t id
= getJablontronCardId(rawid
);
112 PrintAndLog("Jablotron Tag Found: Card ID %u", id
);
113 PrintAndLog("Raw: %08X%08X", raw1
,raw2
);
115 uint8_t chksum
= raw2
& 0xFF;
116 PrintAndLog("Checksum: %02X [%s]",
118 (chksum
== jablontron_chksum(DemodBuffer
)) ? "OK":"FAIL"
122 // Printed format: 1410-nn-nnnn-nnnn
123 PrintAndLog("Printed: 1410-%02X-%04X-%04X",
124 (uint8_t)(id
>> 32) & 0xFF,
125 (uint16_t)(id
>> 16) & 0xFFFF,
126 (uint16_t)id
& 0xFFFF
131 int CmdJablotronRead(const char *Cmd
) {
133 getSamples("30000",false);
134 return CmdJablotronDemod(Cmd
);
137 int CmdJablotronClone(const char *Cmd
) {
139 uint64_t fullcode
= 0;
140 uint32_t blocks
[3] = {T55x7_MODULATION_DIPHASE
| T55x7_BITRATE_RF_64
| 2<<T55x7_MAXBLOCK_SHIFT
, 0, 0};
144 memset(bs
, 0, sizeof(bits
));
146 char cmdp
= param_getchar(Cmd
, 0);
147 if (strlen(Cmd
) == 0 || cmdp
== 'h' || cmdp
== 'H') return usage_lf_jablotron_clone();
149 fullcode
= param_get64ex(Cmd
, 0, 0, 16);
152 if (param_getchar(Cmd
, 1) == 'Q' || param_getchar(Cmd
, 1) == 'q') {
153 //t5555 (Q5) BITRATE = (RF-2)/2 (iceman)
154 blocks
[0] = T5555_MODULATION_BIPHASE
| T5555_INVERT_OUTPUT
| 64<<T5555_BITRATE_SHIFT
| 2<<T5555_MAXBLOCK_SHIFT
;
157 // clearing the topbit needed for the preambl detection.
158 if ((fullcode
& 0x7FFFFFFFFF) != fullcode
) {
159 fullcode
&= 0x7FFFFFFFFF;
160 PrintAndLog("Card Number Truncated to 39bits: %"PRIx64
, fullcode
);
163 if ( !getJablotronBits(fullcode
, bs
)) {
164 PrintAndLog("Error with tag bitstream generation.");
169 blocks
[1] = bytebits_to_byte(bs
,32);
170 blocks
[2] = bytebits_to_byte(bs
+32,32);
172 PrintAndLog("Preparing to clone Jablotron to T55x7 with FullCode: %"PRIx64
, fullcode
);
173 PrintAndLog("Blk | Data ");
174 PrintAndLog("----+------------");
175 PrintAndLog(" 00 | 0x%08x", blocks
[0]);
176 PrintAndLog(" 01 | 0x%08x", blocks
[1]);
177 PrintAndLog(" 02 | 0x%08x", blocks
[2]);
180 UsbCommand c
= {CMD_T55XX_WRITE_BLOCK
, {0,0,0}};
182 for (int i
= 2; i
>= 0; --i
) {
183 c
.arg
[0] = blocks
[i
];
185 clearCommandBuffer();
187 if (!WaitForResponseTimeout(CMD_ACK
, &resp
, 1000)){
188 PrintAndLog("Error occurred, device did not respond during write operation.");
195 int CmdJablotronSim(const char *Cmd
) {
196 uint64_t fullcode
= 0;
198 char cmdp
= param_getchar(Cmd
, 0);
199 if (strlen(Cmd
) == 0 || cmdp
== 'h' || cmdp
== 'H') return usage_lf_jablotron_sim();
201 fullcode
= param_get64ex(Cmd
, 0, 0, 16);
203 // clearing the topbit needed for the preambl detection.
204 if ((fullcode
& 0x7FFFFFFFFF) != fullcode
) {
205 fullcode
&= 0x7FFFFFFFFF;
206 PrintAndLog("Card Number Truncated to 39bits: %"PRIx64
, fullcode
);
209 uint8_t clk
= 64, encoding
= 2, separator
= 0, invert
= 1;
212 arg1
= clk
<< 8 | encoding
;
213 arg2
= invert
<< 8 | separator
;
215 PrintAndLog("Simulating Jablotron - FullCode: %"PRIx64
, fullcode
);
217 UsbCommand c
= {CMD_ASK_SIM_TAG
, {arg1
, arg2
, size
}};
218 getJablotronBits(fullcode
, c
.d
.asBytes
);
219 clearCommandBuffer();
224 static command_t CommandTable
[] = {
225 {"help", CmdHelp
, 1, "This help"},
226 {"read", CmdJablotronRead
, 0, "Attempt to read and extract tag data"},
227 {"clone", CmdJablotronClone
, 0, "clone jablotron tag"},
228 {"sim", CmdJablotronSim
, 0, "simulate jablotron tag"},
229 {NULL
, NULL
, 0, NULL
}
232 int CmdLFJablotron(const char *Cmd
) {
233 clearCommandBuffer();
234 CmdsParse(CommandTable
, Cmd
);
238 int CmdHelp(const char *Cmd
) {
239 CmdsHelp(CommandTable
);