annotate acelp_pitch_delay.c @ 7186:ff5ef7becd94 libavcodec

make sum_of_squares() more generic
author michael
date Thu, 03 Jul 2008 11:50:44 +0000
parents 04da42c2b7b4
children ecb1962c12f3
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
7170
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
1 /*
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
2 * gain code, gain pitch and pitch delay decoding
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
3 *
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
4 * Copyright (c) 2008 Vladimir Voroshilov
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
5 *
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
6 * This file is part of FFmpeg.
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
7 *
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
8 * FFmpeg is free software; you can redistribute it and/or
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
9 * modify it under the terms of the GNU Lesser General Public
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
10 * License as published by the Free Software Foundation; either
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
11 * version 2.1 of the License, or (at your option) any later version.
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
12 *
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
13 * FFmpeg is distributed in the hope that it will be useful,
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
16 * Lesser General Public License for more details.
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
17 *
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
18 * You should have received a copy of the GNU Lesser General Public
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
19 * License along with FFmpeg; if not, write to the Free Software
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
20 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
21 */
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
22
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
23 #include "avcodec.h"
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
24 #include "acelp_pitch_delay.h"
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
25 #include "acelp_math.h"
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
26
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
27 int ff_acelp_decode_8bit_to_1st_delay3(int ac_index)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
28 {
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
29 ac_index += 58;
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
30 if(ac_index > 254)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
31 ac_index = 3 * ac_index - 510;
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
32 return ac_index;
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
33 }
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
34
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
35 int ff_acelp_decode_4bit_to_2nd_delay3(
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
36 int ac_index,
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
37 int pitch_delay_min)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
38 {
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
39 if(ac_index < 4)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
40 return 3 * (ac_index + pitch_delay_min);
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
41 else if(ac_index < 12)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
42 return 3 * pitch_delay_min + ac_index + 6;
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
43 else
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
44 return 3 * (ac_index + pitch_delay_min) - 18;
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
45 }
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
46
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
47 int ff_acelp_decode_5_6_bit_to_2nd_delay3(
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
48 int ac_index,
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
49 int pitch_delay_min)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
50 {
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
51 return 3 * pitch_delay_min + ac_index - 2;
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
52 }
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
53
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
54 int ff_acelp_decode_9bit_to_1st_delay6(int ac_index)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
55 {
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
56 if(ac_index < 463)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
57 return ac_index + 105;
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
58 else
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
59 return 6 * (ac_index - 368);
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
60 }
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
61 int ff_acelp_decode_6bit_to_2nd_delay6(
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
62 int ac_index,
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
63 int pitch_delay_min)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
64 {
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
65 return 6 * pitch_delay_min + ac_index - 3;
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
66 }
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
67
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
68 void ff_acelp_update_past_gain(
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
69 int16_t* quant_energy,
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
70 int gain_corr_factor,
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
71 int log2_ma_pred_order,
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
72 int erasure)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
73 {
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
74 int i;
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
75 int avg_gain=quant_energy[(1 << log2_ma_pred_order) - 1]; // (5.10)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
76
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
77 for(i=(1 << log2_ma_pred_order) - 1; i>0; i--)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
78 {
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
79 avg_gain += quant_energy[i-1];
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
80 quant_energy[i] = quant_energy[i-1];
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
81 }
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
82
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
83 if(erasure)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
84 quant_energy[0] = FFMAX(avg_gain >> log2_ma_pred_order, -10240) - 4096; // -10 and -4 in (5.10)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
85 else
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
86 quant_energy[0] = (6165 * ((ff_log2(gain_corr_factor) >> 2) - (13 << 13))) >> 13;
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
87 }
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
88
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
89 int16_t ff_acelp_decode_gain_code(
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
90 int gain_corr_factor,
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
91 const int16_t* fc_v,
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
92 int mr_energy,
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
93 const int16_t* quant_energy,
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
94 const int16_t* ma_prediction_coeff,
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
95 int subframe_size,
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
96 int ma_pred_order)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
97 {
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
98 int i;
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
99
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
100 mr_energy <<= 10;
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
101
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
102 for(i=0; i<ma_pred_order; i++)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
103 mr_energy += quant_energy[i] * ma_prediction_coeff[i];
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
104
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
105 #ifdef G729_BITEXACT
7186
ff5ef7becd94 make sum_of_squares() more generic
michael
parents: 7170
diff changeset
106 mr_energy += (((-6165LL * ff_log2(dot_product(fc_v, fc_v, subframe_size, 0))) >> 3) & ~0x3ff);
7170
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
107
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
108 mr_energy = (5439 * (mr_energy >> 15)) >> 8; // (0.15) = (0.15) * (7.23)
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
109
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
110 return bidir_sal(
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
111 ((ff_exp2(mr_energy & 0x7fff) + 16) >> 5) * (gain_corr_factor >> 1),
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
112 (mr_energy >> 15) - 25
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
113 );
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
114 #else
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
115 mr_energy = gain_corr_factor * exp(M_LN10 / (20 << 23) * mr_energy) /
7186
ff5ef7becd94 make sum_of_squares() more generic
michael
parents: 7170
diff changeset
116 sqrt(dot_product(fc_v, fc_v, subframe_size, 0));
7170
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
117 return mr_energy >> 12;
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
118 #endif
04da42c2b7b4 gain code, gain pitch and pitch delay decoding for ACELP based codecs
voroshil
parents:
diff changeset
119 }