FreeCalypso > hg > freecalypso-hwlab

annotate uicc/select.c @ 139:6c6e8705dc70

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