@@ -35,6 +35,8 @@ | |||||
#include "celp_filters.h" | #include "celp_filters.h" | ||||
#include "g723_1_data.h" | #include "g723_1_data.h" | ||||
#define CNG_RANDOM_SEED 12345 | |||||
/** | /** | ||||
* G723.1 frame types | * G723.1 frame types | ||||
*/ | */ | ||||
@@ -84,6 +86,7 @@ typedef struct g723_1_context { | |||||
int erased_frames; | int erased_frames; | ||||
int16_t prev_lsp[LPC_ORDER]; | int16_t prev_lsp[LPC_ORDER]; | ||||
int16_t sid_lsp[LPC_ORDER]; | |||||
int16_t prev_excitation[PITCH_MAX]; | int16_t prev_excitation[PITCH_MAX]; | ||||
int16_t excitation[PITCH_MAX + FRAME_LEN + 4]; | int16_t excitation[PITCH_MAX + FRAME_LEN + 4]; | ||||
int16_t synth_mem[LPC_ORDER]; | int16_t synth_mem[LPC_ORDER]; | ||||
@@ -91,6 +94,7 @@ typedef struct g723_1_context { | |||||
int iir_mem[LPC_ORDER]; | int iir_mem[LPC_ORDER]; | ||||
int random_seed; | int random_seed; | ||||
int cng_random_seed; | |||||
int interp_index; | int interp_index; | ||||
int interp_gain; | int interp_gain; | ||||
int sid_gain; | int sid_gain; | ||||
@@ -99,7 +103,7 @@ typedef struct g723_1_context { | |||||
int pf_gain; | int pf_gain; | ||||
int postfilter; | int postfilter; | ||||
int16_t audio[FRAME_LEN + LPC_ORDER + PITCH_MAX]; | |||||
int16_t audio[FRAME_LEN + LPC_ORDER + PITCH_MAX + 4]; | |||||
} G723_1_Context; | } G723_1_Context; | ||||
static av_cold int g723_1_decode_init(AVCodecContext *avctx) | static av_cold int g723_1_decode_init(AVCodecContext *avctx) | ||||
@@ -116,6 +120,10 @@ static av_cold int g723_1_decode_init(AVCodecContext *avctx) | |||||
avctx->coded_frame = &p->frame; | avctx->coded_frame = &p->frame; | ||||
memcpy(p->prev_lsp, dc_lsp, LPC_ORDER * sizeof(*p->prev_lsp)); | memcpy(p->prev_lsp, dc_lsp, LPC_ORDER * sizeof(*p->prev_lsp)); | ||||
memcpy(p->sid_lsp, dc_lsp, LPC_ORDER * sizeof(*p->sid_lsp)); | |||||
p->cng_random_seed = CNG_RANDOM_SEED; | |||||
p->past_frame_type = SID_FRAME; | |||||
return 0; | return 0; | ||||
} | } | ||||
@@ -983,6 +991,201 @@ static void formant_postfilter(G723_1_Context *p, int16_t *lpc, | |||||
} | } | ||||
} | } | ||||
static int sid_gain_to_lsp_index(int gain) | |||||
{ | |||||
if (gain < 0x10) | |||||
return gain << 6; | |||||
else if (gain < 0x20) | |||||
return gain - 8 << 7; | |||||
else | |||||
return gain - 20 << 8; | |||||
} | |||||
static inline int cng_rand(int *state, int base) | |||||
{ | |||||
*state = (*state * 521 + 259) & 0xFFFF; | |||||
return (*state & 0x7FFF) * base >> 15; | |||||
} | |||||
static int estimate_sid_gain(G723_1_Context *p) | |||||
{ | |||||
int i, shift, seg, seg2, t, val, val_add, x, y; | |||||
shift = 16 - p->cur_gain * 2; | |||||
if (shift > 0) | |||||
t = p->sid_gain << shift; | |||||
else | |||||
t = p->sid_gain >> -shift; | |||||
x = t * cng_filt[0] >> 16; | |||||
if (x >= cng_bseg[2]) | |||||
return 0x3F; | |||||
if (x >= cng_bseg[1]) { | |||||
shift = 4; | |||||
seg = 3; | |||||
} else { | |||||
shift = 3; | |||||
seg = (x >= cng_bseg[0]); | |||||
} | |||||
seg2 = FFMIN(seg, 3); | |||||
val = 1 << shift; | |||||
val_add = val >> 1; | |||||
for (i = 0; i < shift; i++) { | |||||
t = seg * 32 + (val << seg2); | |||||
t *= t; | |||||
if (x >= t) | |||||
val += val_add; | |||||
else | |||||
val -= val_add; | |||||
val_add >>= 1; | |||||
} | |||||
t = seg * 32 + (val << seg2); | |||||
y = t * t - x; | |||||
if (y <= 0) { | |||||
t = seg * 32 + (val + 1 << seg2); | |||||
t = t * t - x; | |||||
val = (seg2 - 1 << 4) + val; | |||||
if (t >= y) | |||||
val++; | |||||
} else { | |||||
t = seg * 32 + (val - 1 << seg2); | |||||
t = t * t - x; | |||||
val = (seg2 - 1 << 4) + val; | |||||
if (t >= y) | |||||
val--; | |||||
} | |||||
return val; | |||||
} | |||||
static void generate_noise(G723_1_Context *p) | |||||
{ | |||||
int i, j, idx, t; | |||||
int off[SUBFRAMES]; | |||||
int signs[SUBFRAMES / 2 * 11], pos[SUBFRAMES / 2 * 11]; | |||||
int tmp[SUBFRAME_LEN * 2]; | |||||
int16_t *vector_ptr; | |||||
int64_t sum; | |||||
int b0, c, delta, x, shift; | |||||
p->pitch_lag[0] = cng_rand(&p->cng_random_seed, 21) + 123; | |||||
p->pitch_lag[1] = cng_rand(&p->cng_random_seed, 19) + 123; | |||||
for (i = 0; i < SUBFRAMES; i++) { | |||||
p->subframe[i].ad_cb_gain = cng_rand(&p->cng_random_seed, 50) + 1; | |||||
p->subframe[i].ad_cb_lag = cng_adaptive_cb_lag[i]; | |||||
} | |||||
for (i = 0; i < SUBFRAMES / 2; i++) { | |||||
t = cng_rand(&p->cng_random_seed, 1 << 13); | |||||
off[i * 2] = t & 1; | |||||
off[i * 2 + 1] = ((t >> 1) & 1) + SUBFRAME_LEN; | |||||
t >>= 2; | |||||
for (j = 0; j < 11; j++) { | |||||
signs[i * 11 + j] = (t & 1) * 2 - 1 << 14; | |||||
t >>= 1; | |||||
} | |||||
} | |||||
idx = 0; | |||||
for (i = 0; i < SUBFRAMES; i++) { | |||||
for (j = 0; j < SUBFRAME_LEN / 2; j++) | |||||
tmp[j] = j; | |||||
t = SUBFRAME_LEN / 2; | |||||
for (j = 0; j < pulses[i]; j++, idx++) { | |||||
int idx2 = cng_rand(&p->cng_random_seed, t); | |||||
pos[idx] = tmp[idx2] * 2 + off[i]; | |||||
tmp[idx2] = tmp[--t]; | |||||
} | |||||
} | |||||
vector_ptr = p->audio + LPC_ORDER; | |||||
memcpy(vector_ptr, p->prev_excitation, | |||||
PITCH_MAX * sizeof(*p->excitation)); | |||||
for (i = 0; i < SUBFRAMES; i += 2) { | |||||
gen_acb_excitation(vector_ptr, vector_ptr, | |||||
p->pitch_lag[i >> 1], &p->subframe[i], | |||||
p->cur_rate); | |||||
gen_acb_excitation(vector_ptr + SUBFRAME_LEN, | |||||
vector_ptr + SUBFRAME_LEN, | |||||
p->pitch_lag[i >> 1], &p->subframe[i + 1], | |||||
p->cur_rate); | |||||
t = 0; | |||||
for (j = 0; j < SUBFRAME_LEN * 2; j++) | |||||
t |= FFABS(vector_ptr[j]); | |||||
t = FFMIN(t, 0x7FFF); | |||||
if (!t) { | |||||
shift = 0; | |||||
} else { | |||||
shift = -10 + av_log2(t); | |||||
if (shift < -2) | |||||
shift = -2; | |||||
} | |||||
sum = 0; | |||||
if (shift < 0) { | |||||
for (j = 0; j < SUBFRAME_LEN * 2; j++) { | |||||
t = vector_ptr[j] << -shift; | |||||
sum += t * t; | |||||
tmp[j] = t; | |||||
} | |||||
} else { | |||||
for (j = 0; j < SUBFRAME_LEN * 2; j++) { | |||||
t = vector_ptr[j] >> shift; | |||||
sum += t * t; | |||||
tmp[j] = t; | |||||
} | |||||
} | |||||
b0 = 0; | |||||
for (j = 0; j < 11; j++) | |||||
b0 += tmp[pos[(i / 2) * 11 + j]] * signs[(i / 2) * 11 + j]; | |||||
b0 = b0 * 2 * 2979LL + (1 << 29) >> 30; // approximated division by 11 | |||||
c = p->cur_gain * (p->cur_gain * SUBFRAME_LEN >> 5); | |||||
if (shift * 2 + 3 >= 0) | |||||
c >>= shift * 2 + 3; | |||||
else | |||||
c <<= -(shift * 2 + 3); | |||||
c = (av_clipl_int32(sum << 1) - c) * 2979LL >> 15; | |||||
delta = b0 * b0 * 2 - c; | |||||
if (delta <= 0) { | |||||
x = -b0; | |||||
} else { | |||||
delta = square_root(delta); | |||||
x = delta - b0; | |||||
t = delta + b0; | |||||
if (FFABS(t) < FFABS(x)) | |||||
x = -t; | |||||
} | |||||
shift++; | |||||
if (shift < 0) | |||||
x >>= -shift; | |||||
else | |||||
x <<= shift; | |||||
x = av_clip(x, -10000, 10000); | |||||
for (j = 0; j < 11; j++) { | |||||
idx = (i / 2) * 11 + j; | |||||
vector_ptr[pos[idx]] = av_clip_int16(vector_ptr[pos[idx]] + | |||||
(x * signs[idx] >> 15)); | |||||
} | |||||
/* copy decoded data to serve as a history for the next decoded subframes */ | |||||
memcpy(vector_ptr + PITCH_MAX, vector_ptr, | |||||
sizeof(*vector_ptr) * SUBFRAME_LEN * 2); | |||||
vector_ptr += SUBFRAME_LEN * 2; | |||||
} | |||||
/* Save the excitation for the next frame */ | |||||
memcpy(p->prev_excitation, p->audio + LPC_ORDER + FRAME_LEN, | |||||
PITCH_MAX * sizeof(*p->excitation)); | |||||
} | |||||
static int g723_1_decode_frame(AVCodecContext *avctx, void *data, | static int g723_1_decode_frame(AVCodecContext *avctx, void *data, | ||||
int *got_frame_ptr, AVPacket *avpkt) | int *got_frame_ptr, AVPacket *avpkt) | ||||
{ | { | ||||
@@ -1107,14 +1310,23 @@ static int g723_1_decode_frame(AVCodecContext *avctx, void *data, | |||||
PITCH_MAX * sizeof(*p->excitation)); | PITCH_MAX * sizeof(*p->excitation)); | ||||
} | } | ||||
} | } | ||||
p->cng_random_seed = CNG_RANDOM_SEED; | |||||
} else { | } else { | ||||
memset(out, 0, FRAME_LEN * 2); | |||||
av_log(avctx, AV_LOG_WARNING, | |||||
"G.723.1: Comfort noise generation not supported yet\n"); | |||||
if (p->cur_frame_type == SID_FRAME) { | |||||
p->sid_gain = sid_gain_to_lsp_index(p->subframe[0].amp_index); | |||||
inverse_quant(p->sid_lsp, p->prev_lsp, p->lsp_index, 0); | |||||
} else if (p->past_frame_type == ACTIVE_FRAME) { | |||||
p->sid_gain = estimate_sid_gain(p); | |||||
} | |||||
*got_frame_ptr = 1; | |||||
*(AVFrame *)data = p->frame; | |||||
return frame_size[dec_mode]; | |||||
if (p->past_frame_type == ACTIVE_FRAME) | |||||
p->cur_gain = p->sid_gain; | |||||
else | |||||
p->cur_gain = (p->cur_gain * 7 + p->sid_gain) >> 3; | |||||
generate_noise(p); | |||||
lsp_interpolate(lpc, p->sid_lsp, p->prev_lsp); | |||||
/* Save the lsp_vector for the next frame */ | |||||
memcpy(p->prev_lsp, p->sid_lsp, LPC_ORDER * sizeof(*p->prev_lsp)); | |||||
} | } | ||||
p->past_frame_type = p->cur_frame_type; | p->past_frame_type = p->cur_frame_type; | ||||
@@ -1191,4 +1191,10 @@ static const int16_t postfilter_tbl[2][LPC_ORDER] = { | |||||
{ 24576, 18432, 13824, 10368, 7776, 5832, 4374, 3281, 2460, 1845 } | { 24576, 18432, 13824, 10368, 7776, 5832, 4374, 3281, 2460, 1845 } | ||||
}; | }; | ||||
static const int cng_adaptive_cb_lag[4] = { 1, 0, 1, 3 }; | |||||
static const int cng_filt[4] = { 273, 998, 499, 333 }; | |||||
static const int cng_bseg[3] = { 2048, 18432, 231233 }; | |||||
#endif /* AVCODEC_G723_1_DATA_H */ | #endif /* AVCODEC_G723_1_DATA_H */ |
@@ -27,6 +27,12 @@ fate-g723_1-dec-5: CMD = framecrc -postfilter 1 -i $(SAMPLES)/g723_1/pathd63p.tc | |||||
FATE_G723_1 += fate-g723_1-dec-6 | FATE_G723_1 += fate-g723_1-dec-6 | ||||
fate-g723_1-dec-6: CMD = framecrc -postfilter 1 -i $(SAMPLES)/g723_1/tamed63p.tco | fate-g723_1-dec-6: CMD = framecrc -postfilter 1 -i $(SAMPLES)/g723_1/tamed63p.tco | ||||
FATE_G723_1 += fate-g723_1-dec-7 | |||||
fate-g723_1-dec-7: CMD = framecrc -postfilter 1 -i $(SAMPLES)/g723_1/dtx63b.tco | |||||
FATE_G723_1 += fate-g723_1-dec-8 | |||||
fate-g723_1-dec-8: CMD = framecrc -postfilter 1 -i $(SAMPLES)/g723_1/dtx63e.tco | |||||
FATE_SAMPLES_AVCONV += $(FATE_G723_1) | FATE_SAMPLES_AVCONV += $(FATE_G723_1) | ||||
fate-g723_1: $(FATE_G723_1) | fate-g723_1: $(FATE_G723_1) | ||||
@@ -0,0 +1,12 @@ | |||||
#tb 0: 1/8000 | |||||
0, 0, 0, 240, 480, 0x35e4a1fd | |||||
0, 240, 240, 240, 480, 0x2f7bdd60 | |||||
0, 480, 480, 240, 480, 0x0407e499 | |||||
0, 720, 720, 240, 480, 0x5f5ef209 | |||||
0, 960, 960, 240, 480, 0xe936e8d1 | |||||
0, 1200, 1200, 240, 480, 0x0896ddba | |||||
0, 1440, 1440, 240, 480, 0xa885ea94 | |||||
0, 1680, 1680, 240, 480, 0x40bff3d0 | |||||
0, 1920, 1920, 240, 480, 0xe05ce4c3 | |||||
0, 2160, 2160, 240, 480, 0x80c4f790 | |||||
0, 2400, 2400, 240, 480, 0x65d5e8f9 |
@@ -0,0 +1,121 @@ | |||||
#tb 0: 1/8000 | |||||
0, 0, 0, 240, 480, 0x17930e0f | |||||
0, 240, 240, 240, 480, 0x7c7f4247 | |||||
0, 480, 480, 240, 480, 0xbf3489e5 | |||||
0, 720, 720, 240, 480, 0x24319fc9 | |||||
0, 960, 960, 240, 480, 0xb327eec0 | |||||
0, 1200, 1200, 240, 480, 0xc2ddcbca | |||||
0, 1440, 1440, 240, 480, 0xeebad740 | |||||
0, 1680, 1680, 240, 480, 0x77fcb933 | |||||
0, 1920, 1920, 240, 480, 0x9677c5b7 | |||||
0, 2160, 2160, 240, 480, 0xb49dcb9e | |||||
0, 2400, 2400, 240, 480, 0x0e78d7e6 | |||||
0, 2640, 2640, 240, 480, 0xf752dc3e | |||||
0, 2880, 2880, 240, 480, 0xc95af091 | |||||
0, 3120, 3120, 240, 480, 0xa25de399 | |||||
0, 3360, 3360, 240, 480, 0x34e7e0da | |||||
0, 3600, 3600, 240, 480, 0x6c84e3f4 | |||||
0, 3840, 3840, 240, 480, 0x2c7dda20 | |||||
0, 4080, 4080, 240, 480, 0x00a5f112 | |||||
0, 4320, 4320, 240, 480, 0x943ddd89 | |||||
0, 4560, 4560, 240, 480, 0x4ad4ebac | |||||
0, 4800, 4800, 240, 480, 0xa4ff0aa8 | |||||
0, 5040, 5040, 240, 480, 0xc0f805f2 | |||||
0, 5280, 5280, 240, 480, 0x859ce987 | |||||
0, 5520, 5520, 240, 480, 0x9ebcd0de | |||||
0, 5760, 5760, 240, 480, 0x3de2db0b | |||||
0, 6000, 6000, 240, 480, 0x0affea9c | |||||
0, 6240, 6240, 240, 480, 0xcb1bf81e | |||||
0, 6480, 6480, 240, 480, 0x8a72d71d | |||||
0, 6720, 6720, 240, 480, 0x583cd5cd | |||||
0, 6960, 6960, 240, 480, 0x4be7dc7b | |||||
0, 7200, 7200, 240, 480, 0xb08108c0 | |||||
0, 7440, 7440, 240, 480, 0xd0b3ed59 | |||||
0, 7680, 7680, 240, 480, 0x7d33f822 | |||||
0, 7920, 7920, 240, 480, 0x199c0111 | |||||
0, 8160, 8160, 240, 480, 0x7d29f2a8 | |||||
0, 8400, 8400, 240, 480, 0x424dec5e | |||||
0, 8640, 8640, 240, 480, 0x946cf258 | |||||
0, 8880, 8880, 240, 480, 0xd429da7a | |||||
0, 9120, 9120, 240, 480, 0x0f11df46 | |||||
0, 9360, 9360, 240, 480, 0xf4dce502 | |||||
0, 9600, 9600, 240, 480, 0x01c1de78 | |||||
0, 9840, 9840, 240, 480, 0xd1d3da59 | |||||
0, 10080, 10080, 240, 480, 0x5822f3ec | |||||
0, 10320, 10320, 240, 480, 0xadd5fe67 | |||||
0, 10560, 10560, 240, 480, 0xdcf5f2c3 | |||||
0, 10800, 10800, 240, 480, 0x5176e39b | |||||
0, 11040, 11040, 240, 480, 0xf947e0b1 | |||||
0, 11280, 11280, 240, 480, 0x33b1eb36 | |||||
0, 11520, 11520, 240, 480, 0x57bce9bd | |||||
0, 11760, 11760, 240, 480, 0x806eec1f | |||||
0, 12000, 12000, 240, 480, 0x0a60f94a | |||||
0, 12240, 12240, 240, 480, 0x9eddf27d | |||||
0, 12480, 12480, 240, 480, 0x3d28ef2f | |||||
0, 12720, 12720, 240, 480, 0x52f0e562 | |||||
0, 12960, 12960, 240, 480, 0xf2d6c8a0 | |||||
0, 13200, 13200, 240, 480, 0xfa0df4a1 | |||||
0, 13440, 13440, 240, 480, 0x9cccfda9 | |||||
0, 13680, 13680, 240, 480, 0xa7c1e528 | |||||
0, 13920, 13920, 240, 480, 0xe130e8f9 | |||||
0, 14160, 14160, 240, 480, 0x80f6eabe | |||||
0, 14400, 14400, 240, 480, 0x9bbb027e | |||||
0, 14640, 14640, 240, 480, 0x33cdea7f | |||||
0, 14880, 14880, 240, 480, 0x84d8e761 | |||||
0, 15120, 15120, 240, 480, 0xb99ce457 | |||||
0, 15360, 15360, 240, 480, 0x5dc1e324 | |||||
0, 15600, 15600, 240, 480, 0xc914e6c3 | |||||
0, 15840, 15840, 240, 480, 0x8e77f5c2 | |||||
0, 16080, 16080, 240, 480, 0x3997034d | |||||
0, 16320, 16320, 240, 480, 0x820cfd49 | |||||
0, 16560, 16560, 240, 480, 0x8ad5f24c | |||||
0, 16800, 16800, 240, 480, 0xe21be71c | |||||
0, 17040, 17040, 240, 480, 0x516ae8c8 | |||||
0, 17280, 17280, 240, 480, 0x595bdc3d | |||||
0, 17520, 17520, 240, 480, 0x8a4bee79 | |||||
0, 17760, 17760, 240, 480, 0x307fed64 | |||||
0, 18000, 18000, 240, 480, 0xe71cf219 | |||||
0, 18240, 18240, 240, 480, 0xdb0be1a1 | |||||
0, 18480, 18480, 240, 480, 0x7947dfbd | |||||
0, 18720, 18720, 240, 480, 0x5d90fbf0 | |||||
0, 18960, 18960, 240, 480, 0xa449fc55 | |||||
0, 19200, 19200, 240, 480, 0x45b2f979 | |||||
0, 19440, 19440, 240, 480, 0x2b2be378 | |||||
0, 19680, 19680, 240, 480, 0x2d2edf42 | |||||
0, 19920, 19920, 240, 480, 0x568ee04f | |||||
0, 20160, 20160, 240, 480, 0x66f0debe | |||||
0, 20400, 20400, 240, 480, 0xc943eab7 | |||||
0, 20640, 20640, 240, 480, 0xc9ade3c9 | |||||
0, 20880, 20880, 240, 480, 0x6971f92d | |||||
0, 21120, 21120, 240, 480, 0x48d0ecbc | |||||
0, 21360, 21360, 240, 480, 0xf641dc98 | |||||
0, 21600, 21600, 240, 480, 0xbb18e167 | |||||
0, 21840, 21840, 240, 480, 0x72ce0968 | |||||
0, 22080, 22080, 240, 480, 0x15bee6f6 | |||||
0, 22320, 22320, 240, 480, 0x93d5e91f | |||||
0, 22560, 22560, 240, 480, 0x7aee010b | |||||
0, 22800, 22800, 240, 480, 0x9e82dc87 | |||||
0, 23040, 23040, 240, 480, 0x4ee6f547 | |||||
0, 23280, 23280, 240, 480, 0x3072d102 | |||||
0, 23520, 23520, 240, 480, 0x74d4fb04 | |||||
0, 23760, 23760, 240, 480, 0xc670f958 | |||||
0, 24000, 24000, 240, 480, 0x3965c41f | |||||
0, 24240, 24240, 240, 480, 0x6a2de869 | |||||
0, 24480, 24480, 240, 480, 0xa757f44b | |||||
0, 24720, 24720, 240, 480, 0x94a5168c | |||||
0, 24960, 24960, 240, 480, 0xef0f0c28 | |||||
0, 25200, 25200, 240, 480, 0x3770ebb3 | |||||
0, 25440, 25440, 240, 480, 0x4343de6f | |||||
0, 25680, 25680, 240, 480, 0x3ec8d816 | |||||
0, 25920, 25920, 240, 480, 0x1661e3d3 | |||||
0, 26160, 26160, 240, 480, 0x077cd9fd | |||||
0, 26400, 26400, 240, 480, 0xb5ece07e | |||||
0, 26640, 26640, 240, 480, 0xf303e151 | |||||
0, 26880, 26880, 240, 480, 0x95e4d019 | |||||
0, 27120, 27120, 240, 480, 0x4bd0ddc0 | |||||
0, 27360, 27360, 240, 480, 0x6cebd341 | |||||
0, 27600, 27600, 240, 480, 0xea3fea9e | |||||
0, 27840, 27840, 240, 480, 0x5ad30c3f | |||||
0, 28080, 28080, 240, 480, 0x218c02a5 | |||||
0, 28320, 28320, 240, 480, 0x662decd0 | |||||
0, 28560, 28560, 240, 480, 0x6865e2f2 |