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