/****************************************************************************** * * * Copyright (C) 2018 The Android Open Source Project * * Licensed under the Apache License, Version 2.0 (the "License"); * you may not use this file except in compliance with the License. * You may obtain a copy of the License at: * * http://www.apache.org/licenses/LICENSE-2.0 * * Unless required by applicable law or agreed to in writing, software * distributed under the License is distributed on an "AS IS" BASIS, * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. * See the License for the specific language governing permissions and * limitations under the License. * ***************************************************************************** * Originally developed and contributed by Ittiam Systems Pvt. Ltd, Bangalore */ #include #include #include #include "ixheaacd_type_def.h" #include "ixheaacd_bitbuffer.h" #include "ixheaacd_interface.h" #include "ixheaacd_tns_usac.h" #include "ixheaacd_cnst.h" #include "ixheaacd_acelp_info.h" #include "ixheaacd_sbrdecsettings.h" #include "ixheaacd_info.h" #include "ixheaacd_sbr_common.h" #include "ixheaacd_drc_data_struct.h" #include "ixheaacd_drc_dec.h" #include "ixheaacd_sbrdecoder.h" #include "ixheaacd_mps_polyphase.h" #include "ixheaacd_sbr_const.h" #include "ixheaacd_env_extr_part.h" #include "ixheaacd_sbr_rom.h" #include "ixheaacd_common_rom.h" #include "ixheaacd_hybrid.h" #include "ixheaacd_sbr_scale.h" #include "ixheaacd_ps_dec.h" #include "ixheaacd_freq_sca.h" #include "ixheaacd_lpp_tran.h" #include "ixheaacd_bitbuffer.h" #include "ixheaacd_env_extr.h" #include "ixheaacd_qmf_dec.h" #include "ixheaacd_env_calc.h" #include "ixheaacd_pvc_dec.h" #include "ixheaacd_sbr_dec.h" #include "ixheaacd_error_standards.h" #include "ixheaacd_sbrqmftrans.h" #include "ixheaacd_qmf_poly.h" #include "ixheaacd_constants.h" #include "ixheaacd_basic_ops32.h" #include "ixheaacd_basic_op.h" #include "ixheaacd_esbr_rom.h" #define SBR_CONST_PMIN 1.0f static FLOAT32 *ixheaacd_map_prot_filter(WORD32 filt_length) { switch (filt_length) { case 4: return (FLOAT32 *)&ixheaacd_sub_samp_qmf_window_coeff[0]; break; case 8: return (FLOAT32 *)&ixheaacd_sub_samp_qmf_window_coeff[40]; break; case 12: return (FLOAT32 *)&ixheaacd_sub_samp_qmf_window_coeff[120]; break; case 16: return (FLOAT32 *)&ixheaacd_sub_samp_qmf_window_coeff[240]; break; case 20: return (FLOAT32 *)&ixheaacd_sub_samp_qmf_window_coeff[400]; break; case 24: return (FLOAT32 *)&ixheaacd_sub_samp_qmf_window_coeff[600]; break; case 32: return (FLOAT32 *)&ixheaacd_sub_samp_qmf_window_coeff[840]; break; case 40: return (FLOAT32 *)&ixheaacd_sub_samp_qmf_window_coeff[1160]; break; default: return (FLOAT32 *)&ixheaacd_sub_samp_qmf_window_coeff[0]; } } WORD32 ixheaacd_qmf_hbe_data_reinit(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, WORD16 *p_freq_band_tab[2], WORD16 *p_num_sfb, WORD32 upsamp_4_flag) { WORD32 synth_size, sfb, patch, stop_patch; if (ptr_hbe_txposer != NULL) { ptr_hbe_txposer->start_band = p_freq_band_tab[LOW][0]; ptr_hbe_txposer->end_band = p_freq_band_tab[LOW][p_num_sfb[LOW]]; ptr_hbe_txposer->synth_size = 4 * ((ptr_hbe_txposer->start_band + 4) / 8 + 1); ptr_hbe_txposer->k_start = ixheaacd_start_subband2kL_tbl[ptr_hbe_txposer->start_band]; ptr_hbe_txposer->upsamp_4_flag = upsamp_4_flag; if (upsamp_4_flag) { if (ptr_hbe_txposer->k_start + ptr_hbe_txposer->synth_size > 16) ptr_hbe_txposer->k_start = 16 - ptr_hbe_txposer->synth_size; } else if (ptr_hbe_txposer->core_frame_length == 768) { if (ptr_hbe_txposer->k_start + ptr_hbe_txposer->synth_size > 24) ptr_hbe_txposer->k_start = 24 - ptr_hbe_txposer->synth_size; } memset(ptr_hbe_txposer->synth_buf, 0, 1280 * sizeof(FLOAT32)); synth_size = ptr_hbe_txposer->synth_size; ptr_hbe_txposer->synth_buf_offset = 18 * synth_size; switch (synth_size) { case 4: ptr_hbe_txposer->synth_cos_tab = (FLOAT32 *)ixheaacd_synth_cos_table_kl_4; ptr_hbe_txposer->analy_cos_sin_tab = (FLOAT32 *)ixheaacd_analy_cos_sin_table_kl_8; ptr_hbe_txposer->ixheaacd_real_synth_fft = &ixheaacd_real_synth_fft_p2; ptr_hbe_txposer->ixheaacd_cmplx_anal_fft = &ixheaacd_cmplx_anal_fft_p2; break; case 8: ptr_hbe_txposer->synth_cos_tab = (FLOAT32 *)ixheaacd_synth_cos_table_kl_8; ptr_hbe_txposer->analy_cos_sin_tab = (FLOAT32 *)ixheaacd_analy_cos_sin_table_kl_16; ptr_hbe_txposer->ixheaacd_real_synth_fft = &ixheaacd_real_synth_fft_p2; ptr_hbe_txposer->ixheaacd_cmplx_anal_fft = &ixheaacd_cmplx_anal_fft_p2; break; case 12: ptr_hbe_txposer->synth_cos_tab = (FLOAT32 *)ixheaacd_synth_cos_table_kl_12; ptr_hbe_txposer->analy_cos_sin_tab = (FLOAT32 *)ixheaacd_analy_cos_sin_table_kl_24; ptr_hbe_txposer->ixheaacd_real_synth_fft = &ixheaacd_real_synth_fft_p3; ptr_hbe_txposer->ixheaacd_cmplx_anal_fft = &ixheaacd_cmplx_anal_fft_p3; break; case 16: ptr_hbe_txposer->synth_cos_tab = (FLOAT32 *)ixheaacd_synth_cos_table_kl_16; ptr_hbe_txposer->analy_cos_sin_tab = (FLOAT32 *)ixheaacd_analy_cos_sin_table_kl_32; ptr_hbe_txposer->ixheaacd_real_synth_fft = &ixheaacd_real_synth_fft_p2; ptr_hbe_txposer->ixheaacd_cmplx_anal_fft = &ixheaacd_cmplx_anal_fft_p2; break; case 20: ptr_hbe_txposer->synth_cos_tab = (FLOAT32 *)ixheaacd_synth_cos_table_kl_20; ptr_hbe_txposer->analy_cos_sin_tab = (FLOAT32 *)ixheaacd_analy_cos_sin_table_kl_40; break; default: ptr_hbe_txposer->synth_cos_tab = (FLOAT32 *)ixheaacd_synth_cos_table_kl_4; ptr_hbe_txposer->analy_cos_sin_tab = (FLOAT32 *)ixheaacd_analy_cos_sin_table_kl_8; ptr_hbe_txposer->ixheaacd_real_synth_fft = &ixheaacd_real_synth_fft_p2; ptr_hbe_txposer->ixheaacd_cmplx_anal_fft = &ixheaacd_cmplx_anal_fft_p2; } ptr_hbe_txposer->synth_wind_coeff = ixheaacd_map_prot_filter(synth_size); memset(ptr_hbe_txposer->analy_buf, 0, 640 * sizeof(FLOAT32)); synth_size = 2 * ptr_hbe_txposer->synth_size; ptr_hbe_txposer->analy_wind_coeff = ixheaacd_map_prot_filter(synth_size); memset(ptr_hbe_txposer->x_over_qmf, 0, MAX_NUM_PATCHES * sizeof(WORD32)); sfb = 0; if (upsamp_4_flag) { stop_patch = MAX_NUM_PATCHES; ptr_hbe_txposer->max_stretch = MAX_STRETCH; } else { stop_patch = MAX_STRETCH; } for (patch = 1; patch <= stop_patch; patch++) { while (sfb <= p_num_sfb[LOW] && p_freq_band_tab[LOW][sfb] <= patch * ptr_hbe_txposer->start_band) sfb++; if (sfb <= p_num_sfb[LOW]) { if ((patch * ptr_hbe_txposer->start_band - p_freq_band_tab[LOW][sfb - 1]) <= 3) { ptr_hbe_txposer->x_over_qmf[patch - 1] = p_freq_band_tab[LOW][sfb - 1]; } else { WORD32 sfb = 0; while (sfb <= p_num_sfb[HIGH] && p_freq_band_tab[HIGH][sfb] <= patch * ptr_hbe_txposer->start_band) sfb++; ptr_hbe_txposer->x_over_qmf[patch - 1] = p_freq_band_tab[HIGH][sfb - 1]; } } else { ptr_hbe_txposer->x_over_qmf[patch - 1] = ptr_hbe_txposer->end_band; ptr_hbe_txposer->max_stretch = min(patch, MAX_STRETCH); break; } } if (ptr_hbe_txposer->k_start < 0) { return -1; } } return 0; } WORD32 ixheaacd_qmf_hbe_apply(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, FLOAT32 qmf_buf_real[][64], FLOAT32 qmf_buf_imag[][64], WORD32 num_columns, FLOAT32 pv_qmf_buf_real[][64], FLOAT32 pv_qmf_buf_imag[][64], WORD32 pitch_in_bins) { WORD32 i, qmf_band_idx; WORD32 qmf_voc_columns = ptr_hbe_txposer->no_bins / 2; WORD32 err_code = 0; memcpy(ptr_hbe_txposer->ptr_input_buf, ptr_hbe_txposer->ptr_input_buf + ptr_hbe_txposer->no_bins * ptr_hbe_txposer->synth_size, ptr_hbe_txposer->synth_size * sizeof(FLOAT32)); err_code = ixheaacd_real_synth_filt(ptr_hbe_txposer, num_columns, qmf_buf_real, qmf_buf_imag); if (err_code) return err_code; for (i = 0; i < HBE_OPER_WIN_LEN - 1; i++) { memcpy(ptr_hbe_txposer->qmf_in_buf[i], ptr_hbe_txposer->qmf_in_buf[i + qmf_voc_columns], TWICE_QMF_SYNTH_CHANNELS_NUM * sizeof(FLOAT32)); } err_code = ixheaacd_complex_anal_filt(ptr_hbe_txposer); if (err_code) return err_code; for (i = 0; i < (ptr_hbe_txposer->hbe_qmf_out_len - ptr_hbe_txposer->no_bins); i++) { memcpy(ptr_hbe_txposer->qmf_out_buf[i], ptr_hbe_txposer->qmf_out_buf[i + ptr_hbe_txposer->no_bins], TWICE_QMF_SYNTH_CHANNELS_NUM * sizeof(FLOAT32)); } for (; i < ptr_hbe_txposer->hbe_qmf_out_len; i++) { memset(ptr_hbe_txposer->qmf_out_buf[i], 0, TWICE_QMF_SYNTH_CHANNELS_NUM * sizeof(FLOAT32)); } err_code = ixheaacd_hbe_post_anal_process(ptr_hbe_txposer, pitch_in_bins, ptr_hbe_txposer->upsamp_4_flag); if (err_code) return err_code; for (i = 0; i < ptr_hbe_txposer->no_bins; i++) { for (qmf_band_idx = ptr_hbe_txposer->start_band; qmf_band_idx < ptr_hbe_txposer->end_band; qmf_band_idx++) { pv_qmf_buf_real[i][qmf_band_idx] = (FLOAT32)(ptr_hbe_txposer->qmf_out_buf[i][2 * qmf_band_idx] * ixheaacd_phase_vocoder_cos_table[qmf_band_idx] - ptr_hbe_txposer->qmf_out_buf[i][2 * qmf_band_idx + 1] * ixheaacd_phase_vocoder_sin_table[qmf_band_idx]); pv_qmf_buf_imag[i][qmf_band_idx] = (FLOAT32)(ptr_hbe_txposer->qmf_out_buf[i][2 * qmf_band_idx] * ixheaacd_phase_vocoder_sin_table[qmf_band_idx] + ptr_hbe_txposer->qmf_out_buf[i][2 * qmf_band_idx + 1] * ixheaacd_phase_vocoder_cos_table[qmf_band_idx]); } } return 0; } VOID ixheaacd_norm_qmf_in_buf_4(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, WORD32 qmf_band_idx) { WORD32 i; FLOAT32 *in_buf = &ptr_hbe_txposer->qmf_in_buf[0][2 * qmf_band_idx]; FLOAT32 *norm_buf = &ptr_hbe_txposer->norm_qmf_in_buf[0][2 * qmf_band_idx]; for (; qmf_band_idx <= ptr_hbe_txposer->x_over_qmf[3]; qmf_band_idx++) { for (i = 0; i < ptr_hbe_txposer->hbe_qmf_in_len; i++) { FLOAT32 mag_scaling_fac = 0.0f; FLOAT32 x_r, x_i, temp; FLOAT64 base = 1e-17; x_r = in_buf[0]; x_i = in_buf[1]; temp = x_r * x_r; base = base + temp; temp = x_i * x_i; base = base + temp; temp = (FLOAT32)sqrt(sqrt(base)); mag_scaling_fac = temp * (FLOAT32)(sqrt(temp)); mag_scaling_fac = 1 / mag_scaling_fac; x_r *= mag_scaling_fac; x_i *= mag_scaling_fac; norm_buf[0] = x_r; norm_buf[1] = x_i; in_buf += 128; norm_buf += 128; } in_buf -= (128 * (ptr_hbe_txposer->hbe_qmf_in_len) - 2); norm_buf -= (128 * (ptr_hbe_txposer->hbe_qmf_in_len) - 2); } } VOID ixheaacd_norm_qmf_in_buf_2(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, WORD32 qmf_band_idx) { WORD32 i; FLOAT32 *in_buf = &ptr_hbe_txposer->qmf_in_buf[0][2 * qmf_band_idx]; FLOAT32 *norm_buf = &ptr_hbe_txposer->norm_qmf_in_buf[0][2 * qmf_band_idx]; for (; qmf_band_idx <= ptr_hbe_txposer->x_over_qmf[1]; qmf_band_idx++) { for (i = 0; i < ptr_hbe_txposer->hbe_qmf_in_len; i++) { FLOAT32 mag_scaling_fac = 0.0f; FLOAT32 x_r, x_i, temp; FLOAT64 base = 1e-17; x_r = in_buf[0]; x_i = in_buf[1]; temp = x_r * x_r; base = base + temp; temp = x_i * x_i; base = base + x_i * x_i; mag_scaling_fac = (FLOAT32)(1.0f / base); mag_scaling_fac = (FLOAT32)sqrt(sqrt(mag_scaling_fac)); x_r *= mag_scaling_fac; x_i *= mag_scaling_fac; norm_buf[0] = x_r; norm_buf[1] = x_i; in_buf += 128; norm_buf += 128; } in_buf -= (128 * (ptr_hbe_txposer->hbe_qmf_in_len) - 2); norm_buf -= (128 * (ptr_hbe_txposer->hbe_qmf_in_len) - 2); } } VOID ixheaacd_hbe_xprod_proc_3(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, WORD32 qmf_band_idx, WORD32 qmf_col_idx, FLOAT32 p, WORD32 pitch_in_bins_idx) { WORD32 tr, n1, n2, max_trans_fac, max_n1, max_n2; WORD32 k, addrshift; WORD32 inp_band_idx = 2 * qmf_band_idx / 3; FLOAT64 temp_fac; FLOAT32 max_mag_value; FLOAT32 mag_zero_band, mag_n1_band, mag_n2_band, temp; FLOAT32 temp_r, temp_i; FLOAT32 mag_cmplx_gain = 1.8856f; FLOAT32 *qmf_in_buf_ri = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + HBE_ZERO_BAND_IDX]; mag_zero_band = qmf_in_buf_ri[2 * inp_band_idx] * qmf_in_buf_ri[2 * inp_band_idx] + qmf_in_buf_ri[2 * inp_band_idx + 1] * qmf_in_buf_ri[2 * inp_band_idx + 1]; max_mag_value = 0; max_n1 = max_n2 = max_trans_fac = 0; for (tr = 1; tr < 3; tr++) { temp_fac = (2.0f * qmf_band_idx + 1 - tr * p) * 0.3333334; n1 = (WORD32)(temp_fac); n2 = (WORD32)(temp_fac + p); mag_n1_band = qmf_in_buf_ri[2 * n1] * qmf_in_buf_ri[2 * n1] + qmf_in_buf_ri[2 * n1 + 1] * qmf_in_buf_ri[2 * n1 + 1]; mag_n2_band = qmf_in_buf_ri[2 * n2] * qmf_in_buf_ri[2 * n2] + qmf_in_buf_ri[2 * n2 + 1] * qmf_in_buf_ri[2 * n2 + 1]; temp = min(mag_n1_band, mag_n2_band); if (temp > max_mag_value) { max_mag_value = temp; max_trans_fac = tr; max_n1 = n1; max_n2 = n2; } } if (max_mag_value > mag_zero_band && max_n1 >= 0 && max_n2 < NO_QMF_SYNTH_CHANNELS) { FLOAT32 vec_y_r[2], vec_y_i[2], vec_o_r[2], vec_o_i[2]; FLOAT32 coeff_real[2], coeff_imag[2]; FLOAT32 d1, d2; WORD32 mid_trans_fac, idx; FLOAT64 base = 1e-17; FLOAT32 mag_scaling_fac = 0; FLOAT32 x_zero_band_r; FLOAT32 x_zero_band_i; x_zero_band_r = 0; x_zero_band_i = 0; mid_trans_fac = 3 - max_trans_fac; if (max_trans_fac == 1) { WORD32 idx; d1 = 0; d2 = 1.5; x_zero_band_r = qmf_in_buf_ri[2 * max_n1]; x_zero_band_i = qmf_in_buf_ri[2 * max_n1 + 1]; idx = max_n2 & 3; idx = (idx + 1) & 3; coeff_real[0] = ixheaacd_hbe_post_anal_proc_interp_coeff[idx][0]; coeff_imag[0] = ixheaacd_hbe_post_anal_proc_interp_coeff[idx][1]; coeff_real[1] = coeff_real[0]; coeff_imag[1] = -coeff_imag[0]; vec_y_r[1] = qmf_in_buf_ri[2 * max_n2]; vec_y_i[1] = qmf_in_buf_ri[2 * max_n2 + 1]; addrshift = -2; temp_r = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + addrshift + HBE_ZERO_BAND_IDX][2 * max_n2]; temp_i = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + addrshift + HBE_ZERO_BAND_IDX][2 * max_n2 + 1]; vec_y_r[0] = coeff_real[1] * temp_r - coeff_imag[1] * temp_i; vec_y_i[0] = coeff_imag[1] * temp_r + coeff_real[1] * temp_i; temp_r = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + addrshift + 1 + HBE_ZERO_BAND_IDX][2 * max_n2]; temp_i = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + addrshift + 1 + HBE_ZERO_BAND_IDX][2 * max_n2 + 1]; vec_y_r[0] += coeff_real[0] * temp_r - coeff_imag[0] * temp_i; vec_y_i[0] += coeff_imag[0] * temp_r + coeff_real[0] * temp_i; } else { WORD32 idx; d1 = 1.5; d2 = 0; mid_trans_fac = max_trans_fac; max_trans_fac = 3 - max_trans_fac; x_zero_band_r = qmf_in_buf_ri[2 * max_n2]; x_zero_band_i = qmf_in_buf_ri[2 * max_n2 + 1]; idx = (max_n1 & 3); idx = (idx + 1) & 3; coeff_real[0] = ixheaacd_hbe_post_anal_proc_interp_coeff[idx][0]; coeff_imag[0] = ixheaacd_hbe_post_anal_proc_interp_coeff[idx][1]; coeff_real[1] = coeff_real[0]; coeff_imag[1] = -coeff_imag[0]; vec_y_r[1] = qmf_in_buf_ri[2 * max_n1]; vec_y_i[1] = qmf_in_buf_ri[2 * max_n1 + 1]; addrshift = -2; temp_r = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + addrshift + HBE_ZERO_BAND_IDX][2 * max_n1]; temp_i = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + addrshift + HBE_ZERO_BAND_IDX][2 * max_n1 + 1]; vec_y_r[0] = coeff_real[1] * temp_r - coeff_imag[1] * temp_i; vec_y_i[0] = coeff_imag[1] * temp_r + coeff_real[1] * temp_i; temp_r = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + addrshift + 1 + HBE_ZERO_BAND_IDX][2 * max_n1]; temp_i = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + addrshift + 1 + HBE_ZERO_BAND_IDX][2 * max_n1 + 1]; vec_y_r[0] += coeff_real[0] * temp_r - coeff_imag[0] * temp_i; vec_y_i[0] += coeff_imag[0] * temp_r + coeff_real[0] * temp_i; } base = 1e-17; base = base + x_zero_band_r * x_zero_band_r; base = base + x_zero_band_i * x_zero_band_i; mag_scaling_fac = (FLOAT32)(ixheaacd_cbrt_calc((FLOAT32)base)); x_zero_band_r *= mag_scaling_fac; x_zero_band_i *= mag_scaling_fac; for (k = 0; k < 2; k++) { base = 1e-17; base = base + vec_y_r[k] * vec_y_r[k]; base = base + vec_y_i[k] * vec_y_i[k]; mag_scaling_fac = (FLOAT32)(ixheaacd_cbrt_calc((FLOAT32)base)); vec_y_r[k] *= mag_scaling_fac; vec_y_i[k] *= mag_scaling_fac; } temp_r = x_zero_band_r; temp_i = x_zero_band_i; for (idx = 0; idx < mid_trans_fac - 1; idx++) { FLOAT32 tmp = x_zero_band_r; x_zero_band_r = x_zero_band_r * temp_r - x_zero_band_i * temp_i; x_zero_band_i = tmp * temp_i + x_zero_band_i * temp_r; } for (k = 0; k < 2; k++) { temp_r = vec_y_r[k]; temp_i = vec_y_i[k]; for (idx = 0; idx < max_trans_fac - 1; idx++) { FLOAT32 tmp = vec_y_r[k]; vec_y_r[k] = vec_y_r[k] * temp_r - vec_y_i[k] * temp_i; vec_y_i[k] = tmp * temp_i + vec_y_i[k] * temp_r; } } for (k = 0; k < 2; k++) { vec_o_r[k] = vec_y_r[k] * x_zero_band_r - vec_y_i[k] * x_zero_band_i; vec_o_i[k] = vec_y_r[k] * x_zero_band_i + vec_y_i[k] * x_zero_band_r; } { FLOAT32 cos_theta = ixheaacd_hbe_x_prod_cos_table_trans_3[(pitch_in_bins_idx << 1) + 0]; FLOAT32 sin_theta = ixheaacd_hbe_x_prod_cos_table_trans_3[(pitch_in_bins_idx << 1) + 1]; if (d2 < d1) { sin_theta = -sin_theta; } temp_r = vec_o_r[0]; temp_i = vec_o_i[0]; vec_o_r[0] = (FLOAT32)(cos_theta * temp_r - sin_theta * temp_i); vec_o_i[0] = (FLOAT32)(cos_theta * temp_i + sin_theta * temp_r); } for (k = 0; k < 2; k++) { ptr_hbe_txposer->qmf_out_buf[qmf_col_idx * 2 + (k + HBE_ZERO_BAND_IDX - 1)][2 * qmf_band_idx] += (FLOAT32)(mag_cmplx_gain * vec_o_r[k]); ptr_hbe_txposer ->qmf_out_buf[qmf_col_idx * 2 + (k + HBE_ZERO_BAND_IDX - 1)] [2 * qmf_band_idx + 1] += (FLOAT32)(mag_cmplx_gain * vec_o_i[k]); } } } VOID ixheaacd_hbe_xprod_proc_4(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, WORD32 qmf_band_idx, WORD32 qmf_col_idx, FLOAT32 p, WORD32 pitch_in_bins_idx) { WORD32 k; WORD32 inp_band_idx = qmf_band_idx >> 1; WORD32 tr, n1, n2, max_trans_fac, max_n1, max_n2; FLOAT64 temp_fac; FLOAT32 max_mag_value, mag_zero_band, mag_n1_band, mag_n2_band, temp; FLOAT32 temp_r, temp_i; FLOAT32 mag_cmplx_gain = 2.0f; FLOAT32 *qmf_in_buf_ri = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + HBE_ZERO_BAND_IDX]; mag_zero_band = qmf_in_buf_ri[2 * inp_band_idx] * qmf_in_buf_ri[2 * inp_band_idx] + qmf_in_buf_ri[2 * inp_band_idx + 1] * qmf_in_buf_ri[2 * inp_band_idx + 1]; max_mag_value = 0; max_n1 = max_n2 = max_trans_fac = 0; for (tr = 1; tr < 4; tr++) { temp_fac = (2.0 * qmf_band_idx + 1 - tr * p) * 0.25; n1 = ((WORD32)(temp_fac)) << 1; n2 = ((WORD32)(temp_fac + p)) << 1; mag_n1_band = qmf_in_buf_ri[n1] * qmf_in_buf_ri[n1] + qmf_in_buf_ri[n1 + 1] * qmf_in_buf_ri[n1 + 1]; mag_n2_band = qmf_in_buf_ri[n2] * qmf_in_buf_ri[n2] + qmf_in_buf_ri[n2 + 1] * qmf_in_buf_ri[n2 + 1]; temp = min(mag_n1_band, mag_n2_band); if (temp > max_mag_value) { max_mag_value = temp; max_trans_fac = tr; max_n1 = n1; max_n2 = n2; } } if (max_mag_value > mag_zero_band && max_n1 >= 0 && max_n2 < TWICE_QMF_SYNTH_CHANNELS_NUM) { FLOAT32 vec_y_r[2], vec_y_i[2], vec_o_r[2], vec_o_i[2]; FLOAT32 d1, d2; WORD32 mid_trans_fac, idx; FLOAT32 x_zero_band_r; FLOAT32 x_zero_band_i; FLOAT64 base = 1e-17; FLOAT32 mag_scaling_fac = 0.0f; x_zero_band_r = 0; x_zero_band_i = 0; mid_trans_fac = 4 - max_trans_fac; if (max_trans_fac == 1) { d1 = 0; d2 = 2; x_zero_band_r = qmf_in_buf_ri[max_n1]; x_zero_band_i = qmf_in_buf_ri[max_n1 + 1]; for (k = 0; k < 2; k++) { vec_y_r[k] = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + HBE_ZERO_BAND_IDX + 2 * (k - 1)][max_n2]; vec_y_i[k] = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + HBE_ZERO_BAND_IDX + 2 * (k - 1)][max_n2 + 1]; } } else if (max_trans_fac == 2) { d1 = 0; d2 = 1; x_zero_band_r = qmf_in_buf_ri[max_n1]; x_zero_band_i = qmf_in_buf_ri[max_n1 + 1]; for (k = 0; k < 2; k++) { vec_y_r[k] = ptr_hbe_txposer ->qmf_in_buf[qmf_col_idx + HBE_ZERO_BAND_IDX + (k - 1)][max_n2]; vec_y_i[k] = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + HBE_ZERO_BAND_IDX + (k - 1)][max_n2 + 1]; } } else { d1 = 2; d2 = 0; mid_trans_fac = max_trans_fac; max_trans_fac = 4 - max_trans_fac; x_zero_band_r = qmf_in_buf_ri[max_n2]; x_zero_band_i = qmf_in_buf_ri[max_n2 + 1]; for (k = 0; k < 2; k++) { vec_y_r[k] = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + HBE_ZERO_BAND_IDX + 2 * (k - 1)][max_n1]; vec_y_i[k] = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + HBE_ZERO_BAND_IDX + 2 * (k - 1)][max_n1 + 1]; } } base = 1e-17; base = base + x_zero_band_r * x_zero_band_r; base = base + x_zero_band_i * x_zero_band_i; { temp = (FLOAT32)sqrt(sqrt(base)); mag_scaling_fac = temp * (FLOAT32)(sqrt(temp)); mag_scaling_fac = 1 / mag_scaling_fac; } x_zero_band_r *= mag_scaling_fac; x_zero_band_i *= mag_scaling_fac; for (k = 0; k < 2; k++) { base = 1e-17; base = base + vec_y_r[k] * vec_y_r[k]; base = base + vec_y_i[k] * vec_y_i[k]; { temp = (FLOAT32)sqrt(sqrt(base)); mag_scaling_fac = temp * (FLOAT32)(sqrt(temp)); mag_scaling_fac = 1 / mag_scaling_fac; } vec_y_r[k] *= mag_scaling_fac; vec_y_i[k] *= mag_scaling_fac; } temp_r = x_zero_band_r; temp_i = x_zero_band_i; for (idx = 0; idx < mid_trans_fac - 1; idx++) { FLOAT32 tmp = x_zero_band_r; x_zero_band_r = x_zero_band_r * temp_r - x_zero_band_i * temp_i; x_zero_band_i = tmp * temp_i + x_zero_band_i * temp_r; } for (k = 0; k < 2; k++) { temp_r = vec_y_r[k]; temp_i = vec_y_i[k]; for (idx = 0; idx < max_trans_fac - 1; idx++) { FLOAT32 tmp = vec_y_r[k]; vec_y_r[k] = vec_y_r[k] * temp_r - vec_y_i[k] * temp_i; vec_y_i[k] = tmp * temp_i + vec_y_i[k] * temp_r; } } for (k = 0; k < 2; k++) { vec_o_r[k] = vec_y_r[k] * x_zero_band_r - vec_y_i[k] * x_zero_band_i; vec_o_i[k] = vec_y_r[k] * x_zero_band_i + vec_y_i[k] * x_zero_band_r; } { FLOAT32 cos_theta; FLOAT32 sin_theta; if (d2 == 1) { cos_theta = ixheaacd_hbe_x_prod_cos_table_trans_4_1[(pitch_in_bins_idx << 1) + 0]; sin_theta = ixheaacd_hbe_x_prod_cos_table_trans_4_1[(pitch_in_bins_idx << 1) + 1]; } else { cos_theta = ixheaacd_hbe_x_prod_cos_table_trans_4[(pitch_in_bins_idx << 1) + 0]; sin_theta = ixheaacd_hbe_x_prod_cos_table_trans_4[(pitch_in_bins_idx << 1) + 1]; if (d2 < d1) { sin_theta = -sin_theta; } } temp_r = vec_o_r[0]; temp_i = vec_o_i[0]; vec_o_r[0] = (FLOAT32)(cos_theta * temp_r - sin_theta * temp_i); vec_o_i[0] = (FLOAT32)(cos_theta * temp_i + sin_theta * temp_r); } for (k = 0; k < 2; k++) { ptr_hbe_txposer->qmf_out_buf[qmf_col_idx * 2 + (k + HBE_ZERO_BAND_IDX - 1)][2 * qmf_band_idx] += (FLOAT32)(mag_cmplx_gain * vec_o_r[k]); ptr_hbe_txposer ->qmf_out_buf[qmf_col_idx * 2 + (k + HBE_ZERO_BAND_IDX - 1)] [2 * qmf_band_idx + 1] += (FLOAT32)(mag_cmplx_gain * vec_o_i[k]); } } } VOID ixheaacd_hbe_post_anal_prod2(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, WORD32 qmf_voc_columns, WORD32 qmf_band_idx) { WORD32 i; FLOAT32 *norm_ptr = &ptr_hbe_txposer->norm_qmf_in_buf[1][2 * qmf_band_idx]; FLOAT32 *out_ptr = &ptr_hbe_txposer->qmf_out_buf[1][2 * qmf_band_idx]; FLOAT32 *x_norm_ptr = &ptr_hbe_txposer->norm_qmf_in_buf[HBE_ZERO_BAND_IDX][2 * qmf_band_idx]; ixheaacd_norm_qmf_in_buf_2(ptr_hbe_txposer, qmf_band_idx); for (; qmf_band_idx < ptr_hbe_txposer->x_over_qmf[1]; qmf_band_idx++) { for (i = 0; i < qmf_voc_columns; i++) { WORD32 k; FLOAT32 x_zero_band_r, x_zero_band_i; x_zero_band_r = *x_norm_ptr++; x_zero_band_i = *x_norm_ptr++; for (k = 0; k < HBE_OPER_BLK_LEN_2; k++) { register FLOAT32 tmp_r, tmp_i; tmp_r = *norm_ptr++; tmp_i = *norm_ptr++; *out_ptr++ += ((tmp_r * x_zero_band_r - tmp_i * x_zero_band_i) * 0.3333333f); *out_ptr++ += ((tmp_r * x_zero_band_i + tmp_i * x_zero_band_r) * 0.3333333f); norm_ptr += 126; out_ptr += 126; } norm_ptr -= 128 * 9; out_ptr -= 128 * 8; x_norm_ptr += 126; } out_ptr -= (128 * 2 * qmf_voc_columns) - 2; norm_ptr -= (128 * qmf_voc_columns) - 2; x_norm_ptr -= (128 * qmf_voc_columns) - 2; } } VOID ixheaacd_hbe_post_anal_prod3(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, WORD32 qmf_voc_columns, WORD32 qmf_band_idx) { WORD32 i, inp_band_idx, rem; FLOAT32 *out_buf = &ptr_hbe_txposer->qmf_out_buf[2][2 * qmf_band_idx]; for (; qmf_band_idx < ptr_hbe_txposer->x_over_qmf[2]; qmf_band_idx++) { FLOAT32 temp_r, temp_i; FLOAT32 temp_r1, temp_i1; const FLOAT32 *ptr_sel, *ptr_sel1; inp_band_idx = (2 * qmf_band_idx) / 3; ptr_sel = &ixheaacd_sel_case[(inp_band_idx + 1) & 3][0]; ptr_sel1 = &ixheaacd_sel_case[((inp_band_idx + 1) & 3) + 1][0]; rem = 2 * qmf_band_idx - 3 * inp_band_idx; if (rem == 0 || rem == 1) { FLOAT32 *in_buf = &ptr_hbe_txposer->qmf_in_buf[0][2 * inp_band_idx]; for (i = 0; i < qmf_voc_columns; i += 1) { WORD32 k; FLOAT32 vec_x[2 * HBE_OPER_WIN_LEN]; FLOAT32 *ptr_vec_x = &vec_x[0]; FLOAT32 x_zero_band_r, x_zero_band_i; FLOAT32 mag_scaling_fac; for (k = 0; k < (HBE_OPER_BLK_LEN_3); k += 2) { FLOAT64 base1; FLOAT64 base = 1e-17; temp_r = in_buf[0]; temp_i = in_buf[1]; in_buf += 256; base1 = base + temp_r * temp_r; base1 = base1 + temp_i * temp_i; mag_scaling_fac = (FLOAT32)(ixheaacd_cbrt_calc((FLOAT32)base1)); ptr_vec_x[0] = temp_r * mag_scaling_fac; ptr_vec_x[1] = temp_i * mag_scaling_fac; temp_r = in_buf[0]; temp_i = in_buf[1]; in_buf -= 128; temp_r1 = ptr_sel[0] * temp_r + ptr_sel[1] * temp_i; temp_i1 = ptr_sel[2] * temp_r + ptr_sel[3] * temp_i; temp_r = in_buf[0]; temp_i = in_buf[1]; temp_r1 += ptr_sel[4] * temp_r + ptr_sel[5] * temp_i; temp_i1 += ptr_sel[6] * temp_r + ptr_sel[7] * temp_i; temp_r1 *= 0.3984033437f; temp_i1 *= 0.3984033437f; base1 = base + temp_r1 * temp_r1; base1 = base1 + temp_i1 * temp_i1; mag_scaling_fac = (FLOAT32)(ixheaacd_cbrt_calc((FLOAT32)base1)); ptr_vec_x[2] = temp_r1 * mag_scaling_fac; ptr_vec_x[3] = temp_i1 * mag_scaling_fac; ptr_vec_x += 4; in_buf += 256; } ptr_vec_x = &vec_x[0]; temp_r = vec_x[2 * (HBE_ZERO_BAND_IDX - 2)]; temp_i = vec_x[(2 * (HBE_ZERO_BAND_IDX - 2)) + 1]; x_zero_band_r = temp_r * temp_r - temp_i * temp_i; x_zero_band_i = temp_r * temp_i + temp_i * temp_r; for (k = 0; k < (HBE_OPER_BLK_LEN_3); k++) { temp_r = ptr_vec_x[0] * x_zero_band_r - ptr_vec_x[1] * x_zero_band_i; temp_i = ptr_vec_x[0] * x_zero_band_i + ptr_vec_x[1] * x_zero_band_r; out_buf[0] += (temp_r * 0.4714045f); out_buf[1] += (temp_i * 0.4714045f); ptr_vec_x += 2; out_buf += 128; } in_buf -= 128 * 11; out_buf -= 128 * 6; } } else { FLOAT32 *in_buf = &ptr_hbe_txposer->qmf_in_buf[0][2 * inp_band_idx]; FLOAT32 *in_buf1 = &ptr_hbe_txposer->qmf_in_buf[0][2 * (inp_band_idx + 1)]; for (i = 0; i < qmf_voc_columns; i++) { WORD32 k; FLOAT32 vec_x[2 * HBE_OPER_WIN_LEN]; FLOAT32 vec_x_cap[2 * HBE_OPER_WIN_LEN]; FLOAT32 x_zero_band_r, x_zero_band_i; FLOAT32 *ptr_vec_x = &vec_x[0]; FLOAT32 *ptr_vec_x_cap = &vec_x_cap[0]; FLOAT32 mag_scaling_fac; for (k = 0; k < (HBE_OPER_BLK_LEN_3); k += 2) { FLOAT32 tmp_vr, tmp_vi; FLOAT32 tmp_cr, tmp_ci; FLOAT64 base1; FLOAT64 base = 1e-17; temp_r1 = in_buf[0]; temp_i1 = in_buf[1]; temp_r = in_buf1[0]; temp_i = in_buf1[1]; base1 = base + temp_r * temp_r; base1 = base1 + temp_i * temp_i; mag_scaling_fac = (FLOAT32)(ixheaacd_cbrt_calc((FLOAT32)base1)); ptr_vec_x[0] = temp_r * mag_scaling_fac; ptr_vec_x[1] = temp_i * mag_scaling_fac; base1 = base + temp_r1 * temp_r1; base1 = base1 + temp_i1 * temp_i1; mag_scaling_fac = (FLOAT32)(ixheaacd_cbrt_calc((FLOAT32)base1)); ptr_vec_x_cap[0] = temp_r1 * mag_scaling_fac; ptr_vec_x_cap[1] = temp_i1 * mag_scaling_fac; in_buf += 256; temp_r = in_buf[0]; temp_i = in_buf[1]; temp_r1 = ptr_sel[0] * temp_r + ptr_sel[1] * temp_i; temp_i1 = ptr_sel[2] * temp_r + ptr_sel[3] * temp_i; in_buf -= 128; temp_r = in_buf[0]; temp_i = in_buf[1]; tmp_cr = temp_r1 + ptr_sel[4] * temp_r + ptr_sel[5] * temp_i; tmp_ci = temp_i1 + ptr_sel[6] * temp_r + ptr_sel[7] * temp_i; in_buf1 += 256; temp_r = in_buf1[0]; temp_i = in_buf1[1]; temp_r1 = ptr_sel1[0] * temp_r + ptr_sel1[1] * temp_i; temp_i1 = ptr_sel1[2] * temp_r + ptr_sel1[3] * temp_i; in_buf1 -= 128; temp_r = in_buf1[0]; temp_i = in_buf1[1]; tmp_vr = temp_r1 + ptr_sel1[4] * temp_r + ptr_sel1[5] * temp_i; tmp_vi = temp_i1 + ptr_sel1[6] * temp_r + ptr_sel1[7] * temp_i; tmp_cr *= 0.3984033437f; tmp_ci *= 0.3984033437f; tmp_vr *= 0.3984033437f; tmp_vi *= 0.3984033437f; base1 = base + tmp_vr * tmp_vr; base1 = base1 + tmp_vi * tmp_vi; mag_scaling_fac = (FLOAT32)(ixheaacd_cbrt_calc((FLOAT32)base1)); ptr_vec_x[2] = tmp_vr * mag_scaling_fac; ptr_vec_x[3] = tmp_vi * mag_scaling_fac; base1 = base + tmp_cr * tmp_cr; base1 = base1 + tmp_ci * tmp_ci; mag_scaling_fac = (FLOAT32)(ixheaacd_cbrt_calc((FLOAT32)base1)); ptr_vec_x_cap[2] = tmp_cr * mag_scaling_fac; ptr_vec_x_cap[3] = tmp_ci * mag_scaling_fac; in_buf += 256; in_buf1 += 256; ptr_vec_x += 4; ptr_vec_x_cap += 4; } ptr_vec_x = &vec_x[0]; ptr_vec_x_cap = &vec_x_cap[0]; temp_r = vec_x_cap[2 * (HBE_ZERO_BAND_IDX - 2)]; temp_i = vec_x_cap[2 * (HBE_ZERO_BAND_IDX - 2) + 1]; temp_r1 = vec_x[2 * (HBE_ZERO_BAND_IDX - 2)]; temp_i1 = vec_x[2 * (HBE_ZERO_BAND_IDX - 2) + 1]; x_zero_band_r = temp_r * temp_r - temp_i * temp_i; x_zero_band_i = temp_r * temp_i + temp_i * temp_r; temp_r = temp_r1 * temp_r1 - temp_i1 * temp_i1; temp_i = temp_r1 * temp_i1 + temp_i1 * temp_r1; for (k = 0; k < (HBE_OPER_BLK_LEN_3); k++) { temp_r1 = ptr_vec_x[0] * x_zero_band_r - ptr_vec_x[1] * x_zero_band_i; temp_i1 = ptr_vec_x[0] * x_zero_band_i + ptr_vec_x[1] * x_zero_band_r; temp_r1 += ptr_vec_x_cap[0] * temp_r - ptr_vec_x_cap[1] * temp_i; temp_i1 += ptr_vec_x_cap[0] * temp_i + ptr_vec_x_cap[1] * temp_r; out_buf[0] += (temp_r1 * 0.23570225f); out_buf[1] += (temp_i1 * 0.23570225f); out_buf += 128; ptr_vec_x += 2; ptr_vec_x_cap += 2; } in_buf -= 128 * 11; in_buf1 -= 128 * 11; out_buf -= 128 * 6; } } out_buf -= (256 * qmf_voc_columns) - 2; } } VOID ixheaacd_hbe_post_anal_prod4(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, WORD32 qmf_voc_columns, WORD32 qmf_band_idx) { WORD32 i, inp_band_idx; FLOAT32 *out_ptr = &ptr_hbe_txposer->qmf_out_buf[3][2 * qmf_band_idx]; ixheaacd_norm_qmf_in_buf_4(ptr_hbe_txposer, ((qmf_band_idx >> 1) - 1)); for (; qmf_band_idx < ptr_hbe_txposer->x_over_qmf[3]; qmf_band_idx++) { WORD32 ip_idx; FLOAT32 temp, temp_r, temp_i; FLOAT32 *norm_ptr, *x_norm_ptr; inp_band_idx = qmf_band_idx >> 1; ip_idx = (qmf_band_idx & 1) ? (inp_band_idx + 1) : (inp_band_idx - 1); norm_ptr = &ptr_hbe_txposer->norm_qmf_in_buf[0][2 * ip_idx]; x_norm_ptr = &ptr_hbe_txposer->norm_qmf_in_buf[HBE_ZERO_BAND_IDX][2 * inp_band_idx]; for (i = 0; i < qmf_voc_columns; i++) { WORD32 k; FLOAT32 x_zero_band_r, x_zero_band_i; temp_r = x_zero_band_r = *x_norm_ptr++; temp_i = x_zero_band_i = *x_norm_ptr++; temp = x_zero_band_r * x_zero_band_r - x_zero_band_i * x_zero_band_i; x_zero_band_i = x_zero_band_r * x_zero_band_i + x_zero_band_i * x_zero_band_r; x_zero_band_r = temp_r * temp - temp_i * x_zero_band_i; x_zero_band_i = temp_r * x_zero_band_i + temp_i * temp; for (k = 0; k < HBE_OPER_BLK_LEN_4; k++) { temp = *norm_ptr++; temp_i = *norm_ptr++; temp_r = temp * x_zero_band_r - temp_i * x_zero_band_i; temp_i = temp * x_zero_band_i + temp_i * x_zero_band_r; *out_ptr++ += (temp_r * 0.6666667f); *out_ptr++ += (temp_i * 0.6666667f); norm_ptr += 254; out_ptr += 126; } norm_ptr -= 128 * 11; out_ptr -= 128 * 4; x_norm_ptr += 126; } out_ptr -= (128 * 2 * qmf_voc_columns) - 2; } } VOID ixheaacd_hbe_post_anal_xprod2(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, WORD32 qmf_voc_columns, WORD32 qmf_band_idx, FLOAT32 p, FLOAT32 *cos_sin_theta) { WORD32 i; FLOAT32 *norm_ptr = &ptr_hbe_txposer->norm_qmf_in_buf[1][2 * qmf_band_idx]; FLOAT32 *out_ptr = &ptr_hbe_txposer->qmf_out_buf[1][2 * qmf_band_idx]; FLOAT32 *x_norm_ptr = &ptr_hbe_txposer->norm_qmf_in_buf[HBE_ZERO_BAND_IDX][2 * qmf_band_idx]; ixheaacd_norm_qmf_in_buf_2(ptr_hbe_txposer, qmf_band_idx); for (; qmf_band_idx < ptr_hbe_txposer->x_over_qmf[1]; qmf_band_idx++) { WORD32 n1, n2; FLOAT64 temp_fac; FLOAT32 mag_cmplx_gain = 1.666666667f; temp_fac = (2.0 * qmf_band_idx + 1 - p) * 0.5; n1 = ((WORD32)(temp_fac)) << 1; n2 = ((WORD32)(temp_fac + p)) << 1; for (i = 0; i < qmf_voc_columns; i++) { WORD32 k; FLOAT32 x_zero_band_r, x_zero_band_i; x_zero_band_r = *x_norm_ptr++; x_zero_band_i = *x_norm_ptr++; for (k = 1; k < (HBE_OPER_BLK_LEN_2 + 1); k++) { register FLOAT32 tmp_r, tmp_i; tmp_r = *norm_ptr++; tmp_i = *norm_ptr++; *out_ptr++ += ((tmp_r * x_zero_band_r - tmp_i * x_zero_band_i) * 0.3333333f); *out_ptr++ += ((tmp_r * x_zero_band_i + tmp_i * x_zero_band_r) * 0.3333333f); norm_ptr += 126; out_ptr += 126; } norm_ptr -= 128 * 9; out_ptr -= 128 * 8; x_norm_ptr += 126; { WORD32 max_trans_fac, max_n1, max_n2; FLOAT32 max_mag_value; FLOAT32 mag_zero_band, mag_n1_band, mag_n2_band, temp; FLOAT32 *qmf_in_buf_ri = ptr_hbe_txposer->qmf_in_buf[i + HBE_ZERO_BAND_IDX]; mag_zero_band = qmf_in_buf_ri[2 * qmf_band_idx] * qmf_in_buf_ri[2 * qmf_band_idx] + qmf_in_buf_ri[2 * qmf_band_idx + 1] * qmf_in_buf_ri[2 * qmf_band_idx + 1]; mag_n1_band = qmf_in_buf_ri[n1] * qmf_in_buf_ri[n1] + qmf_in_buf_ri[n1 + 1] * qmf_in_buf_ri[n1 + 1]; mag_n2_band = qmf_in_buf_ri[n2] * qmf_in_buf_ri[n2] + qmf_in_buf_ri[n2 + 1] * qmf_in_buf_ri[n2 + 1]; temp = min(mag_n1_band, mag_n2_band); max_mag_value = 0; max_trans_fac = 0; max_n1 = 0; max_n2 = 0; if (temp > 0) { max_mag_value = temp; max_trans_fac = 1; max_n1 = n1; max_n2 = n2; } if (max_mag_value > mag_zero_band && max_n1 >= 0 && max_n2 < TWICE_QMF_SYNTH_CHANNELS_NUM) { FLOAT32 vec_y_r[2], vec_y_i[2]; FLOAT32 temp_r, temp_i, tmp_r1; WORD32 mid_trans_fac, idx; FLOAT64 base; WORD32 k; FLOAT32 mag_scaling_fac = 0.0f; FLOAT32 x_zero_band_r = 0; FLOAT32 x_zero_band_i = 0; mid_trans_fac = 2 - max_trans_fac; x_zero_band_r = qmf_in_buf_ri[max_n1]; x_zero_band_i = qmf_in_buf_ri[max_n1 + 1]; base = 1e-17; base = base + x_zero_band_r * x_zero_band_r; base = base + x_zero_band_i * x_zero_band_i; mag_scaling_fac = (FLOAT32)(1.0f / base); mag_scaling_fac = (FLOAT32)sqrt(sqrt(mag_scaling_fac)); x_zero_band_r *= mag_scaling_fac; x_zero_band_i *= mag_scaling_fac; temp_r = x_zero_band_r; temp_i = x_zero_band_i; for (idx = 0; idx < mid_trans_fac - 1; idx++) { FLOAT32 tmp = x_zero_band_r; x_zero_band_r = x_zero_band_r * temp_r - x_zero_band_i * temp_i; x_zero_band_i = tmp * temp_i + x_zero_band_i * temp_r; } for (k = 0; k < 2; k++) { temp_r = ptr_hbe_txposer ->qmf_in_buf[i + HBE_ZERO_BAND_IDX - 1 + k][max_n2]; temp_i = ptr_hbe_txposer ->qmf_in_buf[i + HBE_ZERO_BAND_IDX - 1 + k][max_n2 + 1]; base = 1e-17; base = base + temp_r * temp_r; base = base + temp_i * temp_i; mag_scaling_fac = (FLOAT32)(1.0f / base); mag_scaling_fac = (FLOAT32)sqrt(sqrt(mag_scaling_fac)); temp_r *= mag_scaling_fac; temp_i *= mag_scaling_fac; vec_y_r[k] = temp_r; vec_y_i[k] = temp_i; } temp_r = vec_y_r[0] * x_zero_band_r - vec_y_i[0] * x_zero_band_i; temp_i = vec_y_r[0] * x_zero_band_i + vec_y_i[0] * x_zero_band_r; tmp_r1 = (FLOAT32)(cos_sin_theta[0] * temp_r - cos_sin_theta[1] * temp_i); temp_i = (FLOAT32)(cos_sin_theta[0] * temp_i + cos_sin_theta[1] * temp_r); ptr_hbe_txposer->qmf_out_buf[i * 2 + (HBE_ZERO_BAND_IDX - 1)] [2 * qmf_band_idx] += (FLOAT32)(mag_cmplx_gain * tmp_r1); ptr_hbe_txposer->qmf_out_buf[i * 2 + (HBE_ZERO_BAND_IDX - 1)] [2 * qmf_band_idx + 1] += (FLOAT32)(mag_cmplx_gain * temp_i); temp_r = vec_y_r[1] * x_zero_band_r - vec_y_i[1] * x_zero_band_i; temp_i = vec_y_r[1] * x_zero_band_i + vec_y_i[1] * x_zero_band_r; ptr_hbe_txposer->qmf_out_buf[i * 2 + (1 + HBE_ZERO_BAND_IDX - 1)] [2 * qmf_band_idx] += (FLOAT32)(mag_cmplx_gain * temp_r); ptr_hbe_txposer->qmf_out_buf[i * 2 + (1 + HBE_ZERO_BAND_IDX - 1)] [2 * qmf_band_idx + 1] += (FLOAT32)(mag_cmplx_gain * temp_i); } } } out_ptr -= (128 * 2 * qmf_voc_columns) - 2; norm_ptr -= (128 * qmf_voc_columns) - 2; x_norm_ptr -= (128 * qmf_voc_columns) - 2; } } VOID ixheaacd_hbe_post_anal_xprod3(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, WORD32 qmf_voc_columns, WORD32 qmf_band_idx, FLOAT32 p, WORD32 pitch_in_bins_idx) { WORD32 i, inp_band_idx, rem; FLOAT32 *out_buf = &ptr_hbe_txposer->qmf_out_buf[2][2 * qmf_band_idx]; for (; qmf_band_idx < ptr_hbe_txposer->x_over_qmf[2]; qmf_band_idx++) { FLOAT32 temp_r, temp_i; FLOAT32 temp_r1, temp_i1; const FLOAT32 *ptr_sel, *ptr_sel1; inp_band_idx = (2 * qmf_band_idx) / 3; ptr_sel = &ixheaacd_sel_case[(inp_band_idx + 1) & 3][0]; ptr_sel1 = &ixheaacd_sel_case[((inp_band_idx + 1) & 3) + 1][0]; rem = 2 * qmf_band_idx - 3 * inp_band_idx; if (rem == 0 || rem == 1) { FLOAT32 *in_buf = &ptr_hbe_txposer->qmf_in_buf[0][2 * inp_band_idx]; for (i = 0; i < qmf_voc_columns; i += 1) { WORD32 k; FLOAT32 vec_x[2 * HBE_OPER_WIN_LEN]; FLOAT32 *ptr_vec_x = &vec_x[0]; FLOAT32 x_zero_band_r, x_zero_band_i; FLOAT32 mag_scaling_fac; for (k = 0; k < (HBE_OPER_BLK_LEN_3); k += 2) { FLOAT64 base1; FLOAT64 base = 1e-17; temp_r = in_buf[0]; temp_i = in_buf[1]; in_buf += 256; base1 = base + temp_r * temp_r; base1 = base1 + temp_i * temp_i; mag_scaling_fac = (FLOAT32)(ixheaacd_cbrt_calc((FLOAT32)base1)); ptr_vec_x[0] = temp_r * mag_scaling_fac; ptr_vec_x[1] = temp_i * mag_scaling_fac; temp_r = in_buf[0]; temp_i = in_buf[1]; in_buf -= 128; temp_r1 = ptr_sel[0] * temp_r + ptr_sel[1] * temp_i; temp_i1 = ptr_sel[2] * temp_r + ptr_sel[3] * temp_i; temp_r = in_buf[0]; temp_i = in_buf[1]; temp_r1 += ptr_sel[4] * temp_r + ptr_sel[5] * temp_i; temp_i1 += ptr_sel[6] * temp_r + ptr_sel[7] * temp_i; temp_r1 *= 0.3984033437f; temp_i1 *= 0.3984033437f; base1 = base + temp_r1 * temp_r1; base1 = base1 + temp_i1 * temp_i1; mag_scaling_fac = (FLOAT32)(ixheaacd_cbrt_calc((FLOAT32)base1)); ptr_vec_x[2] = temp_r1 * mag_scaling_fac; ptr_vec_x[3] = temp_i1 * mag_scaling_fac; ptr_vec_x += 4; in_buf += 256; } ptr_vec_x = &vec_x[0]; temp_r = vec_x[2 * (HBE_ZERO_BAND_IDX - 2)]; temp_i = vec_x[(2 * (HBE_ZERO_BAND_IDX - 2)) + 1]; x_zero_band_r = temp_r * temp_r - temp_i * temp_i; x_zero_band_i = temp_r * temp_i + temp_i * temp_r; for (k = 0; k < (HBE_OPER_BLK_LEN_3); k++) { temp_r = ptr_vec_x[0] * x_zero_band_r - ptr_vec_x[1] * x_zero_band_i; temp_i = ptr_vec_x[0] * x_zero_band_i + ptr_vec_x[1] * x_zero_band_r; out_buf[0] += (temp_r * 0.4714045f); out_buf[1] += (temp_i * 0.4714045f); ptr_vec_x += 2; out_buf += 128; } ixheaacd_hbe_xprod_proc_3(ptr_hbe_txposer, qmf_band_idx, i, p, pitch_in_bins_idx); in_buf -= 128 * 11; out_buf -= 128 * 6; } } else { FLOAT32 *in_buf = &ptr_hbe_txposer->qmf_in_buf[0][2 * inp_band_idx]; FLOAT32 *in_buf1 = &ptr_hbe_txposer->qmf_in_buf[0][2 * (inp_band_idx + 1)]; for (i = 0; i < qmf_voc_columns; i++) { WORD32 k; FLOAT32 vec_x[2 * HBE_OPER_WIN_LEN]; FLOAT32 vec_x_cap[2 * HBE_OPER_WIN_LEN]; FLOAT32 x_zero_band_r, x_zero_band_i; FLOAT32 *ptr_vec_x = &vec_x[0]; FLOAT32 *ptr_vec_x_cap = &vec_x_cap[0]; FLOAT32 mag_scaling_fac; for (k = 0; k < (HBE_OPER_BLK_LEN_3); k += 2) { FLOAT32 tmp_vr, tmp_vi; FLOAT32 tmp_cr, tmp_ci; FLOAT64 base1; FLOAT64 base = 1e-17; temp_r1 = in_buf[0]; temp_i1 = in_buf[1]; temp_r = in_buf1[0]; temp_i = in_buf1[1]; base1 = base + temp_r * temp_r; base1 = base1 + temp_i * temp_i; mag_scaling_fac = (FLOAT32)(ixheaacd_cbrt_calc((FLOAT32)base1)); ptr_vec_x[0] = temp_r * mag_scaling_fac; ptr_vec_x[1] = temp_i * mag_scaling_fac; base1 = base + temp_r1 * temp_r1; base1 = base1 + temp_i1 * temp_i1; mag_scaling_fac = (FLOAT32)(ixheaacd_cbrt_calc((FLOAT32)base1)); ptr_vec_x_cap[0] = temp_r1 * mag_scaling_fac; ptr_vec_x_cap[1] = temp_i1 * mag_scaling_fac; in_buf += 256; temp_r = in_buf[0]; temp_i = in_buf[1]; temp_r1 = ptr_sel[0] * temp_r + ptr_sel[1] * temp_i; temp_i1 = ptr_sel[2] * temp_r + ptr_sel[3] * temp_i; in_buf -= 128; temp_r = in_buf[0]; temp_i = in_buf[1]; tmp_cr = temp_r1 + ptr_sel[4] * temp_r + ptr_sel[5] * temp_i; tmp_ci = temp_i1 + ptr_sel[6] * temp_r + ptr_sel[7] * temp_i; in_buf1 += 256; temp_r = in_buf1[0]; temp_i = in_buf1[1]; temp_r1 = ptr_sel1[0] * temp_r + ptr_sel1[1] * temp_i; temp_i1 = ptr_sel1[2] * temp_r + ptr_sel1[3] * temp_i; in_buf1 -= 128; temp_r = in_buf1[0]; temp_i = in_buf1[1]; tmp_vr = temp_r1 + ptr_sel1[4] * temp_r + ptr_sel1[5] * temp_i; tmp_vi = temp_i1 + ptr_sel1[6] * temp_r + ptr_sel1[7] * temp_i; tmp_cr *= 0.3984033437f; tmp_ci *= 0.3984033437f; tmp_vr *= 0.3984033437f; tmp_vi *= 0.3984033437f; base1 = base + tmp_vr * tmp_vr; base1 = base1 + tmp_vi * tmp_vi; mag_scaling_fac = (FLOAT32)(ixheaacd_cbrt_calc((FLOAT32)base1)); ptr_vec_x[2] = tmp_vr * mag_scaling_fac; ptr_vec_x[3] = tmp_vi * mag_scaling_fac; base1 = base + tmp_cr * tmp_cr; base1 = base1 + tmp_ci * tmp_ci; mag_scaling_fac = (FLOAT32)(ixheaacd_cbrt_calc((FLOAT32)base1)); ptr_vec_x_cap[2] = tmp_cr * mag_scaling_fac; ptr_vec_x_cap[3] = tmp_ci * mag_scaling_fac; in_buf += 256; in_buf1 += 256; ptr_vec_x += 4; ptr_vec_x_cap += 4; } ptr_vec_x = &vec_x[0]; ptr_vec_x_cap = &vec_x_cap[0]; temp_r = vec_x_cap[2 * (HBE_ZERO_BAND_IDX - 2)]; temp_i = vec_x_cap[2 * (HBE_ZERO_BAND_IDX - 2) + 1]; temp_r1 = vec_x[2 * (HBE_ZERO_BAND_IDX - 2)]; temp_i1 = vec_x[2 * (HBE_ZERO_BAND_IDX - 2) + 1]; x_zero_band_r = temp_r * temp_r - temp_i * temp_i; x_zero_band_i = temp_r * temp_i + temp_i * temp_r; temp_r = temp_r1 * temp_r1 - temp_i1 * temp_i1; temp_i = temp_r1 * temp_i1 + temp_i1 * temp_r1; for (k = 0; k < (HBE_OPER_BLK_LEN_3); k++) { temp_r1 = ptr_vec_x[0] * x_zero_band_r - ptr_vec_x[1] * x_zero_band_i; temp_i1 = ptr_vec_x[0] * x_zero_band_i + ptr_vec_x[1] * x_zero_band_r; temp_r1 += ptr_vec_x_cap[0] * temp_r - ptr_vec_x_cap[1] * temp_i; temp_i1 += ptr_vec_x_cap[0] * temp_i + ptr_vec_x_cap[1] * temp_r; out_buf[0] += (temp_r1 * 0.23570225f); out_buf[1] += (temp_i1 * 0.23570225f); out_buf += 128; ptr_vec_x += 2; ptr_vec_x_cap += 2; } ixheaacd_hbe_xprod_proc_3(ptr_hbe_txposer, qmf_band_idx, i, p, pitch_in_bins_idx); in_buf -= 128 * 11; in_buf1 -= 128 * 11; out_buf -= 128 * 6; } } out_buf -= (256 * qmf_voc_columns) - 2; } } VOID ixheaacd_hbe_post_anal_xprod4(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, WORD32 qmf_voc_columns, WORD32 qmf_band_idx, FLOAT32 p, WORD32 pitch_in_bins_idx) { WORD32 i, inp_band_idx; FLOAT32 *out_ptr = &ptr_hbe_txposer->qmf_out_buf[3][2 * qmf_band_idx]; ixheaacd_norm_qmf_in_buf_4(ptr_hbe_txposer, ((qmf_band_idx >> 1) - 1)); for (; qmf_band_idx < ptr_hbe_txposer->x_over_qmf[3]; qmf_band_idx++) { WORD32 ip_idx; FLOAT32 temp, temp_r, temp_i; FLOAT32 *norm_ptr, *x_norm_ptr; inp_band_idx = qmf_band_idx >> 1; ip_idx = (qmf_band_idx & 1) ? (inp_band_idx + 1) : (inp_band_idx - 1); norm_ptr = &ptr_hbe_txposer->norm_qmf_in_buf[0][2 * ip_idx]; x_norm_ptr = &ptr_hbe_txposer->norm_qmf_in_buf[HBE_ZERO_BAND_IDX][2 * inp_band_idx]; for (i = 0; i < qmf_voc_columns; i++) { WORD32 k; FLOAT32 x_zero_band_r, x_zero_band_i; temp_r = x_zero_band_r = *x_norm_ptr++; temp_i = x_zero_band_i = *x_norm_ptr++; temp = x_zero_band_r * x_zero_band_r - x_zero_band_i * x_zero_band_i; x_zero_band_i = x_zero_band_r * x_zero_band_i + x_zero_band_i * x_zero_band_r; x_zero_band_r = temp_r * temp - temp_i * x_zero_band_i; x_zero_band_i = temp_r * x_zero_band_i + temp_i * temp; for (k = 0; k < HBE_OPER_BLK_LEN_4; k++) { temp = *norm_ptr++; temp_i = *norm_ptr++; temp_r = temp * x_zero_band_r - temp_i * x_zero_band_i; temp_i = temp * x_zero_band_i + temp_i * x_zero_band_r; *out_ptr++ += (temp_r * 0.6666667f); *out_ptr++ += (temp_i * 0.6666667f); norm_ptr += 254; out_ptr += 126; } norm_ptr -= 128 * 11; out_ptr -= 128 * 4; x_norm_ptr += 126; ixheaacd_hbe_xprod_proc_4(ptr_hbe_txposer, qmf_band_idx, i, p, pitch_in_bins_idx); } out_ptr -= (128 * 2 * qmf_voc_columns) - 2; } } IA_ERRORCODE ixheaacd_hbe_post_anal_process( ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, WORD32 pitch_in_bins, WORD32 sbr_upsamp_4_flg) { FLOAT32 p; WORD32 trans_fac; WORD32 qmf_voc_columns = ptr_hbe_txposer->no_bins / 2; FLOAT32 cos_sin_theta[2]; p = (sbr_upsamp_4_flg) ? (FLOAT32)(pitch_in_bins * 0.04166666666666) : (FLOAT32)(pitch_in_bins * 0.08333333333333); if (p < SBR_CONST_PMIN) { trans_fac = 2; if (trans_fac <= ptr_hbe_txposer->max_stretch) ixheaacd_hbe_post_anal_prod2(ptr_hbe_txposer, qmf_voc_columns, ptr_hbe_txposer->x_over_qmf[0]); trans_fac = 3; if (trans_fac <= ptr_hbe_txposer->max_stretch) ixheaacd_hbe_post_anal_prod3(ptr_hbe_txposer, qmf_voc_columns, ptr_hbe_txposer->x_over_qmf[1]); trans_fac = 4; if (trans_fac <= ptr_hbe_txposer->max_stretch) { if (ptr_hbe_txposer->x_over_qmf[2] <= 1) return IA_FATAL_ERROR; ixheaacd_hbe_post_anal_prod4(ptr_hbe_txposer, qmf_voc_columns, ptr_hbe_txposer->x_over_qmf[2]); } } else { trans_fac = 2; if (trans_fac <= ptr_hbe_txposer->max_stretch) { cos_sin_theta[0] = ixheaacd_hbe_x_prod_cos_table_trans_2 [((pitch_in_bins + sbr_upsamp_4_flg * 128) << 1) + 0]; cos_sin_theta[1] = ixheaacd_hbe_x_prod_cos_table_trans_2 [((pitch_in_bins + sbr_upsamp_4_flg * 128) << 1) + 1]; ixheaacd_hbe_post_anal_xprod2(ptr_hbe_txposer, qmf_voc_columns, ptr_hbe_txposer->x_over_qmf[0], p, cos_sin_theta); } trans_fac = 3; if (trans_fac <= ptr_hbe_txposer->max_stretch) ixheaacd_hbe_post_anal_xprod3(ptr_hbe_txposer, qmf_voc_columns, ptr_hbe_txposer->x_over_qmf[1], p, (pitch_in_bins + sbr_upsamp_4_flg * 128)); trans_fac = 4; if (trans_fac <= ptr_hbe_txposer->max_stretch) { if (ptr_hbe_txposer->x_over_qmf[2] <= 1) return IA_FATAL_ERROR; ixheaacd_hbe_post_anal_xprod4(ptr_hbe_txposer, qmf_voc_columns, ptr_hbe_txposer->x_over_qmf[2], p, (pitch_in_bins + sbr_upsamp_4_flg * 128)); } } return IA_NO_ERROR; }