FreeCalypso > hg > gsm-codec-lib

comparison libgsmhr1/unpack_frame.c @ 490:4d80730683d4

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
libgsmhr1: implement TS 101 318 packing and unpacking
author Mychaela Falconia <falcon@freecalypso.org>
date Sat, 15 Jun 2024 05:33:35 +0000
parents
children c275e57132f8
comparison
equal deleted inserted replaced
489:f036e1de5b05 490:4d80730683d4
1 /*
2 * This module holds our gsmhr_unpack_ts101318() function: unpacking a single
3 * GSM-HR codec frame from TS 101 318 packed format into the codec's native
4 * array of parameters.
5 */
6
7 #include <stdint.h>
8 #include "tw_gsmhr.h"
9
10 void gsmhr_unpack_ts101318(const uint8_t *payload, int16_t *params)
11 {
12 const uint8_t *c = payload;
13
14 params[0] = (*c >> 3) & 0x1F;
15 params[1] = (*c++ & 0x7) << 8;
16 params[1] |= *c++;
17 params[2] = (*c++ & 0xFF) << 1;
18 params[2] |= (*c >> 7) & 0x1;
19 params[3] = (*c++ & 0x7F) << 1;
20 params[3] |= (*c >> 7) & 0x1;
21 params[4] = (*c >> 6) & 0x1;
22 params[5] = (*c >> 4) & 0x3;
23 if (params[5]) {
24 /* voiced modes */
25 params[6] = (*c++ & 0xF) << 4;
26 params[6] |= (*c >> 4) & 0xF;
27 params[7] = (*c++ & 0xF) << 5;
28 params[7] |= (*c >> 3) & 0x1F;
29 params[8] = (*c++ & 0x7) << 2;
30 params[8] |= (*c >> 6) & 0x3;
31 params[9] = (*c >> 2) & 0xF;
32 params[10] = (*c++ & 0x3) << 7;
33 params[10] |= (*c >> 1) & 0x7F;
34 params[11] = (*c++ & 0x1) << 4;
35 params[11] |= (*c >> 4) & 0xF;
36 params[12] = *c++ & 0xF;
37 params[13] = (*c++ & 0xFF) << 1;
38 params[13] |= (*c >> 7) & 0x1;
39 params[14] = (*c >> 2) & 0x1F;
40 params[15] = (*c++ & 0x3) << 2;
41 params[15] |= (*c >> 6) & 0x3;
42 params[16] = (*c++ & 0x3F) << 3;
43 params[16] |= (*c >> 5) & 0x7;
44 params[17] = *c++ & 0x1F;
45 } else {
46 /* unvoiced modes */
47 params[6] = (*c++ & 0xF) << 3;
48 params[6] |= (*c >> 5) & 0x7;
49 params[7] = (*c++ & 0x1F) << 2;
50 params[7] |= (*c >> 6) & 0x3;
51 params[8] = (*c >> 1) & 0x1F;
52 params[9] = (*c++ & 0x1) << 6;
53 params[9] |= (*c >> 2) & 0x3F;
54 params[10] = (*c++ & 0x3) << 5;
55 params[10] |= (*c >> 3) & 0x1F;
56 params[11] = (*c++ & 0x7) << 2;
57 params[11] |= (*c >> 6) & 0x3;
58 params[12] = (*c++ & 0x3F) << 1;
59 params[12] |= (*c >> 7) & 0x1;
60 params[13] = *c++ & 0x7F;
61 params[14] = (*c >> 3) & 0x1F;
62 params[15] = (*c++ & 0x7) << 4;
63 params[15] |= (*c >> 4) & 0xF;
64 params[16] = (*c++ & 0xF) << 3;
65 params[16] |= (*c >> 5) & 0x7;
66 params[17] = *c++ & 0x1F;
67 }
68 }