annotate libcommon/dumpdirfunc.c @ 215:3a2f43460582

fc-simtool pnn-write command implemented
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 07 Mar 2021 08:35:57 +0000
parents dcfec53643c5
children
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
1 /*
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
2 * This module implements the common function for dumping EF_DIR.
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
3 */
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
4
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
5 #include <sys/types.h>
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
6 #include <stdio.h>
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
7 #include "simresp.h"
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
8
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
9 static void
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
10 dump_aid(tlv, outf)
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
11 u_char *tlv;
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
12 FILE *outf;
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
13 {
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
14 unsigned reclen, n;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
15
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
16 reclen = tlv[1];
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
17 fputs(" AID:", outf);
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
18 for (n = 0; n < reclen; n++)
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
19 fprintf(outf, " %02X", tlv[n+2]);
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
20 putc('\n', outf);
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
21 }
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
22
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
23 static void
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
24 dump_label(tlv, outf)
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
25 u_char *tlv;
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
26 FILE *outf;
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
27 {
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
28 int rc;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
29 unsigned textlen;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
30
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
31 fputs(" Label: ", outf);
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
32 rc = validate_alpha_field(tlv + 2, tlv[1], &textlen);
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
33 if (rc < 0) {
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
34 fputs("malformed\n", outf);
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
35 return;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
36 }
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
37 print_alpha_field(tlv + 2, textlen, outf);
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
38 putc('\n', outf);
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
39 }
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
40
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
41 static void
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
42 dump_unknown_tlv(tlv, outf)
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
43 u_char *tlv;
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
44 FILE *outf;
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
45 {
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
46 unsigned reclen, n;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
47
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
48 reclen = tlv[1] + 2;
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
49 fputs(" TLV:", outf);
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
50 for (n = 0; n < reclen; n++)
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
51 fprintf(outf, " %02X", tlv[n]);
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
52 putc('\n', outf);
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
53 }
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
54
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
55 void
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
56 dump_efdir_record(outf)
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
57 FILE *outf;
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
58 {
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
59 unsigned totlen, reclen;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
60 u_char *dp, *endp;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
61
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
62 if (sim_resp_data[0] != 0x61) {
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
63 fprintf(outf, " bad: first byte != 0x61\n");
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
64 return;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
65 }
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
66 totlen = sim_resp_data[1];
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
67 if (totlen < 3 || totlen > 0x7F) {
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
68 fprintf(outf, " bad: global length byte 0x%02X is invalid\n",
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
69 totlen);
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
70 return;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
71 }
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
72 if (totlen + 2 > sim_resp_data_len) {
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
73 fprintf(outf,
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
74 " bad: TLV global length exceeds EF record length\n");
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
75 return;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
76 }
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
77 dp = sim_resp_data + 2;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
78 endp = sim_resp_data + 2 + totlen;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
79 while (dp < endp) {
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
80 if (endp - dp < 2) {
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
81 trunc_error: fprintf(outf, " bad: truncated TLV record\n");
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
82 return;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
83 }
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
84 if ((dp[0] & 0x1F) == 0x1F) {
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
85 fprintf(outf, " bad: extended tag not supported\n");
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
86 return;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
87 }
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
88 if (dp[1] & 0x80) {
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
89 fprintf(outf, " bad: extended length not supported\n");
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
90 return;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
91 }
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
92 reclen = dp[1] + 2;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
93 if (endp - dp < reclen)
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
94 goto trunc_error;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
95 switch (dp[0]) {
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
96 case 0x4F:
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
97 dump_aid(dp, outf);
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
98 break;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
99 case 0x50:
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
100 dump_label(dp, outf);
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
101 break;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
102 default:
106
dcfec53643c5 EF_DIR dump commands support output redirection
Mychaela Falconia <falcon@freecalypso.org>
parents: 6
diff changeset
103 dump_unknown_tlv(dp, outf);
6
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
104 }
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
105 dp += reclen;
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
106 }
2c72709e0891 EF_DIR dump meaty function factored out into libcommon
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
107 }