]>
Commit | Line | Data |
---|---|---|
43591e64 | 1 | //----------------------------------------------------------------------------- |
2 | // Copyright (C) 2018 iceman | |
3 | // | |
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 | |
6 | // the license. | |
7 | //----------------------------------------------------------------------------- | |
8 | // Proxmark3 RDV40 Smartcard module commands | |
9 | //----------------------------------------------------------------------------- | |
10 | #include "cmdsmartcard.h" | |
8d7d7b61 | 11 | |
12 | #include <ctype.h> | |
13 | ||
14 | #include "ui.h" | |
15 | #include "cmdparser.h" | |
9f596ec7 | 16 | #include "proxmark3.h" |
8d7d7b61 | 17 | #include "util.h" |
43591e64 | 18 | #include "smartcard.h" |
19 | #include "comms.h" | |
20 | #include "protocols.h" | |
a9104f7e | 21 | #include "cmdhw.h" |
0d2624a0 | 22 | #include "cmdhflist.h" |
8d7d7b61 | 23 | #include "emv/apduinfo.h" // APDUcode description |
24 | #include "emv/emvcore.h" // decodeTVL | |
151a33c0 | 25 | #include "crypto/libpcrypto.h" // sha512hash |
6b6c3be6 | 26 | #include "emv/dump.h" // dump_buffer |
a9104f7e | 27 | #include "pcsc.h" |
43591e64 | 28 | |
9f596ec7 | 29 | #define SC_UPGRADE_FILES_DIRECTORY "sc_upgrade_firmware/" |
43591e64 | 30 | |
a9104f7e | 31 | static bool UseAlternativeSmartcardReader = false; // default: use PM3 RDV40 Smartcard Slot (if available) |
32 | ||
43591e64 | 33 | static int CmdHelp(const char *Cmd); |
34 | ||
8d7d7b61 | 35 | static int usage_sm_raw(void) { |
36 | PrintAndLogEx(NORMAL, "Usage: sc raw [h|r|c] d <0A 0B 0C ... hex>"); | |
37 | PrintAndLogEx(NORMAL, " h : this help"); | |
38 | PrintAndLogEx(NORMAL, " r : do not read response"); | |
151a33c0 | 39 | PrintAndLogEx(NORMAL, " a : active smartcard without select (reset sc module)"); |
40 | PrintAndLogEx(NORMAL, " s : active smartcard with select (get ATR)"); | |
8d7d7b61 | 41 | PrintAndLogEx(NORMAL, " t : executes TLV decoder if it possible"); |
151a33c0 | 42 | PrintAndLogEx(NORMAL, " 0 : use protocol T=0"); |
8d7d7b61 | 43 | PrintAndLogEx(NORMAL, " d <bytes> : bytes to send"); |
44 | PrintAndLogEx(NORMAL, ""); | |
45 | PrintAndLogEx(NORMAL, "Examples:"); | |
6b5105be | 46 | PrintAndLogEx(NORMAL, " sc raw s 0 d 00a404000e315041592e5359532e4444463031 - `1PAY.SYS.DDF01` PSE directory with get ATR"); |
43591e64 | 47 | return 0; |
48 | } | |
8d7d7b61 | 49 | |
a9104f7e | 50 | static int usage_sm_select(void) { |
51 | PrintAndLogEx(NORMAL, "Usage: sc select [h|<reader name>] "); | |
52 | PrintAndLogEx(NORMAL, " h : this help"); | |
53 | PrintAndLogEx(NORMAL, " <reader name> : a card reader's name, wildcards allowed, leave empty to pick from available readers"); | |
54 | PrintAndLogEx(NORMAL, ""); | |
55 | PrintAndLogEx(NORMAL, "Examples:"); | |
56 | PrintAndLogEx(NORMAL, " sc select : list available card readers and pick"); | |
57 | PrintAndLogEx(NORMAL, " sc select Gemalto* : select a connected Gemalto card reader" ); | |
58 | return 0; | |
59 | } | |
60 | ||
8d7d7b61 | 61 | static int usage_sm_reader(void) { |
62 | PrintAndLogEx(NORMAL, "Usage: sc reader [h|s]"); | |
63 | PrintAndLogEx(NORMAL, " h : this help"); | |
64 | PrintAndLogEx(NORMAL, " s : silent (no messages)"); | |
65 | PrintAndLogEx(NORMAL, ""); | |
66 | PrintAndLogEx(NORMAL, "Examples:"); | |
67 | PrintAndLogEx(NORMAL, " sc reader"); | |
43591e64 | 68 | return 0; |
69 | } | |
8d7d7b61 | 70 | |
71 | static int usage_sm_info(void) { | |
72 | PrintAndLogEx(NORMAL, "Usage: s info [h|s]"); | |
73 | PrintAndLogEx(NORMAL, " h : this help"); | |
74 | PrintAndLogEx(NORMAL, " s : silent (no messages)"); | |
75 | PrintAndLogEx(NORMAL, ""); | |
76 | PrintAndLogEx(NORMAL, "Examples:"); | |
77 | PrintAndLogEx(NORMAL, " sc info"); | |
43591e64 | 78 | return 0; |
79 | } | |
8d7d7b61 | 80 | |
81 | static int usage_sm_upgrade(void) { | |
9f596ec7 | 82 | PrintAndLogEx(NORMAL, "Upgrade RDV4.0 Smartcard Socket Firmware"); |
8d7d7b61 | 83 | PrintAndLogEx(NORMAL, "Usage: sc upgrade f <file name>"); |
84 | PrintAndLogEx(NORMAL, " h : this help"); | |
85 | PrintAndLogEx(NORMAL, " f <filename> : firmware file name"); | |
86 | PrintAndLogEx(NORMAL, ""); | |
87 | PrintAndLogEx(NORMAL, "Examples:"); | |
9f596ec7 | 88 | PrintAndLogEx(NORMAL, " sc upgrade f SIM010.BIN"); |
43591e64 | 89 | return 0; |
90 | } | |
8d7d7b61 | 91 | |
92 | static int usage_sm_setclock(void) { | |
93 | PrintAndLogEx(NORMAL, "Usage: sc setclock [h] c <clockspeed>"); | |
94 | PrintAndLogEx(NORMAL, " h : this help"); | |
95 | PrintAndLogEx(NORMAL, " c <> : clockspeed (0 = 16mhz, 1=8mhz, 2=4mhz) "); | |
96 | PrintAndLogEx(NORMAL, ""); | |
97 | PrintAndLogEx(NORMAL, "Examples:"); | |
98 | PrintAndLogEx(NORMAL, " sc setclock c 2"); | |
43591e64 | 99 | return 0; |
100 | } | |
101 | ||
8d7d7b61 | 102 | static int usage_sm_brute(void) { |
103 | PrintAndLogEx(NORMAL, "Tries to bruteforce SFI, "); | |
104 | PrintAndLogEx(NORMAL, "Usage: sc brute [h]"); | |
105 | PrintAndLogEx(NORMAL, " h : this help"); | |
106 | PrintAndLogEx(NORMAL, ""); | |
107 | PrintAndLogEx(NORMAL, "Examples:"); | |
108 | PrintAndLogEx(NORMAL, " sc brute"); | |
109 | return 0; | |
110 | } | |
111 | ||
6b6c3be6 | 112 | uint8_t GetATRTA1(uint8_t *atr, size_t atrlen) { |
113 | if (atrlen > 2) { | |
114 | uint8_t T0 = atr[1]; | |
115 | if (T0 & 0x10) | |
116 | return atr[2]; | |
117 | } | |
118 | ||
119 | return 0x11; // default value is 0x11, corresponding to fmax=5 MHz, Fi=372, Di=1. | |
120 | } | |
121 | ||
122 | int DiArray[] = { | |
123 | 0, // b0000 RFU | |
124 | 1, // b0001 | |
125 | 2, | |
126 | 4, | |
127 | 8, | |
128 | 16, | |
129 | 32, // b0110 | |
130 | 64, // b0111. This was RFU in ISO/IEC 7816-3:1997 and former. Some card readers or drivers may erroneously reject cards using this value | |
131 | 12, | |
132 | 20, | |
133 | 0, // b1010 RFU | |
134 | 0, | |
135 | 0, // ... | |
136 | 0, | |
137 | 0, | |
138 | 0 // b1111 RFU | |
139 | }; | |
140 | ||
141 | int FiArray[] = { | |
142 | 372, // b0000 Historical note: in ISO/IEC 7816-3:1989, this was assigned to cards with internal clock | |
143 | 372, // b0001 | |
144 | 558, // b0010 | |
145 | 744, // b0011 | |
146 | 1116, // b0100 | |
147 | 1488, // b0101 | |
148 | 1860, // b0110 | |
149 | 0, // b0111 RFU | |
150 | 0, // b1000 RFU | |
151 | 512, // b1001 | |
152 | 768, // b1010 | |
153 | 1024, // b1011 | |
154 | 1536, // b1100 | |
155 | 2048, // b1101 | |
156 | 0, // b1110 RFU | |
157 | 0 // b1111 RFU | |
158 | }; | |
159 | ||
160 | float FArray[] = { | |
161 | 4, // b0000 Historical note: in ISO/IEC 7816-3:1989, this was assigned to cards with internal clock | |
162 | 5, // b0001 | |
163 | 6, // b0010 | |
164 | 8, // b0011 | |
165 | 12, // b0100 | |
166 | 16, // b0101 | |
167 | 20, // b0110 | |
168 | 0, // b0111 RFU | |
169 | 0, // b1000 RFU | |
170 | 5, // b1001 | |
171 | 7.5, // b1010 | |
172 | 10, // b1011 | |
173 | 15, // b1100 | |
174 | 20, // b1101 | |
175 | 0, // b1110 RFU | |
176 | 0 // b1111 RFU | |
177 | }; | |
178 | ||
6b5105be | 179 | static int GetATRDi(uint8_t *atr, size_t atrlen) { |
6b6c3be6 | 180 | uint8_t TA1 = GetATRTA1(atr, atrlen); |
181 | ||
182 | return DiArray[TA1 & 0x0f]; // The 4 low-order bits of TA1 (4th MSbit to 1st LSbit) encode Di | |
183 | } | |
184 | ||
6b5105be | 185 | static int GetATRFi(uint8_t *atr, size_t atrlen) { |
6b6c3be6 | 186 | uint8_t TA1 = GetATRTA1(atr, atrlen); |
187 | ||
188 | return FiArray[TA1 >> 4]; // The 4 high-order bits of TA1 (8th MSbit to 5th LSbit) encode fmax and Fi | |
189 | } | |
190 | ||
6b5105be | 191 | static float GetATRF(uint8_t *atr, size_t atrlen) { |
6b6c3be6 | 192 | uint8_t TA1 = GetATRTA1(atr, atrlen); |
193 | ||
194 | return FArray[TA1 >> 4]; // The 4 high-order bits of TA1 (8th MSbit to 5th LSbit) encode fmax and Fi | |
195 | } | |
196 | ||
197 | static int PrintATR(uint8_t *atr, size_t atrlen) { | |
6b6c3be6 | 198 | |
199 | uint8_t T0 = atr[1]; | |
200 | uint8_t K = T0 & 0x0F; | |
151a33c0 | 201 | uint8_t TD1 = 0, T1len = 0, TD1len = 0, TDilen = 0; |
a9104f7e | 202 | bool protocol_T0_present = true; |
203 | bool protocol_T15_present = false; | |
6b6c3be6 | 204 | |
205 | if (T0 & 0x10) { | |
151a33c0 | 206 | PrintAndLog("\t- TA1 (Maximum clock frequency, proposed bit duration) [ 0x%02x ]", atr[2 + T1len]); |
6b6c3be6 | 207 | T1len++; |
208 | } | |
151a33c0 | 209 | |
6b6c3be6 | 210 | if (T0 & 0x20) { |
151a33c0 | 211 | PrintAndLog("\t- TB1 (Deprecated: VPP requirements) [ 0x%02x ]", atr[2 + T1len]); |
6b6c3be6 | 212 | T1len++; |
213 | } | |
151a33c0 | 214 | |
6b6c3be6 | 215 | if (T0 & 0x40) { |
151a33c0 | 216 | PrintAndLog("\t- TC1 (Extra delay between bytes required by card) [ 0x%02x ]", atr[2 + T1len]); |
6b6c3be6 | 217 | T1len++; |
218 | } | |
151a33c0 | 219 | |
6b6c3be6 | 220 | if (T0 & 0x80) { |
221 | TD1 = atr[2 + T1len]; | |
151a33c0 | 222 | PrintAndLog("\t- TD1 (First offered transmission protocol, presence of TA2..TD2) [ 0x%02x ] Protocol T%d", TD1, TD1 & 0x0f); |
a9104f7e | 223 | protocol_T0_present = false; |
224 | if ((TD1 & 0x0f) == 0) { | |
225 | protocol_T0_present = true; | |
226 | } | |
227 | if ((TD1 & 0x0f) == 15) { | |
228 | protocol_T15_present = true; | |
229 | } | |
230 | ||
6b6c3be6 | 231 | T1len++; |
232 | ||
233 | if (TD1 & 0x10) { | |
151a33c0 | 234 | PrintAndLog("\t- TA2 (Specific protocol and parameters to be used after the ATR) [ 0x%02x ]", atr[2 + T1len + TD1len]); |
6b6c3be6 | 235 | TD1len++; |
236 | } | |
237 | if (TD1 & 0x20) { | |
151a33c0 | 238 | PrintAndLog("\t- TB2 (Deprecated: VPP precise voltage requirement) [ 0x%02x ]", atr[2 + T1len + TD1len]); |
6b6c3be6 | 239 | TD1len++; |
240 | } | |
241 | if (TD1 & 0x40) { | |
151a33c0 | 242 | PrintAndLog("\t- TC2 (Maximum waiting time for protocol T=0) [ 0x%02x ]", atr[2 + T1len + TD1len]); |
6b6c3be6 | 243 | TD1len++; |
244 | } | |
245 | if (TD1 & 0x80) { | |
246 | uint8_t TDi = atr[2 + T1len + TD1len]; | |
151a33c0 | 247 | PrintAndLog("\t- TD2 (A supported protocol or more global parameters, presence of TA3..TD3) [ 0x%02x ] Protocol T%d", TDi, TDi & 0x0f); |
a9104f7e | 248 | if ((TDi & 0x0f) == 0) { |
249 | protocol_T0_present = true; | |
250 | } | |
251 | if ((TDi & 0x0f) == 15) { | |
252 | protocol_T15_present = true; | |
253 | } | |
6b6c3be6 | 254 | TD1len++; |
255 | ||
256 | bool nextCycle = true; | |
257 | uint8_t vi = 3; | |
258 | while (nextCycle) { | |
259 | nextCycle = false; | |
260 | if (TDi & 0x10) { | |
151a33c0 | 261 | PrintAndLog("\t- TA%d: 0x%02x", vi, atr[2 + T1len + TD1len + TDilen]); |
6b6c3be6 | 262 | TDilen++; |
263 | } | |
264 | if (TDi & 0x20) { | |
151a33c0 | 265 | PrintAndLog("\t- TB%d: 0x%02x", vi, atr[2 + T1len + TD1len + TDilen]); |
6b6c3be6 | 266 | TDilen++; |
267 | } | |
268 | if (TDi & 0x40) { | |
151a33c0 | 269 | PrintAndLog("\t- TC%d: 0x%02x", vi, atr[2 + T1len + TD1len + TDilen]); |
6b6c3be6 | 270 | TDilen++; |
271 | } | |
272 | if (TDi & 0x80) { | |
273 | TDi = atr[2 + T1len + TD1len + TDilen]; | |
151a33c0 | 274 | PrintAndLog("\t- TD%d [ 0x%02x ] Protocol T%d", vi, TDi, TDi & 0x0f); |
6b6c3be6 | 275 | TDilen++; |
276 | ||
277 | nextCycle = true; | |
278 | vi++; | |
279 | } | |
280 | } | |
281 | } | |
282 | } | |
283 | ||
a9104f7e | 284 | if (!protocol_T0_present || protocol_T15_present) { // there is CRC Check Byte TCK |
285 | uint8_t vxor = 0; | |
286 | for (int i = 1; i < atrlen; i++) | |
287 | vxor ^= atr[i]; | |
288 | ||
289 | if (vxor) | |
290 | PrintAndLogEx(WARNING, "Check sum error. Must be 0 got 0x%02X", vxor); | |
291 | else | |
292 | PrintAndLogEx(INFO, "Check sum OK."); | |
293 | } | |
151a33c0 | 294 | |
151a33c0 | 295 | if (atr[0] != 0x3b) |
296 | PrintAndLogEx(WARNING, "Not a direct convention [ 0x%02x ]", atr[0]); | |
297 | ||
6b6c3be6 | 298 | uint8_t calen = 2 + T1len + TD1len + TDilen + K; |
299 | ||
300 | if (atrlen != calen && atrlen != calen + 1) // may be CRC | |
301 | PrintAndLogEx(ERR, "ATR length error. len: %d, T1len: %d, TD1len: %d, TDilen: %d, K: %d", atrlen, T1len, TD1len, TDilen, K); | |
6b6c3be6 | 302 | |
6b6c3be6 | 303 | if (K > 0) |
a9104f7e | 304 | PrintAndLogEx(INFO, "\nHistorical bytes | len %02d | format %02x", K, atr[2 + T1len + TD1len + TDilen]); |
151a33c0 | 305 | |
6b6c3be6 | 306 | if (K > 1) { |
151a33c0 | 307 | PrintAndLogEx(INFO, "\tHistorical bytes"); |
6b6c3be6 | 308 | dump_buffer(&atr[2 + T1len + TD1len + TDilen], K, NULL, 1); |
309 | } | |
310 | ||
311 | return 0; | |
312 | } | |
313 | ||
0b6efd01 | 314 | bool smart_getATR(smart_card_atr_t *card) |
a9104f7e | 315 | { |
316 | if (UseAlternativeSmartcardReader) { | |
317 | return pcscGetATR(card); | |
318 | } else { | |
319 | UsbCommand c = {CMD_SMART_ATR, {0, 0, 0}}; | |
320 | SendCommand(&c); | |
321 | ||
322 | UsbCommand resp; | |
323 | if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2500) ) { | |
324 | return false; | |
325 | } | |
326 | ||
327 | if (resp.arg[0] & 0xff) { | |
328 | return resp.arg[0] & 0xFF; | |
329 | } | |
330 | ||
331 | memcpy(card, (smart_card_atr_t *)resp.d.asBytes, sizeof(smart_card_atr_t)); | |
332 | ||
333 | return true; | |
8d7d7b61 | 334 | } |
a9104f7e | 335 | } |
8d7d7b61 | 336 | |
a9104f7e | 337 | static bool smart_select(bool silent) { |
338 | ||
339 | smart_card_atr_t card; | |
340 | if (!smart_getATR(&card)) { | |
8d7d7b61 | 341 | if (!silent) PrintAndLogEx(WARNING, "smart card select failed"); |
342 | return false; | |
343 | } | |
344 | ||
345 | if (!silent) { | |
8d7d7b61 | 346 | PrintAndLogEx(INFO, "ISO7816-3 ATR : %s", sprint_hex(card.atr, card.atr_len)); |
347 | } | |
348 | ||
349 | return true; | |
350 | } | |
351 | ||
8d7d7b61 | 352 | |
6b5105be | 353 | static void smart_transmit(uint8_t *data, uint32_t data_len, uint32_t flags, uint8_t *response, int *response_len, uint32_t max_response_len) |
354 | { | |
355 | // PrintAndLogEx(SUCCESS, "C-TPDU>>>> %s", sprint_hex(data, data_len)); | |
356 | if (UseAlternativeSmartcardReader) { | |
357 | *response_len = max_response_len; | |
358 | pcscTransmit(data, data_len, flags, response, response_len); | |
151a33c0 | 359 | } else { |
6b5105be | 360 | UsbCommand c = {CMD_SMART_RAW, {flags, data_len, 0}}; |
361 | memcpy(c.d.asBytes, data, data_len); | |
362 | SendCommand(&c); | |
8d7d7b61 | 363 | |
6b5105be | 364 | if (!WaitForResponseTimeout(CMD_ACK, &c, 2500)) { |
365 | PrintAndLogEx(WARNING, "smart card response timeout"); | |
366 | *response_len = -1; | |
367 | return; | |
368 | } | |
8d7d7b61 | 369 | |
6b5105be | 370 | *response_len = c.arg[0]; |
371 | if (*response_len > 0) { | |
372 | memcpy(response, c.d.asBytes, *response_len); | |
373 | } | |
8d7d7b61 | 374 | } |
375 | ||
6b5105be | 376 | if (*response_len <= 0) { |
377 | PrintAndLogEx(WARNING, "smart card response failed"); | |
378 | *response_len = -2; | |
379 | return; | |
6b6c3be6 | 380 | } |
8d7d7b61 | 381 | |
6b5105be | 382 | if (*response_len < 2) { |
383 | // PrintAndLogEx(SUCCESS, "R-TPDU %02X | ", response[0]); | |
384 | return; | |
6b6c3be6 | 385 | } |
386 | ||
6b5105be | 387 | // PrintAndLogEx(SUCCESS, "R-TPDU<<<< %s", sprint_hex(response, *response_len)); |
388 | // PrintAndLogEx(SUCCESS, "R-TPDU SW %02X%02X | %s", response[*response_len-2], response[*response_len-1], GetAPDUCodeDescription(response[*response_len-2], response[*response_len-1])); | |
8d7d7b61 | 389 | } |
390 | ||
a9104f7e | 391 | |
6b5105be | 392 | static int CmdSmartSelect(const char *Cmd) |
393 | { | |
a9104f7e | 394 | const char *readername; |
395 | ||
396 | if (tolower(param_getchar(Cmd, 0)) == 'h') { | |
397 | return usage_sm_select(); | |
398 | } | |
399 | ||
400 | if (!PM3hasSmartcardSlot() && !pcscCheckForCardReaders()) { | |
401 | PrintAndLogEx(WARNING, "No Smartcard Readers available"); | |
402 | UseAlternativeSmartcardReader = false; | |
403 | return 1; | |
404 | } | |
405 | ||
406 | int bg, en; | |
407 | if (param_getptr(Cmd, &bg, &en, 0)) { | |
408 | UseAlternativeSmartcardReader = pcscSelectAlternativeCardReader(NULL); | |
409 | } else { | |
410 | readername = Cmd + bg; | |
411 | UseAlternativeSmartcardReader = pcscSelectAlternativeCardReader(readername); | |
412 | } | |
413 | ||
414 | return 0; | |
415 | } | |
416 | ||
6b5105be | 417 | |
418 | static int CmdSmartRaw(const char *Cmd) { | |
43591e64 | 419 | |
420 | int hexlen = 0; | |
421 | bool active = false; | |
422 | bool active_select = false; | |
151a33c0 | 423 | bool useT0 = false; |
43591e64 | 424 | uint8_t cmdp = 0; |
425 | bool errors = false, reply = true, decodeTLV = false, breakloop = false; | |
6b5105be | 426 | uint8_t data[ISO7816_MAX_FRAME_SIZE] = {0x00}; |
43591e64 | 427 | |
428 | while (param_getchar(Cmd, cmdp) != 0x00 && !errors) { | |
429 | switch (tolower(param_getchar(Cmd, cmdp))) { | |
430 | case 'h': return usage_sm_raw(); | |
431 | case 'r': | |
432 | reply = false; | |
433 | cmdp++; | |
434 | break; | |
435 | case 'a': | |
436 | active = true; | |
437 | cmdp++; | |
438 | break; | |
439 | case 's': | |
440 | active_select = true; | |
441 | cmdp++; | |
442 | break; | |
443 | case 't': | |
444 | decodeTLV = true; | |
445 | cmdp++; | |
446 | break; | |
151a33c0 | 447 | case '0': |
448 | useT0 = true; | |
449 | cmdp++; | |
450 | break; | |
43591e64 | 451 | case 'd': { |
452 | switch (param_gethex_to_eol(Cmd, cmdp+1, data, sizeof(data), &hexlen)) { | |
453 | case 1: | |
8d7d7b61 | 454 | PrintAndLogEx(WARNING, "Invalid HEX value."); |
43591e64 | 455 | return 1; |
456 | case 2: | |
8d7d7b61 | 457 | PrintAndLogEx(WARNING, "Too many bytes. Max %d bytes", sizeof(data)); |
43591e64 | 458 | return 1; |
459 | case 3: | |
8d7d7b61 | 460 | PrintAndLogEx(WARNING, "Hex must have even number of digits."); |
43591e64 | 461 | return 1; |
462 | } | |
463 | cmdp++; | |
464 | breakloop = true; | |
465 | break; | |
466 | } | |
467 | default: | |
8d7d7b61 | 468 | PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp)); |
43591e64 | 469 | errors = true; |
470 | break; | |
471 | } | |
472 | ||
473 | if ( breakloop ) | |
474 | break; | |
475 | } | |
476 | ||
477 | //Validations | |
478 | if (errors || cmdp == 0 ) return usage_sm_raw(); | |
479 | ||
6b5105be | 480 | uint32_t flags = 0; |
481 | uint32_t protocol = 0; | |
43591e64 | 482 | if (active || active_select) { |
6b5105be | 483 | flags |= SC_CONNECT; |
6b6c3be6 | 484 | if (active_select) |
6b5105be | 485 | flags |= SC_SELECT; |
6b6c3be6 | 486 | } |
43591e64 | 487 | if (hexlen > 0) { |
151a33c0 | 488 | if (useT0) |
6b5105be | 489 | protocol = SC_RAW_T0; |
151a33c0 | 490 | else |
6b5105be | 491 | protocol = SC_RAW; |
43591e64 | 492 | } |
6b5105be | 493 | |
494 | int response_len = 0; | |
495 | uint8_t *response = NULL; | |
496 | if (reply) { | |
497 | response = calloc(ISO7816_MAX_FRAME_SIZE, sizeof(uint8_t)); | |
498 | if ( !response ) | |
499 | return 1; | |
500 | } | |
501 | ||
502 | smart_transmit(data, hexlen, flags|protocol, response, &response_len, ISO7816_MAX_FRAME_SIZE); | |
43591e64 | 503 | |
504 | // reading response from smart card | |
505 | if ( reply ) { | |
6b5105be | 506 | if ( response_len < 0 ) { |
507 | free(response); | |
8d7d7b61 | 508 | return 2; |
43591e64 | 509 | } |
43591e64 | 510 | |
6b5105be | 511 | if ( response[0] == 0x6C ) { |
512 | data[4] = response[1]; | |
513 | smart_transmit(data, hexlen, protocol, response, &response_len, ISO7816_MAX_FRAME_SIZE); | |
8d7d7b61 | 514 | data[4] = 0; |
43591e64 | 515 | } |
516 | ||
6b5105be | 517 | if (decodeTLV && response_len > 4) |
518 | TLVPrintFromBuffer(response, response_len-2); | |
43591e64 | 519 | |
6b5105be | 520 | free(response); |
8d7d7b61 | 521 | } |
522 | return 0; | |
523 | } | |
43591e64 | 524 | |
6b5105be | 525 | |
526 | int ExchangeAPDUSC(uint8_t *APDU, int APDUlen, bool activateCard, bool leaveSignalON, uint8_t *response, int maxresponselen, int *responselen) | |
527 | { | |
528 | uint8_t TPDU[ISO7816_MAX_FRAME_SIZE]; | |
529 | ||
530 | *responselen = 0; | |
43591e64 | 531 | |
8d7d7b61 | 532 | if (activateCard) |
533 | smart_select(false); | |
43591e64 | 534 | |
6b5105be | 535 | uint32_t flags = SC_RAW_T0; |
8d7d7b61 | 536 | if (activateCard) { |
6b5105be | 537 | flags |= SC_SELECT | SC_CONNECT; |
43591e64 | 538 | } |
6b5105be | 539 | |
540 | if (APDUlen == 4) { // Case 1 | |
541 | memcpy(TPDU, APDU, 4); | |
542 | TPDU[4] = 0x00; | |
543 | smart_transmit(TPDU, 5, flags, response, responselen, maxresponselen); | |
544 | } else if (APDUlen == 5) { // Case 2 Short | |
545 | smart_transmit(APDU, 5, flags, response, responselen, maxresponselen); | |
546 | if (response[0] == 0x6C) { // wrong Le | |
547 | uint16_t Le = APDU[4] ? APDU[4] : 256; | |
548 | uint8_t La = response[1]; | |
549 | memcpy(TPDU, APDU, 5); | |
550 | TPDU[4] = La; | |
551 | smart_transmit(TPDU, 5, SC_RAW_T0, response, responselen, maxresponselen); | |
552 | if (Le < La && *responselen >= 0) { | |
553 | response[Le] = response[*responselen-2]; | |
554 | response[Le+1] = response[*responselen-1]; | |
555 | *responselen = Le + 2; | |
556 | } | |
557 | } | |
558 | } else if (APDU[4] != 0 && APDUlen == 5 + APDU[4]) { // Case 3 Short | |
559 | smart_transmit(APDU, APDUlen, flags, response, responselen, maxresponselen); | |
560 | } else if (APDU[4] != 0 && APDUlen == 5 + APDU[4] + 1) { // Case 4 Short | |
561 | smart_transmit(APDU, APDUlen-1, flags, response, responselen, maxresponselen); | |
562 | if (response[0] == 0x90 && response[1] == 0x00) { | |
563 | uint8_t Le = APDU[APDUlen-1]; | |
564 | uint8_t get_response[5] = {0x00, ISO7816_GET_RESPONSE, 0x00, 0x00, Le}; | |
565 | return ExchangeAPDUSC(get_response, 5, false, leaveSignalON, response, maxresponselen, responselen); | |
566 | } | |
567 | } else { // Long Cases not yet implemented | |
568 | PrintAndLogEx(ERR, "Long APDUs not yet implemented"); | |
569 | *responselen = -3; | |
8d7d7b61 | 570 | } |
571 | ||
6b5105be | 572 | if (*responselen < 0 ) { |
4cdd63b2 | 573 | return 1; |
6b5105be | 574 | } else { |
575 | return 0; | |
6b6c3be6 | 576 | } |
43591e64 | 577 | } |
578 | ||
8d7d7b61 | 579 | |
6b5105be | 580 | static int CmdSmartUpgrade(const char *Cmd) { |
43591e64 | 581 | |
9f596ec7 | 582 | PrintAndLogEx(NORMAL, ""); |
583 | PrintAndLogEx(WARNING, "WARNING - RDV4.0 Smartcard Socket Firmware upgrade."); | |
8d7d7b61 | 584 | PrintAndLogEx(WARNING, "A dangerous command, do wrong and you will brick the smart card socket"); |
9f596ec7 | 585 | PrintAndLogEx(NORMAL, ""); |
43591e64 | 586 | |
587 | FILE *f; | |
588 | char filename[FILE_PATH_SIZE] = {0}; | |
589 | uint8_t cmdp = 0; | |
590 | bool errors = false; | |
591 | ||
592 | while (param_getchar(Cmd, cmdp) != 0x00 && !errors) { | |
593 | switch (tolower(param_getchar(Cmd, cmdp))) { | |
594 | case 'f': | |
595 | //File handling and reading | |
596 | if ( param_getstr(Cmd, cmdp+1, filename, FILE_PATH_SIZE) >= FILE_PATH_SIZE ) { | |
8d7d7b61 | 597 | PrintAndLogEx(FAILED, "Filename too long"); |
43591e64 | 598 | errors = true; |
599 | break; | |
600 | } | |
601 | cmdp += 2; | |
602 | break; | |
603 | case 'h': | |
604 | return usage_sm_upgrade(); | |
605 | default: | |
8d7d7b61 | 606 | PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp)); |
43591e64 | 607 | errors = true; |
608 | break; | |
609 | } | |
610 | } | |
611 | ||
612 | //Validations | |
613 | if (errors || cmdp == 0 ) return usage_sm_upgrade(); | |
614 | ||
9f596ec7 | 615 | if (strchr(filename, '\\') || strchr(filename, '/')) { |
616 | PrintAndLogEx(FAILED, "Filename must not contain \\ or /. Firmware file will be found in client/sc_upgrade_firmware directory."); | |
617 | return 1; | |
618 | } | |
619 | ||
620 | char sc_upgrade_file_path[strlen(get_my_executable_directory()) + strlen(SC_UPGRADE_FILES_DIRECTORY) + strlen(filename) + 1]; | |
621 | strcpy(sc_upgrade_file_path, get_my_executable_directory()); | |
622 | strcat(sc_upgrade_file_path, SC_UPGRADE_FILES_DIRECTORY); | |
623 | strcat(sc_upgrade_file_path, filename); | |
624 | if (strlen(sc_upgrade_file_path) >= FILE_PATH_SIZE ) { | |
625 | PrintAndLogEx(FAILED, "Filename too long"); | |
626 | return 1; | |
627 | } | |
628 | ||
d3c60657 | 629 | char sha512filename[FILE_PATH_SIZE] = {'\0'}; |
9f596ec7 | 630 | char *bin_extension = filename; |
631 | char *dot_position = NULL; | |
632 | while ((dot_position = strchr(bin_extension, '.')) != NULL) { | |
633 | bin_extension = dot_position + 1; | |
634 | } | |
635 | if (!strcmp(bin_extension, "BIN") | |
636 | #ifdef _WIN32 | |
637 | || !strcmp(bin_extension, "bin") | |
638 | #endif | |
639 | ) { | |
d3c60657 | 640 | memcpy(sha512filename, filename, strlen(filename) - strlen("bin")); |
9f596ec7 | 641 | strcat(sha512filename, "sha512.txt"); |
642 | } else { | |
643 | PrintAndLogEx(FAILED, "Filename extension of Firmware Upgrade File must be .BIN"); | |
644 | return 1; | |
645 | } | |
646 | ||
647 | PrintAndLogEx(INFO, "Checking integrity using SHA512 File %s ...", sha512filename); | |
648 | char sc_upgrade_sha512file_path[strlen(get_my_executable_directory()) + strlen(SC_UPGRADE_FILES_DIRECTORY) + strlen(sha512filename) + 1]; | |
649 | strcpy(sc_upgrade_sha512file_path, get_my_executable_directory()); | |
650 | strcat(sc_upgrade_sha512file_path, SC_UPGRADE_FILES_DIRECTORY); | |
651 | strcat(sc_upgrade_sha512file_path, sha512filename); | |
652 | if (strlen(sc_upgrade_sha512file_path) >= FILE_PATH_SIZE ) { | |
653 | PrintAndLogEx(FAILED, "Filename too long"); | |
654 | return 1; | |
655 | } | |
656 | ||
657 | // load firmware file | |
658 | f = fopen(sc_upgrade_file_path, "rb"); | |
8d7d7b61 | 659 | if ( !f ){ |
9f596ec7 | 660 | PrintAndLogEx(FAILED, "Firmware file not found or locked."); |
43591e64 | 661 | return 1; |
662 | } | |
663 | ||
664 | // get filesize in order to malloc memory | |
665 | fseek(f, 0, SEEK_END); | |
9f596ec7 | 666 | size_t fsize = ftell(f); |
43591e64 | 667 | fseek(f, 0, SEEK_SET); |
668 | ||
9f596ec7 | 669 | if (fsize < 0) { |
670 | PrintAndLogEx(FAILED, "Could not determine size of firmware file"); | |
43591e64 | 671 | fclose(f); |
672 | return 1; | |
673 | } | |
8d7d7b61 | 674 | |
43591e64 | 675 | uint8_t *dump = calloc(fsize, sizeof(uint8_t)); |
676 | if (!dump) { | |
9f596ec7 | 677 | PrintAndLogEx(FAILED, "Could not allocate memory for firmware"); |
43591e64 | 678 | fclose(f); |
679 | return 1; | |
680 | } | |
681 | ||
9f596ec7 | 682 | size_t firmware_size = fread(dump, 1, fsize, f); |
43591e64 | 683 | if (f) |
684 | fclose(f); | |
685 | ||
9f596ec7 | 686 | // load sha512 file |
687 | f = fopen(sc_upgrade_sha512file_path, "rb"); | |
688 | if ( !f ){ | |
689 | PrintAndLogEx(FAILED, "SHA-512 file not found or locked."); | |
690 | return 1; | |
691 | } | |
692 | ||
693 | // get filesize in order to malloc memory | |
694 | fseek(f, 0, SEEK_END); | |
695 | fsize = ftell(f); | |
696 | fseek(f, 0, SEEK_SET); | |
697 | ||
698 | if (fsize < 0) { | |
699 | PrintAndLogEx(FAILED, "Could not determine size of SHA-512 file"); | |
700 | fclose(f); | |
701 | return 1; | |
702 | } | |
703 | ||
704 | if (fsize < 128) { | |
705 | PrintAndLogEx(FAILED, "SHA-512 file too short"); | |
706 | fclose(f); | |
707 | return 1; | |
708 | } | |
709 | ||
710 | char hashstring[129]; | |
711 | size_t bytes_read = fread(hashstring, 1, 128, f); | |
712 | hashstring[128] = '\0'; | |
713 | ||
714 | if (f) | |
715 | fclose(f); | |
716 | ||
717 | uint8_t hash1[64]; | |
718 | if (bytes_read != 128 || param_gethex(hashstring, 0, hash1, 128)) { | |
719 | PrintAndLogEx(FAILED, "Couldn't read SHA-512 file"); | |
720 | return 1; | |
721 | } | |
722 | ||
723 | uint8_t hash2[64]; | |
724 | if (sha512hash(dump, firmware_size, hash2)) { | |
725 | PrintAndLogEx(FAILED, "Couldn't calculate SHA-512 of Firmware"); | |
726 | return 1; | |
727 | } | |
728 | ||
729 | if (memcmp(hash1, hash2, 64)) { | |
730 | PrintAndLogEx(FAILED, "Couldn't verify integrity of Firmware file (wrong SHA-512)"); | |
731 | return 1; | |
732 | } | |
733 | ||
734 | PrintAndLogEx(SUCCESS, "RDV4.0 Smartcard Socket Firmware uploading to PM3"); | |
735 | ||
43591e64 | 736 | //Send to device |
737 | uint32_t index = 0; | |
738 | uint32_t bytes_sent = 0; | |
9f596ec7 | 739 | uint32_t bytes_remaining = firmware_size; |
43591e64 | 740 | |
741 | while (bytes_remaining > 0){ | |
742 | uint32_t bytes_in_packet = MIN(USB_CMD_DATA_SIZE, bytes_remaining); | |
743 | UsbCommand c = {CMD_SMART_UPLOAD, {index + bytes_sent, bytes_in_packet, 0}}; | |
744 | ||
745 | // Fill usb bytes with 0xFF | |
746 | memset(c.d.asBytes, 0xFF, USB_CMD_DATA_SIZE); | |
747 | memcpy(c.d.asBytes, dump + bytes_sent, bytes_in_packet); | |
748 | clearCommandBuffer(); | |
749 | SendCommand(&c); | |
750 | if ( !WaitForResponseTimeout(CMD_ACK, NULL, 2000) ) { | |
8d7d7b61 | 751 | PrintAndLogEx(WARNING, "timeout while waiting for reply."); |
43591e64 | 752 | free(dump); |
753 | return 1; | |
754 | } | |
755 | ||
756 | bytes_remaining -= bytes_in_packet; | |
757 | bytes_sent += bytes_in_packet; | |
758 | printf("."); fflush(stdout); | |
759 | } | |
760 | free(dump); | |
761 | printf("\n"); | |
9f596ec7 | 762 | PrintAndLogEx(SUCCESS, "RDV4.0 Smartcard Socket Firmware updating, don\'t turn off your PM3!"); |
43591e64 | 763 | |
764 | // trigger the firmware upgrade | |
9f596ec7 | 765 | UsbCommand c = {CMD_SMART_UPGRADE, {firmware_size, 0, 0}}; |
43591e64 | 766 | clearCommandBuffer(); |
767 | SendCommand(&c); | |
768 | UsbCommand resp; | |
769 | if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2500) ) { | |
8d7d7b61 | 770 | PrintAndLogEx(WARNING, "timeout while waiting for reply."); |
43591e64 | 771 | return 1; |
772 | } | |
8d7d7b61 | 773 | if ( (resp.arg[0] & 0xFF ) ) |
9f596ec7 | 774 | PrintAndLogEx(SUCCESS, "RDV4.0 Smartcard Socket Firmware upgraded successful"); |
43591e64 | 775 | else |
9f596ec7 | 776 | PrintAndLogEx(FAILED, "RDV4.0 Smartcard Socket Firmware Upgrade failed"); |
43591e64 | 777 | return 0; |
778 | } | |
779 | ||
6b5105be | 780 | |
781 | static int CmdSmartInfo(const char *Cmd){ | |
43591e64 | 782 | uint8_t cmdp = 0; |
783 | bool errors = false, silent = false; | |
784 | ||
785 | while (param_getchar(Cmd, cmdp) != 0x00 && !errors) { | |
786 | switch (tolower(param_getchar(Cmd, cmdp))) { | |
787 | case 'h': return usage_sm_info(); | |
8d7d7b61 | 788 | case 's': |
43591e64 | 789 | silent = true; |
790 | break; | |
791 | default: | |
8d7d7b61 | 792 | PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp)); |
43591e64 | 793 | errors = true; |
794 | break; | |
795 | } | |
796 | cmdp++; | |
797 | } | |
798 | ||
799 | //Validations | |
800 | if (errors ) return usage_sm_info(); | |
801 | ||
a9104f7e | 802 | smart_card_atr_t card; |
803 | if (!smart_getATR(&card)) { | |
8d7d7b61 | 804 | if (!silent) PrintAndLogEx(WARNING, "smart card select failed"); |
43591e64 | 805 | return 1; |
806 | } | |
0b6efd01 OM |
807 | |
808 | if (!card.atr_len) { | |
809 | if (!silent) PrintAndLogEx(ERR, "can't get ATR from a smart card"); | |
810 | return 1; | |
811 | } | |
43591e64 | 812 | |
43591e64 | 813 | // print header |
151a33c0 | 814 | PrintAndLogEx(INFO, "--- Smartcard Information ---------"); |
8d7d7b61 | 815 | PrintAndLogEx(INFO, "-------------------------------------------------------------"); |
151a33c0 | 816 | PrintAndLogEx(INFO, "ISO7618-3 ATR : %s", sprint_hex(card.atr, card.atr_len)); |
817 | PrintAndLogEx(INFO, "\nhttp://smartcard-atr.appspot.com/parse?ATR=%s", sprint_hex_inrow(card.atr, card.atr_len) ); | |
6b6c3be6 | 818 | |
819 | // print ATR | |
820 | PrintAndLogEx(NORMAL, ""); | |
151a33c0 | 821 | PrintAndLogEx(INFO, "ATR"); |
6b6c3be6 | 822 | PrintATR(card.atr, card.atr_len); |
823 | ||
824 | // print D/F (brom byte TA1 or defaults) | |
825 | PrintAndLogEx(NORMAL, ""); | |
151a33c0 | 826 | PrintAndLogEx(INFO, "D/F (TA1)"); |
6b6c3be6 | 827 | int Di = GetATRDi(card.atr, card.atr_len); |
828 | int Fi = GetATRFi(card.atr, card.atr_len); | |
829 | float F = GetATRF(card.atr, card.atr_len); | |
830 | if (GetATRTA1(card.atr, card.atr_len) == 0x11) | |
831 | PrintAndLogEx(INFO, "Using default values..."); | |
832 | ||
151a33c0 | 833 | PrintAndLogEx(NORMAL, "\t- Di=%d", Di); |
834 | PrintAndLogEx(NORMAL, "\t- Fi=%d", Fi); | |
835 | PrintAndLogEx(NORMAL, "\t- F=%.1f MHz", F); | |
836 | ||
837 | if (Di && Fi) { | |
838 | PrintAndLogEx(NORMAL, "\t- Cycles/ETU=%d", Fi/Di); | |
839 | PrintAndLogEx(NORMAL, "\t- %.1f bits/sec at 4MHz", (float)4000000 / (Fi/Di)); | |
840 | PrintAndLogEx(NORMAL, "\t- %.1f bits/sec at Fmax=%.1fMHz", (F * 1000000) / (Fi/Di), F); | |
841 | } else { | |
842 | PrintAndLogEx(WARNING, "\t- Di or Fi is RFU."); | |
843 | }; | |
6b6c3be6 | 844 | |
43591e64 | 845 | return 0; |
846 | } | |
847 | ||
848 | int CmdSmartReader(const char *Cmd){ | |
849 | uint8_t cmdp = 0; | |
850 | bool errors = false, silent = false; | |
851 | ||
852 | while (param_getchar(Cmd, cmdp) != 0x00 && !errors) { | |
853 | switch (tolower(param_getchar(Cmd, cmdp))) { | |
854 | case 'h': return usage_sm_reader(); | |
8d7d7b61 | 855 | case 's': |
43591e64 | 856 | silent = true; |
857 | break; | |
858 | default: | |
8d7d7b61 | 859 | PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp)); |
43591e64 | 860 | errors = true; |
861 | break; | |
862 | } | |
863 | cmdp++; | |
864 | } | |
865 | ||
866 | //Validations | |
867 | if (errors ) return usage_sm_reader(); | |
868 | ||
a9104f7e | 869 | smart_card_atr_t card; |
870 | if (!smart_getATR(&card)) { | |
8d7d7b61 | 871 | if (!silent) PrintAndLogEx(WARNING, "smart card select failed"); |
43591e64 | 872 | return 1; |
873 | } | |
8d7d7b61 | 874 | |
875 | PrintAndLogEx(INFO, "ISO7816-3 ATR : %s", sprint_hex(card.atr, card.atr_len)); | |
43591e64 | 876 | return 0; |
877 | } | |
878 | ||
6b5105be | 879 | |
880 | static int CmdSmartSetClock(const char *Cmd){ | |
43591e64 | 881 | uint8_t cmdp = 0; |
882 | bool errors = false; | |
883 | uint8_t clock = 0; | |
884 | while (param_getchar(Cmd, cmdp) != 0x00 && !errors) { | |
885 | switch (tolower(param_getchar(Cmd, cmdp))) { | |
886 | case 'h': return usage_sm_setclock(); | |
8d7d7b61 | 887 | case 'c': |
43591e64 | 888 | clock = param_get8ex(Cmd, cmdp+1, 2, 10); |
889 | if ( clock > 2) | |
890 | errors = true; | |
8d7d7b61 | 891 | |
43591e64 | 892 | cmdp += 2; |
893 | break; | |
894 | default: | |
8d7d7b61 | 895 | PrintAndLogEx(WARNING, "Unknown parameter '%c'", param_getchar(Cmd, cmdp)); |
43591e64 | 896 | errors = true; |
897 | break; | |
898 | } | |
899 | } | |
900 | ||
901 | //Validations | |
902 | if (errors || cmdp == 0) return usage_sm_setclock(); | |
903 | ||
904 | UsbCommand c = {CMD_SMART_SETCLOCK, {clock, 0, 0}}; | |
905 | clearCommandBuffer(); | |
906 | SendCommand(&c); | |
907 | UsbCommand resp; | |
908 | if ( !WaitForResponseTimeout(CMD_ACK, &resp, 2500) ) { | |
8d7d7b61 | 909 | PrintAndLogEx(WARNING, "smart card select failed"); |
43591e64 | 910 | return 1; |
911 | } | |
912 | ||
913 | uint8_t isok = resp.arg[0] & 0xFF; | |
914 | if (!isok) { | |
8d7d7b61 | 915 | PrintAndLogEx(WARNING, "smart card set clock failed"); |
43591e64 | 916 | return 1; |
917 | } | |
918 | ||
919 | switch (clock) { | |
920 | case 0: | |
8d7d7b61 | 921 | PrintAndLogEx(SUCCESS, "Clock changed to 16mhz giving 10800 baudrate"); |
43591e64 | 922 | break; |
923 | case 1: | |
8d7d7b61 | 924 | PrintAndLogEx(SUCCESS, "Clock changed to 8mhz giving 21600 baudrate"); |
43591e64 | 925 | break; |
926 | case 2: | |
8d7d7b61 | 927 | PrintAndLogEx(SUCCESS, "Clock changed to 4mhz giving 86400 baudrate"); |
43591e64 | 928 | break; |
929 | default: | |
930 | break; | |
931 | } | |
932 | return 0; | |
933 | } | |
934 | ||
6b5105be | 935 | |
936 | static int CmdSmartList(const char *Cmd) { | |
53fb848a | 937 | if (UseAlternativeSmartcardReader) { |
938 | CmdHFList("7816 p"); | |
939 | } else { | |
940 | CmdHFList("7816"); | |
941 | } | |
8d7d7b61 | 942 | return 0; |
43591e64 | 943 | } |
944 | ||
6b5105be | 945 | |
946 | static int CmdSmartBruteforceSFI(const char *Cmd) { | |
43591e64 | 947 | |
8d7d7b61 | 948 | char ctmp = tolower(param_getchar(Cmd, 0)); |
949 | if (ctmp == 'h') return usage_sm_brute(); | |
43591e64 | 950 | |
8d7d7b61 | 951 | uint8_t data[5] = {0x00, 0xB2, 0x00, 0x00, 0x00}; |
43591e64 | 952 | |
8d7d7b61 | 953 | PrintAndLogEx(INFO, "Selecting card"); |
954 | if ( !smart_select(false) ) { | |
955 | return 1; | |
43591e64 | 956 | } |
957 | ||
6b5105be | 958 | PrintAndLogEx(INFO, "Selecting PSE aid"); |
151a33c0 | 959 | CmdSmartRaw("s 0 t d 00a404000e325041592e5359532e4444463031"); |
960 | CmdSmartRaw("0 t d 00a4040007a000000004101000"); // mastercard | |
961 | // CmdSmartRaw("0 t d 00a4040007a0000000031010"); // visa | |
43591e64 | 962 | |
8d7d7b61 | 963 | PrintAndLogEx(INFO, "starting"); |
43591e64 | 964 | |
6b5105be | 965 | int response_len = 0; |
966 | uint8_t* response = malloc(ISO7816_MAX_FRAME_SIZE); | |
967 | if (!response) | |
8d7d7b61 | 968 | return 1; |
43591e64 | 969 | |
8d7d7b61 | 970 | for (uint8_t i=1; i < 4; i++) { |
971 | for (int p1=1; p1 < 5; p1++) { | |
43591e64 | 972 | |
8d7d7b61 | 973 | data[2] = p1; |
974 | data[3] = (i << 3) + 4; | |
43591e64 | 975 | |
6b5105be | 976 | smart_transmit(data, sizeof(data), SC_RAW_T0, response, &response_len, ISO7816_MAX_FRAME_SIZE); |
43591e64 | 977 | |
6b5105be | 978 | if ( response[0] == 0x6C ) { |
979 | data[4] = response[1]; | |
980 | smart_transmit(data, sizeof(data), SC_RAW_T0, response, &response_len, ISO7816_MAX_FRAME_SIZE); | |
43591e64 | 981 | |
8d7d7b61 | 982 | // TLV decoder |
6b5105be | 983 | if (response_len > 4) |
984 | TLVPrintFromBuffer(response+1, response_len-3); | |
43591e64 | 985 | |
8d7d7b61 | 986 | data[4] = 0; |
43591e64 | 987 | } |
6b5105be | 988 | memset(response, 0x00, ISO7816_MAX_FRAME_SIZE); |
43591e64 | 989 | } |
990 | } | |
6b5105be | 991 | free(response); |
43591e64 | 992 | return 0; |
993 | } | |
994 | ||
995 | static command_t CommandTable[] = { | |
9f596ec7 | 996 | {"help", CmdHelp, 1, "This help"}, |
a9104f7e | 997 | {"select", CmdSmartSelect, 1, "Select the Smartcard Reader to use"}, |
6b5105be | 998 | {"list", CmdSmartList, 1, "List ISO 7816 history"}, |
999 | {"info", CmdSmartInfo, 1, "Tag information"}, | |
1000 | {"reader", CmdSmartReader, 1, "Act like an IS07816 reader"}, | |
1001 | {"raw", CmdSmartRaw, 1, "Send raw hex data to tag"}, | |
9f596ec7 | 1002 | {"upgrade", CmdSmartUpgrade, 0, "Upgrade firmware"}, |
6b5105be | 1003 | {"setclock", CmdSmartSetClock, 1, "Set clock speed"}, |
1004 | {"brute", CmdSmartBruteforceSFI, 1, "Bruteforce SFI"}, | |
9f596ec7 | 1005 | {NULL, NULL, 0, NULL} |
43591e64 | 1006 | }; |
1007 | ||
6b5105be | 1008 | |
43591e64 | 1009 | int CmdSmartcard(const char *Cmd) { |
1010 | clearCommandBuffer(); | |
1011 | CmdsParse(CommandTable, Cmd); | |
1012 | return 0; | |
1013 | } | |
1014 | ||
6b5105be | 1015 | |
1016 | static int CmdHelp(const char *Cmd) { | |
43591e64 | 1017 | CmdsHelp(CommandTable); |
1018 | return 0; | |
1019 | } |