FreeCalypso > hg > fc-sim-tools

comparison uicc/select.c @ 15:b70d35f5476f

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
fc-uicc-tool ported over
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 14 Mar 2021 07:41:09 +0000
parents
children 0e46bbb801e0
comparison
equal deleted inserted replaced
14:b7ee2e85686b 15:b70d35f5476f
1 #include <sys/types.h>
2 #include <ctype.h>
3 #include <string.h>
4 #include <strings.h>
5 #include <stdio.h>
6 #include <stdlib.h>
7 #include "simresp.h"
8
9 u_char std_aid_usim[7] = {0xA0, 0x00, 0x00, 0x00, 0x87, 0x10, 0x02};
10 u_char std_aid_isim[7] = {0xA0, 0x00, 0x00, 0x00, 0x87, 0x10, 0x04};
11
12 unsigned last_sel_file_record_len;
13
14 elem_select_op(file_id)
15 unsigned file_id;
16 {
17 u_char cmd[7];
18 int rc;
19
20 last_sel_file_record_len = 0;
21 /* SELECT command APDU */
22 cmd[0] = 0x00;
23 cmd[1] = 0xA4;
24 cmd[2] = 0x00;
25 cmd[3] = 0x04;
26 cmd[4] = 2;
27 cmd[5] = file_id >> 8;
28 cmd[6] = file_id;
29 return apdu_exchange(cmd, 7);
30 }
31
32 select_op(file_id)
33 unsigned file_id;
34 {
35 u_char cmd[7];
36 int rc;
37 unsigned expect_resp_len;
38
39 last_sel_file_record_len = 0;
40 /* SELECT command APDU */
41 cmd[0] = 0x00;
42 cmd[1] = 0xA4;
43 cmd[2] = 0x00;
44 cmd[3] = 0x04;
45 cmd[4] = 2;
46 cmd[5] = file_id >> 8;
47 cmd[6] = file_id;
48 rc = apdu_exchange(cmd, 7);
49 if (rc < 0)
50 return(rc);
51 if ((sim_resp_sw & 0xFF00) != 0x6100) {
52 fprintf(stderr,
53 "error or unexpected SW response to SELECT of 0x%04X: %04X\n",
54 file_id, sim_resp_sw);
55 return(-1);
56 }
57 expect_resp_len = sim_resp_sw & 0xFF;
58 /* GET RESPONSE follow-up */
59 cmd[1] = 0xC0;
60 cmd[2] = 0;
61 cmd[3] = 0;
62 cmd[4] = expect_resp_len;
63 rc = apdu_exchange(cmd, 5);
64 if (rc < 0)
65 return(rc);
66 if (sim_resp_sw != 0x9000) {
67 fprintf(stderr,
68 "bad SW resp to GET RESPONSE after SELECT: %04X\n",
69 sim_resp_sw);
70 return(-1);
71 }
72 if (sim_resp_data_len != expect_resp_len) {
73 fprintf(stderr,
74 "error: GET RESPONSE after SELECT returned %u bytes, expected %u\n",
75 sim_resp_data_len, expect_resp_len);
76 return(-1);
77 }
78 return(0);
79 }
80
81 select_aid_op(aid, aid_len)
82 u_char *aid;
83 unsigned aid_len;
84 {
85 u_char cmd[21];
86 int rc;
87 unsigned expect_resp_len;
88
89 last_sel_file_record_len = 0;
90 /* SELECT command APDU */
91 cmd[0] = 0x00;
92 cmd[1] = 0xA4;
93 cmd[2] = 0x04;
94 cmd[3] = 0x04;
95 cmd[4] = aid_len;
96 bcopy(aid, cmd + 5, aid_len);
97 rc = apdu_exchange(cmd, aid_len + 5);
98 if (rc < 0)
99 return(rc);
100 if ((sim_resp_sw & 0xFF00) != 0x6100) {
101 fprintf(stderr,
102 "error or unexpected SW response to SELECT by AID: %04X\n",
103 sim_resp_sw);
104 return(-1);
105 }
106 expect_resp_len = sim_resp_sw & 0xFF;
107 /* GET RESPONSE follow-up */
108 cmd[1] = 0xC0;
109 cmd[2] = 0;
110 cmd[3] = 0;
111 cmd[4] = expect_resp_len;
112 rc = apdu_exchange(cmd, 5);
113 if (rc < 0)
114 return(rc);
115 if (sim_resp_sw != 0x9000) {
116 fprintf(stderr,
117 "bad SW resp to GET RESPONSE after SELECT: %04X\n",
118 sim_resp_sw);
119 return(-1);
120 }
121 if (sim_resp_data_len != expect_resp_len) {
122 fprintf(stderr,
123 "error: GET RESPONSE after SELECT returned %u bytes, expected %u\n",
124 sim_resp_data_len, expect_resp_len);
125 return(-1);
126 }
127 return(0);
128 }
129
130 select_resp_header_check(ret_offset, ret_length)
131 unsigned *ret_offset, *ret_length;
132 {
133 unsigned offset, len;
134
135 if (sim_resp_data_len < 2) {
136 tooshort: fprintf(stderr, "error: SELECT response is too short\n");
137 return(-1);
138 }
139 if (sim_resp_data[0] != 0x62) {
140 fprintf(stderr, "error: SELECT response first byte != 0x62\n");
141 return(-1);
142 }
143 len = sim_resp_data[1];
144 if (len <= 0x7F) {
145 offset = 2;
146 return_check: if (offset + len > sim_resp_data_len)
147 goto tooshort;
148 if (ret_offset)
149 *ret_offset = offset;
150 if (ret_length)
151 *ret_length = len;
152 return(0);
153 }
154 if (len != 0x81) {
155 fprintf(stderr, "SELECT response: first length byte is bad\n");
156 return(-1);
157 }
158 if (sim_resp_data_len < 3)
159 goto tooshort;
160 len = sim_resp_data[2];
161 offset = 3;
162 goto return_check;
163 }
164
165 static void
166 check_for_record_struct(tlv)
167 u_char *tlv;
168 {
169 unsigned reclen;
170
171 if (tlv[1] != 5)
172 return;
173 if (tlv[2] & 0x80)
174 return;
175 if ((tlv[2] & 0x38) == 0x38)
176 return;
177 if ((tlv[2] & 0x03) != 0x02)
178 return;
179 reclen = (tlv[4] << 8) | tlv[5];
180 if (reclen < 1 || reclen > 255)
181 return;
182 last_sel_file_record_len = reclen;
183 }
184
185 parse_and_display_select_response(outf)
186 FILE *outf;
187 {
188 unsigned offset, totlen, reclen, n;
189 u_char *dp, *endp;
190 int rc;
191
192 rc = select_resp_header_check(&offset, &totlen);
193 if (rc < 0)
194 return(rc);
195 dp = sim_resp_data + offset;
196 endp = sim_resp_data + offset + totlen;
197 while (dp < endp) {
198 if (endp - dp < 2) {
199 trunc_error: fprintf(stderr,
200 "error: truncated TLV record in SELECT response\n");
201 return(-1);
202 }
203 if ((dp[0] & 0x1F) == 0x1F) {
204 fprintf(stderr,
205 "error: extended tag not supported in SELECT response\n");
206 return(-1);
207 }
208 if (dp[1] & 0x80) {
209 fprintf(stderr,
210 "error: extended length not supported in SELECT response\n");
211 return(-1);
212 }
213 reclen = dp[1] + 2;
214 if (endp - dp < reclen)
215 goto trunc_error;
216 if (dp[0] == 0x82)
217 check_for_record_struct(dp);
218 for (n = 0; n < reclen; n++) {
219 if (n)
220 putc(' ', outf);
221 fprintf(outf, "%02X", *dp++);
222 }
223 putc('\n', outf);
224 }
225 return(0);
226 }
227
228 cmd_select(argc, argv, outf)
229 char **argv;
230 FILE *outf;
231 {
232 int file_id, rc;
233
234 if (isxdigit(argv[1][0]) && isxdigit(argv[1][1]) &&
235 isxdigit(argv[1][2]) && isxdigit(argv[1][3]) && !argv[1][4])
236 file_id = strtoul(argv[1], 0, 16);
237 else
238 file_id = find_symbolic_file_name(argv[1]);
239 if (file_id < 0) {
240 fprintf(stderr,
241 "error: file ID argument is not a hex value or a recognized symbolic name\n");
242 return(-1);
243 }
244 rc = select_op(file_id);
245 if (rc < 0)
246 return(rc);
247 return parse_and_display_select_response(outf);
248 }
249
250 cmd_select_aid(argc, argv, outf)
251 char **argv;
252 FILE *outf;
253 {
254 u_char aid[16];
255 unsigned aid_len;
256 int rc;
257
258 rc = decode_hex_data_from_string(argv[1], aid, 1, 16);
259 if (rc < 0)
260 return(rc);
261 aid_len = rc;
262 rc = select_aid_op(aid, aid_len);
263 if (rc < 0)
264 return(rc);
265 return parse_and_display_select_response(outf);
266 }
267
268 cmd_select_usim(argc, argv, outf)
269 char **argv;
270 FILE *outf;
271 {
272 int rc;
273
274 rc = select_aid_op(std_aid_usim, 7);
275 if (rc < 0)
276 return(rc);
277 return parse_and_display_select_response(outf);
278 }
279
280 cmd_select_isim(argc, argv, outf)
281 char **argv;
282 FILE *outf;
283 {
284 int rc;
285
286 rc = select_aid_op(std_aid_isim, 7);
287 if (rc < 0)
288 return(rc);
289 return parse_and_display_select_response(outf);
290 }
291
292 u_char *
293 extract_select_resp_tag(sought_tag)
294 unsigned sought_tag;
295 {
296 unsigned offset, totlen, reclen;
297 u_char *dp, *endp;
298 int rc;
299
300 rc = select_resp_header_check(&offset, &totlen);
301 if (rc < 0)
302 return(0);
303 dp = sim_resp_data + offset;
304 endp = sim_resp_data + offset + totlen;
305 while (dp < endp) {
306 if (endp - dp < 2) {
307 trunc_error: fprintf(stderr,
308 "error: truncated TLV record in SELECT response\n");
309 return(0);
310 }
311 if ((dp[0] & 0x1F) == 0x1F) {
312 fprintf(stderr,
313 "error: extended tag not supported in SELECT response\n");
314 return(0);
315 }
316 if (dp[1] & 0x80) {
317 fprintf(stderr,
318 "error: extended length not supported in SELECT response\n");
319 return(0);
320 }
321 reclen = dp[1] + 2;
322 if (endp - dp < reclen)
323 goto trunc_error;
324 if (dp[0] == sought_tag)
325 return(dp);
326 dp += reclen;
327 }
328 fprintf(stderr, "error: tag 0x%02X not found in SELECT response\n",
329 sought_tag);
330 return(0);
331 }
332
333 select_resp_get_transparent(lenp)
334 unsigned *lenp;
335 {
336 u_char *tlv;
337
338 tlv = extract_select_resp_tag(0x82);
339 if (!tlv)
340 return(-1);
341 if (tlv[1] != 2) {
342 bad_file_desc: fprintf(stderr, "error: file type is not transparent EF\n");
343 return(-1);
344 }
345 if (tlv[2] & 0x80)
346 goto bad_file_desc;
347 if ((tlv[2] & 0x38) == 0x38)
348 goto bad_file_desc;
349 if ((tlv[2] & 0x07) != 0x01)
350 goto bad_file_desc;
351 tlv = extract_select_resp_tag(0x80);
352 if (!tlv)
353 return(-1);
354 if (tlv[1] != 2) {
355 fprintf(stderr,
356 "error: file size TLV element has wrong length\n");
357 return(-1);
358 }
359 if (lenp)
360 *lenp = (tlv[2] << 8) | tlv[3];
361 return(0);
362 }
363
364 select_resp_get_linear_fixed(rec_len_ret, rec_count_ret)
365 unsigned *rec_len_ret, *rec_count_ret;
366 {
367 u_char *tlv;
368 unsigned reclen;
369
370 tlv = extract_select_resp_tag(0x82);
371 if (!tlv)
372 return(-1);
373 if (tlv[1] != 5) {
374 bad_file_desc: fprintf(stderr, "error: file type is not linear fixed EF\n");
375 return(-1);
376 }
377 if (tlv[2] & 0x80)
378 goto bad_file_desc;
379 if ((tlv[2] & 0x38) == 0x38)
380 goto bad_file_desc;
381 if ((tlv[2] & 0x07) != 0x02)
382 goto bad_file_desc;
383 reclen = (tlv[4] << 8) | tlv[5];
384 if (reclen < 1 || reclen > 255) {
385 fprintf(stderr,
386 "error: SELECT response gives invalid record length\n");
387 return(-1);
388 }
389 if (rec_len_ret)
390 *rec_len_ret = reclen;
391 if (rec_count_ret)
392 *rec_count_ret = tlv[6];
393 return(0);
394 }