FreeCalypso > hg > freecalypso-hwlab
comparison simtool/dumpdir.c @ 143:431194b772e1
fc-simtool: uicc-dump command ported over
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Thu, 04 Feb 2021 05:12:24 +0000 |
parents | |
children |
comparison
equal
deleted
inserted
replaced
142:74c5dc7408e9 | 143:431194b772e1 |
---|---|
1 /* | |
2 * This module implements the dump of EF_DIR. | |
3 */ | |
4 | |
5 #include <sys/types.h> | |
6 #include <stdio.h> | |
7 #include <stdlib.h> | |
8 #include <pcsclite.h> | |
9 #include <winscard.h> | |
10 #include "globals.h" | |
11 #include "file_id.h" | |
12 | |
13 static | |
14 check_all_blank() | |
15 { | |
16 u_char *dp, *endp; | |
17 | |
18 dp = sim_resp_data; | |
19 endp = sim_resp_data + sim_resp_data_len; | |
20 while (dp < endp) | |
21 if (*dp++ != 0xFF) | |
22 return(0); | |
23 return(1); | |
24 } | |
25 | |
26 static void | |
27 dump_aid(tlv) | |
28 u_char *tlv; | |
29 { | |
30 unsigned reclen, n; | |
31 | |
32 reclen = tlv[1]; | |
33 printf(" AID:"); | |
34 for (n = 0; n < reclen; n++) | |
35 printf(" %02X", tlv[n+2]); | |
36 putchar('\n'); | |
37 } | |
38 | |
39 static void | |
40 dump_label(tlv) | |
41 u_char *tlv; | |
42 { | |
43 int rc; | |
44 unsigned textlen; | |
45 | |
46 printf(" Label: "); | |
47 rc = validate_alpha_field(tlv + 2, tlv[1], &textlen); | |
48 if (rc < 0) { | |
49 printf("malformed\n"); | |
50 return; | |
51 } | |
52 print_alpha_field(tlv + 2, textlen, stdout); | |
53 putchar('\n'); | |
54 } | |
55 | |
56 static void | |
57 dump_unknown_tlv(tlv) | |
58 u_char *tlv; | |
59 { | |
60 unsigned reclen, n; | |
61 | |
62 reclen = tlv[1] + 2; | |
63 printf(" TLV:"); | |
64 for (n = 0; n < reclen; n++) | |
65 printf(" %02X", tlv[n]); | |
66 putchar('\n'); | |
67 } | |
68 | |
69 static void | |
70 dump_record(recno) | |
71 unsigned recno; | |
72 { | |
73 unsigned totlen, reclen; | |
74 u_char *dp, *endp; | |
75 | |
76 printf("Record #%u:\n", recno); | |
77 if (sim_resp_data[0] != 0x61) { | |
78 printf(" bad: first byte != 0x61\n"); | |
79 return; | |
80 } | |
81 totlen = sim_resp_data[1]; | |
82 if (totlen < 3 || totlen > 0x7F) { | |
83 printf(" bad: global length byte 0x%02X is invalid\n", totlen); | |
84 return; | |
85 } | |
86 if (totlen + 2 > sim_resp_data_len) { | |
87 printf(" bad: TLV global length exceeds EF record length\n"); | |
88 return; | |
89 } | |
90 dp = sim_resp_data + 2; | |
91 endp = sim_resp_data + 2 + totlen; | |
92 while (dp < endp) { | |
93 if (endp - dp < 2) { | |
94 trunc_error: printf(" bad: truncated TLV record\n"); | |
95 return; | |
96 } | |
97 if ((dp[0] & 0x1F) == 0x1F) { | |
98 printf(" bad: extended tag not supported\n"); | |
99 return; | |
100 } | |
101 if (dp[1] & 0x80) { | |
102 printf(" bad: extended length not supported\n"); | |
103 return; | |
104 } | |
105 reclen = dp[1] + 2; | |
106 if (endp - dp < reclen) | |
107 goto trunc_error; | |
108 switch (dp[0]) { | |
109 case 0x4F: | |
110 dump_aid(dp); | |
111 break; | |
112 case 0x50: | |
113 dump_label(dp); | |
114 break; | |
115 default: | |
116 dump_unknown_tlv(dp); | |
117 } | |
118 dp += reclen; | |
119 } | |
120 } | |
121 | |
122 cmd_uicc_dir() | |
123 { | |
124 int rc; | |
125 unsigned recno; | |
126 | |
127 rc = select_op(FILEID_MF); | |
128 if (rc < 0) | |
129 return(rc); | |
130 rc = select_op(EF_DIR); | |
131 if (rc < 0) | |
132 return(rc); | |
133 rc = parse_ef_select_response(); | |
134 if (rc < 0) | |
135 return(rc); | |
136 if (curfile_structure != 0x01) { | |
137 fprintf(stderr, "error: EF_DIR is not linear fixed\n"); | |
138 return(-1); | |
139 } | |
140 if (curfile_record_len < 5) { | |
141 fprintf(stderr, "error: EF_DIR record length is too short\n"); | |
142 return(-1); | |
143 } | |
144 for (recno = 1; recno <= curfile_record_count; recno++) { | |
145 rc = readrec_op(recno, 0x04, curfile_record_len); | |
146 if (rc < 0) | |
147 return(rc); | |
148 if (check_all_blank()) | |
149 continue; | |
150 dump_record(recno); | |
151 } | |
152 return(0); | |
153 } |