00001 
00002 
00003 
00004 
00005 
00006 
00007 
00008 
00009 
00010 
00011 
00012 
00013 
00014 
00015 
00016 
00017 
00018 
00019 
00020 
00021 
00022 
00023 #include "avcodec.h"
00024 #include "dsputil.h"
00025 #include "acelp_pitch_delay.h"
00026 #include "celp_math.h"
00027 
00028 int ff_acelp_decode_8bit_to_1st_delay3(int ac_index)
00029 {
00030     ac_index += 58;
00031     if(ac_index > 254)
00032         ac_index = 3 * ac_index - 510;
00033     return ac_index;
00034 }
00035 
00036 int ff_acelp_decode_4bit_to_2nd_delay3(
00037         int ac_index,
00038         int pitch_delay_min)
00039 {
00040     if(ac_index < 4)
00041         return 3 * (ac_index + pitch_delay_min);
00042     else if(ac_index < 12)
00043         return 3 * pitch_delay_min + ac_index + 6;
00044     else
00045         return 3 * (ac_index + pitch_delay_min) - 18;
00046 }
00047 
00048 int ff_acelp_decode_5_6_bit_to_2nd_delay3(
00049         int ac_index,
00050         int pitch_delay_min)
00051 {
00052         return 3 * pitch_delay_min + ac_index - 2;
00053 }
00054 
00055 int ff_acelp_decode_9bit_to_1st_delay6(int ac_index)
00056 {
00057     if(ac_index < 463)
00058         return ac_index + 105;
00059     else
00060         return 6 * (ac_index - 368);
00061 }
00062 int ff_acelp_decode_6bit_to_2nd_delay6(
00063         int ac_index,
00064         int pitch_delay_min)
00065 {
00066     return 6 * pitch_delay_min + ac_index - 3;
00067 }
00068 
00069 void ff_acelp_update_past_gain(
00070     int16_t* quant_energy,
00071     int gain_corr_factor,
00072     int log2_ma_pred_order,
00073     int erasure)
00074 {
00075     int i;
00076     int avg_gain=quant_energy[(1 << log2_ma_pred_order) - 1]; 
00077 
00078     for(i=(1 << log2_ma_pred_order) - 1; i>0; i--)
00079     {
00080         avg_gain       += quant_energy[i-1];
00081         quant_energy[i] = quant_energy[i-1];
00082     }
00083 
00084     if(erasure)
00085         quant_energy[0] = FFMAX(avg_gain >> log2_ma_pred_order, -10240) - 4096; 
00086     else
00087         quant_energy[0] = (6165 * ((ff_log2(gain_corr_factor) >> 2) - (13 << 13))) >> 13;
00088 }
00089 
00090 int16_t ff_acelp_decode_gain_code(
00091     DSPContext *dsp,
00092     int gain_corr_factor,
00093     const int16_t* fc_v,
00094     int mr_energy,
00095     const int16_t* quant_energy,
00096     const int16_t* ma_prediction_coeff,
00097     int subframe_size,
00098     int ma_pred_order)
00099 {
00100     int i;
00101 
00102     mr_energy <<= 10;
00103 
00104     for(i=0; i<ma_pred_order; i++)
00105         mr_energy += quant_energy[i] * ma_prediction_coeff[i];
00106 
00107 #ifdef G729_BITEXACT
00108     mr_energy += (((-6165LL * ff_log2(dsp->scalarproduct_int16(fc_v, fc_v, subframe_size, 0))) >> 3) & ~0x3ff);
00109 
00110     mr_energy = (5439 * (mr_energy >> 15)) >> 8;           
00111 
00112     return bidir_sal(
00113                ((ff_exp2(mr_energy & 0x7fff) + 16) >> 5) * (gain_corr_factor >> 1),
00114                (mr_energy >> 15) - 25
00115            );
00116 #else
00117     mr_energy = gain_corr_factor * exp(M_LN10 / (20 << 23) * mr_energy) /
00118                 sqrt(dsp->scalarproduct_int16(fc_v, fc_v, subframe_size, 0));
00119     return mr_energy >> 12;
00120 #endif
00121 }