void interpolate_isp( int16 isp_old[], /* input : isps from past frame */ int16 isp_new[], /* input : isps from present frame */ const int16 frac[], /* input : fraction for 3 first subfr (Q15) */ int16 Az[] /* output: LP coefficients in 4 subframes */ ) { int16 i, k, fac_old, fac_new; int16 isp[M]; int32 L_tmp; for (k = 0; k < 3; k++) { fac_new = frac[k]; fac_old = add_int16(sub_int16(32767, fac_new), 1); /* 1.0 - fac_new */ for (i = 0; i < M; i++) { L_tmp = mul_16by16_to_int32(isp_old[i], fac_old); L_tmp = mac_16by16_to_int32(L_tmp, isp_new[i], fac_new); isp[i] = amr_wb_round(L_tmp); } Isp_Az(isp, Az, M, 0); Az += MP1; } /* 4th subframe: isp_new (frac=1.0) */ Isp_Az(isp_new, Az, M, 0); return; }
/* adjust gain according to energy of code */ /* past_gain_code(Q3) * gcode_inov(Q12) => Q16 */ //调整增益根据能量代码 *gain_cod = mul_16by16_to_int32(*past_gain_code, gcode_inov); return; } /* * Compute gcode0 * = Sum(i=0,1) pred[i]*past_qua_en[i] + mean_ener - ener_code */ L_tmp = L_deposit_h(MEAN_ENER); /* MEAN_ENER in Q16 */ L_tmp = shl_int32(L_tmp, 8); /* From Q16 to Q24 */ L_tmp = mac_16by16_to_int32(L_tmp, pred[0], past_qua_en[0]); /* Q13*Q10 -> Q24 */ L_tmp = mac_16by16_to_int32(L_tmp, pred[1], past_qua_en[1]); /* Q13*Q10 -> Q24 */ L_tmp = mac_16by16_to_int32(L_tmp, pred[2], past_qua_en[2]); /* Q13*Q10 -> Q24 */ L_tmp = mac_16by16_to_int32(L_tmp, pred[3], past_qua_en[3]); /* Q13*Q10 -> Q24 */ gcode0 = extract_h(L_tmp); /* From Q24 to Q8 */ /* * gcode0 = pow(10.0, gcode0/20) * = pow(2, 3.321928*gcode0/20) * = pow(2, 0.166096*gcode0) */ L_tmp = ((int32)gcode0 * 5443) >> 7; /* *0.166096 in Q15 -> Q24 */ int32_to_dpf(L_tmp, &exp_gcode0, &frac); /* Extract exponant of gcode0 */
void agc2_amr_wb( int16 * sig_in, /* (i) : postfilter input signal */ int16 * sig_out, /* (i/o) : postfilter output signal */ int16 l_trm /* (i) : subframe size */ ) { int16 i, exp; int16 gain_in, gain_out, g0; int32 s; int16 temp; /* calculate gain_out with exponent */ temp = sig_out[0] >> 2; s = fxp_mul_16by16(temp, temp) << 1; for (i = 1; i < l_trm; i++) { temp = sig_out[i] >> 2; s = mac_16by16_to_int32(s, temp, temp); } if (s == 0) { return; } exp = normalize_amr_wb(s) - 1; gain_out = amr_wb_round(s << exp); /* calculate gain_in with exponent */ temp = sig_in[0] >> 2; s = mul_16by16_to_int32(temp, temp); for (i = 1; i < l_trm; i++) { temp = sig_in[i] >> 2; s = mac_16by16_to_int32(s, temp, temp); } if (s == 0) { g0 = 0; } else { i = normalize_amr_wb(s); gain_in = amr_wb_round(s << i); exp -= i; /* * g0 = sqrt(gain_in/gain_out) */ s = div_16by16(gain_out, gain_in); s = shl_int32(s, 7); /* s = gain_out / gain_in */ s = shr_int32(s, exp); /* add exponent */ s = one_ov_sqrt(s); g0 = amr_wb_round(shl_int32(s, 9)); } /* sig_out(n) = gain(n) sig_out(n) */ for (i = 0; i < l_trm; i++) { sig_out[i] = extract_h(shl_int32(fxp_mul_16by16(sig_out[i], g0), 3)); } return; }