6923d3f1 |
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 Presco tag commands |
b9957414 |
8 | // ASK/Manchester, rf/32, 128 bits (complete) |
6923d3f1 |
9 | //----------------------------------------------------------------------------- |
10 | #include <string.h> |
11 | #include <inttypes.h> |
acf0582d |
12 | #include <stdio.h> |
6923d3f1 |
13 | #include "cmdlfpresco.h" |
29ada8fc |
14 | #include "proxmark3.h" |
15 | #include "ui.h" |
16 | #include "util.h" |
17 | #include "graph.h" |
18 | #include "cmdparser.h" |
19 | #include "cmddata.h" |
20 | #include "cmdmain.h" |
21 | #include "cmdlf.h" |
22 | #include "protocols.h" // for T55xx config register definitions |
23 | #include "lfdemod.h" // parityTest |
24 | |
6923d3f1 |
25 | static int CmdHelp(const char *Cmd); |
26 | |
27 | int usage_lf_presco_clone(void){ |
28 | PrintAndLog("clone a Presco tag to a T55x7 tag."); |
29ada8fc |
29 | PrintAndLog("Usage: lf presco clone d <Card-ID> H <hex-ID> <Q5>"); |
6923d3f1 |
30 | PrintAndLog("Options :"); |
29ada8fc |
31 | PrintAndLog(" d <Card-ID> : 9 digit presco card ID"); |
32 | PrintAndLog(" H <hex-ID> : 8 digit hex card number"); |
33 | PrintAndLog(" <Q5> : specify write to Q5 (t5555 instead of t55x7)"); |
6923d3f1 |
34 | PrintAndLog(""); |
29ada8fc |
35 | PrintAndLog("Sample : lf presco clone d 123456789"); |
6923d3f1 |
36 | return 0; |
37 | } |
38 | |
39 | int usage_lf_presco_sim(void) { |
40 | PrintAndLog("Enables simulation of presco card with specified card number."); |
41 | PrintAndLog("Simulation runs until the button is pressed or another USB command is issued."); |
42 | PrintAndLog("Per presco format, the card number is 9 digit number and can contain *# chars. Larger values are truncated."); |
43 | PrintAndLog(""); |
29ada8fc |
44 | PrintAndLog("Usage: lf presco sim d <Card-ID> or H <hex-ID>"); |
6923d3f1 |
45 | PrintAndLog("Options :"); |
29ada8fc |
46 | PrintAndLog(" d <Card-ID> : 9 digit presco card number"); |
47 | PrintAndLog(" H <hex-ID> : 8 digit hex card number"); |
6923d3f1 |
48 | PrintAndLog(""); |
29ada8fc |
49 | PrintAndLog("Sample : lf presco sim d 123456789"); |
6923d3f1 |
50 | return 0; |
51 | } |
52 | |
29ada8fc |
53 | // convert base 12 ID to sitecode & usercode & 8 bit other unknown code |
54 | int GetWiegandFromPresco(const char *Cmd, uint32_t *sitecode, uint32_t *usercode, uint32_t *fullcode, bool *Q5) { |
55 | |
6923d3f1 |
56 | uint8_t val = 0; |
29ada8fc |
57 | bool hex = false, errors = false; |
58 | uint8_t cmdp = 0; |
59 | char id[11]; |
60 | int stringlen = 0; |
61 | while(param_getchar(Cmd, cmdp) != 0x00) { |
62 | switch(param_getchar(Cmd, cmdp)) { |
63 | case 'h': |
64 | return -1; |
65 | case 'H': |
66 | hex = true; |
67 | //get hex |
68 | *fullcode = param_get32ex(Cmd, cmdp+1, 0, 10); |
69 | cmdp+=2; |
70 | break; |
dab1c6f5 |
71 | case 'D': |
72 | case 'd': |
29ada8fc |
73 | //param get string int param_getstr(const char *line, int paramnum, char * str) |
74 | stringlen = param_getstr(Cmd, cmdp+1, id); |
75 | if (stringlen < 2) return -1; |
76 | cmdp+=2; |
77 | break; |
78 | case 'Q': |
79 | case 'q': |
80 | *Q5 = true; |
81 | cmdp++; |
82 | break; |
83 | default: |
84 | PrintAndLog("Unknown parameter '%c'", param_getchar(Cmd, cmdp)); |
85 | errors = 1; |
86 | break; |
87 | } |
88 | if(errors) break; |
6923d3f1 |
89 | } |
29ada8fc |
90 | // No args |
91 | if(cmdp == 0) errors = 1; |
6923d3f1 |
92 | |
29ada8fc |
93 | //Validations |
ebf93643 |
94 | if(errors || (stringlen == 0 && !hex) ) return -1; |
6923d3f1 |
95 | |
29ada8fc |
96 | if (!hex) { |
97 | for (int index =0; index < strlen(id); ++index) { |
98 | // Get value from number string. |
99 | if ( id[index] == '*' ) val = 10; |
100 | if ( id[index] == '#') val = 11; |
101 | if ( id[index] >= 0x30 && id[index] <= 0x39 ) |
102 | val = id[index] - 0x30; |
103 | |
104 | *fullcode += val; |
105 | |
106 | // last digit is only added, not multipled. |
107 | if ( index < strlen(id)-1 ) |
108 | *fullcode *= 12; |
109 | } |
110 | } |
6923d3f1 |
111 | |
29ada8fc |
112 | *usercode = *fullcode & 0x0000FFFF; //% 65566 |
113 | *sitecode = (*fullcode >> 24) & 0x000000FF; // /= 16777216; |
114 | return 0; |
115 | } |
6923d3f1 |
116 | |
29ada8fc |
117 | // calc not certain - intended to get bitstream for programming / sim |
118 | int GetPrescoBits(uint32_t fullcode, uint8_t *prescoBits) { |
119 | num_to_bytebits(0x10D00000, 32, prescoBits); |
120 | num_to_bytebits(0x00000000, 32, prescoBits+32); |
121 | num_to_bytebits(0x00000000, 32, prescoBits+64); |
122 | num_to_bytebits(fullcode , 32, prescoBits+96); |
6923d3f1 |
123 | return 1; |
124 | } |
29ada8fc |
125 | |
6923d3f1 |
126 | //see ASKDemod for what args are accepted |
127 | int CmdPrescoDemod(const char *Cmd) { |
128 | if (!ASKDemod(Cmd, false, false, 1)) { |
129 | if (g_debugMode) PrintAndLog("ASKDemod failed"); |
130 | return 0; |
131 | } |
132 | size_t size = DemodBufferLen; |
b9957414 |
133 | //call lfdemod.c demod for presco |
6923d3f1 |
134 | int ans = PrescoDemod(DemodBuffer, &size); |
135 | if (ans < 0) { |
136 | if (g_debugMode) PrintAndLog("Error Presco_Demod %d", ans); |
137 | return 0; |
138 | } |
139 | //got a good demod |
140 | uint32_t raw1 = bytebits_to_byte(DemodBuffer+ans, 32); |
141 | uint32_t raw2 = bytebits_to_byte(DemodBuffer+ans+32, 32); |
29ada8fc |
142 | uint32_t raw3 = bytebits_to_byte(DemodBuffer+ans+64, 32); |
143 | uint32_t raw4 = bytebits_to_byte(DemodBuffer+ans+96, 32); |
144 | uint32_t cardid = raw4; |
6923d3f1 |
145 | PrintAndLog("Presco Tag Found: Card ID %08X", cardid); |
29ada8fc |
146 | PrintAndLog("Raw: %08X%08X%08X%08X", raw1,raw2,raw3,raw4); |
9fe4507c |
147 | setDemodBuf(DemodBuffer, 128, ans); |
148 | setClockGrid(g_DemodClock, g_DemodStartIdx + (ans*g_DemodClock)); |
149 | |
29ada8fc |
150 | uint32_t sitecode = 0, usercode = 0, fullcode = 0; |
151 | bool Q5=false; |
152 | char cmd[12] = {0}; |
153 | sprintf(cmd, "H %08X", cardid); |
154 | GetWiegandFromPresco(cmd, &sitecode, &usercode, &fullcode, &Q5); |
155 | PrintAndLog("SiteCode %u, UserCode %u, FullCode, %08X", sitecode, usercode, fullcode); |
156 | |
6923d3f1 |
157 | return 1; |
158 | } |
159 | |
160 | //see ASKDemod for what args are accepted |
161 | int CmdPrescoRead(const char *Cmd) { |
29ada8fc |
162 | // Presco Number: 123456789 --> Sitecode 30 | usercode 8665 |
6923d3f1 |
163 | |
164 | // read lf silently |
b9957414 |
165 | lf_read(true, 10000); |
6923d3f1 |
166 | // demod and output Presco ID |
167 | return CmdPrescoDemod(Cmd); |
168 | } |
169 | |
29ada8fc |
170 | // takes base 12 ID converts to hex |
171 | // Or takes 8 digit hex ID |
6923d3f1 |
172 | int CmdPrescoClone(const char *Cmd) { |
173 | |
29ada8fc |
174 | bool Q5 = false; |
175 | uint32_t sitecode=0, usercode=0, fullcode=0; |
6923d3f1 |
176 | uint32_t blocks[5] = {T55x7_MODULATION_MANCHESTER | T55x7_BITRATE_RF_32 | 4<<T55x7_MAXBLOCK_SHIFT | T55x7_ST_TERMINATOR, 0, 0, 0, 5}; |
177 | |
29ada8fc |
178 | // get wiegand from printed number. |
179 | if (GetWiegandFromPresco(Cmd, &sitecode, &usercode, &fullcode, &Q5) == -1) return usage_lf_presco_clone(); |
180 | |
181 | if (Q5) |
6f1a5978 |
182 | blocks[0] = T5555_MODULATION_MANCHESTER | ((32-2)>>1)<<T5555_BITRATE_SHIFT | 4<<T5555_MAXBLOCK_SHIFT | T5555_ST_TERMINATOR; |
6923d3f1 |
183 | |
6923d3f1 |
184 | if ((sitecode & 0xFF) != sitecode) { |
185 | sitecode &= 0xFF; |
186 | PrintAndLog("Facility-Code Truncated to 8-bits (Presco): %u", sitecode); |
187 | } |
188 | |
189 | if ((usercode & 0xFFFF) != usercode) { |
190 | usercode &= 0xFFFF; |
191 | PrintAndLog("Card Number Truncated to 16-bits (Presco): %u", usercode); |
192 | } |
193 | |
29ada8fc |
194 | blocks[1] = 0x10D00000; //preamble |
195 | blocks[2] = 0x00000000; |
196 | blocks[3] = 0x00000000; |
197 | blocks[4] = fullcode; |
6923d3f1 |
198 | |
29ada8fc |
199 | PrintAndLog("Preparing to clone Presco to T55x7 with SiteCode: %u, UserCode: %u, FullCode: %08x", sitecode, usercode, fullcode); |
6923d3f1 |
200 | PrintAndLog("Blk | Data "); |
201 | PrintAndLog("----+------------"); |
202 | PrintAndLog(" 00 | 0x%08x", blocks[0]); |
203 | PrintAndLog(" 01 | 0x%08x", blocks[1]); |
204 | PrintAndLog(" 02 | 0x%08x", blocks[2]); |
205 | PrintAndLog(" 03 | 0x%08x", blocks[3]); |
206 | PrintAndLog(" 04 | 0x%08x", blocks[4]); |
6923d3f1 |
207 | |
29ada8fc |
208 | UsbCommand resp; |
209 | UsbCommand c = {CMD_T55XX_WRITE_BLOCK, {0,0,0}}; |
6923d3f1 |
210 | |
29ada8fc |
211 | for (int i=4; i>=0; i--) { |
212 | c.arg[0] = blocks[i]; |
213 | c.arg[1] = i; |
214 | clearCommandBuffer(); |
215 | SendCommand(&c); |
216 | if (!WaitForResponseTimeout(CMD_ACK, &resp, 1000)){ |
217 | PrintAndLog("Error occurred, device did not respond during write operation."); |
218 | return -1; |
219 | } |
220 | } |
221 | return 0; |
222 | } |
6923d3f1 |
223 | |
29ada8fc |
224 | // takes base 12 ID converts to hex |
225 | // Or takes 8 digit hex ID |
226 | int CmdPrescoSim(const char *Cmd) { |
227 | uint32_t sitecode=0, usercode=0, fullcode=0; |
228 | bool Q5=false; |
229 | // get wiegand from printed number. |
230 | if (GetWiegandFromPresco(Cmd, &sitecode, &usercode, &fullcode, &Q5) == -1) return usage_lf_presco_sim(); |
6923d3f1 |
231 | |
29ada8fc |
232 | uint8_t clk = 32, encoding = 1, separator = 1, invert = 0; |
233 | uint16_t arg1, arg2; |
234 | size_t size = 128; |
235 | arg1 = clk << 8 | encoding; |
236 | arg2 = invert << 8 | separator; |
6923d3f1 |
237 | |
29ada8fc |
238 | PrintAndLog("Simulating Presco - SiteCode: %u, UserCode: %u, FullCode: %08X",sitecode, usercode, fullcode); |
6923d3f1 |
239 | |
29ada8fc |
240 | UsbCommand c = {CMD_ASK_SIM_TAG, {arg1, arg2, size}}; |
241 | GetPrescoBits(fullcode, c.d.asBytes); |
242 | clearCommandBuffer(); |
243 | SendCommand(&c); |
6923d3f1 |
244 | return 0; |
245 | } |
246 | |
247 | static command_t CommandTable[] = { |
29ada8fc |
248 | {"help", CmdHelp, 1, "This help"}, |
249 | {"read", CmdPrescoRead, 0, "Attempt to read and Extract tag data"}, |
250 | {"clone", CmdPrescoClone, 0, "d <9 digit ID> or h <hex> [Q5] clone presco tag"}, |
251 | {"sim", CmdPrescoSim, 0, "d <9 digit ID> or h <hex> simulate presco tag"}, |
252 | {NULL, NULL, 0, NULL} |
6923d3f1 |
253 | }; |
254 | |
255 | int CmdLFPresco(const char *Cmd) { |
256 | clearCommandBuffer(); |
257 | CmdsParse(CommandTable, Cmd); |
258 | return 0; |
259 | } |
260 | |
261 | int CmdHelp(const char *Cmd) { |
262 | CmdsHelp(CommandTable); |
263 | return 0; |
264 | } |