FreeCalypso > hg > freecalypso-hwlab
comparison uicc/pbdump.c @ 136:a21d348e01db
fc-uicc-tool: pb-dump command ported over
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Thu, 04 Feb 2021 03:40:55 +0000 |
parents | |
children |
comparison
equal
deleted
inserted
replaced
135:51d6aaa43a7b | 136:a21d348e01db |
---|---|
1 /* | |
2 * This module implements the pb-dump command. | |
3 */ | |
4 | |
5 #include <sys/types.h> | |
6 #include <string.h> | |
7 #include <strings.h> | |
8 #include <stdio.h> | |
9 #include <stdlib.h> | |
10 #include <pcsclite.h> | |
11 #include <winscard.h> | |
12 #include "globals.h" | |
13 | |
14 static char gsm_address_digits[16] = | |
15 {'0','1','2','3','4','5','6','7','8','9','*','#','a','b','c','?'}; | |
16 | |
17 static | |
18 check_all_blank() | |
19 { | |
20 u_char *dp, *endp; | |
21 | |
22 dp = sim_resp_data; | |
23 endp = sim_resp_data + sim_resp_data_len; | |
24 while (dp < endp) | |
25 if (*dp++ != 0xFF) | |
26 return(0); | |
27 return(1); | |
28 } | |
29 | |
30 static | |
31 decode_number(data, nbytes, out) | |
32 u_char *data; | |
33 unsigned nbytes; | |
34 char *out; | |
35 { | |
36 u_char *dp, *endp; | |
37 int c; | |
38 | |
39 dp = data; | |
40 endp = data + nbytes; | |
41 while (dp < endp) { | |
42 c = *dp & 0xF; | |
43 if (c == 0xF) | |
44 return(-1); | |
45 *out++ = gsm_address_digits[c]; | |
46 c = *dp >> 4; | |
47 if (c == 0xF) { | |
48 if (dp + 1 == endp) | |
49 break; | |
50 else | |
51 return(-1); | |
52 } | |
53 *out++ = gsm_address_digits[c]; | |
54 dp++; | |
55 } | |
56 *out = '\0'; | |
57 return(0); | |
58 } | |
59 | |
60 static | |
61 check_blank_area(dp, endp) | |
62 u_char *dp, *endp; | |
63 { | |
64 while (dp < endp) | |
65 if (*dp++ != 0xFF) | |
66 return(-1); | |
67 return(0); | |
68 } | |
69 | |
70 static void | |
71 dump_record(recno, record_len, outf) | |
72 unsigned recno, record_len; | |
73 FILE *outf; | |
74 { | |
75 int rc; | |
76 unsigned textlen; | |
77 u_char *fixp; | |
78 char digits[21]; | |
79 | |
80 fprintf(outf, "#%u: ", recno); | |
81 if (record_len > 14) { | |
82 rc = validate_alpha_field(sim_resp_data, | |
83 record_len - 14, | |
84 &textlen); | |
85 if (rc < 0) { | |
86 malformed: fprintf(outf, "malformed record\n"); | |
87 return; | |
88 } | |
89 } else | |
90 textlen = 0; | |
91 fixp = sim_resp_data + sim_resp_data_len - 14; | |
92 if (fixp[0] < 2 || fixp[0] > 11) | |
93 goto malformed; | |
94 rc = decode_number(fixp + 2, fixp[0] - 1, digits); | |
95 if (rc < 0) | |
96 goto malformed; | |
97 rc = check_blank_area(fixp + 1 + fixp[0], fixp + 12); | |
98 if (rc < 0) | |
99 goto malformed; | |
100 /* all checks passed */ | |
101 fprintf(outf, "%s,0x%02X ", digits, fixp[1]); | |
102 if (fixp[12] != 0xFF) | |
103 fprintf(outf, "CCP=%u ", fixp[12]); | |
104 if (fixp[13] != 0xFF) | |
105 fprintf(outf, "EXT=%u ", fixp[13]); | |
106 print_alpha_field(sim_resp_data, textlen, outf); | |
107 putc('\n', outf); | |
108 } | |
109 | |
110 cmd_pb_dump(argc, argv) | |
111 char **argv; | |
112 { | |
113 int rc; | |
114 FILE *outf; | |
115 unsigned recno; | |
116 unsigned record_len, record_count; | |
117 | |
118 rc = phonebook_op_common(argv[1], &record_len, &record_count); | |
119 if (rc < 0) | |
120 return(rc); | |
121 if (argv[2]) { | |
122 outf = fopen(argv[2], "w"); | |
123 if (!outf) { | |
124 perror(argv[2]); | |
125 return(-1); | |
126 } | |
127 } else | |
128 outf = stdout; | |
129 for (recno = 1; recno <= record_count; recno++) { | |
130 rc = readrec_op(recno, 0x04, record_len); | |
131 if (rc < 0) { | |
132 if (argv[2]) | |
133 fclose(outf); | |
134 return(rc); | |
135 } | |
136 if (check_all_blank()) | |
137 continue; | |
138 dump_record(recno, record_len, outf); | |
139 } | |
140 if (argv[2]) | |
141 fclose(outf); | |
142 return(0); | |
143 } | |
144 | |
145 cmd_pb_dump_rec(argc, argv) | |
146 char **argv; | |
147 { | |
148 int rc; | |
149 unsigned recno, startrec, endrec; | |
150 unsigned record_len, record_count; | |
151 | |
152 rc = phonebook_op_common(argv[1], &record_len, &record_count); | |
153 if (rc < 0) | |
154 return(rc); | |
155 startrec = strtoul(argv[2], 0, 0); | |
156 if (startrec < 1 || startrec > record_count) { | |
157 fprintf(stderr, | |
158 "error: specified starting record number is invalid\n"); | |
159 return(-1); | |
160 } | |
161 if (argv[3]) { | |
162 endrec = strtoul(argv[3], 0, 0); | |
163 if (endrec < 1 || endrec > record_count) { | |
164 fprintf(stderr, | |
165 "error: specified final record number is invalid\n"); | |
166 return(-1); | |
167 } | |
168 if (startrec > endrec) { | |
169 fprintf(stderr, | |
170 "error: reverse record range specified\n"); | |
171 return(-1); | |
172 } | |
173 } else | |
174 endrec = startrec; | |
175 for (recno = startrec; recno <= endrec; recno++) { | |
176 rc = readrec_op(recno, 0x04, record_len); | |
177 if (rc < 0) | |
178 return(rc); | |
179 if (check_all_blank()) | |
180 continue; | |
181 dump_record(recno, record_len, stdout); | |
182 } | |
183 return(0); | |
184 } |