FreeCalypso > hg > fc-pcsc-tools

annotate libutil/gsm7_decode.c @ 183:2545dd27ca38

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
fc-simtool write-imsi-sh command implemented
author Mychaela Falconia <falcon@freecalypso.org>
date Sat, 06 Mar 2021 05:24:26 +0000
parents f064dbcc5f41
children
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
0
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
1 /*
21
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
2 * This module contains functions for decoding GSM7 strings
0
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
3 * that exist in various SIM files.
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
4 */
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
5
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
6 #include <sys/types.h>
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
7 #include <stdio.h>
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
8
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
9 static char gsm7_decode_table[128] = {
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
10 '@', 0, '$', 0, 0, 0, 0, 0,
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
11 0, 0, '\n', 0, 0, '\r', 0, 0,
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
12 0, '_', 0, 0, 0, 0, 0, 0,
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
13 0, 0, 0, 0, 0, 0, 0, 0,
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
14 ' ', '!', '"', '#', 0, '%', '&', 0x27,
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
15 '(', ')', '*', '+', ',', '-', '.', '/',
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
16 '0', '1', '2', '3', '4', '5', '6', '7',
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
17 '8', '9', ':', ';', '<', '=', '>', '?',
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
18 0, 'A', 'B', 'C', 'D', 'E', 'F', 'G',
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
19 'H', 'I', 'J', 'K', 'L', 'M', 'N', 'O',
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
20 'P', 'Q', 'R', 'S', 'T', 'U', 'V', 'W',
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
21 'X', 'Y', 'Z', 0, 0, 0, 0, 0,
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
22 0, 'a', 'b', 'c', 'd', 'e', 'f', 'g',
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
23 'h', 'i', 'j', 'k', 'l', 'm', 'n', 'o',
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
24 'p', 'q', 'r', 's', 't', 'u', 'v', 'w',
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
25 'x', 'y', 'z', 0, 0, 0, 0, 0
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
26 };
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
27
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
28 static char gsm7ext_decode_table[128] = {
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
29 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
30 0, 0, 0, 0, '^', 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
31 0, 0, 0, 0, 0, 0, 0, 0, '{', '}', 0, 0, 0, 0, 0, '\\',
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
32 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, '[', '~', ']', 0,
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
33 '|', 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
34 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
35 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
36 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
37 };
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
38
21
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
39 void
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
40 print_gsm7_string_to_file(data, nbytes, outf)
0
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
41 u_char *data;
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
42 unsigned nbytes;
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
43 FILE *outf;
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
44 {
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
45 u_char *dp, *endp;
21
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
46 int b, c;
0
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
47
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
48 dp = data;
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
49 endp = data + nbytes;
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
50 putc('"', outf);
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
51 while (dp < endp) {
21
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
52 b = *dp++;
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
53 if (b == 0x1B) {
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
54 if (dp >= endp || *dp == 0x1B || *dp == '\n' ||
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
55 *dp == '\r') {
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
56 putc('\\', outf);
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
57 putc('e', outf);
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
58 continue;
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
59 }
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
60 b = *dp++;
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
61 c = gsm7ext_decode_table[b];
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
62 if (!c) {
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
63 fprintf(outf, "\\e\\%02X", b);
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
64 continue;
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
65 }
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
66 } else {
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
67 c = gsm7_decode_table[b];
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
68 if (!c) {
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
69 fprintf(outf, "\\%02X", b);
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
70 continue;
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
71 }
d4dc86195382 GSM7 quoted string output factored out, uses new escapes
Mychaela Falconia <falcon@freecalypso.org>
parents: 0
diff changeset
72 }
0
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
73 if (c == '\n') {
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
74 putc('\\', outf);
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
75 putc('n', outf);
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
76 continue;
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
77 }
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
78 if (c == '\r') {
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
79 putc('\\', outf);
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
80 putc('r', outf);
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
81 continue;
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
82 }
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
83 if (c == '"' || c == '\\')
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
84 putc('\\', outf);
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
85 putc(c, outf);
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
86 }
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
87 putc('"', outf);
f7145c77b7fb starting libcommon: factored out of fc-simtool
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
88 }