FreeCalypso > hg > fc-pcsc-tools
annotate libutil/gsm7_pack.c @ 213:50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sun, 07 Mar 2021 07:40:33 +0000 |
parents | |
children |
rev | line source |
---|---|
213
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1 /* |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2 * This library module implements the function for packing septets into octets. |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
3 */ |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
4 |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
5 #include <sys/types.h> |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
6 |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
7 gsm7_pack(inbuf, outbuf, noctets) |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
8 u_char *inbuf, *outbuf; |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
9 unsigned noctets; |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
10 { |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
11 u_char *ip = inbuf, *op = outbuf; |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
12 unsigned n, c; |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
13 |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
14 for (n = 0; n < noctets; n++) { |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
15 c = n % 7; |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
16 *op++ = ((ip[1] << 7) | ip[0]) >> c; |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
17 if (c == 6) |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
18 ip += 2; |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
19 else |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
20 ip += 1; |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
21 } |
50bdc48e7487
libutil: gsm7_pack.c brought over from FC uptools
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
22 } |