]> cvs.zerfleddert.de Git - proxmark3-svn/blame - client/cmdhf14b.c
ADD: started with a NEDAP demod, read, clone and sim functionality.
[proxmark3-svn] / client / cmdhf14b.c
CommitLineData
a553f267 1//-----------------------------------------------------------------------------
2// Copyright (C) 2010 iZsh <izsh at fail0verflow.com>
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// High frequency ISO14443B commands
9//-----------------------------------------------------------------------------
10
7fe9b0b7 11#include <stdio.h>
12#include <stdlib.h>
13#include <stdbool.h>
7fe9b0b7 14#include <stdint.h>
7fe9b0b7 15#include "cmdhf14b.h"
16
5de71ee6 17#define TIMEOUT 2000
7fe9b0b7 18static int CmdHelp(const char *Cmd);
19
6fc68747 20int usage_hf_14b_info(void){
18b90cce 21 PrintAndLog("Usage: hf 14b info [h] [s]");
22 PrintAndLog("Options:");
23 PrintAndLog(" h this help");
24 PrintAndLog(" s silently");
25 PrintAndLog("sample:");
26 PrintAndLog(" hf 14b info");
388c92bd 27 return 0;
7fe9b0b7 28}
6fc68747 29int usage_hf_14b_reader(void){
18b90cce 30 PrintAndLog("Usage: hf 14b reader [h] [s]");
31 PrintAndLog("Options:");
32 PrintAndLog(" h this help");
33 PrintAndLog(" s silently");
34 PrintAndLog("sample:");
35 PrintAndLog(" hf 14b reader");
22e24700 36 return 0;
7fe9b0b7 37}
6fc68747 38int usage_hf_14b_raw(void){
39 PrintAndLog("Usage: hf 14b raw [-h] [-r] [-c] [-p] [-s || -ss] <0A 0B 0C ... hex>");
18b90cce 40 PrintAndLog("Options:");
6fc68747 41 PrintAndLog(" -h this help");
42 PrintAndLog(" -r do not read response");
43 PrintAndLog(" -c calculate and append CRC");
44 PrintAndLog(" -p leave the field on after receive");
45 PrintAndLog(" -s active signal field ON with select");
46 PrintAndLog(" -ss active signal field ON with select for SRx ST Microelectronics tags");
18b90cce 47 PrintAndLog("sample:");
48 PrintAndLog(" hf 14b raw -s -c -p 0200a40400");
6fc68747 49 return 0;
7fe9b0b7 50}
6fc68747 51int usage_hf_14b_snoop(void){
52 PrintAndLog("It get data from the field and saves it into command buffer.");
53 PrintAndLog("Buffer accessible from command 'hf list 14b'");
18b90cce 54 PrintAndLog("Usage: hf 14b snoop [h]");
55 PrintAndLog("Options:");
56 PrintAndLog(" h this help");
57 PrintAndLog("sample:");
58 PrintAndLog(" hf 14b snoop");
6fc68747 59 return 0;
60}
61int usage_hf_14b_sim(void){
dccddaef 62 PrintAndLog("Emulating ISO/IEC 14443 type B tag with 4 UID / PUPI");
63 PrintAndLog("Usage: hf 14b sim [h] u <uid>");
18b90cce 64 PrintAndLog("Options:");
65 PrintAndLog(" h this help");
dccddaef 66 PrintAndLog(" u 4byte UID/PUPI");
18b90cce 67 PrintAndLog("sample:");
68 PrintAndLog(" hf 14b sim");
dccddaef 69 PrintAndLog(" hf 14b sim u 11223344");
6fc68747 70 return 0;
71}
72int usage_hf_14b_read_srx(void){
73 PrintAndLog("Usage: hf 14b read [h] <1|2>");
74 PrintAndLog("Options:");
75 PrintAndLog(" h this help");
76 PrintAndLog(" <1|2> 1 = SRIX4K , 2 = SRI512");
18b90cce 77 PrintAndLog("sample:");
78 PrintAndLog(" hf 14b read 1");
79 PrintAndLog(" hf 14b read 2");
22e24700 80 return 0;
7fe9b0b7 81}
6fc68747 82int usage_hf_14b_write_srx(void){
18b90cce 83 PrintAndLog("Usage: hf 14b [h] write <1|2> <BLOCK> <DATA>");
6fc68747 84 PrintAndLog("Options:");
85 PrintAndLog(" h this help");
86 PrintAndLog(" <1|2> 1 = SRIX4K , 2 = SRI512");
87 PrintAndLog(" <block> BLOCK number depends on tag, special block == FF");
88 PrintAndLog(" <data> hex bytes of data to be written");
18b90cce 89 PrintAndLog("sample:");
90 PrintAndLog(" hf 14b write 1 7F 11223344");
91 PrintAndLog(" hf 14b write 1 FF 11223344");
92 PrintAndLog(" hf 14b write 2 15 11223344");
93 PrintAndLog(" hf 14b write 2 FF 11223344");
22e24700 94 return 0;
7fe9b0b7 95}
96
18b90cce 97static void switch_on_field_14b(void) {
98 UsbCommand c = {CMD_ISO_14443B_COMMAND, {ISO14B_CONNECT, 0, 0}};
99 clearCommandBuffer();
100 SendCommand(&c);
101}
102
103static int switch_off_field_14b(void) {
6fc68747 104 UsbCommand c = {CMD_ISO_14443B_COMMAND, {ISO14B_DISCONNECT, 0, 0}};
abb21530 105 clearCommandBuffer();
d71d59db 106 SendCommand(&c);
18b90cce 107 return 0;
3607b5a9 108}
d71d59db 109
6fc68747 110int CmdHF14BList(const char *Cmd) {
111 CmdHFList("14b");
112 return 0;
113}
22e24700 114
6fc68747 115int CmdHF14BSim(const char *Cmd) {
dccddaef 116 char cmdp = param_getchar(Cmd, 0);
6fc68747 117 if (cmdp == 'h' || cmdp == 'H') return usage_hf_14b_sim();
118
dccddaef 119 uint32_t pupi = 0;
120 if (cmdp == 'u' || cmdp == 'U') {
121 pupi = param_get32ex(Cmd, 1, 0, 16);
122 }
123
124 UsbCommand c = {CMD_SIMULATE_TAG_ISO_14443B, {pupi, 0, 0}};
abb21530 125 clearCommandBuffer();
22e24700 126 SendCommand(&c);
6fc68747 127 return 0;
128}
22e24700 129
6fc68747 130int CmdHF14BSnoop(const char *Cmd) {
6de14cec 131
6fc68747 132 char cmdp = param_getchar(Cmd, 0);
133 if (cmdp == 'h' || cmdp == 'H') return usage_hf_14b_snoop();
6de14cec 134
6fc68747 135 UsbCommand c = {CMD_SNOOP_ISO_14443B, {0, 0, 0}};
136 clearCommandBuffer();
137 SendCommand(&c);
138 return 0;
1299c798 139}
140
141int CmdHF14BCmdRaw (const char *Cmd) {
6fc68747 142 bool reply = TRUE;
143 bool power = FALSE;
144 bool select = FALSE;
145 char buf[5]="";
146
147 int i = 0;
148 uint8_t data[USB_CMD_DATA_SIZE] = {0x00};
149 uint16_t datalen = 0;
18b90cce 150 uint32_t flags = ISO14B_CONNECT;
6fc68747 151 uint32_t temp = 0;
152
153 if (strlen(Cmd)<3) return usage_hf_14b_raw();
7cf3ef20 154
155 // strip
6fc68747 156 while (*Cmd==' ' || *Cmd=='\t') ++Cmd;
7cf3ef20 157
1299c798 158 while (Cmd[i]!='\0') {
6fc68747 159 if (Cmd[i]==' ' || Cmd[i]=='\t') { ++i; continue; }
1299c798 160 if (Cmd[i]=='-') {
161 switch (Cmd[i+1]) {
6fc68747 162 case 'H':
163 case 'h':
164 return usage_hf_14b_raw();
7cf3ef20 165 case 'r':
166 case 'R':
6fc68747 167 reply = FALSE;
7cf3ef20 168 break;
169 case 'c':
170 case 'C':
6fc68747 171 flags |= ISO14B_APPEND_CRC;
7cf3ef20 172 break;
173 case 'p':
174 case 'P':
6fc68747 175 power = TRUE;
7cf3ef20 176 break;
b10a759f 177 case 's':
178 case 'S':
6fc68747 179 select = TRUE;
b10a759f 180 if (Cmd[i+2]=='s' || Cmd[i+2]=='S') {
6fc68747 181 flags |= ISO14B_SELECT_SR;
182 ++i;
183 } else {
184 flags |= ISO14B_SELECT_STD;
b10a759f 185 }
186 break;
7cf3ef20 187 default:
6fc68747 188 return usage_hf_14b_raw();
7cf3ef20 189 }
190 i+=2;
191 continue;
192 }
1299c798 193 if ((Cmd[i]>='0' && Cmd[i]<='9') ||
194 (Cmd[i]>='a' && Cmd[i]<='f') ||
195 (Cmd[i]>='A' && Cmd[i]<='F') ) {
7cf3ef20 196 buf[strlen(buf)+1]=0;
1299c798 197 buf[strlen(buf)]=Cmd[i];
7cf3ef20 198 i++;
199
200 if (strlen(buf)>=2) {
201 sscanf(buf,"%x",&temp);
6fc68747 202 data[datalen++] = (uint8_t)(temp & 0xff);
7cf3ef20 203 *buf=0;
b10a759f 204 memset(buf, 0x00, sizeof(buf));
7cf3ef20 205 }
206 continue;
207 }
208 PrintAndLog("Invalid char on input");
b10a759f 209 return 0;
7cf3ef20 210 }
b10a759f 211
6fc68747 212 if(!power)
213 flags |= ISO14B_DISCONNECT;
214
215 if(datalen>0)
216 flags |= ISO14B_RAW;
217
218 // Max buffer is USB_CMD_DATA_SIZE
219 datalen = (datalen > USB_CMD_DATA_SIZE) ? USB_CMD_DATA_SIZE : datalen;
220
221 UsbCommand c = {CMD_ISO_14443B_COMMAND, {flags, datalen, 0}};
222 memcpy(c.d.asBytes, data, datalen);
223 clearCommandBuffer();
224 SendCommand(&c);
225
226 if (!reply) return 1;
227
228 bool success = TRUE;
229 // get back iso14b_card_select_t, don't print it.
230 if(select)
231 success = waitCmd(FALSE);
232
233 // get back response from the raw bytes you sent.
234 if(success && datalen>0) waitCmd(TRUE);
235
236 return 1;
1299c798 237}
238
6de14cec 239// print full atqb info
186ad603 240// bytes
241// 0,1,2,3 = application data
242// 4 = bit rate capacity
243// 5 = max frame size / -4 info
244// 6 = FWI / Coding options
6fc68747 245static void print_atqb_resp(uint8_t *data, uint8_t cid){
186ad603 246 //PrintAndLog(" UID: %s", sprint_hex(data+1,4));
247 PrintAndLog(" App Data: %s", sprint_hex(data,4));
248 PrintAndLog(" Protocol: %s", sprint_hex(data+4,3));
6fc68747 249 uint8_t BitRate = data[4];
186ad603 250 if (!BitRate) PrintAndLog(" Bit Rate: 106 kbit/s only PICC <-> PCD");
251 if (BitRate & 0x10) PrintAndLog(" Bit Rate: 212 kbit/s PICC -> PCD supported");
252 if (BitRate & 0x20) PrintAndLog(" Bit Rate: 424 kbit/s PICC -> PCD supported");
253 if (BitRate & 0x40) PrintAndLog(" Bit Rate: 847 kbit/s PICC -> PCD supported");
254 if (BitRate & 0x01) PrintAndLog(" Bit Rate: 212 kbit/s PICC <- PCD supported");
255 if (BitRate & 0x02) PrintAndLog(" Bit Rate: 424 kbit/s PICC <- PCD supported");
256 if (BitRate & 0x04) PrintAndLog(" Bit Rate: 847 kbit/s PICC <- PCD supported");
257 if (BitRate & 0x80) PrintAndLog(" Same bit rate <-> required");
22e24700 258
6fc68747 259 uint16_t maxFrame = data[5]>>4;
22e24700 260 if (maxFrame < 5) maxFrame = 8 * maxFrame + 16;
261 else if (maxFrame == 5) maxFrame = 64;
262 else if (maxFrame == 6) maxFrame = 96;
263 else if (maxFrame == 7) maxFrame = 128;
264 else if (maxFrame == 8) maxFrame = 256;
265 else maxFrame = 257;
186ad603 266
267 PrintAndLog("Max Frame Size: %u%s bytes",maxFrame, (maxFrame == 257) ? "+ RFU" : "");
22e24700 268
6fc68747 269 uint8_t protocolT = data[5] & 0xF;
186ad603 270 PrintAndLog(" Protocol Type: Protocol is %scompliant with ISO/IEC 14443-4",(protocolT) ? "" : "not " );
271
272 uint8_t fwt = data[6]>>4;
273 if ( fwt < 16 ){
274 uint32_t etus = (32 << fwt);
275 uint32_t fwt_time = (302 << fwt);
18b90cce 276 PrintAndLog("Frame Wait Integer: %u - %u ETUs | %u us", fwt, etus, fwt_time);
186ad603 277 } else {
278 PrintAndLog("Frame Wait Integer: %u - RFU", fwt);
279 }
280
281 PrintAndLog(" App Data Code: Application is %s",(data[6]&4) ? "Standard" : "Proprietary");
282 PrintAndLog(" Frame Options: NAD is %ssupported",(data[6]&2) ? "" : "not ");
283 PrintAndLog(" Frame Options: CID is %ssupported",(data[6]&1) ? "" : "not ");
284 PrintAndLog("Tag :");
285 PrintAndLog(" Max Buf Length: %u (MBLI) %s", cid>>4, (cid & 0xF0) ? "" : "chained frames not supported");
286 PrintAndLog(" CDI : %u", cid & 0x0f);
22e24700 287 return;
1299c798 288}
289
6de14cec 290// get SRx chip model (from UID) // from ST Microelectronics
d71d59db 291char *get_ST_Chip_Model(uint8_t data){
292 static char model[20];
293 char *retStr = model;
294 memset(model,0, sizeof(model));
295
296 switch (data) {
297 case 0x0: sprintf(retStr, "SRIX4K (Special)"); break;
298 case 0x2: sprintf(retStr, "SR176"); break;
299 case 0x3: sprintf(retStr, "SRIX4K"); break;
300 case 0x4: sprintf(retStr, "SRIX512"); break;
301 case 0x6: sprintf(retStr, "SRI512"); break;
302 case 0x7: sprintf(retStr, "SRI4K"); break;
303 case 0xC: sprintf(retStr, "SRT512"); break;
5636ee8c 304 default : sprintf(retStr, "Unknown"); break;
d71d59db 305 }
17ad0e09 306 return retStr;
307}
308
6fc68747 309// REMAKE:
b10a759f 310int print_ST_Lock_info(uint8_t model){
b10a759f 311
6fc68747 312 // PrintAndLog("Chip Write Protection Bits:");
313 // // now interpret the data
314 // switch (model){
315 // case 0x0: //fall through (SRIX4K special)
316 // case 0x3: //fall through (SRIx4K)
317 // case 0x7: // (SRI4K)
318 // //only need data[3]
319 // blk1 = 9;
320 // PrintAndLog(" raw: %s", sprint_bin(data+3, 1));
321 // PrintAndLog(" 07/08:%slocked", (data[3] & 1) ? " not " : " " );
322 // for (uint8_t i = 1; i<8; i++){
323 // PrintAndLog(" %02u:%slocked", blk1, (data[3] & (1 << i)) ? " not " : " " );
324 // blk1++;
325 // }
326 // break;
327 // case 0x4: //fall through (SRIX512)
328 // case 0x6: //fall through (SRI512)
329 // case 0xC: // (SRT512)
330 // //need data[2] and data[3]
331 // blk1 = 0;
332 // PrintAndLog(" raw: %s", sprint_bin(data+2, 2));
333 // for (uint8_t b=2; b<4; b++){
334 // for (uint8_t i=0; i<8; i++){
335 // PrintAndLog(" %02u:%slocked", blk1, (data[b] & (1 << i)) ? " not " : " " );
336 // blk1++;
337 // }
338 // }
339 // break;
340 // case 0x2: // (SR176)
341 // //need data[2]
342 // blk1 = 0;
343 // PrintAndLog(" raw: %s", sprint_bin(data+2, 1));
344 // for (uint8_t i = 0; i<8; i++){
345 // PrintAndLog(" %02u/%02u:%slocked", blk1, blk1+1, (data[2] & (1 << i)) ? " " : " not " );
346 // blk1+=2;
347 // }
348 // break;
349 // default:
350 // return rawClose();
351 // }
b10a759f 352 return 1;
353}
354
6de14cec 355// print UID info from SRx chips (ST Microelectronics)
6fc68747 356static void print_st_general_info(uint8_t *data, uint8_t len){
17ad0e09 357 //uid = first 8 bytes in data
6fc68747 358 PrintAndLog(" UID: %s", sprint_hex(SwapEndian64(data,8,8), len));
17ad0e09 359 PrintAndLog(" MFG: %02X, %s", data[6], getTagInfo(data[6]));
360 PrintAndLog("Chip: %02X, %s", data[5]>>2, get_ST_Chip_Model(data[5]>>2));
361 return;
362}
363
6fc68747 364//05 00 00 = find one tag in field
365//1d xx xx xx xx 00 08 01 00 = attrib xx=UID (resp 10 [f9 e0])
366//a3 = ? (resp 03 [e2 c2])
367//02 = ? (resp 02 [6a d3])
368// 022b (resp 02 67 00 [29 5b])
369// 0200a40400 (resp 02 67 00 [29 5b])
370// 0200a4040c07a0000002480300 (resp 02 67 00 [29 5b])
371// 0200a4040c07a0000002480200 (resp 02 67 00 [29 5b])
372// 0200a4040006a0000000010100 (resp 02 6a 82 [4b 4c])
373// 0200a4040c09d27600002545500200 (resp 02 67 00 [29 5b])
374// 0200a404000cd2760001354b414e4d30310000 (resp 02 6a 82 [4b 4c])
375// 0200a404000ca000000063504b43532d313500 (resp 02 6a 82 [4b 4c])
376// 0200a4040010a000000018300301000000000000000000 (resp 02 6a 82 [4b 4c])
377//03 = ? (resp 03 [e3 c2])
378//c2 = ? (resp c2 [66 15])
379//b2 = ? (resp a3 [e9 67])
380//a2 = ? (resp 02 [6a d3])
6de14cec 381
382// 14b get and print Full Info (as much as we know)
6fc68747 383bool HF14B_Std_Info(bool verbose){
6de14cec 384 //add more info here
6fc68747 385 return FALSE;
17ad0e09 386}
387
6fc68747 388// SRx get and print full info (needs more info...)
389bool HF14B_ST_Info(bool verbose){
390
391 UsbCommand c = {CMD_ISO_14443B_COMMAND, {ISO14B_CONNECT | ISO14B_SELECT_SR | ISO14B_DISCONNECT, 0, 0}};
392 clearCommandBuffer();
393 SendCommand(&c);
394 UsbCommand resp;
17ad0e09 395
5de71ee6 396 if (!WaitForResponseTimeout(CMD_ACK, &resp, TIMEOUT)) {
6fc68747 397 if (verbose) PrintAndLog("timeout while waiting for reply.");
398 return FALSE;
399 }
17ad0e09 400
6fc68747 401 iso14b_card_select_t card;
402 memcpy(&card, (iso14b_card_select_t *)resp.d.asBytes, sizeof(iso14b_card_select_t));
403
404 uint64_t status = resp.arg[0];
18b90cce 405 if ( status > 0 ) return switch_off_field_14b();
17ad0e09 406
6fc68747 407 //add locking bit information here. uint8_t data[16] = {0x00};
408 // uint8_t datalen = 2;
409 // uint8_t resplen;
410 // uint8_t blk1;
411 // data[0] = 0x08;
412
413 //
414 // if (model == 0x2) { //SR176 has special command:
415 // data[1] = 0xf;
416 // resplen = 4;
417 // } else {
418 // data[1] = 0xff;
419 // resplen = 6;
420 // }
421
422 // //std read cmd
423 // if (HF14BCmdRaw(true, true, data, &datalen, false)==0)
424 // return rawClose();
425
426 // if (datalen != resplen || !crc) return rawClose();
427 //print_ST_Lock_info(data[5]>>2);
18b90cce 428 switch_off_field_14b();
6fc68747 429 return TRUE;
430}
17ad0e09 431
6fc68747 432// get and print all info known about any known 14b tag
433bool HF14BInfo(bool verbose){
17ad0e09 434
6fc68747 435 // try std 14b (atqb)
436 if (HF14B_Std_Info(verbose)) return TRUE;
17ad0e09 437
6fc68747 438 // try st 14b
439 if (HF14B_ST_Info(verbose)) return TRUE;
b10a759f 440
6fc68747 441 // try unknown 14b read commands (to be identified later)
442 // could be read of calypso, CEPAS, moneo, or pico pass.
b10a759f 443
6fc68747 444 if (verbose) PrintAndLog("no 14443B tag found");
445 return FALSE;
446}
17ad0e09 447
6fc68747 448// menu command to get and print all info known about any known 14b tag
449int CmdHF14Binfo(const char *Cmd){
450 char cmdp = param_getchar(Cmd, 0);
451 if (cmdp == 'h' || cmdp == 'H') return usage_hf_14b_info();
452
453 bool verbose = !((cmdp == 's') || (cmdp == 'S'));
454 return HF14BInfo(verbose);
6de14cec 455}
456
6fc68747 457bool HF14B_ST_Reader(bool verbose){
458
459 bool isSuccess = FALSE;
460
18b90cce 461 switch_on_field_14b();
462
6fc68747 463 // SRx get and print general info about SRx chip from UID
18b90cce 464 UsbCommand c = {CMD_ISO_14443B_COMMAND, {ISO14B_SELECT_SR, 0, 0}};
6fc68747 465 clearCommandBuffer();
466 SendCommand(&c);
467 UsbCommand resp;
5de71ee6 468 if (!WaitForResponseTimeout(CMD_ACK, &resp, TIMEOUT)) {
6fc68747 469 if (verbose) PrintAndLog("timeout while waiting for reply.");
470 return FALSE;
471 }
6fc68747 472
473 iso14b_card_select_t card;
474 memcpy(&card, (iso14b_card_select_t *)resp.d.asBytes, sizeof(iso14b_card_select_t));
17ad0e09 475
6fc68747 476 uint64_t status = resp.arg[0];
22e24700 477
6fc68747 478 switch( status ){
479 case 0:
480 print_st_general_info(card.uid, card.uidlen);
481 isSuccess = TRUE;
482 break;
483 case 1:
484 if (verbose) PrintAndLog("iso14443-3 random chip id fail");
485 break;
486 case 2:
487 if (verbose) PrintAndLog("iso14443-3 ATTRIB fail");
488 break;
489 case 3:
490 if (verbose) PrintAndLog("iso14443-3 CRC fail");
491 break;
492 default:
493 if (verbose) PrintAndLog("iso14443b card select SRx failed");
494 break;
22e24700 495 }
496
18b90cce 497 switch_off_field_14b();
6fc68747 498 return isSuccess;
1299c798 499}
500
6fc68747 501bool HF14B_Std_Reader(bool verbose){
22e24700 502
6fc68747 503 bool isSuccess = FALSE;
22e24700 504
6fc68747 505 // 14b get and print UID only (general info)
506 UsbCommand c = {CMD_ISO_14443B_COMMAND, {ISO14B_CONNECT | ISO14B_SELECT_STD | ISO14B_DISCONNECT, 0, 0}};
507 clearCommandBuffer();
508 SendCommand(&c);
509 UsbCommand resp;
510
5de71ee6 511 if (!WaitForResponseTimeout(CMD_ACK, &resp, TIMEOUT)) {
6fc68747 512 if (verbose) PrintAndLog("timeout while waiting for reply.");
513 return FALSE;
514 }
515
516 iso14b_card_select_t card;
517 memcpy(&card, (iso14b_card_select_t *)resp.d.asBytes, sizeof(iso14b_card_select_t));
518
519 uint64_t status = resp.arg[0];
520
521 switch( status ){
522 case 0:
523 PrintAndLog(" UID : %s", sprint_hex(card.uid, card.uidlen));
524 PrintAndLog(" ATQB : %s", sprint_hex(card.atqb, sizeof(card.atqb)));
525 PrintAndLog(" CHIPID : %02X", card.chipid);
526 print_atqb_resp(card.atqb, card.cid);
527 isSuccess = TRUE;
528 break;
529 case 2:
530 if (verbose) PrintAndLog("iso14443-3 ATTRIB fail");
531 break;
532 case 3:
533 if (verbose) PrintAndLog("iso14443-3 CRC fail");
534 break;
535 default:
536 if (verbose) PrintAndLog("iso14443b card select failed");
537 break;
538 }
539
18b90cce 540 switch_off_field_14b();
6fc68747 541 return isSuccess;
542}
1299c798 543
6fc68747 544// test for other 14b type tags (mimic another reader - don't have tags to identify)
545bool HF14B_Other_Reader(){
abb21530 546
6fc68747 547 // uint8_t data[] = {0x00, 0x0b, 0x3f, 0x80};
548 // uint8_t datalen = 4;
d71d59db 549
6fc68747 550 // // 14b get and print UID only (general info)
551 // uint32_t flags = ISO14B_CONNECT | ISO14B_SELECT_STD | ISO14B_RAW | ISO14B_APPEND_CRC;
552
553 // UsbCommand c = {CMD_ISO_14443B_COMMAND, {flags, datalen, 0}};
554 // memcpy(c.d.asBytes, data, datalen);
555
556 // clearCommandBuffer();
557 // SendCommand(&c);
558 // UsbCommand resp;
559 // WaitForResponse(CMD_ACK,&resp);
560
561 // if (datalen > 2 ) {
562 // printandlog ("\n14443-3b tag found:");
563 // printandlog ("unknown tag type answered to a 0x000b3f80 command ans:");
564 // //printandlog ("%s", sprint_hex(data, datalen));
565 // rawclose();
566 // return true;
567 // }
568
569 // c.arg1 = 1;
570 // c.d.asBytes[0] = ISO14443B_AUTHENTICATE;
571 // clearCommandBuffer();
572 // SendCommand(&c);
573 // UsbCommand resp;
574 // WaitForResponse(CMD_ACK, &resp);
575
576 // if (datalen > 0) {
577 // PrintAndLog ("\n14443-3b tag found:");
578 // PrintAndLog ("Unknown tag type answered to a 0x0A command ans:");
579 // // PrintAndLog ("%s", sprint_hex(data, datalen));
580 // rawClose();
581 // return TRUE;
582 // }
583
584 // c.arg1 = 1;
585 // c.d.asBytes[0] = ISO14443B_RESET;
586 // clearCommandBuffer();
587 // SendCommand(&c);
588 // UsbCommand resp;
589 // WaitForResponse(CMD_ACK, &resp);
590
591 // if (datalen > 0) {
592 // PrintAndLog ("\n14443-3b tag found:");
593 // PrintAndLog ("Unknown tag type answered to a 0x0C command ans:");
594 // PrintAndLog ("%s", sprint_hex(data, datalen));
595 // rawClose();
596 // return TRUE;
597 // }
598
599 // rawClose();
600 return FALSE;
7cf3ef20 601}
602
6de14cec 603// get and print general info about all known 14b chips
6fc68747 604bool HF14BReader(bool verbose){
6de14cec 605
606 // try std 14b (atqb)
6fc68747 607 if (HF14B_Std_Reader(verbose)) return TRUE;
6de14cec 608
6fc68747 609 // try ST Microelectronics 14b
610 if (HF14B_ST_Reader(verbose)) return TRUE;
6de14cec 611
612 // try unknown 14b read commands (to be identified later)
613 // could be read of calypso, CEPAS, moneo, or pico pass.
6fc68747 614 if (HF14B_Other_Reader()) return TRUE;
6de14cec 615
616 if (verbose) PrintAndLog("no 14443B tag found");
6fc68747 617 return FALSE;
6de14cec 618}
619
620// menu command to get and print general info about all known 14b chips
621int CmdHF14BReader(const char *Cmd){
6fc68747 622 char cmdp = param_getchar(Cmd, 0);
623 if (cmdp == 'h' || cmdp == 'H') return usage_hf_14b_reader();
624
625 bool verbose = !((cmdp == 's') || (cmdp == 'S'));
626 return HF14BReader(verbose);
6de14cec 627}
628
6fc68747 629/* New command to read the contents of a SRI512|SRIX4K tag
630 * SRI* tags are ISO14443-B modulated memory tags,
631 * this command just dumps the contents of the memory/
632 */
633int CmdHF14BReadSri(const char *Cmd){
634 char cmdp = param_getchar(Cmd, 0);
635 if (strlen(Cmd) < 1 || cmdp == 'h' || cmdp == 'H') return usage_hf_14b_read_srx();
636
637 uint8_t tagtype = param_get8(Cmd, 0);
638 uint8_t blocks = (tagtype == 1) ? 0x7F : 0x0F;
639
640 UsbCommand c = {CMD_READ_SRI_TAG, {blocks, 0, 0}};
641 clearCommandBuffer();
642 SendCommand(&c);
643 return 0;
644}
645// New command to write a SRI512/SRIX4K tag.
646int CmdHF14BWriteSri(const char *Cmd){
3fe4ff4f 647/*
648 * For SRIX4K blocks 00 - 7F
649 * hf 14b raw -c -p 09 $srix4kwblock $srix4kwdata
650 *
651 * For SR512 blocks 00 - 0F
652 * hf 14b raw -c -p 09 $sr512wblock $sr512wdata
653 *
654 * Special block FF = otp_lock_reg block.
655 * Data len 4 bytes-
656 */
657 char cmdp = param_getchar(Cmd, 0);
658 uint8_t blockno = -1;
659 uint8_t data[4] = {0x00};
660 bool isSrix4k = true;
6fc68747 661 char str[30];
662 memset(str, 0x00, sizeof(str));
663
664 if (strlen(Cmd) < 1 || cmdp == 'h' || cmdp == 'H') return usage_hf_14b_write_srx();
3fe4ff4f 665
b5be31f9 666 if ( cmdp == '2' )
3fe4ff4f 667 isSrix4k = false;
668
b5be31f9 669 //blockno = param_get8(Cmd, 1);
670
6fc68747 671 if ( param_gethex(Cmd, 1, &blockno, 2) ) {
b5be31f9 672 PrintAndLog("Block number must include 2 HEX symbols");
673 return 0;
674 }
3fe4ff4f 675
676 if ( isSrix4k ){
677 if ( blockno > 0x7f && blockno != 0xff ){
678 PrintAndLog("Block number out of range");
679 return 0;
680 }
681 } else {
682 if ( blockno > 0x0f && blockno != 0xff ){
683 PrintAndLog("Block number out of range");
684 return 0;
685 }
686 }
687
688 if (param_gethex(Cmd, 2, data, 8)) {
689 PrintAndLog("Data must include 8 HEX symbols");
690 return 0;
691 }
692
6fc68747 693 if ( blockno == 0xff) {
694 PrintAndLog("[%s] Write special block %02X [ %s ]",
695 (isSrix4k) ? "SRIX4K":"SRI512",
696 blockno,
697 sprint_hex(data,4)
698 );
699 } else {
700 PrintAndLog("[%s] Write block %02X [ %s ]",
701 (isSrix4k) ? "SRIX4K":"SRI512",
702 blockno,
703 sprint_hex(data,4)
704 );
705 }
706
707 sprintf(str, "-ss -c %02x %02x %02x%02x%02x%02x", ISO14443B_WRITE_BLK, blockno, data[0], data[1], data[2], data[3]);
3fe4ff4f 708 CmdHF14BCmdRaw(str);
709 return 0;
710}
711
341fd1de 712uint32_t srix4kEncode(uint32_t value) {
5636ee8c 713/*
714// vv = value
715// pp = position
716// vv vv vv pp
7174 bytes : 00 1A 20 01
718*/
5636ee8c 719 // only the lower crumbs.
720 uint8_t block = (value & 0xFF);
721 uint8_t i = 0;
722 uint8_t valuebytes[] = {0,0,0};
723
5636ee8c 724 num_to_bytes(value, 3, valuebytes);
725
726 // Scrambled part
727 // Crumb swapping of value.
728 uint8_t temp[] = {0,0};
ff3e0744 729 temp[0] = (CRUMB(value, 22) << 4 | CRUMB(value, 14 ) << 2 | CRUMB(value, 6)) << 4;
730 temp[0] |= CRUMB(value, 20) << 4 | CRUMB(value, 12 ) << 2 | CRUMB(value, 4);
731 temp[1] = (CRUMB(value, 18) << 4 | CRUMB(value, 10 ) << 2 | CRUMB(value, 2)) << 4;
732 temp[1] |= CRUMB(value, 16) << 4 | CRUMB(value, 8 ) << 2 | CRUMB(value, 0);
5636ee8c 733
734 // chksum part
735 uint32_t chksum = 0xFF - block;
736
737 // chksum is reduced by each nibbles of value.
738 for (i = 0; i < 3; ++i){
ff3e0744 739 chksum -= NIBBLE_HIGH(valuebytes[i]);
740 chksum -= NIBBLE_LOW(valuebytes[i]);
5636ee8c 741 }
742
341fd1de 743 // base4 conversion and left shift twice
5636ee8c 744 i = 3;
745 uint8_t base4[] = {0,0,0,0};
746 while( chksum !=0 ){
747 base4[i--] = (chksum % 4 << 2);
748 chksum /= 4;
749 }
750
751 // merge scambled and chksum parts
752 uint32_t encvalue =
ff3e0744 753 ( NIBBLE_LOW ( base4[0]) << 28 ) |
754 ( NIBBLE_HIGH( temp[0]) << 24 ) |
5636ee8c 755
ff3e0744 756 ( NIBBLE_LOW ( base4[1]) << 20 ) |
757 ( NIBBLE_LOW ( temp[0]) << 16 ) |
5636ee8c 758
ff3e0744 759 ( NIBBLE_LOW ( base4[2]) << 12 ) |
760 ( NIBBLE_HIGH( temp[1]) << 8 ) |
5636ee8c 761
ff3e0744 762 ( NIBBLE_LOW ( base4[3]) << 4 ) |
763 NIBBLE_LOW ( temp[1] );
5636ee8c 764
341fd1de 765 PrintAndLog("ICE encoded | %08X -> %08X", value, encvalue);
766 return encvalue;
767}
768uint32_t srix4kDecode(uint32_t value) {
769 switch(value) {
770 case 0xC04F42C5: return 0x003139;
771 case 0xC1484807: return 0x002943;
772 case 0xC0C60848: return 0x001A20;
773 }
5636ee8c 774 return 0;
775}
341fd1de 776uint32_t srix4kDecodeCounter(uint32_t num) {
777 uint32_t value = ~num;
778 ++value;
779 return value;
780}
781
782uint32_t srix4kGetMagicbytes( uint64_t uid, uint32_t block6, uint32_t block18, uint32_t block19 ){
783#define MASK 0xFFFFFFFF;
784 uint32_t uid32 = uid & MASK;
785 uint32_t counter = srix4kDecodeCounter(block6);
786 uint32_t decodedBlock18 = srix4kDecode(block18);
787 uint32_t decodedBlock19 = srix4kDecode(block19);
788 uint32_t doubleBlock = (decodedBlock18 << 16 | decodedBlock19) + 1;
789
790 uint32_t result = (uid32 * doubleBlock * counter) & MASK;
791 PrintAndLog("Magic bytes | %08X", result);
792 return result;
793}
794int srix4kValid(const char *Cmd){
795
796 uint64_t uid = 0xD00202501A4532F9;
797 uint32_t block6 = 0xFFFFFFFF;
798 uint32_t block18 = 0xC04F42C5;
799 uint32_t block19 = 0xC1484807;
800 uint32_t block21 = 0xD1BCABA4;
801
802 uint32_t test_b18 = 0x00313918;
803 uint32_t test_b18_enc = srix4kEncode(test_b18);
804 //uint32_t test_b18_dec = srix4kDecode(test_b18_enc);
805 PrintAndLog("ENCODE & CHECKSUM | %08X -> %08X (%s)", test_b18, test_b18_enc , "");
806
807 uint32_t magic = srix4kGetMagicbytes(uid, block6, block18, block19);
808 PrintAndLog("BLOCK 21 | %08X -> %08X (no XOR)", block21, magic ^ block21);
5636ee8c 809 return 0;
810}
341fd1de 811
812int CmdteaSelfTest(const char *Cmd){
813
814 uint8_t v[8], v_le[8];
815 memset(v, 0x00, sizeof(v));
816 memset(v_le, 0x00, sizeof(v_le));
817 uint8_t* v_ptr = v_le;
818
819 uint8_t cmdlen = strlen(Cmd);
820 cmdlen = ( sizeof(v)<<2 < cmdlen ) ? sizeof(v)<<2 : cmdlen;
821
822 if ( param_gethex(Cmd, 0, v, cmdlen) > 0 ){
823 PrintAndLog("can't read hex chars, uneven? :: %u", cmdlen);
824 return 1;
825 }
826
827 SwapEndian64ex(v , 8, 4, v_ptr);
828
e994394a 829 // ENCRYPTION KEY:
ff3e0744 830 uint8_t key[16] = {0x55,0xFE,0xF6,0x30,0x62,0xBF,0x0B,0xC1,0xC9,0xB3,0x7C,0x34,0x97,0x3E,0x29,0xFB };
e994394a 831 uint8_t keyle[16];
832 uint8_t* key_ptr = keyle;
833 SwapEndian64ex(key , sizeof(key), 4, key_ptr);
341fd1de 834
e994394a 835 PrintAndLog("TEST LE enc| %s", sprint_hex(v_ptr, 8));
836
837 tea_decrypt(v_ptr, key_ptr);
838 PrintAndLog("TEST LE dec | %s", sprint_hex_ascii(v_ptr, 8));
839
840 tea_encrypt(v_ptr, key_ptr);
841 tea_encrypt(v_ptr, key_ptr);
842 PrintAndLog("TEST enc2 | %s", sprint_hex_ascii(v_ptr, 8));
341fd1de 843
5636ee8c 844 return 0;
845}
846
6fc68747 847bool waitCmd(bool verbose) {
848
849 bool crc = FALSE;
850 uint8_t b1 = 0, b2 = 0;
851 uint8_t data[USB_CMD_DATA_SIZE] = {0x00};
852 uint8_t status = 0;
853 uint16_t len = 0;
854 UsbCommand resp;
855
5de71ee6 856 if (WaitForResponseTimeout(CMD_ACK, &resp, TIMEOUT)) {
6fc68747 857
a420e5c1 858 status = (resp.arg[0] & 0xFF);
6fc68747 859 if ( status > 0 ) return FALSE;
a420e5c1 860
6fc68747 861 len = (resp.arg[1] & 0xFFFF);
a420e5c1 862
6fc68747 863 memcpy(data, resp.d.asBytes, len);
864
865 if (verbose) {
a420e5c1 866 if ( len >= 3 ) {
867 ComputeCrc14443(CRC_14443_B, data, len-2, &b1, &b2);
868 crc = ( data[len-2] == b1 && data[len-1] == b2);
869
870 PrintAndLog("[LEN %u] %s[%02X %02X] %s",
871 len,
872 sprint_hex(data, len-2),
873 data[len-2],
874 data[len-1],
875 (crc) ? "OK" : "FAIL"
876 );
877 } else {
878 PrintAndLog("[LEN %u] %s", len, sprint_hex(data, len) );
879 }
6fc68747 880 }
881 return TRUE;
882 } else {
883 PrintAndLog("timeout while waiting for reply.");
884 return FALSE;
885 }
886}
887
e994394a 888static command_t CommandTable[] = {
22e24700 889 {"help", CmdHelp, 1, "This help"},
6de14cec 890 {"info", CmdHF14Binfo, 0, "Find and print details about a 14443B tag"},
891 {"list", CmdHF14BList, 0, "[Deprecated] List ISO 14443B history"},
6fc68747 892 {"raw", CmdHF14BCmdRaw, 0, "Send raw hex data to tag"},
6de14cec 893 {"reader", CmdHF14BReader, 0, "Act as a 14443B reader to identify a tag"},
894 {"sim", CmdHF14BSim, 0, "Fake ISO 14443B tag"},
895 {"snoop", CmdHF14BSnoop, 0, "Eavesdrop ISO 14443B"},
6fc68747 896 {"sriread", CmdHF14BReadSri, 0, "Read contents of a SRI512 | SRIX4K tag"},
897 {"sriwrite", CmdHF14BWriteSri, 0, "Write data to a SRI512 | SRIX4K tag"},
341fd1de 898 //{"valid", srix4kValid, 1, "srix4k checksum test"},
6fc68747 899 //{"valid", CmdteaSelfTest, 1, "tea test"},
22e24700 900 {NULL, NULL, 0, NULL}
7fe9b0b7 901};
902
e994394a 903int CmdHF14B(const char *Cmd) {
904 clearCommandBuffer();
22e24700 905 CmdsParse(CommandTable, Cmd);
906 return 0;
7fe9b0b7 907}
908
e994394a 909int CmdHelp(const char *Cmd) {
22e24700 910 CmdsHelp(CommandTable);
911 return 0;
7fe9b0b7 912}
Impressum, Datenschutz