FreeCalypso > hg > freecalypso-hwlab

comparison uicc/pbdump.c @ 136:a21d348e01db

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
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 }