]>
Commit | Line | Data |
---|---|---|
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 | } |