]> cvs.zerfleddert.de Git - proxmark3-svn/blob - client/cmdhf14a.c
minor fixes regaring the newly released patches from the pm3 community
[proxmark3-svn] / client / cmdhf14a.c
1 //-----------------------------------------------------------------------------
2 // 2011, 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 <stdio.h>
13 #include <stdlib.h>
14 #include <string.h>
15 #include <unistd.h>
16 #include "util.h"
17 #include "../common/iso14443crc.h"
18 #include "data.h"
19 #include "proxmark3.h"
20 #include "ui.h"
21 #include "cmdparser.h"
22 #include "cmdhf14a.h"
23 #include "../include/common.h"
24 #include "cmdmain.h"
25 #include "../include/mifare.h"
26
27 static int CmdHelp(const char *Cmd);
28 static void waitCmd(uint8_t iLen);
29
30 int CmdHF14AList(const char *Cmd)
31 {
32 bool ShowWaitCycles = false;
33 char param = param_getchar(Cmd, 0);
34
35 if (param == 'h' || (param != 0 && param != 'f')) {
36 PrintAndLog("List data in trace buffer.");
37 PrintAndLog("Usage: hf 14a list [f]");
38 PrintAndLog("f - show frame delay times as well");
39 PrintAndLog("sample: hf 14a list f");
40 return 0;
41 }
42
43 if (param == 'f') {
44 ShowWaitCycles = true;
45 }
46
47 // for the time being. Need better Bigbuf handling.
48 #define TRACE_SIZE 3000
49
50 uint8_t trace[TRACE_SIZE];
51 GetFromBigBuf(trace, TRACE_SIZE, 0);
52 WaitForResponse(CMD_ACK,NULL);
53
54 PrintAndLog("Recorded Activity");
55 PrintAndLog("");
56 PrintAndLog("Start = Start of Start Bit, End = End of last modulation. Src = Source of Transfer");
57 PrintAndLog("All times are in carrier periods (1/13.56Mhz)");
58 PrintAndLog("");
59 PrintAndLog(" Start | End | Src | Data");
60 PrintAndLog("-----------|-----------|-----|--------");
61
62 uint16_t tracepos = 0;
63 uint16_t duration;
64 uint16_t data_len;
65 uint16_t parity_len;
66 bool isResponse;
67 uint32_t timestamp;
68 uint32_t first_timestamp;
69 uint32_t EndOfTransmissionTimestamp;
70
71 for (;;) {
72
73 if(tracepos >= TRACE_SIZE) {
74 break;
75 }
76
77 timestamp = *((uint32_t *)(trace + tracepos));
78 if(tracepos == 0) {
79 first_timestamp = timestamp;
80 }
81 tracepos += 4;
82 duration = *((uint16_t *)(trace + tracepos));
83 tracepos += 2;
84 data_len = *((uint16_t *)(trace + tracepos));
85 tracepos += 2;
86
87 if (data_len & 0x8000) {
88 data_len &= 0x7fff;
89 isResponse = true;
90 } else {
91 isResponse = false;
92 }
93
94 parity_len = (data_len-1)/8 + 1;
95
96 if (tracepos + data_len + parity_len >= TRACE_SIZE) {
97 break;
98 }
99
100 uint8_t *frame = trace + tracepos;
101 tracepos += data_len;
102 uint8_t *parityBytes = trace + tracepos;
103 tracepos += parity_len;
104
105 // Break and stick with current result if buffer was not completely full
106 if (timestamp == 0x44444444) break;
107
108 char line[1000] = "";
109 int j;
110 for (j = 0; j < data_len; j++) {
111 int oddparity = 0x01;
112 int k;
113
114 for (k=0;k<8;k++) {
115 oddparity ^= (((frame[j] & 0xFF) >> k) & 0x01);
116 }
117
118 uint8_t parityBits = parityBytes[j>>3];
119 if (isResponse && (oddparity != ((parityBits >> (7-(j&0x0007))) & 0x01))) {
120 sprintf(line+(j*4), "%02x! ", frame[j]);
121 } else {
122 sprintf(line+(j*4), "%02x ", frame[j]);
123 }
124 }
125
126 char crc[6] = "";
127 if (data_len > 2) {
128 uint8_t b1, b2;
129 ComputeCrc14443(CRC_14443_A, frame, data_len-2, &b1, &b2);
130 if (b1 != frame[data_len-2] || b2 != frame[data_len-1]) {
131 sprintf(crc, (isResponse & (data_len < 6)) ? "" : " !crc");
132 } else {
133 sprintf(crc, "");
134 }
135 }
136
137 EndOfTransmissionTimestamp = timestamp + duration;
138
139 PrintAndLog(" %9d | %9d | %s | %s %s",
140 (timestamp - first_timestamp),
141 (EndOfTransmissionTimestamp - first_timestamp),
142 (isResponse ? "Tag" : "Rdr"),
143 line,
144 crc);
145
146 bool next_isResponse = *((uint16_t *)(trace + tracepos + 6)) & 0x8000;
147
148 if (ShowWaitCycles && !isResponse && next_isResponse) {
149 uint32_t next_timestamp = *((uint32_t *)(trace + tracepos));
150 if (next_timestamp != 0x44444444) {
151 PrintAndLog(" %9d | %9d | %s | fdt (Frame Delay Time): %d",
152 (EndOfTransmissionTimestamp - first_timestamp),
153 (next_timestamp - first_timestamp),
154 " ",
155 (next_timestamp - EndOfTransmissionTimestamp));
156 }
157 }
158
159 }
160
161 return 0;
162 }
163
164 void iso14a_set_timeout(uint32_t timeout) {
165 UsbCommand c = {CMD_READER_ISO_14443a, {ISO14A_SET_TIMEOUT, 0, timeout}};
166 SendCommand(&c);
167 }
168
169 int CmdHF14AReader(const char *Cmd)
170 {
171 //UsbCommand c = {CMD_READER_ISO_14443a, {ISO14A_CONNECT | ISO14A_NO_DISCONNECT, 0, 0}};
172 UsbCommand c = {CMD_READER_ISO_14443a, {ISO14A_CONNECT , 0, 0}};
173 SendCommand(&c);
174
175 UsbCommand resp;
176 WaitForResponse(CMD_ACK,&resp);
177
178 iso14a_card_select_t card;
179 memcpy(&card, (iso14a_card_select_t *)resp.d.asBytes, sizeof(iso14a_card_select_t));
180
181 uint64_t select_status = resp.arg[0]; // 0: couldn't read, 1: OK, with ATS, 2: OK, no ATS
182
183 if(select_status == 0) {
184 PrintAndLog("iso14443a card select failed");
185 return 0;
186 }
187
188 PrintAndLog("ATQA : %02x %02x", card.atqa[1], card.atqa[0]);
189 PrintAndLog(" UID : %s", sprint_hex(card.uid, card.uidlen));
190 PrintAndLog(" SAK : %02x [%d]", card.sak, resp.arg[0]);
191
192 switch (card.sak) {
193 case 0x00: PrintAndLog("TYPE : NXP MIFARE Ultralight | Ultralight C"); break;
194 case 0x01: PrintAndLog("TYPE : NXP TNP3xxx Activision Game Appliance"); break;
195 case 0x04: PrintAndLog("TYPE : NXP MIFARE (various !DESFire !DESFire EV1)"); break;
196 case 0x08: PrintAndLog("TYPE : NXP MIFARE CLASSIC 1k | Plus 2k SL1"); break;
197 case 0x09: PrintAndLog("TYPE : NXP MIFARE Mini 0.3k"); break;
198 case 0x10: PrintAndLog("TYPE : NXP MIFARE Plus 2k SL2"); break;
199 case 0x11: PrintAndLog("TYPE : NXP MIFARE Plus 4k SL2"); break;
200 case 0x18: PrintAndLog("TYPE : NXP MIFARE Classic 4k | Plus 4k SL1"); break;
201 case 0x20: PrintAndLog("TYPE : NXP MIFARE DESFire 4k | DESFire EV1 2k/4k/8k | Plus 2k/4k SL3 | JCOP 31/41"); break;
202 case 0x24: PrintAndLog("TYPE : NXP MIFARE DESFire | DESFire EV1"); break;
203 case 0x28: PrintAndLog("TYPE : JCOP31 or JCOP41 v2.3.1"); break;
204 case 0x38: PrintAndLog("TYPE : Nokia 6212 or 6131 MIFARE CLASSIC 4K"); break;
205 case 0x88: PrintAndLog("TYPE : Infineon MIFARE CLASSIC 1K"); break;
206 case 0x98: PrintAndLog("TYPE : Gemplus MPCOS"); break;
207 default: ;
208 }
209
210
211 // try to request ATS even if tag claims not to support it
212 if (select_status == 2) {
213 uint8_t rats[] = { 0xE0, 0x80 }; // FSDI=8 (FSD=256), CID=0
214 c.arg[0] = ISO14A_RAW | ISO14A_APPEND_CRC | ISO14A_NO_DISCONNECT;
215 c.arg[1] = 2;
216 c.arg[2] = 0;
217 memcpy(c.d.asBytes, rats, 2);
218 SendCommand(&c);
219 WaitForResponse(CMD_ACK,&resp);
220
221 memcpy(&card.ats, resp.d.asBytes, resp.arg[0]);
222 card.ats_len = resp.arg[0]; // note: ats_len includes CRC Bytes
223 }
224
225 // disconnect
226 c.arg[0] = 0;
227 c.arg[1] = 0;
228 c.arg[2] = 0;
229 SendCommand(&c);
230
231
232 if(card.ats_len >= 3) { // a valid ATS consists of at least the length byte (TL) and 2 CRC bytes
233 bool ta1 = 0, tb1 = 0, tc1 = 0;
234 int pos;
235
236 if (select_status == 2) {
237 PrintAndLog("SAK incorrectly claims that card doesn't support RATS");
238 }
239 PrintAndLog(" ATS : %s", sprint_hex(card.ats, card.ats_len));
240 PrintAndLog(" - TL : length is %d bytes", card.ats[0]);
241 if (card.ats[0] != card.ats_len - 2) {
242 PrintAndLog("ATS may be corrupted. Length of ATS (%d bytes incl. 2 Bytes CRC) doesn't match TL", card.ats_len);
243 }
244
245 if (card.ats[0] > 1) { // there is a format byte (T0)
246 ta1 = (card.ats[1] & 0x10) == 0x10;
247 tb1 = (card.ats[1] & 0x20) == 0x20;
248 tc1 = (card.ats[1] & 0x40) == 0x40;
249 int16_t fsci = card.ats[1] & 0x0f;
250 PrintAndLog(" - T0 : TA1 is%s present, TB1 is%s present, "
251 "TC1 is%s present, FSCI is %d (FSC = %ld)",
252 (ta1 ? "" : " NOT"), (tb1 ? "" : " NOT"), (tc1 ? "" : " NOT"),
253 fsci,
254 fsci < 5 ? (fsci - 2) * 8 :
255 fsci < 8 ? (fsci - 3) * 32 :
256 fsci == 8 ? 256 :
257 -1
258 );
259 }
260 pos = 2;
261 if (ta1) {
262 char dr[16], ds[16];
263 dr[0] = ds[0] = '\0';
264 if (card.ats[pos] & 0x10) strcat(ds, "2, ");
265 if (card.ats[pos] & 0x20) strcat(ds, "4, ");
266 if (card.ats[pos] & 0x40) strcat(ds, "8, ");
267 if (card.ats[pos] & 0x01) strcat(dr, "2, ");
268 if (card.ats[pos] & 0x02) strcat(dr, "4, ");
269 if (card.ats[pos] & 0x04) strcat(dr, "8, ");
270 if (strlen(ds) != 0) ds[strlen(ds) - 2] = '\0';
271 if (strlen(dr) != 0) dr[strlen(dr) - 2] = '\0';
272 PrintAndLog(" - TA1 : different divisors are%s supported, "
273 "DR: [%s], DS: [%s]",
274 (card.ats[pos] & 0x80 ? " NOT" : ""), dr, ds);
275 pos++;
276 }
277 if (tb1) {
278 uint32_t sfgi = card.ats[pos] & 0x0F;
279 uint32_t fwi = card.ats[pos] >> 4;
280 PrintAndLog(" - TB1 : SFGI = %d (SFGT = %s%ld/fc), FWI = %d (FWT = %ld/fc)",
281 (sfgi),
282 sfgi ? "" : "(not needed) ",
283 sfgi ? (1 << 12) << sfgi : 0,
284 fwi,
285 (1 << 12) << fwi
286 );
287 pos++;
288 }
289 if (tc1) {
290 PrintAndLog(" - TC1 : NAD is%s supported, CID is%s supported",
291 (card.ats[pos] & 0x01) ? "" : " NOT",
292 (card.ats[pos] & 0x02) ? "" : " NOT");
293 pos++;
294 }
295 if (card.ats[0] > pos) {
296 char *tip = "";
297 if (card.ats[0] - pos >= 7) {
298 if (memcmp(card.ats + pos, "\xC1\x05\x2F\x2F\x01\xBC\xD6", 7) == 0) {
299 tip = "-> MIFARE Plus X 2K or 4K";
300 } else if (memcmp(card.ats + pos, "\xC1\x05\x2F\x2F\x00\x35\xC7", 7) == 0) {
301 tip = "-> MIFARE Plus S 2K or 4K";
302 }
303 }
304 PrintAndLog(" - HB : %s%s", sprint_hex(card.ats + pos, card.ats[0] - pos), tip);
305 if (card.ats[pos] == 0xC1) {
306 PrintAndLog(" c1 -> Mifare or (multiple) virtual cards of various type");
307 PrintAndLog(" %02x -> Length is %d bytes",
308 card.ats[pos + 1], card.ats[pos + 1]);
309 switch (card.ats[pos + 2] & 0xf0) {
310 case 0x10:
311 PrintAndLog(" 1x -> MIFARE DESFire");
312 break;
313 case 0x20:
314 PrintAndLog(" 2x -> MIFARE Plus");
315 break;
316 }
317 switch (card.ats[pos + 2] & 0x0f) {
318 case 0x00:
319 PrintAndLog(" x0 -> <1 kByte");
320 break;
321 case 0x01:
322 PrintAndLog(" x0 -> 1 kByte");
323 break;
324 case 0x02:
325 PrintAndLog(" x0 -> 2 kByte");
326 break;
327 case 0x03:
328 PrintAndLog(" x0 -> 4 kByte");
329 break;
330 case 0x04:
331 PrintAndLog(" x0 -> 8 kByte");
332 break;
333 }
334 switch (card.ats[pos + 3] & 0xf0) {
335 case 0x00:
336 PrintAndLog(" 0x -> Engineering sample");
337 break;
338 case 0x20:
339 PrintAndLog(" 2x -> Released");
340 break;
341 }
342 switch (card.ats[pos + 3] & 0x0f) {
343 case 0x00:
344 PrintAndLog(" x0 -> Generation 1");
345 break;
346 case 0x01:
347 PrintAndLog(" x1 -> Generation 2");
348 break;
349 case 0x02:
350 PrintAndLog(" x2 -> Generation 3");
351 break;
352 }
353 switch (card.ats[pos + 4] & 0x0f) {
354 case 0x00:
355 PrintAndLog(" x0 -> Only VCSL supported");
356 break;
357 case 0x01:
358 PrintAndLog(" x1 -> VCS, VCSL, and SVC supported");
359 break;
360 case 0x0E:
361 PrintAndLog(" xE -> no VCS command supported");
362 break;
363 }
364 }
365 }
366 } else {
367 PrintAndLog("proprietary non iso14443-4 card found, RATS not supported");
368 }
369
370 return select_status;
371 }
372
373 // Collect ISO14443 Type A UIDs
374 int CmdHF14ACUIDs(const char *Cmd)
375 {
376 // requested number of UIDs
377 int n = atoi(Cmd);
378 // collect at least 1 (e.g. if no parameter was given)
379 n = n > 0 ? n : 1;
380
381 PrintAndLog("Collecting %d UIDs", n);
382 PrintAndLog("Start: %u", time(NULL));
383 // repeat n times
384 for (int i = 0; i < n; i++) {
385 // execute anticollision procedure
386 UsbCommand c = {CMD_READER_ISO_14443a, {ISO14A_CONNECT, 0, 0}};
387 SendCommand(&c);
388
389 UsbCommand resp;
390 WaitForResponse(CMD_ACK,&resp);
391
392 iso14a_card_select_t *card = (iso14a_card_select_t *) resp.d.asBytes;
393
394 // check if command failed
395 if (resp.arg[0] == 0) {
396 PrintAndLog("Card select failed.");
397 } else {
398 char uid_string[20];
399 for (uint16_t i = 0; i < card->uidlen; i++) {
400 sprintf(&uid_string[2*i], "%02X", card->uid[i]);
401 }
402 PrintAndLog("%s", uid_string);
403 }
404 }
405 PrintAndLog("End: %u", time(NULL));
406
407 return 1;
408 }
409
410 // ## simulate iso14443a tag
411 // ## greg - added ability to specify tag UID
412 int CmdHF14ASim(const char *Cmd)
413 {
414 UsbCommand c = {CMD_SIMULATE_TAG_ISO_14443a,{0,0,0}};
415
416 // Retrieve the tag type
417 uint8_t tagtype = param_get8ex(Cmd,0,0,10);
418
419 // When no argument was given, just print help message
420 if (tagtype == 0) {
421 PrintAndLog("");
422 PrintAndLog(" Emulating ISO/IEC 14443 type A tag with 4 or 7 byte UID");
423 PrintAndLog("");
424 PrintAndLog(" syntax: hf 14a sim <type> <uid>");
425 PrintAndLog(" types: 1 = MIFARE Classic");
426 PrintAndLog(" 2 = MIFARE Ultralight");
427 PrintAndLog(" 3 = MIFARE DESFIRE");
428 PrintAndLog(" 4 = ISO/IEC 14443-4");
429 PrintAndLog(" 5 = MIFARE TNP3XXX");
430 PrintAndLog("");
431 return 1;
432 }
433
434 // Store the tag type
435 c.arg[0] = tagtype;
436
437 // Retrieve the full 4 or 7 byte long uid
438 uint64_t long_uid = param_get64ex(Cmd,1,0,16);
439
440 // Are we handling the (optional) second part uid?
441 if (long_uid > 0xffffffff) {
442 PrintAndLog("Emulating ISO/IEC 14443 type A tag with 7 byte UID (%014"llx")",long_uid);
443 // Store the second part
444 c.arg[2] = (long_uid & 0xffffffff);
445 long_uid >>= 32;
446 // Store the first part, ignore the first byte, it is replaced by cascade byte (0x88)
447 c.arg[1] = (long_uid & 0xffffff);
448 } else {
449 PrintAndLog("Emulating ISO/IEC 14443 type A tag with 4 byte UID (%08x)",long_uid);
450 // Only store the first part
451 c.arg[1] = long_uid & 0xffffffff;
452 }
453 /*
454 // At lease save the mandatory first part of the UID
455 c.arg[0] = long_uid & 0xffffffff;
456
457 if (c.arg[1] == 0) {
458 PrintAndLog("Emulating ISO/IEC 14443 type A tag with UID %01d %08x %08x",c.arg[0],c.arg[1],c.arg[2]);
459 }
460
461 switch (c.arg[0]) {
462 case 1: {
463 PrintAndLog("Emulating ISO/IEC 14443-3 type A tag with 4 byte UID");
464 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)};
465 } break;
466 case 2: {
467 PrintAndLog("Emulating ISO/IEC 14443-4 type A tag with 7 byte UID");
468 } break;
469 default: {
470 PrintAndLog("Error: unkown tag type (%d)",c.arg[0]);
471 PrintAndLog("syntax: hf 14a sim <uid>",c.arg[0]);
472 PrintAndLog(" type1: 4 ",c.arg[0]);
473
474 return 1;
475 } break;
476 }
477 */
478 /*
479 unsigned int hi = 0, lo = 0;
480 int n = 0, i = 0;
481 while (sscanf(&Cmd[i++], "%1x", &n ) == 1) {
482 hi= (hi << 4) | (lo >> 28);
483 lo= (lo << 4) | (n & 0xf);
484 }
485 */
486 // 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)};
487 // PrintAndLog("Emulating ISO/IEC 14443 type A tag with UID %01d %08x %08x",c.arg[0],c.arg[1],c.arg[2]);
488 SendCommand(&c);
489 return 0;
490 }
491
492 int CmdHF14ASnoop(const char *Cmd) {
493 int param = 0;
494
495 if (param_getchar(Cmd, 0) == 'h') {
496 PrintAndLog("It get data from the field and saves it into command buffer.");
497 PrintAndLog("Buffer accessible from command hf 14a list.");
498 PrintAndLog("Usage: hf 14a snoop [c][r]");
499 PrintAndLog("c - triggered by first data from card");
500 PrintAndLog("r - triggered by first 7-bit request from reader (REQ,WUP,...)");
501 PrintAndLog("sample: hf 14a snoop c r");
502 return 0;
503 }
504
505 for (int i = 0; i < 2; i++) {
506 char ctmp = param_getchar(Cmd, i);
507 if (ctmp == 'c' || ctmp == 'C') param |= 0x01;
508 if (ctmp == 'r' || ctmp == 'R') param |= 0x02;
509 }
510
511 UsbCommand c = {CMD_SNOOP_ISO_14443a, {param, 0, 0}};
512 SendCommand(&c);
513 return 0;
514 }
515
516 int CmdHF14ACmdRaw(const char *cmd) {
517 UsbCommand c = {CMD_READER_ISO_14443a, {0, 0, 0}};
518 uint8_t reply=1;
519 uint8_t crc=0;
520 uint8_t power=0;
521 uint8_t active=0;
522 uint8_t active_select=0;
523 uint16_t numbits=0;
524 uint16_t timeout=0;
525 uint8_t bTimeout=0;
526 char buf[5]="";
527 int i=0;
528 uint8_t data[USB_CMD_DATA_SIZE];
529 unsigned int datalen=0, temp;
530
531 if (strlen(cmd)<2) {
532 PrintAndLog("Usage: hf 14a raw [-r] [-c] [-p] [-f] [-b] [-t] <number of bits> <0A 0B 0C ... hex>");
533 PrintAndLog(" -r do not read response");
534 PrintAndLog(" -c calculate and append CRC");
535 PrintAndLog(" -p leave the signal field ON after receive");
536 PrintAndLog(" -a active signal field ON without select");
537 PrintAndLog(" -s active signal field ON with select");
538 PrintAndLog(" -b number of bits to send. Useful for send partial byte");
539 PrintAndLog(" -t timeout");
540 return 0;
541 }
542
543 // strip
544 while (*cmd==' ' || *cmd=='\t') cmd++;
545
546 while (cmd[i]!='\0') {
547 if (cmd[i]==' ' || cmd[i]=='\t') { i++; continue; }
548 if (cmd[i]=='-') {
549 switch (cmd[i+1]) {
550 case 'r':
551 reply=0;
552 break;
553 case 'c':
554 crc=1;
555 break;
556 case 'p':
557 power=1;
558 break;
559 case 'a':
560 active=1;
561 break;
562 case 's':
563 active_select=1;
564 break;
565 case 'b':
566 sscanf(cmd+i+2,"%d",&temp);
567 numbits = temp & 0xFFFF;
568 i+=3;
569 while(cmd[i]!=' ' && cmd[i]!='\0') { i++; }
570 i-=2;
571 break;
572 case 't':
573 bTimeout=1;
574 sscanf(cmd+i+2,"%d",&temp);
575 timeout = temp & 0xFFFF;
576 i+=3;
577 while(cmd[i]!=' ' && cmd[i]!='\0') { i++; }
578 i+=2;
579 break;
580 default:
581 PrintAndLog("Invalid option");
582 return 0;
583 }
584 i+=2;
585 continue;
586 }
587 if ((cmd[i]>='0' && cmd[i]<='9') ||
588 (cmd[i]>='a' && cmd[i]<='f') ||
589 (cmd[i]>='A' && cmd[i]<='F') ) {
590 buf[strlen(buf)+1]=0;
591 buf[strlen(buf)]=cmd[i];
592 i++;
593
594 if (strlen(buf)>=2) {
595 sscanf(buf,"%x",&temp);
596 data[datalen]=(uint8_t)(temp & 0xff);
597 *buf=0;
598 if (++datalen>sizeof(data)){
599 if (crc)
600 PrintAndLog("Buffer is full, we can't add CRC to your data");
601 break;
602 }
603 }
604 continue;
605 }
606 PrintAndLog("Invalid char on input");
607 return 0;
608 }
609 if(crc && datalen>0 && datalen<sizeof(data)-2)
610 {
611 uint8_t first, second;
612 ComputeCrc14443(CRC_14443_A, data, datalen, &first, &second);
613 data[datalen++] = first;
614 data[datalen++] = second;
615 }
616
617 if(active || active_select)
618 {
619 c.arg[0] |= ISO14A_CONNECT;
620 if(active)
621 c.arg[0] |= ISO14A_NO_SELECT;
622 }
623 if(bTimeout){
624 #define MAX_TIMEOUT 624*105 // max timeout is 624 ms
625 c.arg[0] |= ISO14A_SET_TIMEOUT;
626 c.arg[2] = timeout * 105; // each bit is about 9.4 us
627 if(c.arg[2]>MAX_TIMEOUT) {
628 c.arg[2] = MAX_TIMEOUT;
629 PrintAndLog("Set timeout to 624 ms. The max we can wait for response");
630 }
631 }
632 if(power)
633 c.arg[0] |= ISO14A_NO_DISCONNECT;
634 if(datalen>0)
635 c.arg[0] |= ISO14A_RAW;
636
637 // Max buffer is USB_CMD_DATA_SIZE
638 c.arg[1] = (datalen & 0xFFFF) | (numbits << 16);
639 memcpy(c.d.asBytes,data,datalen);
640
641 SendCommand(&c);
642
643 if (reply) {
644 if(active_select)
645 waitCmd(1);
646 if(datalen>0)
647 waitCmd(0);
648 } // if reply
649 return 0;
650 }
651
652 static void waitCmd(uint8_t iSelect)
653 {
654 uint8_t *recv;
655 UsbCommand resp;
656 char *hexout;
657
658 if (WaitForResponseTimeout(CMD_ACK,&resp,10000)) {
659 recv = resp.d.asBytes;
660 uint8_t iLen = iSelect ? resp.arg[1] : resp.arg[0];
661 PrintAndLog("received %i octets",iLen);
662 if(!iLen)
663 return;
664 hexout = (char *)malloc(iLen * 3 + 1);
665 if (hexout != NULL) {
666 for (int i = 0; i < iLen; i++) { // data in hex
667 sprintf(&hexout[i * 3], "%02X ", recv[i]);
668 }
669 PrintAndLog("%s", hexout);
670 free(hexout);
671 } else {
672 PrintAndLog("malloc failed your client has low memory?");
673 }
674 } else {
675 PrintAndLog("timeout while waiting for reply.");
676 }
677 }
678
679 static command_t CommandTable[] =
680 {
681 {"help", CmdHelp, 1, "This help"},
682 {"list", CmdHF14AList, 0, "List ISO 14443a history"},
683 {"reader", CmdHF14AReader, 0, "Act like an ISO14443 Type A reader"},
684 {"cuids", CmdHF14ACUIDs, 0, "<n> Collect n>0 ISO14443 Type A UIDs in one go"},
685 {"sim", CmdHF14ASim, 0, "<UID> -- Fake ISO 14443a tag"},
686 {"snoop", CmdHF14ASnoop, 0, "Eavesdrop ISO 14443 Type A"},
687 {"raw", CmdHF14ACmdRaw, 0, "Send raw hex data to tag"},
688 {NULL, NULL, 0, NULL}
689 };
690
691 int CmdHF14A(const char *Cmd) {
692 // flush
693 WaitForResponseTimeout(CMD_ACK,NULL,100);
694
695 // parse
696 CmdsParse(CommandTable, Cmd);
697 return 0;
698 }
699
700 int CmdHelp(const char *Cmd)
701 {
702 CmdsHelp(CommandTable);
703 return 0;
704 }
Impressum, Datenschutz