comparison simtool/dispatch.c @ 10:ddd767f6e15b

fc-simtool ported over
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 14 Mar 2021 07:11:25 +0000
parents
children
comparison
equal deleted inserted replaced
9:c9ef9e91dd8e 10:ddd767f6e15b
1 /*
2 * This module implements the command dispatch for fc-simtool
3 */
4
5 #include <ctype.h>
6 #include <stdio.h>
7 #include <string.h>
8 #include <strings.h>
9 #include <stdlib.h>
10
11 extern int cmd_a38();
12 extern int cmd_apdu();
13 extern int cmd_atr();
14 extern int cmd_bfsearch();
15 extern int cmd_bfsearch_full();
16 extern int cmd_cd();
17 extern int cmd_change_chv();
18 extern int cmd_disable_chv1();
19 extern int cmd_disable_chv1_rpt();
20 extern int cmd_enable_chv1();
21 extern int cmd_enable_chv1_rpt();
22 extern int cmd_envelope();
23 extern int cmd_envelope_imm();
24 extern int cmd_erase_file();
25 extern int cmd_exec();
26 extern int cmd_exit();
27 extern int cmd_fix_sysmo_msisdn();
28 extern int cmd_fplmn_dump();
29 extern int cmd_fplmn_erase();
30 extern int cmd_fplmn_erase_all();
31 extern int cmd_fplmn_write();
32 extern int cmd_fplmn_write_list();
33 extern int cmd_get_response();
34 extern int cmd_grcard1_set_adm();
35 extern int cmd_grcard1_set_ki();
36 extern int cmd_grcard1_set_pin();
37 extern int cmd_grcard2_set_adm5();
38 extern int cmd_grcard2_set_adm5_hex();
39 extern int cmd_grcard2_set_comp128();
40 extern int cmd_grcard2_set_ki();
41 extern int cmd_grcard2_set_pin();
42 extern int cmd_grcard2_set_puk();
43 extern int cmd_grcard2_set_super();
44 extern int cmd_grcard2_set_super_hex();
45 extern int cmd_iccid();
46 extern int cmd_imsi();
47 extern int cmd_imsi_raw();
48 extern int cmd_inval_adn();
49 extern int cmd_lnd_dump();
50 extern int cmd_lnd_erase();
51 extern int cmd_lnd_restore();
52 extern int cmd_lnd_write();
53 extern int cmd_opl_dump();
54 extern int cmd_opl_erase();
55 extern int cmd_opl_write();
56 extern int cmd_pb_dump();
57 extern int cmd_pb_dump_rec();
58 extern int cmd_pb_erase();
59 extern int cmd_pb_erase_one();
60 extern int cmd_pb_erase_range();
61 extern int cmd_pb_restore();
62 extern int cmd_pb_update();
63 extern int cmd_pb_update_imm();
64 extern int cmd_pb_update_imm_hex();
65 extern int cmd_plmnsel_dump();
66 extern int cmd_plmnsel_erase();
67 extern int cmd_plmnsel_erase_all();
68 extern int cmd_plmnsel_write();
69 extern int cmd_plmnsel_write_list();
70 extern int cmd_pnn_dump();
71 extern int cmd_pnn_erase();
72 extern int cmd_pnn_write();
73 extern int cmd_readbin();
74 extern int cmd_readef();
75 extern int cmd_readrec();
76 extern int cmd_rehab_adn();
77 extern int cmd_rehab_imsi();
78 extern int cmd_rehab_loci();
79 extern int cmd_restore_file();
80 extern int cmd_savebin();
81 extern int cmd_save_sms_bin();
82 extern int cmd_select();
83 extern int cmd_sim_resp();
84 extern int cmd_sms_erase_all();
85 extern int cmd_sms_erase_one();
86 extern int cmd_sms_erase_range();
87 extern int cmd_smsp_dump();
88 extern int cmd_smsp_erase_all();
89 extern int cmd_smsp_erase_one();
90 extern int cmd_smsp_erase_range();
91 extern int cmd_smsp_restore();
92 extern int cmd_smsp_set();
93 extern int cmd_smsp_set_tag();
94 extern int cmd_spn();
95 extern int cmd_sst();
96 extern int cmd_telecom_sum();
97 extern int cmd_terminal_profile();
98 extern int cmd_uicc_dir();
99 extern int cmd_unblock_chv();
100 extern int cmd_update_bin();
101 extern int cmd_update_bin_imm();
102 extern int cmd_update_rec();
103 extern int cmd_update_rec_fill();
104 extern int cmd_update_rec_imm();
105 extern int cmd_user_sum();
106 extern int cmd_verify_chv();
107 extern int cmd_verify_ext();
108 extern int cmd_verify_hex();
109 extern int cmd_verify_sjs1_adm1();
110 extern int cmd_write_acc();
111 extern int cmd_write_iccid();
112 extern int cmd_write_iccid_sh18();
113 extern int cmd_write_iccid_sh19();
114 extern int cmd_write_imsi();
115 extern int cmd_write_imsi_sh();
116 extern int cmd_write_spn();
117 extern int cmd_write_sst();
118
119 extern int current_ef_inval();
120 extern int current_ef_rehab();
121
122 static struct cmdtab {
123 char *cmd;
124 int minargs;
125 int maxargs;
126 int allow_redir;
127 int (*func)();
128 } cmdtab[] = {
129 {"a38", 1, 1, 1, cmd_a38},
130 {"apdu", 1, 1, 0, cmd_apdu},
131 {"atr", 0, 0, 0, cmd_atr},
132 {"bfsearch", 1, 18, 1, cmd_bfsearch},
133 {"bfsearch-full", 0, 0, 1, cmd_bfsearch_full},
134 {"bfsearch-mf", 0, 0, 1, cmd_bfsearch_full},
135 {"cd", 1, 1, 0, cmd_cd},
136 {"change-chv1", 2, 2, 0, cmd_change_chv},
137 {"change-chv2", 2, 2, 0, cmd_change_chv},
138 {"change-pin1", 2, 2, 0, cmd_change_chv},
139 {"change-pin2", 2, 2, 0, cmd_change_chv},
140 {"cur-ef-inval", 0, 0, 0, current_ef_inval},
141 {"cur-ef-rehab", 0, 0, 0, current_ef_rehab},
142 {"disable-chv1", 1, 1, 0, cmd_disable_chv1},
143 {"disable-chv1-rpt", 1, 1, 0, cmd_disable_chv1_rpt},
144 {"disable-pin1", 1, 1, 0, cmd_disable_chv1},
145 {"disable-pin1-rpt", 1, 1, 0, cmd_disable_chv1_rpt},
146 {"enable-chv1", 1, 1, 0, cmd_enable_chv1},
147 {"enable-chv1-rpt", 1, 1, 0, cmd_enable_chv1_rpt},
148 {"enable-pin1", 1, 1, 0, cmd_enable_chv1},
149 {"enable-pin1-rpt", 1, 1, 0, cmd_enable_chv1_rpt},
150 {"envelope", 1, 1, 0, cmd_envelope},
151 {"envelope-imm", 1, 1, 0, cmd_envelope_imm},
152 {"erase-file", 1, 2, 0, cmd_erase_file},
153 {"exec", 1, 1, 0, cmd_exec},
154 {"exit", 0, 1, 0, cmd_exit},
155 {"fix-sysmo-msisdn", 0, 0, 0, cmd_fix_sysmo_msisdn},
156 {"fplmn-dump", 0, 0, 1, cmd_fplmn_dump},
157 {"fplmn-erase", 1, 2, 0, cmd_fplmn_erase},
158 {"fplmn-erase-all", 0, 0, 0, cmd_fplmn_erase_all},
159 {"fplmn-write", 2, 2, 0, cmd_fplmn_write},
160 {"fplmn-write-list", 1, 1, 0, cmd_fplmn_write_list},
161 {"get-response", 1, 1, 1, cmd_get_response},
162 {"grcard1-set-adm1", 2, 2, 0, cmd_grcard1_set_adm},
163 {"grcard1-set-adm2", 2, 2, 0, cmd_grcard1_set_adm},
164 {"grcard1-set-ki", 1, 1, 0, cmd_grcard1_set_ki},
165 {"grcard1-set-pin1", 2, 2, 0, cmd_grcard1_set_pin},
166 {"grcard1-set-pin2", 2, 2, 0, cmd_grcard1_set_pin},
167 {"grcard2-set-adm5", 1, 1, 0, cmd_grcard2_set_adm5},
168 {"grcard2-set-adm5-hex", 1, 1, 0, cmd_grcard2_set_adm5_hex},
169 {"grcard2-set-comp128", 1, 1, 0, cmd_grcard2_set_comp128},
170 {"grcard2-set-ki", 1, 1, 0, cmd_grcard2_set_ki},
171 {"grcard2-set-pin1", 1, 1, 0, cmd_grcard2_set_pin},
172 {"grcard2-set-pin2", 1, 1, 0, cmd_grcard2_set_pin},
173 {"grcard2-set-puk1", 1, 1, 0, cmd_grcard2_set_puk},
174 {"grcard2-set-puk2", 1, 1, 0, cmd_grcard2_set_puk},
175 {"grcard2-set-super", 1, 1, 0, cmd_grcard2_set_super},
176 {"grcard2-set-super-hex", 1, 1, 0, cmd_grcard2_set_super_hex},
177 {"iccid", 0, 0, 1, cmd_iccid},
178 {"imsi", 0, 0, 1, cmd_imsi},
179 {"imsi-raw", 0, 0, 1, cmd_imsi_raw},
180 {"inval-adn", 0, 0, 0, cmd_inval_adn},
181 {"lnd-dump", 0, 0, 1, cmd_lnd_dump},
182 {"lnd-erase", 0, 0, 0, cmd_lnd_erase},
183 {"lnd-restore", 1, 1, 0, cmd_lnd_restore},
184 {"lnd-write", 1, 2, 0, cmd_lnd_write},
185 {"opl-dump", 0, 0, 1, cmd_opl_dump},
186 {"opl-erase", 1, 2, 0, cmd_opl_erase},
187 {"opl-write", 5, 5, 0, cmd_opl_write},
188 {"pb-dump", 1, 1, 1, cmd_pb_dump},
189 {"pb-dump-rec", 2, 3, 1, cmd_pb_dump_rec},
190 {"pb-erase", 1, 1, 0, cmd_pb_erase},
191 {"pb-erase-one", 2, 2, 0, cmd_pb_erase_one},
192 {"pb-erase-range", 3, 3, 0, cmd_pb_erase_range},
193 {"pb-restore", 2, 2, 0, cmd_pb_restore},
194 {"pb-update", 2, 2, 0, cmd_pb_update},
195 {"pb-update-imm", 3, 4, 0, cmd_pb_update_imm},
196 {"pb-update-imm-hex", 4, 4, 0, cmd_pb_update_imm_hex},
197 {"plmnsel-dump", 0, 0, 1, cmd_plmnsel_dump},
198 {"plmnsel-erase", 1, 2, 0, cmd_plmnsel_erase},
199 {"plmnsel-erase-all", 0, 0, 0, cmd_plmnsel_erase_all},
200 {"plmnsel-write", 2, 2, 0, cmd_plmnsel_write},
201 {"plmnsel-write-list", 1, 1, 0, cmd_plmnsel_write_list},
202 {"pnn-dump", 0, 0, 1, cmd_pnn_dump},
203 {"pnn-erase", 1, 2, 0, cmd_pnn_erase},
204 {"pnn-write", 2, 3, 0, cmd_pnn_write},
205 {"quit", 0, 1, 0, cmd_exit},
206 {"readbin", 2, 2, 1, cmd_readbin},
207 {"readef", 1, 1, 1, cmd_readef},
208 {"readrec", 1, 2, 1, cmd_readrec},
209 {"rehab-adn", 0, 0, 0, cmd_rehab_adn},
210 {"rehab-imsi", 0, 0, 0, cmd_rehab_imsi},
211 {"rehab-loci", 0, 0, 0, cmd_rehab_loci},
212 {"restore-file", 2, 2, 0, cmd_restore_file},
213 {"savebin", 2, 2, 0, cmd_savebin},
214 {"save-sms-bin", 1, 1, 0, cmd_save_sms_bin},
215 {"select", 1, 1, 1, cmd_select},
216 {"sim-resp", 0, 0, 1, cmd_sim_resp},
217 {"sms-erase-all", 0, 0, 0, cmd_sms_erase_all},
218 {"sms-erase-one", 1, 1, 0, cmd_sms_erase_one},
219 {"sms-erase-range", 2, 2, 0, cmd_sms_erase_range},
220 {"smsp-dump", 0, 0, 1, cmd_smsp_dump},
221 {"smsp-erase-all", 0, 0, 0, cmd_smsp_erase_all},
222 {"smsp-erase-one", 1, 1, 0, cmd_smsp_erase_one},
223 {"smsp-erase-range", 2, 2, 0, cmd_smsp_erase_range},
224 {"smsp-restore", 1, 1, 0, cmd_smsp_restore},
225 {"smsp-set", 2, 6, 0, cmd_smsp_set},
226 {"smsp-set-tag", 3, 7, 0, cmd_smsp_set_tag},
227 {"spn", 0, 0, 1, cmd_spn},
228 {"sst", 0, 0, 1, cmd_sst},
229 {"telecom-sum", 0, 0, 0, cmd_telecom_sum},
230 {"terminal-profile", 1, 1, 0, cmd_terminal_profile},
231 {"uicc-dir", 0, 0, 1, cmd_uicc_dir},
232 {"unblock-chv1", 2, 2, 0, cmd_unblock_chv},
233 {"unblock-chv2", 2, 2, 0, cmd_unblock_chv},
234 {"unblock-pin1", 2, 2, 0, cmd_unblock_chv},
235 {"unblock-pin2", 2, 2, 0, cmd_unblock_chv},
236 {"update-bin", 2, 2, 0, cmd_update_bin},
237 {"update-bin-imm", 2, 2, 0, cmd_update_bin_imm},
238 {"update-rec", 2, 2, 0, cmd_update_rec},
239 {"update-rec-fill", 2, 2, 0, cmd_update_rec_fill},
240 {"update-rec-imm", 2, 2, 0, cmd_update_rec_imm},
241 {"user-sum", 0, 0, 1, cmd_user_sum},
242 {"verify-chv1", 1, 1, 0, cmd_verify_chv},
243 {"verify-chv2", 1, 1, 0, cmd_verify_chv},
244 {"verify-ext", 2, 2, 0, cmd_verify_ext},
245 {"verify-hex", 2, 2, 0, cmd_verify_hex},
246 {"verify-pin1", 1, 1, 0, cmd_verify_chv},
247 {"verify-pin2", 1, 1, 0, cmd_verify_chv},
248 {"verify-sjs1-adm1", 1, 1, 0, cmd_verify_sjs1_adm1},
249 {"write-acc", 1, 1, 0, cmd_write_acc},
250 {"write-iccid", 1, 1, 0, cmd_write_iccid},
251 {"write-iccid-sh18", 1, 1, 0, cmd_write_iccid_sh18},
252 {"write-iccid-sh19", 1, 1, 0, cmd_write_iccid_sh19},
253 {"write-imsi", 1, 1, 0, cmd_write_imsi},
254 {"write-imsi-sh", 1, 1, 0, cmd_write_imsi_sh},
255 {"write-spn", 2, 2, 0, cmd_write_spn},
256 {"write-sst", 1, 1, 0, cmd_write_sst},
257 {0, 0, 0, 0, 0}
258 };
259
260 static FILE *
261 handle_output_redir(str)
262 char *str;
263 {
264 char *cp, *fn;
265 FILE *outf;
266
267 for (cp = str; isspace(*cp); cp++)
268 ;
269 if (!*cp || *cp == '#') {
270 fprintf(stderr, "error: no filename after '>'\n");
271 return(0);
272 }
273 for (fn = cp; *cp && !isspace(*cp); cp++)
274 ;
275 if (*cp)
276 *cp++ = '\0';
277 while (isspace(*cp))
278 cp++;
279 if (*cp && *cp != '#') {
280 fprintf(stderr, "error: invalid syntax after '>'\n");
281 return(0);
282 }
283 outf = fopen(fn, "w");
284 if (!outf)
285 perror(fn);
286 return outf;
287 }
288
289 simtool_dispatch_cmd(cmd, is_script)
290 char *cmd;
291 {
292 char *argv[20];
293 char *cp, **ap;
294 struct cmdtab *tp;
295 FILE *outf;
296 int rc;
297
298 for (cp = cmd; isspace(*cp); cp++)
299 ;
300 if (!*cp || *cp == '#')
301 return(0);
302 if (is_script)
303 printf("Script command: %s\n", cp);
304 if (*cp == '!')
305 return system(cp + 1);
306 argv[0] = cp;
307 while (*cp && !isspace(*cp))
308 cp++;
309 if (*cp)
310 *cp++ = '\0';
311 for (tp = cmdtab; tp->cmd; tp++)
312 if (!strcmp(tp->cmd, argv[0]))
313 break;
314 if (!tp->func) {
315 fprintf(stderr, "error: no such command\n");
316 return(-1);
317 }
318 for (ap = argv + 1; ; ) {
319 while (isspace(*cp))
320 cp++;
321 if (!*cp || *cp == '#' || *cp == '>')
322 break;
323 if (ap - argv - 1 >= tp->maxargs) {
324 fprintf(stderr, "error: too many arguments\n");
325 return(-1);
326 }
327 if (*cp == '"') {
328 *ap++ = ++cp;
329 for (;;) {
330 if (!*cp) {
331 unterm_qstring: fprintf(stderr,
332 "error: unterminated quoted string\n");
333 return(-1);
334 }
335 if (*cp == '"')
336 break;
337 if (*cp++ == '\\') {
338 if (!*cp)
339 goto unterm_qstring;
340 cp++;
341 }
342 }
343 *cp++ = '\0';
344 } else {
345 *ap++ = cp;
346 while (*cp && !isspace(*cp))
347 cp++;
348 if (*cp)
349 *cp++ = '\0';
350 }
351 }
352 if (ap - argv - 1 < tp->minargs) {
353 fprintf(stderr, "error: too few arguments\n");
354 return(-1);
355 }
356 *ap = 0;
357 if (*cp == '>') {
358 if (!tp->allow_redir) {
359 fprintf(stderr,
360 "error: command does not support output redirection\n");
361 return(-1);
362 }
363 outf = handle_output_redir(cp + 1);
364 if (!outf)
365 return(-1);
366 } else
367 outf = stdout;
368 rc = tp->func(ap - argv, argv, outf);
369 if (outf != stdout)
370 fclose(outf);
371 return rc;
372 }
373
374 dispatch_ready_argv(argc, argv)
375 char **argv;
376 {
377 struct cmdtab *tp;
378
379 for (tp = cmdtab; tp->cmd; tp++)
380 if (!strcmp(tp->cmd, argv[0]))
381 break;
382 if (!tp->func) {
383 fprintf(stderr, "error: no such command\n");
384 return(-1);
385 }
386 if (argc - 1 > tp->maxargs) {
387 fprintf(stderr, "error: too many arguments\n");
388 return(-1);
389 }
390 if (argc - 1 < tp->minargs) {
391 fprintf(stderr, "error: too few arguments\n");
392 return(-1);
393 }
394 return tp->func(argc, argv, stdout);
395 }