Add AMR codec, for supporting EFR transcoding
[lcr.git] / gsm_audio.c
1 /*****************************************************************************\
2 **                                                                           **
3 ** LCR                                                                       **
4 **                                                                           **
5 **---------------------------------------------------------------------------**
6 ** Copyright: Andreas Eversberg                                              **
7 **                                                                           **
8 ** gsm audio                                                                 **
9 **                                                                           **
10 \*****************************************************************************/ 
11
12 extern "C" {
13 #include "libgsmfr/inc/gsm.h"
14
15
16 /* create gsm instance */
17 void *gsm_fr_create(void)
18 {
19         int value = 1;
20         gsm handle;
21
22         handle = gsm_create();
23         if (handle)
24                 gsm_option(handle, 0/*GSM_OPT_WAV49*/, &value);
25
26         return handle;
27 }
28
29 /* free gsm instance */
30 void gsm_fr_destroy(void *arg)
31 {
32         gsm_destroy((gsm)arg);
33 }
34
35 /* decode frame into samples, return error */
36 int gsm_fr_decode(void *arg, unsigned char *frame, signed short *samples)
37 {
38 //      int value = 0;
39
40 //      gsm_option((gsm)arg, GSM_OPT_FRAME_INDEX, &value);
41         return gsm_decode((gsm)arg, (gsm_byte *)frame, (gsm_signal *)samples);
42 }
43
44 /* encode samples into frame */
45 void gsm_fr_encode(void *arg, signed short *samples, unsigned char *frame)
46 {
47 //      int value = 0;
48         
49 //      gsm_option((gsm)arg, GSM_OPT_FRAME_INDEX, &value);
50         gsm_encode((gsm)arg, (gsm_signal *)samples, (gsm_byte *)frame);
51 }
52
53 #ifdef WITH_GSMAMR
54
55 #include <stdlib.h>
56 #include <string.h>
57
58 #include <opencore-amrnb/interf_dec.h>
59 #include <opencore-amrnb/interf_enc.h>
60
61
62 struct codec_efr_state {
63         void *encoder;
64         void *decoder;
65 };
66
67 /* create gsm instance */
68 void *gsm_amr_create(void)
69 {
70         struct codec_efr_state *st;
71
72         st = (struct codec_efr_state *)calloc(1, sizeof(*st));
73         if (!st)
74                 return NULL;
75
76         st->encoder = Encoder_Interface_init(0);
77         st->decoder = Decoder_Interface_init();
78
79         return (void *)st;
80 }
81
82 /* free gsm instance */
83 void gsm_amr_destroy(void *arg)
84 {
85         struct codec_efr_state *st = (struct codec_efr_state *)arg;
86
87         Decoder_Interface_exit(st->decoder);
88         Encoder_Interface_exit(st->encoder);
89
90         return;
91 }
92
93 enum Mode amr_mode[8] = {
94         MR475,    /* 4.75 kbps */
95         MR515,    /* 5.15 kbps */
96         MR59,     /* 5.90 kbps */
97         MR67,     /* 6.70 kbps */
98         MR74,     /* 7.40 kbps */
99         MR795,    /* 7.95 kbps */
100         MR102,    /* 10.2 kbps */
101         MR122,    /* 12.2 kbps */
102 };
103
104 /* decode frame into samples, return error */
105 int gsm_amr_decode(void *arg, unsigned char *frame, signed short *samples)
106 {
107         struct codec_efr_state *st = (struct codec_efr_state *)arg;
108
109         Decoder_Interface_Decode(
110                 st->decoder,
111                 (const unsigned char*) frame + 1,
112                 (short *) samples,
113                 0
114         );
115
116         return 0;
117 }
118
119 /* encode samples into frame */
120 int gsm_amr_encode(void *arg, signed short *samples, unsigned char *frame, int mode)
121 {
122         struct codec_efr_state *st = (struct codec_efr_state *)arg;
123         int rv;
124
125         rv = Encoder_Interface_Encode(
126                 st->encoder,
127                 amr_mode[mode],
128                 (const short*) samples,
129                 (unsigned char*) frame + 1,
130                 1
131         );
132
133         frame[0] = 0xf0; /* no request */
134
135         return rv;
136 }
137
138 const unsigned short gsm690_12_2_bitorder[244] = {
139           0,   1,   2,   3,   4,   5,   6,   7,   8,   9,
140          10,  11,  12,  13,  14,  23,  15,  16,  17,  18,
141          19,  20,  21,  22,  24,  25,  26,  27,  28,  38,
142         141,  39, 142,  40, 143,  41, 144,  42, 145,  43,
143         146,  44, 147,  45, 148,  46, 149,  47,  97, 150,
144         200,  48,  98, 151, 201,  49,  99, 152, 202,  86,
145         136, 189, 239,  87, 137, 190, 240,  88, 138, 191,
146         241,  91, 194,  92, 195,  93, 196,  94, 197,  95,
147         198,  29,  30,  31,  32,  33,  34,  35,  50, 100,
148         153, 203,  89, 139, 192, 242,  51, 101, 154, 204,
149          55, 105, 158, 208,  90, 140, 193, 243,  59, 109,
150         162, 212,  63, 113, 166, 216,  67, 117, 170, 220,
151          36,  37,  54,  53,  52,  58,  57,  56,  62,  61,
152          60,  66,  65,  64,  70,  69,  68, 104, 103, 102,
153         108, 107, 106, 112, 111, 110, 116, 115, 114, 120,
154         119, 118, 157, 156, 155, 161, 160, 159, 165, 164,
155         163, 169, 168, 167, 173, 172, 171, 207, 206, 205,
156         211, 210, 209, 215, 214, 213, 219, 218, 217, 223,
157         222, 221,  73,  72,  71,  76,  75,  74,  79,  78,
158          77,  82,  81,  80,  85,  84,  83, 123, 122, 121,
159         126, 125, 124, 129, 128, 127, 132, 131, 130, 135,
160         134, 133, 176, 175, 174, 179, 178, 177, 182, 181,
161         180, 185, 184, 183, 188, 187, 186, 226, 225, 224,
162         229, 228, 227, 232, 231, 230, 235, 234, 233, 238,
163         237, 236,  96, 199,
164 };
165
166 /* decode frame into samples, return error */
167 int gsm_efr_decode(void *arg, unsigned char *frame, signed short *samples)
168 {
169         struct codec_efr_state *st = (struct codec_efr_state *)arg;
170         unsigned char cod[32], bit;
171         int i, si;
172
173         cod[0] = 0x3c; /* good AMR 12,2 frame */
174         memset(cod + 1, 0, 31);
175
176         for (i = 0; i < 244; i++) {
177                 si = gsm690_12_2_bitorder[i] + 4;
178                 bit = (frame[si >> 3] >> (7 - (si & 7))) & 1;
179                 cod[(i >> 3) + 1] |= (bit << (7 - (i & 7)));
180         }
181
182         Decoder_Interface_Decode(
183                 st->decoder,
184                 (const unsigned char*) cod,
185                 (short *) samples,
186                 0
187         );
188
189         return 0;
190 }
191
192 /* encode samples into frame */
193 int gsm_efr_encode(void *arg, signed short *samples, unsigned char *frame)
194 {
195         struct codec_efr_state *st = (struct codec_efr_state *)arg;
196         int rv;
197         unsigned char cod[32], bit;
198         int i, di;
199
200         rv = Encoder_Interface_Encode(
201                 st->encoder,
202                 MR122,
203                 (const short*) samples,
204                 (unsigned char*) cod,
205                 1
206         );
207
208         if (cod[0] != 0x3c)
209                 return -1;
210
211         frame[0] = 0xc0;
212         memset(frame + 1, 0, 30);
213
214         for (i = 0; i < 244; i++) {
215                 di = gsm690_12_2_bitorder[i] + 4;
216                 bit = (cod[(i >> 3) + 1] >> (7 - (i & 7))) & 1;
217                 frame[di >> 3] |= (bit << (7 - (di & 7)));
218         }
219         return rv;
220 }
221
222 #endif
223
224 } /* extern "C" */
225