1 //-----------------------------------------------------------------------------
2 // Copyright (C) 2010 iZsh <izsh at fail0verflow.com>
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
8 //-----------------------------------------------------------------------------
9 // High frequency commands
10 //-----------------------------------------------------------------------------
20 #include "iso14443crc.h"
23 #include "cmdparser.h"
28 #include "cmdhflegic.h"
29 #include "cmdhficlass.h"
33 #include "cmdhftopaz.h"
34 #include "protocols.h"
35 #include "emv/cmdemv.h"
36 #include "cmdhflist.h"
38 static int CmdHelp(const char *Cmd
);
40 int CmdHFTune(const char *Cmd
)
42 UsbCommand c
={CMD_MEASURE_ANTENNA_TUNING_HF
};
48 * @brief iso14443B_CRC_check Checks CRC in command or response
52 * @return 0 : CRC-command, CRC not ok
53 * 1 : CRC-command, CRC ok
57 uint8_t iso14443B_CRC_check(bool isResponse
, uint8_t* data
, uint8_t len
)
61 if(len
<= 2) return 2;
63 ComputeCrc14443(CRC_14443_B
, data
, len
-2, &b1
, &b2
);
64 if(b1
!= data
[len
-2] || b2
!= data
[len
-1]) {
72 * @brief iclass_CRC_Ok Checks CRC in command or response
76 * @return 0 : CRC-command, CRC not ok
77 * 1 : CRC-command, CRC ok
80 uint8_t iclass_CRC_check(bool isResponse
, uint8_t* data
, uint8_t len
)
82 if(len
< 4) return 2;//CRC commands (and responses) are all at least 4 bytes
86 if(!isResponse
)//Commands to tag
89 These commands should have CRC. Total length leftmost
92 12 UPDATE - unsecured, ends with CRC16
93 14 UPDATE - secured, ends with signature instead
96 if(len
== 4 || len
== 12)//Covers three of them
98 //Don't include the command byte
99 ComputeCrc14443(CRC_ICLASS
, (data
+1), len
-3, &b1
, &b2
);
100 return b1
== data
[len
-2] && b2
== data
[len
-1];
105 These tag responses should have CRC. Total length leftmost
107 10 READ data[8] crc[2]
108 34 READ4 data[32]crc[2]
109 10 UPDATE data[8] crc[2]
110 10 SELECT csn[8] crc[2]
111 10 IDENTIFY asnb[8] crc[2]
112 10 PAGESEL block1[8] crc[2]
113 10 DETECT csn[8] crc[2]
117 4 CHECK chip_response[4]
122 In conclusion, without looking at the command; any response
123 of length 10 or 34 should have CRC
125 if(len
!= 10 && len
!= 34) return true;
127 ComputeCrc14443(CRC_ICLASS
, data
, len
-2, &b1
, &b2
);
128 return b1
== data
[len
-2] && b2
== data
[len
-1];
133 bool is_last_record(uint16_t tracepos
, uint8_t *trace
, uint16_t traceLen
)
135 return(tracepos
+ sizeof(uint32_t) + sizeof(uint16_t) + sizeof(uint16_t) >= traceLen
);
139 bool next_record_is_response(uint16_t tracepos
, uint8_t *trace
)
141 uint16_t next_records_datalen
= *((uint16_t *)(trace
+ tracepos
+ sizeof(uint32_t) + sizeof(uint16_t)));
143 return(next_records_datalen
& 0x8000);
147 bool merge_topaz_reader_frames(uint32_t timestamp
, uint32_t *duration
, uint16_t *tracepos
, uint16_t traceLen
, uint8_t *trace
, uint8_t *frame
, uint8_t *topaz_reader_command
, uint16_t *data_len
)
150 #define MAX_TOPAZ_READER_CMD_LEN 16
152 uint32_t last_timestamp
= timestamp
+ *duration
;
154 if ((*data_len
!= 1) || (frame
[0] == TOPAZ_WUPA
) || (frame
[0] == TOPAZ_REQA
)) return false;
156 memcpy(topaz_reader_command
, frame
, *data_len
);
158 while (!is_last_record(*tracepos
, trace
, traceLen
) && !next_record_is_response(*tracepos
, trace
)) {
159 uint32_t next_timestamp
= *((uint32_t *)(trace
+ *tracepos
));
160 *tracepos
+= sizeof(uint32_t);
161 uint16_t next_duration
= *((uint16_t *)(trace
+ *tracepos
));
162 *tracepos
+= sizeof(uint16_t);
163 uint16_t next_data_len
= *((uint16_t *)(trace
+ *tracepos
)) & 0x7FFF;
164 *tracepos
+= sizeof(uint16_t);
165 uint8_t *next_frame
= (trace
+ *tracepos
);
166 *tracepos
+= next_data_len
;
167 if ((next_data_len
== 1) && (*data_len
+ next_data_len
<= MAX_TOPAZ_READER_CMD_LEN
)) {
168 memcpy(topaz_reader_command
+ *data_len
, next_frame
, next_data_len
);
169 *data_len
+= next_data_len
;
170 last_timestamp
= next_timestamp
+ next_duration
;
173 *tracepos
= *tracepos
- next_data_len
- sizeof(uint16_t) - sizeof(uint16_t) - sizeof(uint32_t);
176 uint16_t next_parity_len
= (next_data_len
-1)/8 + 1;
177 *tracepos
+= next_parity_len
;
180 *duration
= last_timestamp
- timestamp
;
186 uint16_t printTraceLine(uint16_t tracepos
, uint16_t traceLen
, uint8_t *trace
, uint8_t protocol
, bool showWaitCycles
, bool markCRCBytes
)
189 uint16_t data_len
, parity_len
;
191 uint8_t topaz_reader_command
[9];
192 uint32_t timestamp
, first_timestamp
, EndOfTransmissionTimestamp
;
193 char explanation
[30] = {0};
194 uint8_t mfData
[32] = {0};
195 size_t mfDataLen
= 0;
197 if (tracepos
+ sizeof(uint32_t) + sizeof(uint16_t) + sizeof(uint16_t) > traceLen
) return traceLen
;
199 first_timestamp
= *((uint32_t *)(trace
));
200 timestamp
= *((uint32_t *)(trace
+ tracepos
));
203 duration
= *((uint16_t *)(trace
+ tracepos
));
205 data_len
= *((uint16_t *)(trace
+ tracepos
));
208 if (data_len
& 0x8000) {
214 parity_len
= (data_len
-1)/8 + 1;
216 if (tracepos
+ data_len
+ parity_len
> traceLen
) {
219 uint8_t *frame
= trace
+ tracepos
;
220 tracepos
+= data_len
;
221 uint8_t *parityBytes
= trace
+ tracepos
;
222 tracepos
+= parity_len
;
224 if (protocol
== TOPAZ
&& !isResponse
) {
225 // topaz reader commands come in 1 or 9 separate frames with 7 or 8 Bits each.
227 if (merge_topaz_reader_frames(timestamp
, &duration
, &tracepos
, traceLen
, trace
, frame
, topaz_reader_command
, &data_len
)) {
228 frame
= topaz_reader_command
;
232 //Check the CRC status
233 uint8_t crcStatus
= 2;
238 crcStatus
= iclass_CRC_check(isResponse
, frame
, data_len
);
242 crcStatus
= iso14443B_CRC_check(isResponse
, frame
, data_len
);
245 crcStatus
= mifare_CRC_check(isResponse
, frame
, data_len
);
248 crcStatus
= iso14443A_CRC_check(isResponse
, frame
, data_len
);
254 //0 CRC-command, CRC not ok
255 //1 CRC-command, CRC ok
258 //--- Draw the data column
259 //char line[16][110];
262 for (int j
= 0; j
< data_len
&& j
/16 < 16; j
++) {
264 uint8_t parityBits
= parityBytes
[j
>>3];
265 if (protocol
!= ISO_14443B
&& (isResponse
|| protocol
== ISO_14443A
) && (oddparity8(frame
[j
]) != ((parityBits
>> (7-(j
&0x0007))) & 0x01))) {
266 snprintf(line
[j
/16]+(( j
% 16) * 4),110, "%02x! ", frame
[j
]);
268 snprintf(line
[j
/16]+(( j
% 16) * 4), 110, " %02x ", frame
[j
]);
274 if(crcStatus
== 0 || crcStatus
== 1)
276 char *pos1
= line
[(data_len
-2)/16]+(((data_len
-2) % 16) * 4);
278 char *pos2
= line
[(data_len
)/16]+(((data_len
) % 16) * 4);
279 sprintf(pos2
, "%c", ']');
286 sprintf(line
[0],"<empty trace - possible error>");
289 //--- Draw the CRC column
291 char *crc
= (crcStatus
== 0 ? "!crc" : (crcStatus
== 1 ? " ok " : " "));
293 EndOfTransmissionTimestamp
= timestamp
+ duration
;
295 if (protocol
== PROTO_MIFARE
)
296 annotateMifare(explanation
, sizeof(explanation
), frame
, data_len
, parityBytes
, parity_len
, isResponse
);
301 case ICLASS
: annotateIclass(explanation
,sizeof(explanation
),frame
,data_len
); break;
302 case ISO_14443A
: annotateIso14443a(explanation
,sizeof(explanation
),frame
,data_len
); break;
303 case ISO_14443B
: annotateIso14443b(explanation
,sizeof(explanation
),frame
,data_len
); break;
304 case TOPAZ
: annotateTopaz(explanation
,sizeof(explanation
),frame
,data_len
); break;
309 int num_lines
= MIN((data_len
- 1)/16 + 1, 16);
310 for (int j
= 0; j
< num_lines
; j
++) {
312 PrintAndLog(" %10d | %10d | %s |%-64s | %s| %s",
313 (timestamp
- first_timestamp
),
314 (EndOfTransmissionTimestamp
- first_timestamp
),
315 (isResponse
? "Tag" : "Rdr"),
317 (j
== num_lines
-1) ? crc
: " ",
318 (j
== num_lines
-1) ? explanation
: "");
320 PrintAndLog(" | | |%-64s | %s| %s",
322 (j
== num_lines
-1) ? crc
: " ",
323 (j
== num_lines
-1) ? explanation
: "");
327 if (DecodeMifareData(frame
, data_len
, parityBytes
, isResponse
, mfData
, &mfDataLen
)) {
328 memset(explanation
, 0x00, sizeof(explanation
));
330 explanation
[0] = '>';
331 annotateIso14443a(&explanation
[1], sizeof(explanation
) - 1, mfData
, mfDataLen
);
333 uint8_t crcc
= iso14443A_CRC_check(isResponse
, mfData
, mfDataLen
);
334 PrintAndLog(" | * | dec |%-64s | %-4s| %s",
335 sprint_hex(mfData
, mfDataLen
),
336 (crcc
== 0 ? "!crc" : (crcc
== 1 ? " ok " : " ")),
337 (true) ? explanation
: "");
340 if (is_last_record(tracepos
, trace
, traceLen
)) return traceLen
;
342 if (showWaitCycles
&& !isResponse
&& next_record_is_response(tracepos
, trace
)) {
343 uint32_t next_timestamp
= *((uint32_t *)(trace
+ tracepos
));
344 PrintAndLog(" %10d | %10d | %s | fdt (Frame Delay Time): %d",
345 (EndOfTransmissionTimestamp
- first_timestamp
),
346 (next_timestamp
- first_timestamp
),
348 (next_timestamp
- EndOfTransmissionTimestamp
));
355 int CmdHFList(const char *Cmd
)
357 #ifdef WITH_SMARTCARD
358 PrintAndLog("TEST_WITH_SMARTCARD");
361 PrintAndLog("TEST_WITH_TEST");
363 bool showWaitCycles
= false;
364 bool markCRCBytes
= false;
365 bool loadFromFile
= false;
366 bool saveToFile
= false;
371 char filename
[FILE_PATH_SIZE
] = {0};
372 uint8_t protocol
= 0;
374 // parse command line
375 int tlen
= param_getstr(Cmd
, 0, type
, sizeof(type
));
376 if (param_getlength(Cmd
, 1) == 1) {
377 param1
= param_getchar(Cmd
, 1);
379 param_getstr(Cmd
, 1, filename
, sizeof(filename
));
381 if (param_getlength(Cmd
, 2) == 1) {
382 param2
= param_getchar(Cmd
, 2);
383 } else if (strlen(filename
) == 0) {
384 param_getstr(Cmd
, 2, filename
, sizeof(filename
));
386 if (param_getlength(Cmd
, 3) == 1) {
387 param3
= param_getchar(Cmd
, 3);
388 } else if (strlen(filename
) == 0) {
389 param_getstr(Cmd
, 3, filename
, sizeof(filename
));
400 || (param1
!= 0 && param1
!= 'f' && param1
!= 'c' && param1
!= 'l')
401 || (param2
!= 0 && param2
!= 'f' && param2
!= 'c' && param2
!= 'l')
402 || (param3
!= 0 && param3
!= 'f' && param3
!= 'c' && param3
!= 'l')) {
407 if(strcmp(type
, "iclass") == 0) {
409 } else if(strcmp(type
, "mf") == 0) {
410 protocol
= PROTO_MIFARE
;
411 } else if(strcmp(type
, "14a") == 0) {
412 protocol
= ISO_14443A
;
413 } else if(strcmp(type
, "14b") == 0) {
414 protocol
= ISO_14443B
;
415 } else if(strcmp(type
,"topaz") == 0) {
417 } else if(strcmp(type
,"raw") == 0) {
418 protocol
= -1; //No crc, no annotations
419 } else if (strcmp(type
, "save") == 0) {
426 if (param1
== 'f' || param2
== 'f' || param3
== 'f') {
427 showWaitCycles
= true;
430 if (param1
== 'c' || param2
== 'c' || param3
== 'c') {
434 if (param1
== 'l' || param2
== 'l' || param3
== 'l') {
438 if ((loadFromFile
|| saveToFile
) && strlen(filename
) == 0) {
442 if (loadFromFile
&& saveToFile
) {
447 PrintAndLog("List or save protocol data.");
448 PrintAndLog("Usage: hf list <protocol> [f] [c] [l <filename>]");
449 PrintAndLog(" hf list save <filename>");
450 PrintAndLog(" f - show frame delay times as well");
451 PrintAndLog(" c - mark CRC bytes");
452 PrintAndLog(" l - load data from file instead of trace buffer");
453 PrintAndLog(" save - save data to file");
454 PrintAndLog("Supported <protocol> values:");
455 PrintAndLog(" raw - just show raw data without annotations");
456 PrintAndLog(" 14a - interpret data as iso14443a communications");
457 PrintAndLog(" mf - interpret data as iso14443a communications and decrypt crypto1 stream");
458 PrintAndLog(" 14b - interpret data as iso14443b communications");
459 PrintAndLog(" iclass - interpret data as iclass communications");
460 PrintAndLog(" topaz - interpret data as topaz communications");
462 PrintAndLog("example: hf list 14a f");
463 PrintAndLog("example: hf list iclass");
464 PrintAndLog("example: hf list save myCardTrace.trc");
465 PrintAndLog("example: hf list 14a l myCardTrace.trc");
471 uint32_t tracepos
= 0;
472 uint32_t traceLen
= 0;
475 #define TRACE_CHUNK_SIZE (1<<16) // 64K to start with. Will be enough for BigBuf and some room for future extensions
476 FILE *tracefile
= NULL
;
478 trace
= malloc(TRACE_CHUNK_SIZE
);
480 PrintAndLog("Cannot allocate memory for trace");
483 if ((tracefile
= fopen(filename
,"rb")) == NULL
) {
484 PrintAndLog("Could not open file %s", filename
);
488 while (!feof(tracefile
)) {
489 bytes_read
= fread(trace
+traceLen
, 1, TRACE_CHUNK_SIZE
, tracefile
);
490 traceLen
+= bytes_read
;
491 if (!feof(tracefile
)) {
492 uint8_t *p
= realloc(trace
, traceLen
+ TRACE_CHUNK_SIZE
);
494 PrintAndLog("Cannot allocate memory for trace");
504 trace
= malloc(USB_CMD_DATA_SIZE
);
505 // Query for the size of the trace
507 GetFromBigBuf(trace
, USB_CMD_DATA_SIZE
, 0, &response
, -1, false);
508 traceLen
= response
.arg
[2];
509 if (traceLen
> USB_CMD_DATA_SIZE
) {
510 uint8_t *p
= realloc(trace
, traceLen
);
512 PrintAndLog("Cannot allocate memory for trace");
517 GetFromBigBuf(trace
, traceLen
, 0, NULL
, -1, false);
522 FILE *tracefile
= NULL
;
523 if ((tracefile
= fopen(filename
,"wb")) == NULL
) {
524 PrintAndLog("Could not create file %s", filename
);
527 fwrite(trace
, 1, traceLen
, tracefile
);
528 PrintAndLog("Recorded Activity (TraceLen = %d bytes) written to file %s", traceLen
, filename
);
531 PrintAndLog("Recorded Activity (TraceLen = %d bytes)", traceLen
);
533 PrintAndLog("Start = Start of Start Bit, End = End of last modulation. Src = Source of Transfer");
534 PrintAndLog("iso14443a - All times are in carrier periods (1/13.56Mhz)");
535 PrintAndLog("iClass - Timings are not as accurate");
537 PrintAndLog(" Start | End | Src | Data (! denotes parity error) | CRC | Annotation |");
538 PrintAndLog("------------|------------|-----|-----------------------------------------------------------------|-----|--------------------|");
541 while(tracepos
< traceLen
)
543 tracepos
= printTraceLine(tracepos
, traceLen
, trace
, protocol
, showWaitCycles
, markCRCBytes
);
551 int CmdHFSearch(const char *Cmd
){
554 ans
= CmdHF14AInfo("s");
556 PrintAndLog("\nValid ISO14443A Tag Found - Quiting Search\n");
559 ans
= HFiClassReader("", false, false);
561 PrintAndLog("\nValid iClass Tag (or PicoPass Tag) Found - Quiting Search\n");
564 ans
= HF15Reader("", false);
566 PrintAndLog("\nValid ISO15693 Tag Found - Quiting Search\n");
569 //14b is longest test currently (and rarest chip type) ... put last
570 ans
= HF14BInfo(false);
572 PrintAndLog("\nValid ISO14443B Tag Found - Quiting Search\n");
575 PrintAndLog("\nno known/supported 13.56 MHz tags found\n");
579 int CmdHFSnoop(const char *Cmd
)
582 UsbCommand c
= {CMD_HF_SNIFFER
, {strtol(Cmd
, &pEnd
,0),strtol(pEnd
, &pEnd
,0),0}};
587 static command_t CommandTable
[] =
589 {"help", CmdHelp
, 1, "This help"},
590 {"14a", CmdHF14A
, 1, "{ ISO14443A RFIDs... }"},
591 {"14b", CmdHF14B
, 1, "{ ISO14443B RFIDs... }"},
592 {"15", CmdHF15
, 1, "{ ISO15693 RFIDs... }"},
593 {"epa", CmdHFEPA
, 1, "{ German Identification Card... }"},
594 {"emv", CmdHFEMV
, 1, "{ EMV cards... }"},
595 {"legic", CmdHFLegic
, 0, "{ LEGIC RFIDs... }"},
596 {"iclass", CmdHFiClass
, 1, "{ ICLASS RFIDs... }"},
597 {"mf", CmdHFMF
, 1, "{ MIFARE RFIDs... }"},
598 {"mfu", CmdHFMFUltra
, 1, "{ MIFARE Ultralight RFIDs... }"},
599 {"mfp", CmdHFMFP
, 1, "{ MIFARE Plus RFIDs... }"},
600 {"topaz", CmdHFTopaz
, 1, "{ TOPAZ (NFC Type 1) RFIDs... }"},
601 {"tune", CmdHFTune
, 0, "Continuously measure HF antenna tuning"},
602 {"list", CmdHFList
, 1, "List protocol data in trace buffer"},
603 {"search", CmdHFSearch
, 1, "Search for known HF tags [preliminary]"},
604 {"snoop", CmdHFSnoop
, 0, "<samples to skip (10000)> <triggers to skip (1)> Generic HF Snoop"},
605 {NULL
, NULL
, 0, NULL
}
608 int CmdHF(const char *Cmd
)
610 CmdsParse(CommandTable
, Cmd
);
614 int CmdHelp(const char *Cmd
)
616 CmdsHelp(CommandTable
);