TLV decoding works
[proxmark3-svn] / client / cmdhf14a.c
1 //-----------------------------------------------------------------------------
2 // 2011, 2017 Merlok
3 // Copyright (C) 2010 iZsh <izsh at fail0verflow.com>, Hagen Fritsch
4 //
5 // This code is licensed to you under the terms of the GNU GPL, version 2 or,
6 // at your option, any later version. See the LICENSE.txt file for the text of
7 // the license.
8 //-----------------------------------------------------------------------------
9 // High frequency ISO14443A commands
10 //-----------------------------------------------------------------------------
11
12 #include "cmdhf14a.h"
13
14 static int CmdHelp(const char *Cmd);
15 static int waitCmd(uint8_t iLen);
16
17 const manufactureName manufactureMapping[] = {
18 // ID, "Vendor Country"
19 { 0x01, "Motorola UK" },
20 { 0x02, "ST Microelectronics SA France" },
21 { 0x03, "Hitachi, Ltd Japan" },
22 { 0x04, "NXP Semiconductors Germany" },
23 { 0x05, "Infineon Technologies AG Germany" },
24 { 0x06, "Cylink USA" },
25 { 0x07, "Texas Instrument France" },
26 { 0x08, "Fujitsu Limited Japan" },
27 { 0x09, "Matsushita Electronics Corporation, Semiconductor Company Japan" },
28 { 0x0A, "NEC Japan" },
29 { 0x0B, "Oki Electric Industry Co. Ltd Japan" },
30 { 0x0C, "Toshiba Corp. Japan" },
31 { 0x0D, "Mitsubishi Electric Corp. Japan" },
32 { 0x0E, "Samsung Electronics Co. Ltd Korea" },
33 { 0x0F, "Hynix / Hyundai, Korea" },
34 { 0x10, "LG-Semiconductors Co. Ltd Korea" },
35 { 0x11, "Emosyn-EM Microelectronics USA" },
36 { 0x12, "INSIDE Technology France" },
37 { 0x13, "ORGA Kartensysteme GmbH Germany" },
38 { 0x14, "SHARP Corporation Japan" },
39 { 0x15, "ATMEL France" },
40 { 0x16, "EM Microelectronic-Marin SA Switzerland" },
41 { 0x17, "KSW Microtec GmbH Germany" },
42 { 0x18, "ZMD AG Germany" },
43 { 0x19, "XICOR, Inc. USA" },
44 { 0x1A, "Sony Corporation Japan Identifier Company Country" },
45 { 0x1B, "Malaysia Microelectronic Solutions Sdn. Bhd Malaysia" },
46 { 0x1C, "Emosyn USA" },
47 { 0x1D, "Shanghai Fudan Microelectronics Co. Ltd. P.R. China" },
48 { 0x1E, "Magellan Technology Pty Limited Australia" },
49 { 0x1F, "Melexis NV BO Switzerland" },
50 { 0x20, "Renesas Technology Corp. Japan" },
51 { 0x21, "TAGSYS France" },
52 { 0x22, "Transcore USA" },
53 { 0x23, "Shanghai belling corp., ltd. China" },
54 { 0x24, "Masktech Germany Gmbh Germany" },
55 { 0x25, "Innovision Research and Technology Plc UK" },
56 { 0x26, "Hitachi ULSI Systems Co., Ltd. Japan" },
57 { 0x27, "Cypak AB Sweden" },
58 { 0x28, "Ricoh Japan" },
59 { 0x29, "ASK France" },
60 { 0x2A, "Unicore Microsystems, LLC Russian Federation" },
61 { 0x2B, "Dallas Semiconductor/Maxim USA" },
62 { 0x2C, "Impinj, Inc. USA" },
63 { 0x2D, "RightPlug Alliance USA" },
64 { 0x2E, "Broadcom Corporation USA" },
65 { 0x2F, "MStar Semiconductor, Inc Taiwan, ROC" },
66 { 0x30, "BeeDar Technology Inc. USA" },
67 { 0x31, "RFIDsec Denmark" },
68 { 0x32, "Schweizer Electronic AG Germany" },
69 { 0x33, "AMIC Technology Corp Taiwan" },
70 { 0x34, "Mikron JSC Russia" },
71 { 0x35, "Fraunhofer Institute for Photonic Microsystems Germany" },
72 { 0x36, "IDS Microchip AG Switzerland" },
73 { 0x37, "Kovio USA" },
74 { 0x38, "HMT Microelectronic Ltd Switzerland Identifier Company Country" },
75 { 0x39, "Silicon Craft Technology Thailand" },
76 { 0x3A, "Advanced Film Device Inc. Japan" },
77 { 0x3B, "Nitecrest Ltd UK" },
78 { 0x3C, "Verayo Inc. USA" },
79 { 0x3D, "HID Global USA" },
80 { 0x3E, "Productivity Engineering Gmbh Germany" },
81 { 0x3F, "Austriamicrosystems AG (reserved) Austria" },
82 { 0x40, "Gemalto SA France" },
83 { 0x41, "Renesas Electronics Corporation Japan" },
84 { 0x42, "3Alogics Inc Korea" },
85 { 0x43, "Top TroniQ Asia Limited Hong Kong" },
86 { 0x44, "Gentag Inc (USA) USA" },
87 { 0x00, "no tag-info available" } // must be the last entry
88 };
89
90 // get a product description based on the UID
91 // uid[8] tag uid
92 // returns description of the best match
93 char* getTagInfo(uint8_t uid) {
94
95 int i;
96 int len = sizeof(manufactureMapping) / sizeof(manufactureName);
97
98 for ( i = 0; i < len; ++i )
99 if ( uid == manufactureMapping[i].uid)
100 return manufactureMapping[i].desc;
101
102 //No match, return default
103 return manufactureMapping[len-1].desc;
104 }
105
106 int CmdHF14AList(const char *Cmd)
107 {
108 PrintAndLog("Deprecated command, use 'hf list 14a' instead");
109 return 0;
110 }
111
112 int CmdHF14AReader(const char *Cmd)
113 {
114 UsbCommand c = {CMD_READER_ISO_14443a, {ISO14A_CONNECT | ISO14A_NO_DISCONNECT, 0, 0}};
115 SendCommand(&c);
116
117 UsbCommand resp;
118 WaitForResponse(CMD_ACK,&resp);
119
120 iso14a_card_select_t card;
121 memcpy(&card, (iso14a_card_select_t *)resp.d.asBytes, sizeof(iso14a_card_select_t));
122
123 uint64_t select_status = resp.arg[0]; // 0: couldn't read, 1: OK, with ATS, 2: OK, no ATS, 3: proprietary Anticollision
124
125 if(select_status == 0) {
126 if (Cmd[0] != 's') PrintAndLog("iso14443a card select failed");
127 // disconnect
128 c.arg[0] = 0;
129 c.arg[1] = 0;
130 c.arg[2] = 0;
131 SendCommand(&c);
132 return 0;
133 }
134
135 if(select_status == 3) {
136 PrintAndLog("Card doesn't support standard iso14443-3 anticollision");
137 PrintAndLog("ATQA : %02x %02x", card.atqa[1], card.atqa[0]);
138 // disconnect
139 c.arg[0] = 0;
140 c.arg[1] = 0;
141 c.arg[2] = 0;
142 SendCommand(&c);
143 return 0;
144 }
145
146 PrintAndLog(" UID : %s", sprint_hex(card.uid, card.uidlen));
147 PrintAndLog("ATQA : %02x %02x", card.atqa[1], card.atqa[0]);
148 PrintAndLog(" SAK : %02x [%d]", card.sak, resp.arg[0]);
149
150 switch (card.sak) {
151 case 0x00:
152
153 //***************************************test****************
154 // disconnect
155 c.arg[0] = 0;
156 c.arg[1] = 0;
157 c.arg[2] = 0;
158 SendCommand(&c);
159
160 uint32_t tagT = GetHF14AMfU_Type();
161 ul_print_type(tagT, 0);
162
163 //reconnect for further tests
164 c.arg[0] = ISO14A_CONNECT | ISO14A_NO_DISCONNECT;
165 c.arg[1] = 0;
166 c.arg[2] = 0;
167
168 SendCommand(&c);
169
170 UsbCommand resp;
171 WaitForResponse(CMD_ACK,&resp);
172
173 memcpy(&card, (iso14a_card_select_t *)resp.d.asBytes, sizeof(iso14a_card_select_t));
174
175 select_status = resp.arg[0]; // 0: couldn't read, 1: OK, with ATS, 2: OK, no ATS
176
177 if(select_status == 0) {
178 //PrintAndLog("iso14443a card select failed");
179 // disconnect
180 c.arg[0] = 0;
181 c.arg[1] = 0;
182 c.arg[2] = 0;
183 SendCommand(&c);
184 return 0;
185 }
186
187 /* orig
188 // check if the tag answers to GETVERSION (0x60)
189 c.arg[0] = ISO14A_RAW | ISO14A_APPEND_CRC | ISO14A_NO_DISCONNECT;
190 c.arg[1] = 1;
191 c.arg[2] = 0;
192 c.d.asBytes[0] = 0x60;
193 SendCommand(&c);
194 WaitForResponse(CMD_ACK,&resp);
195
196 uint8_t version[10] = {0};
197 memcpy(version, resp.d.asBytes, resp.arg[0] < sizeof(version) ? resp.arg[0] : sizeof(version));
198 uint8_t len = resp.arg[0] & 0xff;
199 switch ( len ){
200 // todo, identify "Magic UL-C tags". // they usually have a static nonce response to 0x1A command.
201 // UL-EV1, size, check version[6] == 0x0b (smaller) 0x0b * 4 == 48
202 case 0x0A:PrintAndLog("TYPE : NXP MIFARE Ultralight EV1 %d bytes", (version[6] == 0xB) ? 48 : 128);break;
203 case 0x01:PrintAndLog("TYPE : NXP MIFARE Ultralight C");break;
204 case 0x00:PrintAndLog("TYPE : NXP MIFARE Ultralight");break;
205 }
206 */
207 break;
208 case 0x01: PrintAndLog("TYPE : NXP TNP3xxx Activision Game Appliance"); break;
209 case 0x04: PrintAndLog("TYPE : NXP MIFARE (various !DESFire !DESFire EV1)"); break;
210 case 0x08: PrintAndLog("TYPE : NXP MIFARE CLASSIC 1k | Plus 2k SL1"); break;
211 case 0x09: PrintAndLog("TYPE : NXP MIFARE Mini 0.3k"); break;
212 case 0x10: PrintAndLog("TYPE : NXP MIFARE Plus 2k SL2"); break;
213 case 0x11: PrintAndLog("TYPE : NXP MIFARE Plus 4k SL2"); break;
214 case 0x18: PrintAndLog("TYPE : NXP MIFARE Classic 4k | Plus 4k SL1"); break;
215 case 0x20: PrintAndLog("TYPE : NXP MIFARE DESFire 4k | DESFire EV1 2k/4k/8k | Plus 2k/4k SL3 | JCOP 31/41"); break;
216 case 0x24: PrintAndLog("TYPE : NXP MIFARE DESFire | DESFire EV1"); break;
217 case 0x28: PrintAndLog("TYPE : JCOP31 or JCOP41 v2.3.1"); break;
218 case 0x38: PrintAndLog("TYPE : Nokia 6212 or 6131 MIFARE CLASSIC 4K"); break;
219 case 0x88: PrintAndLog("TYPE : Infineon MIFARE CLASSIC 1K"); break;
220 case 0x98: PrintAndLog("TYPE : Gemplus MPCOS"); break;
221 default: ;
222 }
223
224 // Double & triple sized UID, can be mapped to a manufacturer.
225 // HACK: does this apply for Ultralight cards?
226 if ( card.uidlen > 4 ) {
227 PrintAndLog("MANUFACTURER : %s", getTagInfo(card.uid[0]));
228 }
229
230 // try to request ATS even if tag claims not to support it
231 if (select_status == 2) {
232 uint8_t rats[] = { 0xE0, 0x80 }; // FSDI=8 (FSD=256), CID=0
233 c.arg[0] = ISO14A_RAW | ISO14A_APPEND_CRC | ISO14A_NO_DISCONNECT;
234 c.arg[1] = 2;
235 c.arg[2] = 0;
236 memcpy(c.d.asBytes, rats, 2);
237 SendCommand(&c);
238 WaitForResponse(CMD_ACK,&resp);
239
240 memcpy(card.ats, resp.d.asBytes, resp.arg[0]);
241 card.ats_len = resp.arg[0]; // note: ats_len includes CRC Bytes
242 }
243
244 if(card.ats_len >= 3) { // a valid ATS consists of at least the length byte (TL) and 2 CRC bytes
245 bool ta1 = 0, tb1 = 0, tc1 = 0;
246 int pos;
247
248 if (select_status == 2) {
249 PrintAndLog("SAK incorrectly claims that card doesn't support RATS");
250 }
251 PrintAndLog(" ATS : %s", sprint_hex(card.ats, card.ats_len));
252 PrintAndLog(" - TL : length is %d bytes", card.ats[0]);
253 if (card.ats[0] != card.ats_len - 2) {
254 PrintAndLog("ATS may be corrupted. Length of ATS (%d bytes incl. 2 Bytes CRC) doesn't match TL", card.ats_len);
255 }
256
257 if (card.ats[0] > 1) { // there is a format byte (T0)
258 ta1 = (card.ats[1] & 0x10) == 0x10;
259 tb1 = (card.ats[1] & 0x20) == 0x20;
260 tc1 = (card.ats[1] & 0x40) == 0x40;
261 int16_t fsci = card.ats[1] & 0x0f;
262 PrintAndLog(" - T0 : TA1 is%s present, TB1 is%s present, "
263 "TC1 is%s present, FSCI is %d (FSC = %ld)",
264 (ta1 ? "" : " NOT"), (tb1 ? "" : " NOT"), (tc1 ? "" : " NOT"),
265 fsci,
266 fsci < 5 ? (fsci - 2) * 8 :
267 fsci < 8 ? (fsci - 3) * 32 :
268 fsci == 8 ? 256 :
269 -1
270 );
271 }
272 pos = 2;
273 if (ta1) {
274 char dr[16], ds[16];
275 dr[0] = ds[0] = '\0';
276 if (card.ats[pos] & 0x10) strcat(ds, "2, ");
277 if (card.ats[pos] & 0x20) strcat(ds, "4, ");
278 if (card.ats[pos] & 0x40) strcat(ds, "8, ");
279 if (card.ats[pos] & 0x01) strcat(dr, "2, ");
280 if (card.ats[pos] & 0x02) strcat(dr, "4, ");
281 if (card.ats[pos] & 0x04) strcat(dr, "8, ");
282 if (strlen(ds) != 0) ds[strlen(ds) - 2] = '\0';
283 if (strlen(dr) != 0) dr[strlen(dr) - 2] = '\0';
284 PrintAndLog(" - TA1 : different divisors are%s supported, "
285 "DR: [%s], DS: [%s]",
286 (card.ats[pos] & 0x80 ? " NOT" : ""), dr, ds);
287 pos++;
288 }
289 if (tb1) {
290 uint32_t sfgi = card.ats[pos] & 0x0F;
291 uint32_t fwi = card.ats[pos] >> 4;
292 PrintAndLog(" - TB1 : SFGI = %d (SFGT = %s%ld/fc), FWI = %d (FWT = %ld/fc)",
293 (sfgi),
294 sfgi ? "" : "(not needed) ",
295 sfgi ? (1 << 12) << sfgi : 0,
296 fwi,
297 (1 << 12) << fwi
298 );
299 pos++;
300 }
301 if (tc1) {
302 PrintAndLog(" - TC1 : NAD is%s supported, CID is%s supported",
303 (card.ats[pos] & 0x01) ? "" : " NOT",
304 (card.ats[pos] & 0x02) ? "" : " NOT");
305 pos++;
306 }
307 if (card.ats[0] > pos) {
308 char *tip = "";
309 if (card.ats[0] - pos >= 7) {
310 if (memcmp(card.ats + pos, "\xC1\x05\x2F\x2F\x01\xBC\xD6", 7) == 0) {
311 tip = "-> MIFARE Plus X 2K or 4K";
312 } else if (memcmp(card.ats + pos, "\xC1\x05\x2F\x2F\x00\x35\xC7", 7) == 0) {
313 tip = "-> MIFARE Plus S 2K or 4K";
314 }
315 }
316 PrintAndLog(" - HB : %s%s", sprint_hex(card.ats + pos, card.ats[0] - pos), tip);
317 if (card.ats[pos] == 0xC1) {
318 PrintAndLog(" c1 -> Mifare or (multiple) virtual cards of various type");
319 PrintAndLog(" %02x -> Length is %d bytes",
320 card.ats[pos + 1], card.ats[pos + 1]);
321 switch (card.ats[pos + 2] & 0xf0) {
322 case 0x10:
323 PrintAndLog(" 1x -> MIFARE DESFire");
324 break;
325 case 0x20:
326 PrintAndLog(" 2x -> MIFARE Plus");
327 break;
328 }
329 switch (card.ats[pos + 2] & 0x0f) {
330 case 0x00:
331 PrintAndLog(" x0 -> <1 kByte");
332 break;
333 case 0x01:
334 PrintAndLog(" x1 -> 1 kByte");
335 break;
336 case 0x02:
337 PrintAndLog(" x2 -> 2 kByte");
338 break;
339 case 0x03:
340 PrintAndLog(" x3 -> 4 kByte");
341 break;
342 case 0x04:
343 PrintAndLog(" x4 -> 8 kByte");
344 break;
345 }
346 switch (card.ats[pos + 3] & 0xf0) {
347 case 0x00:
348 PrintAndLog(" 0x -> Engineering sample");
349 break;
350 case 0x20:
351 PrintAndLog(" 2x -> Released");
352 break;
353 }
354 switch (card.ats[pos + 3] & 0x0f) {
355 case 0x00:
356 PrintAndLog(" x0 -> Generation 1");
357 break;
358 case 0x01:
359 PrintAndLog(" x1 -> Generation 2");
360 break;
361 case 0x02:
362 PrintAndLog(" x2 -> Generation 3");
363 break;
364 }
365 switch (card.ats[pos + 4] & 0x0f) {
366 case 0x00:
367 PrintAndLog(" x0 -> Only VCSL supported");
368 break;
369 case 0x01:
370 PrintAndLog(" x1 -> VCS, VCSL, and SVC supported");
371 break;
372 case 0x0E:
373 PrintAndLog(" xE -> no VCS command supported");
374 break;
375 }
376 }
377 }
378 } else {
379 PrintAndLog("proprietary non iso14443-4 card found, RATS not supported");
380 }
381
382
383 // try to see if card responses to "chinese magic backdoor" commands.
384 mfCIdentify();
385
386 return select_status;
387 }
388
389 // Collect ISO14443 Type A UIDs
390 int CmdHF14ACUIDs(const char *Cmd)
391 {
392 // requested number of UIDs
393 int n = atoi(Cmd);
394 // collect at least 1 (e.g. if no parameter was given)
395 n = n > 0 ? n : 1;
396
397 PrintAndLog("Collecting %d UIDs", n);
398 PrintAndLog("Start: %" PRIu64, msclock()/1000);
399 // repeat n times
400 for (int i = 0; i < n; i++) {
401 // execute anticollision procedure
402 UsbCommand c = {CMD_READER_ISO_14443a, {ISO14A_CONNECT | ISO14A_NO_RATS, 0, 0}};
403 SendCommand(&c);
404
405 UsbCommand resp;
406 WaitForResponse(CMD_ACK,&resp);
407
408 iso14a_card_select_t *card = (iso14a_card_select_t *) resp.d.asBytes;
409
410 // check if command failed
411 if (resp.arg[0] == 0) {
412 PrintAndLog("Card select failed.");
413 } else {
414 char uid_string[20];
415 for (uint16_t i = 0; i < card->uidlen; i++) {
416 sprintf(&uid_string[2*i], "%02X", card->uid[i]);
417 }
418 PrintAndLog("%s", uid_string);
419 }
420 }
421 PrintAndLog("End: %" PRIu64, msclock()/1000);
422
423 return 1;
424 }
425
426 // ## simulate iso14443a tag
427 // ## greg - added ability to specify tag UID
428 int CmdHF14ASim(const char *Cmd)
429 {
430 UsbCommand c = {CMD_SIMULATE_TAG_ISO_14443a,{0,0,0}};
431
432 // Retrieve the tag type
433 uint8_t tagtype = param_get8ex(Cmd,0,0,10);
434
435 // When no argument was given, just print help message
436 if (tagtype == 0) {
437 PrintAndLog("");
438 PrintAndLog(" Emulating ISO/IEC 14443 type A tag with 4 or 7 byte UID");
439 PrintAndLog("");
440 PrintAndLog(" syntax: hf 14a sim <type> <uid>");
441 PrintAndLog(" types: 1 = MIFARE Classic");
442 PrintAndLog(" 2 = MIFARE Ultralight");
443 PrintAndLog(" 3 = MIFARE Desfire");
444 PrintAndLog(" 4 = ISO/IEC 14443-4");
445 PrintAndLog(" 5 = MIFARE Tnp3xxx");
446 PrintAndLog("");
447 return 1;
448 }
449
450 // Store the tag type
451 c.arg[0] = tagtype;
452
453 // Retrieve the full 4 or 7 byte long uid
454 uint64_t long_uid = param_get64ex(Cmd,1,0,16);
455
456 // Are we handling the (optional) second part uid?
457 if (long_uid > 0xffffffff) {
458 PrintAndLog("Emulating ISO/IEC 14443 type A tag with 7 byte UID (%014" PRIx64 ")",long_uid);
459 // Store the second part
460 c.arg[2] = (long_uid & 0xffffffff);
461 long_uid >>= 32;
462 // Store the first part, ignore the first byte, it is replaced by cascade byte (0x88)
463 c.arg[1] = (long_uid & 0xffffff);
464 } else {
465 PrintAndLog("Emulating ISO/IEC 14443 type A tag with 4 byte UID (%08x)",long_uid);
466 // Only store the first part
467 c.arg[1] = long_uid & 0xffffffff;
468 }
469 /*
470 // At lease save the mandatory first part of the UID
471 c.arg[0] = long_uid & 0xffffffff;
472
473 if (c.arg[1] == 0) {
474 PrintAndLog("Emulating ISO/IEC 14443 type A tag with UID %01d %08x %08x",c.arg[0],c.arg[1],c.arg[2]);
475 }
476
477 switch (c.arg[0]) {
478 case 1: {
479 PrintAndLog("Emulating ISO/IEC 14443-3 type A tag with 4 byte UID");
480 UsbCommand c = {CMD_SIMULATE_TAG_ISO_14443a,param_get32ex(Cmd,0,0,10),param_get32ex(Cmd,1,0,16),param_get32ex(Cmd,2,0,16)};
481 } break;
482 case 2: {
483 PrintAndLog("Emulating ISO/IEC 14443-4 type A tag with 7 byte UID");
484 } break;
485 default: {
486 PrintAndLog("Error: unkown tag type (%d)",c.arg[0]);
487 PrintAndLog("syntax: hf 14a sim <uid>",c.arg[0]);
488 PrintAndLog(" type1: 4 ",c.arg[0]);
489
490 return 1;
491 } break;
492 }
493 */
494 /*
495 unsigned int hi = 0, lo = 0;
496 int n = 0, i = 0;
497 while (sscanf(&Cmd[i++], "%1x", &n ) == 1) {
498 hi= (hi << 4) | (lo >> 28);
499 lo= (lo << 4) | (n & 0xf);
500 }
501 */
502 // UsbCommand c = {CMD_SIMULATE_TAG_ISO_14443a,param_get32ex(Cmd,0,0,10),param_get32ex(Cmd,1,0,16),param_get32ex(Cmd,2,0,16)};
503 // PrintAndLog("Emulating ISO/IEC 14443 type A tag with UID %01d %08x %08x",c.arg[0],c.arg[1],c.arg[2]);
504 SendCommand(&c);
505 return 0;
506 }
507
508 int CmdHF14ASnoop(const char *Cmd) {
509 int param = 0;
510
511 uint8_t ctmp = param_getchar(Cmd, 0) ;
512 if (ctmp == 'h' || ctmp == 'H') {
513 PrintAndLog("It get data from the field and saves it into command buffer.");
514 PrintAndLog("Buffer accessible from command hf list 14a.");
515 PrintAndLog("Usage: hf 14a snoop [c][r]");
516 PrintAndLog("c - triggered by first data from card");
517 PrintAndLog("r - triggered by first 7-bit request from reader (REQ,WUP,...)");
518 PrintAndLog("sample: hf 14a snoop c r");
519 return 0;
520 }
521
522 for (int i = 0; i < 2; i++) {
523 ctmp = param_getchar(Cmd, i);
524 if (ctmp == 'c' || ctmp == 'C') param |= 0x01;
525 if (ctmp == 'r' || ctmp == 'R') param |= 0x02;
526 }
527
528 UsbCommand c = {CMD_SNOOP_ISO_14443a, {param, 0, 0}};
529 SendCommand(&c);
530 return 0;
531 }
532
533 int ExchangeAPDU14a(uint8_t *datain, int datainlen, bool activateField, bool leaveSignalON, uint8_t *dataout, int *dataoutlen) {
534 uint8_t data[USB_CMD_DATA_SIZE];
535 int datalen;
536 uint8_t cmdc = 0;
537 uint8_t first, second;
538
539 if (activateField)
540 cmdc |= ISO14A_CONNECT;
541 if (leaveSignalON)
542 cmdc |= ISO14A_NO_DISCONNECT;
543
544 // ISO 14443 APDU frame: PCB [CID] [NAD] APDU CRC PCB=0x02
545 memcpy(data + 1, datain, datainlen);
546 data[0] = 0x02; // bnr,nad,cid,chn=0; i-block(0x00)
547 datalen = datainlen + 1;
548
549 ComputeCrc14443(CRC_14443_A, data, datalen, &first, &second);
550 data[datalen++] = first;
551 data[datalen++] = second;
552
553 // "Command APDU" length should be 5+255+1, but javacard's APDU buffer might be smaller - 133 bytes
554 // https://stackoverflow.com/questions/32994936/safe-max-java-card-apdu-data-command-and-respond-size
555 // here length USB_CMD_DATA_SIZE=512
556 // timeout timeout14a * 1.06 / 100, true, size, &keyBlock[6 * c], e_sector); // timeout is (ms * 106)/10 or us*0.0106
557 UsbCommand c = {CMD_READER_ISO_14443a, {ISO14A_RAW | ISO14A_SET_TIMEOUT | cmdc, (datalen & 0xFFFF), 1000 * 1000 * 1.06 / 100}};
558 memcpy(c.d.asBytes, data, datalen);
559 SendCommand(&c);
560
561 uint8_t *recv;
562 UsbCommand resp;
563
564 if (activateField) {
565 if (!WaitForResponseTimeout(CMD_ACK, &resp, 1500))
566 return 1;
567 if (resp.arg[0] != 1)
568 return 1;
569 }
570
571 if (WaitForResponseTimeout(CMD_ACK, &resp, 1500)) {
572 recv = resp.d.asBytes;
573 uint8_t iLen = resp.arg[0];
574
575 *dataoutlen = iLen - 1 - 2;
576 if (*dataoutlen < 0)
577 *dataoutlen = 0;
578 memcpy(dataout, recv + 1, *dataoutlen);
579
580 if(!iLen)
581 return 1;
582
583 // check apdu length
584 if (iLen < 5) {
585 PrintAndLog("APDU ERROR: Small APDU response.");
586 return 2;
587 }
588
589 // check block
590 if (data[0] != recv[0]) {
591 PrintAndLog("APDU ERROR: Block type mismatch: %02x-%02x", data[0], recv[0]);
592 return 2;
593 }
594
595 // CRC Check
596 ComputeCrc14443(CRC_14443_A, recv, iLen, &first, &second);
597 if (first || second) {
598 PrintAndLog("APDU ERROR: ISO 14443A CRC error.");
599 return 3;
600 }
601
602 } else {
603 PrintAndLog("APDU ERROR: Reply timeout.");
604 return 4;
605 }
606
607 return 0;
608 }
609
610 int CmdHF14AAPDU(const char *cmd) {
611 uint8_t data[USB_CMD_DATA_SIZE];
612 int datalen = 0;
613 bool activateField = false;
614 bool leaveSignalON = false;
615 bool decodeTLV = false;
616
617 if (strlen(cmd) < 2) {
618 PrintAndLog("Usage: hf 14a apdu [-s] [-k] [-t] <APDU (hex)>");
619 PrintAndLog(" -s activate field and select card");
620 PrintAndLog(" -k leave the signal field ON after receive response");
621 PrintAndLog(" -t executes TLV decoder if it possible. TODO!!!!");
622 return 0;
623 }
624
625 int cmdp = 0;
626 while(param_getchar(cmd, cmdp) != 0x00) {
627 char c = param_getchar(cmd, cmdp);
628 if ((c == '-') && (param_getlength(cmd, cmdp) == 2))
629 switch (param_getchar_indx(cmd, 1, cmdp)) {
630 case 's':
631 case 'S':
632 activateField = true;
633 break;
634 case 'k':
635 case 'K':
636 leaveSignalON = true;
637 break;
638 case 't':
639 case 'T':
640 decodeTLV = true;
641 break;
642 default:
643 PrintAndLog("Unknown parameter '%c'", param_getchar_indx(cmd, 1, cmdp));
644 return 1;
645 }
646
647 if (isxdigit(c)) {
648 // len = data + PCB(1b) + CRC(2b)
649 switch(param_gethex_to_eol(cmd, cmdp, data, sizeof(data) - 1 - 2, &datalen)) {
650 case 1:
651 PrintAndLog("Invalid HEX value.");
652 return 1;
653 case 2:
654 PrintAndLog("APDU too large.");
655 return 1;
656 case 3:
657 PrintAndLog("Hex must have even number of digits.");
658 return 1;
659 }
660
661 // we get all the hex to end of line with spaces
662 break;
663 }
664
665 cmdp++;
666 }
667
668 PrintAndLog("--%s %s %s >>>> %s", activateField ? "sel": "", leaveSignalON ? "keep": "", decodeTLV ? "TLV": "", sprint_hex(data, datalen));
669
670 switch(ExchangeAPDU14a(data, datalen, activateField, leaveSignalON, data, &datalen)) {
671 case 0:
672 break;
673 case 1:
674 PrintAndLog("APDU ERROR: Send APDU error.");
675 return 1;
676 case 2:
677 return 2;
678 case 3:
679 return 3;
680 case 4:
681 return 4;
682 default:
683 return 5;
684 }
685
686 PrintAndLog("<<<< %s", sprint_hex(data, datalen));
687
688 PrintAndLog("APDU response: %02x %02x - %s", data[datalen - 2], data[datalen - 1], GetAPDUCodeDescription(data[datalen - 2], data[datalen - 1]));
689
690 // here TLV decoder...
691 if (decodeTLV && datalen > 4) {
692 TLVPrintFromBuffer(data, datalen - 2);
693 }
694
695 return 0;
696 }
697
698 int CmdHF14ACmdRaw(const char *cmd) {
699 UsbCommand c = {CMD_READER_ISO_14443a, {0, 0, 0}};
700 bool reply=1;
701 bool crc = false;
702 bool power = false;
703 bool active = false;
704 bool active_select = false;
705 bool no_rats = false;
706 uint16_t numbits = 0;
707 bool bTimeout = false;
708 uint32_t timeout = 0;
709 bool topazmode = false;
710 char buf[5]="";
711 int i = 0;
712 uint8_t data[USB_CMD_DATA_SIZE];
713 uint16_t datalen = 0;
714 uint32_t temp;
715
716 if (strlen(cmd)<2) {
717 PrintAndLog("Usage: hf 14a raw [-r] [-c] [-p] [-f] [-b] [-t] <number of bits> <0A 0B 0C ... hex>");
718 PrintAndLog(" -r do not read response");
719 PrintAndLog(" -c calculate and append CRC");
720 PrintAndLog(" -p leave the signal field ON after receive");
721 PrintAndLog(" -a active signal field ON without select");
722 PrintAndLog(" -s active signal field ON with select");
723 PrintAndLog(" -b number of bits to send. Useful for send partial byte");
724 PrintAndLog(" -t timeout in ms");
725 PrintAndLog(" -T use Topaz protocol to send command");
726 PrintAndLog(" -3 ISO14443-3 select only (skip RATS)");
727 return 0;
728 }
729
730
731 // strip
732 while (*cmd==' ' || *cmd=='\t') cmd++;
733
734 while (cmd[i]!='\0') {
735 if (cmd[i]==' ' || cmd[i]=='\t') { i++; continue; }
736 if (cmd[i]=='-') {
737 switch (cmd[i+1]) {
738 case 'r':
739 reply = false;
740 break;
741 case 'c':
742 crc = true;
743 break;
744 case 'p':
745 power = true;
746 break;
747 case 'a':
748 active = true;
749 break;
750 case 's':
751 active_select = true;
752 break;
753 case 'b':
754 sscanf(cmd+i+2,"%d",&temp);
755 numbits = temp & 0xFFFF;
756 i+=3;
757 while(cmd[i]!=' ' && cmd[i]!='\0') { i++; }
758 i-=2;
759 break;
760 case 't':
761 bTimeout = true;
762 sscanf(cmd+i+2,"%d",&temp);
763 timeout = temp;
764 i+=3;
765 while(cmd[i]!=' ' && cmd[i]!='\0') { i++; }
766 i-=2;
767 break;
768 case 'T':
769 topazmode = true;
770 break;
771 case '3':
772 no_rats = true;
773 break;
774 default:
775 PrintAndLog("Invalid option");
776 return 0;
777 }
778 i+=2;
779 continue;
780 }
781 if ((cmd[i]>='0' && cmd[i]<='9') ||
782 (cmd[i]>='a' && cmd[i]<='f') ||
783 (cmd[i]>='A' && cmd[i]<='F') ) {
784 buf[strlen(buf)+1]=0;
785 buf[strlen(buf)]=cmd[i];
786 i++;
787
788 if (strlen(buf)>=2) {
789 sscanf(buf,"%x",&temp);
790 data[datalen]=(uint8_t)(temp & 0xff);
791 *buf=0;
792 if (datalen > sizeof(data)-1) {
793 if (crc)
794 PrintAndLog("Buffer is full, we can't add CRC to your data");
795 break;
796 } else {
797 datalen++;
798 }
799 }
800 continue;
801 }
802 PrintAndLog("Invalid char on input");
803 return 0;
804 }
805
806 if(crc && datalen>0 && datalen<sizeof(data)-2)
807 {
808 uint8_t first, second;
809 if (topazmode) {
810 ComputeCrc14443(CRC_14443_B, data, datalen, &first, &second);
811 } else {
812 ComputeCrc14443(CRC_14443_A, data, datalen, &first, &second);
813 }
814 data[datalen++] = first;
815 data[datalen++] = second;
816 }
817
818 if(active || active_select)
819 {
820 c.arg[0] |= ISO14A_CONNECT;
821 if(active)
822 c.arg[0] |= ISO14A_NO_SELECT;
823 }
824
825 if(bTimeout){
826 #define MAX_TIMEOUT 40542464 // = (2^32-1) * (8*16) / 13560000Hz * 1000ms/s
827 c.arg[0] |= ISO14A_SET_TIMEOUT;
828 if(timeout > MAX_TIMEOUT) {
829 timeout = MAX_TIMEOUT;
830 PrintAndLog("Set timeout to 40542 seconds (11.26 hours). The max we can wait for response");
831 }
832 c.arg[2] = 13560000 / 1000 / (8*16) * timeout; // timeout in ETUs (time to transfer 1 bit, approx. 9.4 us)
833 }
834
835 if(power) {
836 c.arg[0] |= ISO14A_NO_DISCONNECT;
837 }
838
839 if(datalen > 0) {
840 c.arg[0] |= ISO14A_RAW;
841 }
842
843 if(topazmode) {
844 c.arg[0] |= ISO14A_TOPAZMODE;
845 }
846
847 if(no_rats) {
848 c.arg[0] |= ISO14A_NO_RATS;
849 }
850
851 // Max buffer is USB_CMD_DATA_SIZE (512)
852 c.arg[1] = (datalen & 0xFFFF) | ((uint32_t)numbits << 16);
853 memcpy(c.d.asBytes,data,datalen);
854
855 SendCommand(&c);
856
857 if (reply) {
858 int res = 0;
859 if (active_select)
860 res = waitCmd(1);
861 if (!res && datalen > 0)
862 waitCmd(0);
863 } // if reply
864 return 0;
865 }
866
867
868 static int waitCmd(uint8_t iSelect) {
869 uint8_t *recv;
870 UsbCommand resp;
871 char *hexout;
872
873 if (WaitForResponseTimeout(CMD_ACK,&resp,1500)) {
874 recv = resp.d.asBytes;
875 uint8_t iLen = iSelect ? resp.arg[1] : resp.arg[0];
876 PrintAndLog("received %i octets", iLen);
877 if(!iLen)
878 return 1;
879 hexout = (char *)malloc(iLen * 3 + 1);
880 if (hexout != NULL) {
881 for (int i = 0; i < iLen; i++) { // data in hex
882 sprintf(&hexout[i * 3], "%02X ", recv[i]);
883 }
884 PrintAndLog("%s", hexout);
885 free(hexout);
886 } else {
887 PrintAndLog("malloc failed your client has low memory?");
888 return 2;
889 }
890 } else {
891 PrintAndLog("timeout while waiting for reply.");
892 return 3;
893 }
894 return 0;
895 }
896
897 static command_t CommandTable[] =
898 {
899 {"help", CmdHelp, 1, "This help"},
900 {"list", CmdHF14AList, 0, "[Deprecated] List ISO 14443a history"},
901 {"reader", CmdHF14AReader, 0, "Act like an ISO14443 Type A reader"},
902 {"cuids", CmdHF14ACUIDs, 0, "<n> Collect n>0 ISO14443 Type A UIDs in one go"},
903 {"sim", CmdHF14ASim, 0, "<UID> -- Simulate ISO 14443a tag"},
904 {"snoop", CmdHF14ASnoop, 0, "Eavesdrop ISO 14443 Type A"},
905 {"apdu", CmdHF14AAPDU, 0, "Send ISO 1443-4 APDU to tag"},
906 {"raw", CmdHF14ACmdRaw, 0, "Send raw hex data to tag"},
907 {NULL, NULL, 0, NULL}
908 };
909
910 int CmdHF14A(const char *Cmd) {
911 // flush
912 WaitForResponseTimeout(CMD_ACK,NULL,100);
913
914 // parse
915 CmdsParse(CommandTable, Cmd);
916 return 0;
917 }
918
919 int CmdHelp(const char *Cmd)
920 {
921 CmdsHelp(CommandTable);
922 return 0;
923 }
Impressum, Datenschutz