/****************************************************************************** * * * 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 "ixheaacd_sbr_common.h" #include "ixheaac_type_def.h" #include "ixheaac_constants.h" #include "ixheaac_basic_ops32.h" #include "ixheaac_basic_ops16.h" #include "ixheaac_basic_ops40.h" #include "ixheaac_basic_ops_arr.h" #include "ixheaac_basic_ops.h" #include "ixheaacd_defines.h" #include "ixheaac_basic_op.h" #include "ixheaacd_intrinsics.h" #include "ixheaacd_common_rom.h" #include "ixheaacd_basic_funcs.h" #include "ixheaacd_bitbuffer.h" #include "ixheaacd_sbrdecsettings.h" #include "ixheaacd_defines.h" #include "ixheaacd_pns.h" #include "ixheaacd_aac_rom.h" #include "ixheaacd_pulsedata.h" #include "ixheaacd_drc_data_struct.h" #include "ixheaacd_lt_predict.h" #include "ixheaacd_cnst.h" #include "ixheaacd_ec_defines.h" #include "ixheaacd_ec_struct_def.h" #include "ixheaacd_channelinfo.h" #include "ixheaacd_drc_dec.h" #include "ixheaacd_sbrdecoder.h" #include "ixheaacd_sbr_scale.h" #include "ixheaacd_lpp_tran.h" #include "ixheaacd_env_extr_part.h" #include "ixheaacd_sbr_rom.h" #include "ixheaacd_hybrid.h" #include "ixheaacd_ps_dec.h" #include "ixheaacd_env_extr.h" #include "ixheaacd_ps_dec.h" #include "ixheaacd_qmf_dec.h" #include "ixheaacd_env_calc.h" #include "ixheaac_sbr_const.h" #include "ixheaacd_pvc_dec.h" #include "ixheaacd_sbr_dec.h" #include "ixheaacd_function_selector.h" VOID ixheaacd_k_chan_filt(const FLOAT32 *ptr_qmf_re, const FLOAT32 *ptr_qmf_im, FLOAT32 (*ptr_tmp_hyb_re)[MAX_NUM_QMF_CHANNELS], FLOAT32 (*ptr_tmp_hyb_im)[MAX_NUM_QMF_CHANNELS], WORD32 nSamples, WORD32 k, WORD32 bCplx, const FLOAT32 *p, FLOAT32 *cos_sin_mod_tbl) { WORD32 i, n, q; FLOAT32 real, imag; FLOAT32 cos_val, sin_val; FLOAT32 *p_real_imag = cos_sin_mod_tbl; if (bCplx) { for (i = 0; i < nSamples; i++) { for (q = 0; q < k; q++) { real = 0; imag = 0; for (n = 0; n < 13; n++) { cos_val = *p_real_imag++; sin_val = *p_real_imag++; real += p[n] * (ptr_qmf_re[n + i] * cos_val - ptr_qmf_im[n + i] * sin_val); imag += p[n] * (ptr_qmf_im[n + i] * cos_val + ptr_qmf_re[n + i] * sin_val); } ptr_tmp_hyb_re[i][q] = real; ptr_tmp_hyb_im[i][q] = imag; } p_real_imag -= (13 * k * 2); } } else { for (i = 0; i < nSamples; i++) { for (q = 0; q < k; q++) { real = 0; imag = 0; for (n = 0; n < 13; n++) { cos_val = *p_real_imag++; real += p[n] * (ptr_qmf_re[n + i] * cos_val); imag += p[n] * (ptr_qmf_im[n + i] * cos_val); } ptr_tmp_hyb_re[i][q] = real; ptr_tmp_hyb_im[i][q] = imag; } p_real_imag -= (13 * k); } } } VOID ixheaacd_hyb_anal(const FLOAT32 **ptr_qmf_re, const FLOAT32 **ptr_qmf_im, ia_ps_dec_struct *ptr_ps_dec, ia_ps_tables_struct *ptr_ps_tables, WORD32 use_34_st_bands) { WORD32 k, n, band; WORD32 band_res; WORD32 frame_size; WORD32 ch_offset = 0; FLOAT32(*ptr_tmp_hyb_re)[MAX_NUM_COLUMNS]; FLOAT32(*ptr_tmp_hyb_im)[MAX_NUM_COLUMNS]; ia_hybrid_flt_struct *ptr_hybrid; if (!use_34_st_bands) { ptr_tmp_hyb_re = ptr_ps_dec->hyb_left_re; ptr_tmp_hyb_im = ptr_ps_dec->hyb_left_im; ptr_hybrid = &ptr_ps_dec->str_flt_hybrid20; } else { ptr_tmp_hyb_re = NULL; ptr_tmp_hyb_im = ptr_ps_dec->hyb_left_im; ptr_hybrid = &ptr_ps_dec->str_flt_hybrid34; } frame_size = ptr_hybrid->frame_size; for (band = 0; band < ptr_hybrid->num_qmf_bands; band++) { band_res = ptr_hybrid->ptr_resol[band]; memcpy(ptr_hybrid->ptr_work_re, ptr_hybrid->ptr_qmf_buf_re[band], (HYBRID_FILTER_LENGTH - 1) * sizeof(ptr_hybrid->ptr_work_re[0])); memcpy(ptr_hybrid->ptr_work_im, ptr_hybrid->ptr_qmf_buf_im[band], (HYBRID_FILTER_LENGTH - 1) * sizeof(ptr_hybrid->ptr_work_im[0])); for (n = 0; n < frame_size; n++) { ptr_hybrid->ptr_work_re[(HYBRID_FILTER_LENGTH - 1) + n] = ptr_qmf_re[n + HYBRID_FILTER_DELAY][band]; ptr_hybrid->ptr_work_im[(HYBRID_FILTER_LENGTH - 1) + n] = ptr_qmf_im[n + HYBRID_FILTER_DELAY][band]; } memcpy(ptr_hybrid->ptr_qmf_buf_re[band], ptr_hybrid->ptr_work_re + frame_size, (HYBRID_FILTER_LENGTH - 1) * sizeof(ptr_hybrid->ptr_qmf_buf_re[band][0])); memcpy(ptr_hybrid->ptr_qmf_buf_im[band], ptr_hybrid->ptr_work_im + frame_size, (HYBRID_FILTER_LENGTH - 1) * sizeof(ptr_hybrid->ptr_qmf_buf_im[band][0])); if (ptr_tmp_hyb_re) { switch (band_res) { case NO_HYBRID_CHANNELS_2: ixheaacd_k_chan_filt( ptr_hybrid->ptr_work_re, ptr_hybrid->ptr_work_im, ptr_hybrid->ptr_temp_re, ptr_hybrid->ptr_temp_im, frame_size, NO_HYBRID_CHANNELS_2, REAL, ptr_ps_tables->p2_13_20, &ptr_ps_tables->cos_mod_2channel[0][0]); break; case NO_HYBRID_CHANNELS_4: ixheaacd_k_chan_filt( ptr_hybrid->ptr_work_re, ptr_hybrid->ptr_work_im, ptr_hybrid->ptr_temp_re, ptr_hybrid->ptr_temp_im, frame_size, NO_HYBRID_CHANNELS_4, CPLX, ptr_ps_tables->p4_13_34, &ptr_ps_tables->cos_sin_mod_4channel[0][0]); break; case NO_HYBRID_CHANNELS_8: ixheaacd_k_chan_filt( ptr_hybrid->ptr_work_re, ptr_hybrid->ptr_work_im, ptr_hybrid->ptr_temp_re, ptr_hybrid->ptr_temp_im, frame_size, NO_HYBRID_CHANNELS_8, CPLX, use_34_st_bands ? ptr_ps_tables->p8_13_34 : ptr_ps_tables->p8_13_20, &ptr_ps_tables->cos_sin_mod_8channel[0][0]); break; case NO_HYBRID_CHANNELS_12: ixheaacd_k_chan_filt(ptr_hybrid->ptr_work_re, ptr_hybrid->ptr_work_im, ptr_hybrid->ptr_temp_re, ptr_hybrid->ptr_temp_im, frame_size, NO_HYBRID_CHANNELS_12, CPLX, ptr_ps_tables->p12_13_34, &ptr_ps_tables->cos_sin_mod_12channel[0][0]); break; default: break; } for (n = 0; n < frame_size; n++) { for (k = 0; k < (WORD32)band_res; k++) { ptr_tmp_hyb_re[n][ch_offset + k] = ptr_hybrid->ptr_temp_re[n][k]; ptr_tmp_hyb_im[n][ch_offset + k] = ptr_hybrid->ptr_temp_im[n][k]; } } ch_offset += band_res; } } } VOID ixheaacd_hyb_synth( FLOAT32 (*ptr_tmp_hyb_re)[MAX_NUM_COLUMNS], FLOAT32 (*ptr_tmp_hyb_im)[MAX_NUM_COLUMNS], FLOAT32 **ptr_qmf_re, FLOAT32 **ptr_qmf_im, ia_hybrid_flt_struct *ptr_hybrid) { WORD32 k, n, band; WORD16 band_res; WORD32 frame_size = ptr_hybrid->frame_size; WORD32 ch_offset = 0; for (band = 0; band < ptr_hybrid->num_qmf_bands; band++) { band_res = ptr_hybrid->ptr_resol[band]; for (n = 0; n < frame_size; n++) { ptr_qmf_re[n][band] = ptr_qmf_im[n][band] = 0; for (k = 0; k < (WORD32)band_res; k++) { ptr_qmf_re[n][band] += ptr_tmp_hyb_re[n][ch_offset + k]; ptr_qmf_im[n][band] += ptr_tmp_hyb_im[n][ch_offset + k]; } } ch_offset += band_res; } } VOID ixheaacd_map_34_float_to_20(FLOAT32 *ptr_index) { ptr_index[0] = (2 * ptr_index[0] + ptr_index[1]) / 3.0f; ptr_index[1] = (ptr_index[1] + 2 * ptr_index[2]) / 3.0f; ptr_index[2] = (2 * ptr_index[3] + ptr_index[4]) / 3.0f; ptr_index[3] = (ptr_index[4] + 2 * ptr_index[5]) / 3.0f; ptr_index[4] = (ptr_index[6] + ptr_index[7]) / 2.0f; ptr_index[5] = (ptr_index[8] + ptr_index[9]) / 2.0f; ptr_index[6] = ptr_index[10]; ptr_index[7] = ptr_index[11]; ptr_index[8] = (ptr_index[12] + ptr_index[13]) / 2.0f; ptr_index[9] = (ptr_index[14] + ptr_index[15]) / 2.0f; ptr_index[10] = ptr_index[16]; ptr_index[11] = ptr_index[17]; ptr_index[12] = ptr_index[18]; ptr_index[13] = ptr_index[19]; ptr_index[14] = (ptr_index[20] + ptr_index[21]) / 2.0f; ptr_index[15] = (ptr_index[22] + ptr_index[23]) / 2.0f; ptr_index[16] = (ptr_index[24] + ptr_index[25]) / 2.0f; ptr_index[17] = (ptr_index[26] + ptr_index[27]) / 2.0f; ptr_index[18] = (ptr_index[28] + ptr_index[29] + ptr_index[30] + ptr_index[31]) / 4.0f; ptr_index[19] = (ptr_index[32] + ptr_index[33]) / 2.0f; } VOID ixheaacd_map_20_float_to_34(FLOAT32 *ptr_index) { FLOAT32 arr_temp[NUM_HI_RES_BINS]; WORD32 i; arr_temp[0] = ptr_index[0]; arr_temp[1] = (ptr_index[0] + ptr_index[1]) / 2.0f; arr_temp[2] = ptr_index[1]; arr_temp[3] = ptr_index[2]; arr_temp[4] = (ptr_index[2] + ptr_index[3]) / 2.0f; arr_temp[5] = ptr_index[3]; arr_temp[6] = ptr_index[4]; arr_temp[7] = ptr_index[4]; arr_temp[8] = ptr_index[5]; arr_temp[9] = ptr_index[5]; arr_temp[10] = ptr_index[6]; arr_temp[11] = ptr_index[7]; arr_temp[12] = ptr_index[8]; arr_temp[13] = ptr_index[8]; arr_temp[14] = ptr_index[9]; arr_temp[15] = ptr_index[9]; arr_temp[16] = ptr_index[10]; arr_temp[17] = ptr_index[11]; arr_temp[18] = ptr_index[12]; arr_temp[19] = ptr_index[13]; arr_temp[20] = ptr_index[14]; arr_temp[21] = ptr_index[14]; arr_temp[22] = ptr_index[15]; arr_temp[23] = ptr_index[15]; arr_temp[24] = ptr_index[16]; arr_temp[25] = ptr_index[16]; arr_temp[26] = ptr_index[17]; arr_temp[27] = ptr_index[17]; arr_temp[28] = ptr_index[18]; arr_temp[29] = ptr_index[18]; arr_temp[30] = ptr_index[18]; arr_temp[31] = ptr_index[18]; arr_temp[32] = ptr_index[19]; arr_temp[33] = ptr_index[19]; for (i = 0; i < 34; i++) { ptr_index[i] = arr_temp[i]; } } WORD32 ixheaacd_create_ps_esbr_dec(ia_ps_dec_struct *ptr_ps_dec_struct, ia_ps_tables_struct *ptr_ps_tables, UWORD32 noQmfChans, UWORD32 num_sub_samples, WORD32 ps_mode) { UWORD32 i; ia_ps_dec_struct *ptr_ps_dec = ptr_ps_dec_struct; ptr_ps_dec = ptr_ps_dec_struct; ptr_ps_dec->num_sub_samples = num_sub_samples; ptr_ps_dec->num_chans = noQmfChans; ptr_ps_dec->ps_mode = ps_mode; ptr_ps_dec->ps_data_present = 0; ptr_ps_dec->enable_iid = 0; ptr_ps_dec->iid_mode = 0; ptr_ps_dec->enable_icc = 0; ptr_ps_dec->icc_mode = 0; ptr_ps_dec->enable_ext = 0; ptr_ps_dec->use_pca_rot_flg = 0; ptr_ps_dec->freq_res_ipd = 0; ptr_ps_dec->use_34_st_bands = 0; ptr_ps_dec->use_34_st_bands_prev = 0; ptr_ps_dec->str_flt_hybrid20.frame_size = ptr_ps_dec->num_sub_samples; ptr_ps_dec->str_flt_hybrid20.num_qmf_bands = NUM_QMF_BANDS_IN_HYBRID20; ptr_ps_dec->str_flt_hybrid20.ptr_resol = (WORD16 *)&ptr_ps_tables->band_res_hyb20[0]; ptr_ps_dec->str_flt_hybrid20.ptr_work_re = &ptr_ps_dec->hyb_work_re_20[0]; ptr_ps_dec->str_flt_hybrid20.ptr_work_im = &ptr_ps_dec->hyb_work_im_20[0]; ptr_ps_dec->str_flt_hybrid20.ptr_qmf_buf_re = ptr_ps_dec->hyb_qmf_buf_re_20; ptr_ps_dec->str_flt_hybrid20.ptr_qmf_buf_im = ptr_ps_dec->hyb_qmf_buf_im_20; ptr_ps_dec->str_flt_hybrid20.ptr_temp_re = ptr_ps_dec->hyb_temp_re_20; ptr_ps_dec->str_flt_hybrid20.ptr_temp_im = ptr_ps_dec->hyb_temp_im_20; ptr_ps_dec->str_flt_hybrid34.frame_size = ptr_ps_dec->num_sub_samples; ptr_ps_dec->str_flt_hybrid34.num_qmf_bands = NUM_QMF_BANDS_IN_HYBRID34; ptr_ps_dec->str_flt_hybrid34.ptr_resol = (WORD16 *)&ptr_ps_tables->band_res_hyb34[0]; ptr_ps_dec->str_flt_hybrid34.ptr_work_re = &ptr_ps_dec->hyb_work_re_34[0]; ptr_ps_dec->str_flt_hybrid34.ptr_work_im = &ptr_ps_dec->hyb_work_im_34[0]; ptr_ps_dec->str_flt_hybrid34.ptr_qmf_buf_re = ptr_ps_dec->hyb_qmf_buf_re_34; ptr_ps_dec->str_flt_hybrid34.ptr_qmf_buf_im = ptr_ps_dec->hyb_qmf_buf_im_34; ptr_ps_dec->str_flt_hybrid34.ptr_temp_re = ptr_ps_dec->hyb_temp_re_34; ptr_ps_dec->str_flt_hybrid34.ptr_temp_im = ptr_ps_dec->hyb_temp_im_34; ptr_ps_dec->delay_buf_idx = 0; for (i = 0; i < NUM_OF_QUAD_MIRROR_FILTER_CHNLS; i++) { ptr_ps_dec->delay_qmf_delay_buf_idx[i] = 0; ptr_ps_dec->delay_qmf_delay_num_samp[i] = ptr_ps_tables->qmf_delay_idx_tbl[i]; } for (i = 0; i < NUM_HI_RES_BINS; i++) { ptr_ps_dec->h11_re_prev[i] = 1.0f; ptr_ps_dec->h12_re_prev[i] = 1.0f; } memset(ptr_ps_dec->h11_im_prev, 0, sizeof(ptr_ps_dec->h11_im_prev)); memset(ptr_ps_dec->h12_im_prev, 0, sizeof(ptr_ps_dec->h12_im_prev)); memset(ptr_ps_dec->h21_re_prev, 0, sizeof(ptr_ps_dec->h21_re_prev)); memset(ptr_ps_dec->h22_re_prev, 0, sizeof(ptr_ps_dec->h22_re_prev)); memset(ptr_ps_dec->h21_im_prev, 0, sizeof(ptr_ps_dec->h21_im_prev)); memset(ptr_ps_dec->h22_im_prev, 0, sizeof(ptr_ps_dec->h22_im_prev)); memset(ptr_ps_dec->ipd_idx_map_1, 0, sizeof(ptr_ps_dec->ipd_idx_map_1)); memset(ptr_ps_dec->opd_idx_map_1, 0, sizeof(ptr_ps_dec->opd_idx_map_1)); memset(ptr_ps_dec->ipd_idx_map_2, 0, sizeof(ptr_ps_dec->ipd_idx_map_2)); memset(ptr_ps_dec->opd_idx_map_2, 0, sizeof(ptr_ps_dec->opd_idx_map_2)); for (i = 0; i < NUM_HI_RES_BINS; i++) { ptr_ps_dec->peak_decay_fast_bin[i] = 0.0f; ptr_ps_dec->prev_nrg_bin[i] = 0.0f; ptr_ps_dec->prev_peak_diff_bin[i] = 0.0f; } memset(ptr_ps_dec->qmf_delay_buf_re, 0, sizeof(ptr_ps_dec->qmf_delay_buf_re)); memset(ptr_ps_dec->qmf_delay_buf_im, 0, sizeof(ptr_ps_dec->qmf_delay_buf_im)); memset(ptr_ps_dec->sub_qmf_delay_buf_re, 0, sizeof(ptr_ps_dec->sub_qmf_delay_buf_re)); memset(ptr_ps_dec->sub_qmf_delay_buf_im, 0, sizeof(ptr_ps_dec->sub_qmf_delay_buf_im)); for (i = 0; i < NUM_SER_AP_LINKS; i++) { memset(&ptr_ps_dec->ser_qmf_delay_buf_re[i][0][0], 0, sizeof(ptr_ps_dec->ser_qmf_delay_buf_re[i])); memset(&ptr_ps_dec->ser_qmf_delay_buf_im[i][0][0], 0, sizeof(ptr_ps_dec->ser_qmf_delay_buf_im[i])); memset(&ptr_ps_dec->ser_sub_qmf_dealy_buf_re[i][0][0], 0, sizeof(ptr_ps_dec->ser_sub_qmf_dealy_buf_re[i])); memset(&ptr_ps_dec->ser_sub_qmf_dealy_buf_im[i][0][0], 0, sizeof(ptr_ps_dec->ser_sub_qmf_dealy_buf_im[i])); } return 0; } VOID ixheaacd_esbr_apply_ps(ia_ps_dec_struct *ptr_ps_dec, FLOAT32 **pp_qmf_buf_re_left, FLOAT32 **pp_qmf_buf_im_left, FLOAT32 **pp_qmf_buf_re_right, FLOAT32 **pp_qmf_buf_im_right, WORD32 usb, ia_ps_tables_struct *ptr_ps_tables, WORD32 num_time_slot) { WORD32 sb; WORD32 i, k; WORD32 max_num_column; if (num_time_slot == 15) max_num_column = MAX_NUM_COLUMNS_960; else max_num_column = MAX_NUM_COLUMNS; if (ptr_ps_dec->use_34_st_bands) { ptr_ps_dec->ptr_group_borders = (WORD32 *)&ptr_ps_tables->group_borders_34_tbl[0]; ptr_ps_dec->ptr_bins_group_map = (WORD32 *)&ptr_ps_tables->bin_group_map_34[0]; ptr_ps_dec->ptr_hybrid = &ptr_ps_dec->str_flt_hybrid34; ptr_ps_dec->num_groups = NUM_IID_GROUPS_HI_RES; ptr_ps_dec->num_sub_qmf_groups = SUBQMF_GROUPS_HI_RES; ptr_ps_dec->num_bins = NUM_HI_RES_BINS; ptr_ps_dec->first_delay_gr = SUBQMF_GROUPS_HI_RES; } else { ptr_ps_dec->ptr_group_borders = (WORD32 *)&ptr_ps_tables->group_borders_20_tbl[0]; ptr_ps_dec->ptr_bins_group_map = (WORD32 *)&ptr_ps_tables->bin_group_map_20[0]; ptr_ps_dec->ptr_hybrid = &ptr_ps_dec->str_flt_hybrid20; ptr_ps_dec->num_groups = NUM_IID_GROUPS; ptr_ps_dec->num_sub_qmf_groups = SUBQMF_GROUPS; ptr_ps_dec->num_bins = NUM_MID_RES_BINS; ptr_ps_dec->first_delay_gr = SUBQMF_GROUPS; } for (sb = usb; sb < ptr_ps_dec->num_chans; sb++) { for (i = 0; i < NUM_SER_AP_LINKS; i++) { for (k = 0; k < ptr_ps_dec->delay_sample_ser[i]; k++) { ptr_ps_dec->ser_qmf_delay_buf_re[i][k][sb] = 0; ptr_ps_dec->ser_qmf_delay_buf_im[i][k][sb] = 0; } } for (k = 0; k < HIGH_DEL; k++) { ptr_ps_dec->qmf_delay_buf_re[k][sb] = 0; ptr_ps_dec->qmf_delay_buf_im[k][sb] = 0; } } ixheaacd_hyb_anal((const FLOAT32 **)pp_qmf_buf_re_left, (const FLOAT32 **)pp_qmf_buf_im_left, ptr_ps_dec, ptr_ps_tables, 0); ixheaacd_hyb_anal((const FLOAT32 **)pp_qmf_buf_re_left, (const FLOAT32 **)pp_qmf_buf_im_left, ptr_ps_dec, ptr_ps_tables, 1); if (!ptr_ps_dec->use_34_st_bands) { WORD32 k; for (k = 0; k < (WORD32)ptr_ps_dec->num_sub_samples; k++) { ptr_ps_dec->hyb_left_re[k][3] += ptr_ps_dec->hyb_left_re[k][4]; ptr_ps_dec->hyb_left_im[k][3] += ptr_ps_dec->hyb_left_im[k][4]; ptr_ps_dec->hyb_left_re[k][4] = 0.; ptr_ps_dec->hyb_left_im[k][4] = 0.; ptr_ps_dec->hyb_left_re[k][2] += ptr_ps_dec->hyb_left_re[k][5]; ptr_ps_dec->hyb_left_im[k][2] += ptr_ps_dec->hyb_left_im[k][5]; ptr_ps_dec->hyb_left_re[k][5] = 0.; ptr_ps_dec->hyb_left_im[k][5] = 0.; } } if (ptr_ps_dec->ps_mode & 0x0080) { WORD32 i, j; for (i = 0; i < max_num_column; i++) { for (j = 0; j < NUM_OF_QUAD_MIRROR_FILTER_CHNLS; j++) { pp_qmf_buf_im_right[i][j] = pp_qmf_buf_im_left[i][j]; pp_qmf_buf_re_right[i][j] = pp_qmf_buf_re_left[i][j]; } } for (i = 0; i < max_num_column; i++) { for (j = 0; j < NUM_SUB_QMF_CHANNELS_HI_RES; j++) { ptr_ps_dec->hyb_right_re[i][j] = ptr_ps_dec->hyb_left_re[i][j]; ptr_ps_dec->hyb_right_im[i][j] = ptr_ps_dec->hyb_left_im[i][j]; } } } else { if (ptr_ps_dec->ps_mode & 0x0002) { WORD32 i, j; for (i = 0; i < max_num_column; i++) { for (j = 0; j < NUM_OF_QUAD_MIRROR_FILTER_CHNLS; j++) { pp_qmf_buf_im_right[i][j] = 0.; pp_qmf_buf_re_right[i][j] = 0.; } } for (i = 0; i < max_num_column; i++) { for (j = 0; j < NUM_SUB_QMF_CHANNELS_HI_RES; j++) { ptr_ps_dec->hyb_right_re[i][j] = 0.; ptr_ps_dec->hyb_right_im[i][j] = 0.; } } } else { ixheaacd_esbr_ps_de_correlate(ptr_ps_dec, pp_qmf_buf_re_left, pp_qmf_buf_im_left, pp_qmf_buf_re_right, pp_qmf_buf_im_right, ptr_ps_tables); } if (!(ptr_ps_dec->ps_mode & 0x0040)) { ixheaacd_esbr_ps_apply_rotation(ptr_ps_dec, pp_qmf_buf_re_left, pp_qmf_buf_im_left, pp_qmf_buf_re_right, pp_qmf_buf_im_right, ptr_ps_tables); } } ixheaacd_hyb_synth(ptr_ps_dec->hyb_left_re, ptr_ps_dec->hyb_left_im, pp_qmf_buf_re_left, pp_qmf_buf_im_left, ptr_ps_dec->ptr_hybrid); ixheaacd_hyb_synth(ptr_ps_dec->hyb_right_re, ptr_ps_dec->hyb_right_im, pp_qmf_buf_re_right, pp_qmf_buf_im_right, ptr_ps_dec->ptr_hybrid); ptr_ps_dec->use_34_st_bands_prev = ptr_ps_dec->use_34_st_bands; } VOID ixheaacd_esbr_ps_de_correlate( ia_ps_dec_struct *ptr_ps_dec, FLOAT32 **pp_qmf_buf_re_left, FLOAT32 **pp_qmf_buf_im_left, FLOAT32 **pp_qmf_buf_re_right, FLOAT32 **pp_qmf_buf_im_right, ia_ps_tables_struct *ptr_ps_tables) { WORD32 sb, maxsb, gr, k; WORD32 m; WORD32 l_delay = 0; WORD32 l_ser_delay_arr[NUM_SER_AP_LINKS] = {0}; FLOAT32 re_left; FLOAT32 im_left; FLOAT32 peak_diff, nrg, trans_ratio; FLOAT32(*pp_hyb_left_re)[MAX_NUM_COLUMNS]; FLOAT32(*pp_hyb_left_im)[MAX_NUM_COLUMNS]; FLOAT32(*pp_hyb_right_re)[MAX_NUM_COLUMNS]; FLOAT32(*pp_hyb_right_im)[MAX_NUM_COLUMNS]; FLOAT32(*ppp_ser_sub_qmf_dealy_buf_re)[5][NUM_OF_QUAD_MIRROR_FILTER_CHNLS]; FLOAT32(*ppp_ser_sub_qmf_dealy_buf_im)[5][NUM_OF_QUAD_MIRROR_FILTER_CHNLS]; FLOAT32(*pp_sub_qmf_delay_buf_re)[NUM_OF_QUAD_MIRROR_FILTER_CHNLS]; FLOAT32(*pp_sub_qmf_delay_buf_im)[NUM_OF_QUAD_MIRROR_FILTER_CHNLS]; FLOAT32 *pp_frac_delay_phase_fac_re; FLOAT32 *pp_frac_delay_phase_fac_im; FLOAT32(*pp_frac_delay_phase_fac_ser_re)[NUM_SER_AP_LINKS]; FLOAT32(*pp_frac_delay_phase_fac_ser_im)[NUM_SER_AP_LINKS]; WORD32 *p_delay_qmf_delay_num_samp = NULL; WORD32 *p_delay_qmf_delay_buf_idx = NULL; FLOAT32 pow_arr[32][NUM_HI_RES_BINS]; FLOAT32 trans_ratio_arr[32][NUM_HI_RES_BINS]; WORD32 bin; FLOAT32 decay_cutoff; pp_hyb_left_re = ptr_ps_dec->hyb_left_re; pp_hyb_left_im = ptr_ps_dec->hyb_left_im; pp_hyb_right_re = ptr_ps_dec->hyb_right_re; pp_hyb_right_im = ptr_ps_dec->hyb_right_im; ppp_ser_sub_qmf_dealy_buf_re = ptr_ps_dec->ser_sub_qmf_dealy_buf_re; ppp_ser_sub_qmf_dealy_buf_im = ptr_ps_dec->ser_sub_qmf_dealy_buf_im; pp_sub_qmf_delay_buf_re = ptr_ps_dec->sub_qmf_delay_buf_re; pp_sub_qmf_delay_buf_im = ptr_ps_dec->sub_qmf_delay_buf_im; if (ptr_ps_dec->use_34_st_bands != ptr_ps_dec->use_34_st_bands_prev) { if (ptr_ps_dec->use_34_st_bands) { WORD32 i; for (i = 0; i < NUM_SER_AP_LINKS; i++) { memset(&ptr_ps_dec->ser_qmf_delay_buf_re[i][0][0], 0, sizeof(ptr_ps_dec->ser_qmf_delay_buf_re[i])); memset(&ptr_ps_dec->ser_qmf_delay_buf_im[i][0][0], 0, sizeof(ptr_ps_dec->ser_qmf_delay_buf_im[i])); memset(&ptr_ps_dec->ser_sub_qmf_dealy_buf_re[i][0][0], 0, sizeof(ptr_ps_dec->ser_sub_qmf_dealy_buf_re[i])); memset(&ptr_ps_dec->ser_sub_qmf_dealy_buf_im[i][0][0], 0, sizeof(ptr_ps_dec->ser_sub_qmf_dealy_buf_im[i])); } return; } else { WORD32 i; for (i = 0; i < NUM_SER_AP_LINKS; i++) { memset(&ptr_ps_dec->ser_qmf_delay_buf_re[i][0][0], 0, sizeof(ptr_ps_dec->ser_qmf_delay_buf_re[i])); memset(&ptr_ps_dec->ser_qmf_delay_buf_im[i][0][0], 0, sizeof(ptr_ps_dec->ser_qmf_delay_buf_im[i])); memset(&ptr_ps_dec->ser_sub_qmf_dealy_buf_re[i][0][0], 0, sizeof(ptr_ps_dec->ser_sub_qmf_dealy_buf_re[i])); memset(&ptr_ps_dec->ser_sub_qmf_dealy_buf_im[i][0][0], 0, sizeof(ptr_ps_dec->ser_sub_qmf_dealy_buf_im[i])); } return; } } if (ptr_ps_dec->use_34_st_bands) { pp_frac_delay_phase_fac_re = ptr_ps_tables->frac_delay_phase_fac_qmf_sub_re_34; pp_frac_delay_phase_fac_im = ptr_ps_tables->frac_delay_phase_fac_qmf_sub_im_34; pp_frac_delay_phase_fac_ser_re = ptr_ps_tables->frac_delay_phase_fac_ser_qmf_sub_re_34; pp_frac_delay_phase_fac_ser_im = ptr_ps_tables->frac_delay_phase_fac_ser_qmf_sub_im_34; } else { pp_frac_delay_phase_fac_re = ptr_ps_tables->frac_delay_phase_fac_qmf_sub_re_20; pp_frac_delay_phase_fac_im = ptr_ps_tables->frac_delay_phase_fac_qmf_sub_im_20; pp_frac_delay_phase_fac_ser_re = ptr_ps_tables->frac_delay_phase_fac_ser_qmf_sub_re_20; pp_frac_delay_phase_fac_ser_im = ptr_ps_tables->frac_delay_phase_fac_ser_qmf_sub_im_20; } for (k = 0; k < 32; k++) { for (bin = 0; bin < NUM_HI_RES_BINS; bin++) { pow_arr[k][bin] = 0; } } for (gr = 0; gr < ptr_ps_dec->num_sub_qmf_groups; gr++) { bin = (~NEGATE_IPD_MASK) & ptr_ps_dec->ptr_bins_group_map[gr]; maxsb = ptr_ps_dec->ptr_group_borders[gr] + 1; for (sb = ptr_ps_dec->ptr_group_borders[gr]; sb < maxsb; sb++) { for (k = ptr_ps_dec->border_position[0]; k < ptr_ps_dec->border_position[ptr_ps_dec->num_env]; k++) { im_left = pp_hyb_left_re[k][sb]; re_left = pp_hyb_left_im[k][sb]; pow_arr[k][bin] += im_left * im_left + re_left * re_left; } } } for (; gr < ptr_ps_dec->num_groups; gr++) { bin = (~NEGATE_IPD_MASK) & ptr_ps_dec->ptr_bins_group_map[gr]; maxsb = ptr_ps_dec->ptr_group_borders[gr + 1]; for (sb = ptr_ps_dec->ptr_group_borders[gr]; sb < maxsb; sb++) { for (k = ptr_ps_dec->border_position[0]; k < ptr_ps_dec->border_position[ptr_ps_dec->num_env]; k++) { im_left = pp_qmf_buf_re_left[k][sb]; re_left = pp_qmf_buf_im_left[k][sb]; pow_arr[k][bin] += im_left * im_left + re_left * re_left; } } } for (bin = 0; bin < ptr_ps_dec->num_bins; bin++) { for (k = ptr_ps_dec->border_position[0]; k < ptr_ps_dec->border_position[ptr_ps_dec->num_env]; k++) { FLOAT32 q = 1.5f; ptr_ps_dec->peak_decay_fast_bin[bin] *= PEAK_DECAY_FACTOR_FAST; if (ptr_ps_dec->peak_decay_fast_bin[bin] < pow_arr[k][bin]) ptr_ps_dec->peak_decay_fast_bin[bin] = pow_arr[k][bin]; peak_diff = ptr_ps_dec->prev_peak_diff_bin[bin]; peak_diff += INIT_FILT_COEFF * (ptr_ps_dec->peak_decay_fast_bin[bin] - pow_arr[k][bin] - ptr_ps_dec->prev_peak_diff_bin[bin]); ptr_ps_dec->prev_peak_diff_bin[bin] = peak_diff; nrg = ptr_ps_dec->prev_nrg_bin[bin]; nrg += INIT_FILT_COEFF * (pow_arr[k][bin] - ptr_ps_dec->prev_nrg_bin[bin]); ptr_ps_dec->prev_nrg_bin[bin] = nrg; if (q * peak_diff <= nrg) { trans_ratio_arr[k][bin] = 1.0f; } else { trans_ratio_arr[k][bin] = nrg / (q * peak_diff); } } } if (ptr_ps_dec->use_34_st_bands) { decay_cutoff = DECAY_CUTOFF_HI_RES; } else { decay_cutoff = DECAY_CUTOFF; } for (gr = 0; gr < ptr_ps_dec->num_sub_qmf_groups; gr++) { maxsb = ptr_ps_dec->ptr_group_borders[gr] + 1; for (sb = ptr_ps_dec->ptr_group_borders[gr]; sb < maxsb; sb++) { FLOAT32 decay_scale_factor; decay_scale_factor = 1.0f; decay_scale_factor = max(decay_scale_factor, 0.0f); l_delay = ptr_ps_dec->delay_buf_idx; for (k = 0; k < NUM_SER_AP_LINKS; k++) l_ser_delay_arr[k] = ptr_ps_dec->delay_buf_idx_ser[k]; for (k = ptr_ps_dec->border_position[0]; k < ptr_ps_dec->border_position[ptr_ps_dec->num_env]; k++) { FLOAT32 real, imag, real0, imag0, r_r0, i_r0; im_left = pp_hyb_left_re[k][sb]; re_left = pp_hyb_left_im[k][sb]; { real0 = pp_sub_qmf_delay_buf_re[l_delay][sb]; imag0 = pp_sub_qmf_delay_buf_im[l_delay][sb]; pp_sub_qmf_delay_buf_re[l_delay][sb] = im_left; pp_sub_qmf_delay_buf_im[l_delay][sb] = re_left; real = real0 * pp_frac_delay_phase_fac_re[sb] - imag0 * pp_frac_delay_phase_fac_im[sb]; imag = real0 * pp_frac_delay_phase_fac_im[sb] + imag0 * pp_frac_delay_phase_fac_re[sb]; r_r0 = real; i_r0 = imag; for (m = 0; m < NUM_SER_AP_LINKS; m++) { real0 = ppp_ser_sub_qmf_dealy_buf_re[m][l_ser_delay_arr[m]][sb]; imag0 = ppp_ser_sub_qmf_dealy_buf_im[m][l_ser_delay_arr[m]][sb]; real = real0 * pp_frac_delay_phase_fac_ser_re[sb][m] - imag0 * pp_frac_delay_phase_fac_ser_im[sb][m]; imag = real0 * pp_frac_delay_phase_fac_ser_im[sb][m] + imag0 * pp_frac_delay_phase_fac_ser_re[sb][m]; real += -decay_scale_factor * ptr_ps_tables->all_pass_link_decay_ser[m] * r_r0; imag += -decay_scale_factor * ptr_ps_tables->all_pass_link_decay_ser[m] * i_r0; ppp_ser_sub_qmf_dealy_buf_re[m][l_ser_delay_arr[m]][sb] = r_r0 + decay_scale_factor * ptr_ps_tables->all_pass_link_decay_ser[m] * real; ppp_ser_sub_qmf_dealy_buf_im[m][l_ser_delay_arr[m]][sb] = i_r0 + decay_scale_factor * ptr_ps_tables->all_pass_link_decay_ser[m] * imag; r_r0 = real; i_r0 = imag; } } bin = (~NEGATE_IPD_MASK) & ptr_ps_dec->ptr_bins_group_map[gr]; trans_ratio = trans_ratio_arr[k][bin]; pp_hyb_right_re[k][sb] = trans_ratio * r_r0; pp_hyb_right_im[k][sb] = trans_ratio * i_r0; if (++l_delay >= DEL_ALL_PASS) l_delay = 0; for (m = 0; m < NUM_SER_AP_LINKS; m++) { if (++l_ser_delay_arr[m] >= ptr_ps_dec->delay_sample_ser[m]) { l_ser_delay_arr[m] = 0; } } } } } { ppp_ser_sub_qmf_dealy_buf_re = ptr_ps_dec->ser_qmf_delay_buf_re; ppp_ser_sub_qmf_dealy_buf_im = ptr_ps_dec->ser_qmf_delay_buf_im; pp_sub_qmf_delay_buf_re = ptr_ps_dec->qmf_delay_buf_re; pp_sub_qmf_delay_buf_im = ptr_ps_dec->qmf_delay_buf_im; pp_frac_delay_phase_fac_re = ptr_ps_tables->qmf_fract_delay_phase_factor_re; pp_frac_delay_phase_fac_im = ptr_ps_tables->qmf_fract_delay_phase_factor_im; pp_frac_delay_phase_fac_ser_re = ptr_ps_tables->qmf_ser_fract_delay_phase_factor_re; pp_frac_delay_phase_fac_ser_im = ptr_ps_tables->qmf_ser_fract_delay_phase_factor_im; p_delay_qmf_delay_buf_idx = ptr_ps_dec->delay_qmf_delay_buf_idx; p_delay_qmf_delay_num_samp = ptr_ps_dec->delay_qmf_delay_num_samp; } for (; gr < ptr_ps_dec->num_groups; gr++) { maxsb = ptr_ps_dec->ptr_group_borders[gr + 1]; for (sb = ptr_ps_dec->ptr_group_borders[gr]; sb < maxsb; sb++) { FLOAT32 decay_scale_factor; if (sb <= decay_cutoff) decay_scale_factor = 1.0f; else decay_scale_factor = 1.0f + decay_cutoff * DECAY_SLOPE - DECAY_SLOPE * sb; decay_scale_factor = max(decay_scale_factor, 0.0f); l_delay = ptr_ps_dec->delay_buf_idx; for (k = 0; k < NUM_SER_AP_LINKS; k++) l_ser_delay_arr[k] = ptr_ps_dec->delay_buf_idx_ser[k]; for (k = ptr_ps_dec->border_position[0]; k < ptr_ps_dec->border_position[ptr_ps_dec->num_env]; k++) { FLOAT32 real, imag, real0, imag0, r_r0, i_r0; im_left = pp_qmf_buf_re_left[k][sb]; re_left = pp_qmf_buf_im_left[k][sb]; if (gr >= ptr_ps_dec->first_delay_gr && sb >= NUM_OF_ALL_PASS_CHNLS) { real = pp_sub_qmf_delay_buf_re[p_delay_qmf_delay_buf_idx[sb]][sb]; imag = pp_sub_qmf_delay_buf_im[p_delay_qmf_delay_buf_idx[sb]][sb]; r_r0 = real; i_r0 = imag; pp_sub_qmf_delay_buf_re[p_delay_qmf_delay_buf_idx[sb]][sb] = im_left; pp_sub_qmf_delay_buf_im[p_delay_qmf_delay_buf_idx[sb]][sb] = re_left; } else { real0 = pp_sub_qmf_delay_buf_re[l_delay][sb]; imag0 = pp_sub_qmf_delay_buf_im[l_delay][sb]; pp_sub_qmf_delay_buf_re[l_delay][sb] = im_left; pp_sub_qmf_delay_buf_im[l_delay][sb] = re_left; real = real0 * pp_frac_delay_phase_fac_re[sb] - imag0 * pp_frac_delay_phase_fac_im[sb]; imag = real0 * pp_frac_delay_phase_fac_im[sb] + imag0 * pp_frac_delay_phase_fac_re[sb]; r_r0 = real; i_r0 = imag; for (m = 0; m < NUM_SER_AP_LINKS; m++) { real0 = ppp_ser_sub_qmf_dealy_buf_re[m][l_ser_delay_arr[m]][sb]; imag0 = ppp_ser_sub_qmf_dealy_buf_im[m][l_ser_delay_arr[m]][sb]; real = real0 * pp_frac_delay_phase_fac_ser_re[sb][m] - imag0 * pp_frac_delay_phase_fac_ser_im[sb][m]; imag = real0 * pp_frac_delay_phase_fac_ser_im[sb][m] + imag0 * pp_frac_delay_phase_fac_ser_re[sb][m]; real += -decay_scale_factor * ptr_ps_tables->all_pass_link_decay_ser[m] * r_r0; imag += -decay_scale_factor * ptr_ps_tables->all_pass_link_decay_ser[m] * i_r0; ppp_ser_sub_qmf_dealy_buf_re[m][l_ser_delay_arr[m]][sb] = r_r0 + decay_scale_factor * ptr_ps_tables->all_pass_link_decay_ser[m] * real; ppp_ser_sub_qmf_dealy_buf_im[m][l_ser_delay_arr[m]][sb] = i_r0 + decay_scale_factor * ptr_ps_tables->all_pass_link_decay_ser[m] * imag; r_r0 = real; i_r0 = imag; } } bin = (~NEGATE_IPD_MASK) & ptr_ps_dec->ptr_bins_group_map[gr]; trans_ratio = trans_ratio_arr[k][bin]; pp_qmf_buf_re_right[k][sb] = trans_ratio * r_r0; pp_qmf_buf_im_right[k][sb] = trans_ratio * i_r0; if (++l_delay >= DEL_ALL_PASS) l_delay = 0; if (gr >= ptr_ps_dec->first_delay_gr && sb >= NUM_OF_ALL_PASS_CHNLS) { if (++p_delay_qmf_delay_buf_idx[sb] >= p_delay_qmf_delay_num_samp[sb]) { p_delay_qmf_delay_buf_idx[sb] = 0; } } for (m = 0; m < NUM_SER_AP_LINKS; m++) { if (++l_ser_delay_arr[m] >= ptr_ps_dec->delay_sample_ser[m]) { l_ser_delay_arr[m] = 0; } } } } } ptr_ps_dec->delay_buf_idx = l_delay; for (m = 0; m < NUM_SER_AP_LINKS; m++) { ptr_ps_dec->delay_buf_idx_ser[m] = l_ser_delay_arr[m]; } } VOID ixheaacd_esbr_ps_apply_rotation( ia_ps_dec_struct *ptr_ps_dec, FLOAT32 **pp_qmf_buf_re_left, FLOAT32 **pp_qmf_buf_im_left, FLOAT32 **pp_qmf_buf_re_right, FLOAT32 **pp_qmf_buf_im_right, ia_ps_tables_struct *ptr_ps_tables) { WORD32 i; WORD32 group; WORD32 bin = 0; WORD32 subband, max_subband; WORD32 env; FLOAT32(*p_hyb_left_re)[MAX_NUM_COLUMNS]; FLOAT32(*p_hyb_left_im)[MAX_NUM_COLUMNS]; FLOAT32(*p_hyb_rigth_re)[MAX_NUM_COLUMNS]; FLOAT32(*p_hyb_rigth_im)[MAX_NUM_COLUMNS]; FLOAT32 scale_fac_l, scale_fac_r; FLOAT32 alpha, beta; FLOAT32 ipd, opd; FLOAT32 ipd1, opd1; FLOAT32 ipd2, opd2; FLOAT32 h11r, h12r, h21r, h22r; FLOAT32 h11i, h12i, h21i, h22i; FLOAT32 H11r, H12r, H21r, H22r; FLOAT32 H11i, H12i, H21i, H22i; FLOAT32 deltaH11r, deltaH12r, deltaH21r, deltaH22r; FLOAT32 deltaH11i, deltaH12i, deltaH21i, deltaH22i; FLOAT32 l_left_re, l_left_im; FLOAT32 l_right_re, l_right_im; WORD32 L; FLOAT32 *ptr_scale_factors; const WORD32 *ptr_quantized_iids; WORD32 num_iid_steps; if (ptr_ps_dec->iid_quant) { num_iid_steps = NUM_IID_STEPS_FINE; ptr_scale_factors = ptr_ps_tables->scale_factors_fine_flt; ptr_quantized_iids = ptr_ps_tables->quantized_iids_fine; } else { num_iid_steps = NUM_IID_STEPS; ptr_scale_factors = ptr_ps_tables->scale_factors_flt; ptr_quantized_iids = ptr_ps_tables->quantized_iids; } if (ptr_ps_dec->use_34_st_bands != ptr_ps_dec->use_34_st_bands_prev) { if (ptr_ps_dec->use_34_st_bands) { ixheaacd_map_20_float_to_34(ptr_ps_dec->h11_re_prev); ixheaacd_map_20_float_to_34(ptr_ps_dec->h12_re_prev); ixheaacd_map_20_float_to_34(ptr_ps_dec->h21_re_prev); ixheaacd_map_20_float_to_34(ptr_ps_dec->h22_re_prev); ixheaacd_map_20_float_to_34(ptr_ps_dec->h11_im_prev); ixheaacd_map_20_float_to_34(ptr_ps_dec->h12_im_prev); ixheaacd_map_20_float_to_34(ptr_ps_dec->h21_im_prev); ixheaacd_map_20_float_to_34(ptr_ps_dec->h22_im_prev); memset(ptr_ps_dec->ipd_idx_map_1, 0, sizeof(ptr_ps_dec->ipd_idx_map_1)); memset(ptr_ps_dec->opd_idx_map_1, 0, sizeof(ptr_ps_dec->opd_idx_map_1)); memset(ptr_ps_dec->ipd_idx_map_2, 0, sizeof(ptr_ps_dec->ipd_idx_map_2)); memset(ptr_ps_dec->opd_idx_map_2, 0, sizeof(ptr_ps_dec->opd_idx_map_2)); } else { ixheaacd_map_34_float_to_20(ptr_ps_dec->h11_re_prev); ixheaacd_map_34_float_to_20(ptr_ps_dec->h12_re_prev); ixheaacd_map_34_float_to_20(ptr_ps_dec->h21_re_prev); ixheaacd_map_34_float_to_20(ptr_ps_dec->h22_re_prev); ixheaacd_map_34_float_to_20(ptr_ps_dec->h11_im_prev); ixheaacd_map_34_float_to_20(ptr_ps_dec->h12_im_prev); ixheaacd_map_34_float_to_20(ptr_ps_dec->h21_im_prev); ixheaacd_map_34_float_to_20(ptr_ps_dec->h22_im_prev); memset(ptr_ps_dec->ipd_idx_map_1, 0, sizeof(ptr_ps_dec->ipd_idx_map_1)); memset(ptr_ps_dec->opd_idx_map_1, 0, sizeof(ptr_ps_dec->opd_idx_map_1)); memset(ptr_ps_dec->ipd_idx_map_2, 0, sizeof(ptr_ps_dec->ipd_idx_map_2)); memset(ptr_ps_dec->opd_idx_map_2, 0, sizeof(ptr_ps_dec->opd_idx_map_2)); } } for (env = 0; env < ptr_ps_dec->num_env; env++) { for (bin = 0; bin < ptr_ps_dec->num_bins; bin++) { if (!ptr_ps_dec->use_pca_rot_flg) { scale_fac_r = ptr_scale_factors[num_iid_steps + ptr_ps_dec->iid_par_table[env][bin]]; scale_fac_l = ptr_scale_factors[num_iid_steps - ptr_ps_dec->iid_par_table[env][bin]]; alpha = ptr_ps_tables->alphas[ptr_ps_dec->icc_par_table[env][bin]]; beta = alpha * (scale_fac_r - scale_fac_l) / PSC_SQRT2F; h11r = (FLOAT32)(scale_fac_l * cos(beta + alpha)); h12r = (FLOAT32)(scale_fac_r * cos(beta - alpha)); h21r = (FLOAT32)(scale_fac_l * sin(beta + alpha)); h22r = (FLOAT32)(scale_fac_r * sin(beta - alpha)); } else { FLOAT32 c, rho, mu, alpha, gamma; WORD32 i; i = ptr_ps_dec->iid_par_table[env][bin]; c = (FLOAT32)pow( 10.0, ((i) ? (((i > 0) ? 1 : -1) * ptr_quantized_iids[((i > 0) ? i : -i) - 1]) : 0.) / 20.0); rho = ptr_ps_tables->quantized_rhos[ptr_ps_dec->icc_par_table[env][bin]]; rho = max(rho, 0.05f); if (rho == 0.0f && c == 1.) { alpha = (FLOAT32)PI / 4.0f; } else { if (rho <= 0.05f) { rho = 0.05f; } alpha = 0.5f * (FLOAT32)atan((2.0f * c * rho) / (c * c - 1.0f)); if (alpha < 0.) { alpha += (FLOAT32)PI / 2.0f; } } mu = c + 1.0f / c; mu = 1 + (4.0f * rho * rho - 4.0f) / (mu * mu); gamma = (FLOAT32)atan(sqrt((1.0f - sqrt(mu)) / (1.0f + sqrt(mu)))); h11r = (FLOAT32)(sqrt(2.) * cos(alpha) * cos(gamma)); h12r = (FLOAT32)(sqrt(2.) * sin(alpha) * cos(gamma)); h21r = (FLOAT32)(sqrt(2.) * -sin(alpha) * sin(gamma)); h22r = (FLOAT32)(sqrt(2.) * cos(alpha) * sin(gamma)); } if (bin >= ptr_ps_tables->ipd_bins_tbl[ptr_ps_dec->freq_res_ipd]) { h11i = h12i = h21i = h22i = 0.0f; } else { ipd = (IPD_SCALE_FACTOR * 2.0f) * ptr_ps_dec->ipd_idx_map[env][bin]; opd = (OPD_SCALE_FACTOR * 2.0f) * ptr_ps_dec->opd_idx_map[env][bin]; ipd1 = (IPD_SCALE_FACTOR * 2.0f) * ptr_ps_dec->ipd_idx_map_1[bin]; opd1 = (OPD_SCALE_FACTOR * 2.0f) * ptr_ps_dec->opd_idx_map_1[bin]; ipd2 = (IPD_SCALE_FACTOR * 2.0f) * ptr_ps_dec->ipd_idx_map_2[bin]; opd2 = (OPD_SCALE_FACTOR * 2.0f) * ptr_ps_dec->opd_idx_map_2[bin]; l_left_re = (FLOAT32)cos(ipd); l_left_im = (FLOAT32)sin(ipd); l_right_re = (FLOAT32)cos(opd); l_right_im = (FLOAT32)sin(opd); l_left_re += PHASE_SMOOTH_HIST1 * (FLOAT32)cos(ipd1); l_left_im += PHASE_SMOOTH_HIST1 * (FLOAT32)sin(ipd1); l_right_re += PHASE_SMOOTH_HIST1 * (FLOAT32)cos(opd1); l_right_im += PHASE_SMOOTH_HIST1 * (FLOAT32)sin(opd1); l_left_re += PHASE_SMOOTH_HIST2 * (FLOAT32)cos(ipd2); l_left_im += PHASE_SMOOTH_HIST2 * (FLOAT32)sin(ipd2); l_right_re += PHASE_SMOOTH_HIST2 * (FLOAT32)cos(opd2); l_right_im += PHASE_SMOOTH_HIST2 * (FLOAT32)sin(opd2); ipd = (FLOAT32)atan2(l_left_im, l_left_re); opd = (FLOAT32)atan2(l_right_im, l_right_re); l_left_re = (FLOAT32)cos(opd); l_left_im = (FLOAT32)sin(opd); opd -= ipd; l_right_re = (FLOAT32)cos(opd); l_right_im = (FLOAT32)sin(opd); h11i = h11r * l_left_im; h12i = h12r * l_right_im; h21i = h21r * l_left_im; h22i = h22r * l_right_im; h11r *= l_left_re; h12r *= l_right_re; h21r *= l_left_re; h22r *= l_right_re; } ptr_ps_dec->h11_re_vec[bin] = h11r; ptr_ps_dec->h12_re_vec[bin] = h12r; ptr_ps_dec->h21_re_vec[bin] = h21r; ptr_ps_dec->h22_re_vec[bin] = h22r; ptr_ps_dec->h11_im_vec[bin] = h11i; ptr_ps_dec->h12_im_vec[bin] = h12i; ptr_ps_dec->h21_im_vec[bin] = h21i; ptr_ps_dec->h22_im_vec[bin] = h22i; } p_hyb_left_re = ptr_ps_dec->hyb_left_re; p_hyb_left_im = ptr_ps_dec->hyb_left_im; p_hyb_rigth_re = ptr_ps_dec->hyb_right_re; p_hyb_rigth_im = ptr_ps_dec->hyb_right_im; for (group = 0; group < ptr_ps_dec->num_sub_qmf_groups; group++) { bin = (~NEGATE_IPD_MASK) & ptr_ps_dec->ptr_bins_group_map[group]; max_subband = ptr_ps_dec->ptr_group_borders[group] + 1; L = ptr_ps_dec->border_position[env + 1] - ptr_ps_dec->border_position[env]; H11r = ptr_ps_dec->h11_re_prev[bin]; H12r = ptr_ps_dec->h12_re_prev[bin]; H21r = ptr_ps_dec->h21_re_prev[bin]; H22r = ptr_ps_dec->h22_re_prev[bin]; if ((NEGATE_IPD_MASK & ptr_ps_dec->ptr_bins_group_map[group]) != 0) { H11i = -ptr_ps_dec->h11_im_prev[bin]; H12i = -ptr_ps_dec->h12_im_prev[bin]; H21i = -ptr_ps_dec->h21_im_prev[bin]; H22i = -ptr_ps_dec->h22_im_prev[bin]; } else { H11i = ptr_ps_dec->h11_im_prev[bin]; H12i = ptr_ps_dec->h12_im_prev[bin]; H21i = ptr_ps_dec->h21_im_prev[bin]; H22i = ptr_ps_dec->h22_im_prev[bin]; } h11r = ptr_ps_dec->h11_re_vec[bin]; h12r = ptr_ps_dec->h12_re_vec[bin]; h21r = ptr_ps_dec->h21_re_vec[bin]; h22r = ptr_ps_dec->h22_re_vec[bin]; if ((NEGATE_IPD_MASK & ptr_ps_dec->ptr_bins_group_map[group]) != 0) { h11i = -ptr_ps_dec->h11_im_vec[bin]; h12i = -ptr_ps_dec->h12_im_vec[bin]; h21i = -ptr_ps_dec->h21_im_vec[bin]; h22i = -ptr_ps_dec->h22_im_vec[bin]; } else { h11i = ptr_ps_dec->h11_im_vec[bin]; h12i = ptr_ps_dec->h12_im_vec[bin]; h21i = ptr_ps_dec->h21_im_vec[bin]; h22i = ptr_ps_dec->h22_im_vec[bin]; } deltaH11r = (h11r - H11r) / L; deltaH12r = (h12r - H12r) / L; deltaH21r = (h21r - H21r) / L; deltaH22r = (h22r - H22r) / L; deltaH11i = (h11i - H11i) / L; deltaH12i = (h12i - H12i) / L; deltaH21i = (h21i - H21i) / L; deltaH22i = (h22i - H22i) / L; for (i = ptr_ps_dec->border_position[env]; i < ptr_ps_dec->border_position[env + 1]; i++) { H11r += deltaH11r; H12r += deltaH12r; H21r += deltaH21r; H22r += deltaH22r; H11i += deltaH11i; H12i += deltaH12i; H21i += deltaH21i; H22i += deltaH22i; for (subband = ptr_ps_dec->ptr_group_borders[group]; subband < max_subband; subband++) { l_left_re = H11r * p_hyb_left_re[i][subband] - H11i * p_hyb_left_im[i][subband] + H21r * p_hyb_rigth_re[i][subband] - H21i * p_hyb_rigth_im[i][subband]; l_left_im = H11i * p_hyb_left_re[i][subband] + H11r * p_hyb_left_im[i][subband] + H21i * p_hyb_rigth_re[i][subband] + H21r * p_hyb_rigth_im[i][subband]; l_right_re = H12r * p_hyb_left_re[i][subband] - H12i * p_hyb_left_im[i][subband] + H22r * p_hyb_rigth_re[i][subband] - H22i * p_hyb_rigth_im[i][subband]; l_right_im = H12i * p_hyb_left_re[i][subband] + H12r * p_hyb_left_im[i][subband] + H22i * p_hyb_rigth_re[i][subband] + H22r * p_hyb_rigth_im[i][subband]; p_hyb_left_re[i][subband] = l_left_re; p_hyb_left_im[i][subband] = l_left_im; p_hyb_rigth_re[i][subband] = l_right_re; p_hyb_rigth_im[i][subband] = l_right_im; } } } for (; group < ptr_ps_dec->num_groups; group++) { bin = (~NEGATE_IPD_MASK) & ptr_ps_dec->ptr_bins_group_map[group]; max_subband = ptr_ps_dec->ptr_group_borders[group + 1]; L = ptr_ps_dec->border_position[env + 1] - ptr_ps_dec->border_position[env]; H11r = ptr_ps_dec->h11_re_prev[bin]; H12r = ptr_ps_dec->h12_re_prev[bin]; H21r = ptr_ps_dec->h21_re_prev[bin]; H22r = ptr_ps_dec->h22_re_prev[bin]; if ((NEGATE_IPD_MASK & ptr_ps_dec->ptr_bins_group_map[group]) != 0) { H11i = -ptr_ps_dec->h11_im_prev[bin]; H12i = -ptr_ps_dec->h12_im_prev[bin]; H21i = -ptr_ps_dec->h21_im_prev[bin]; H22i = -ptr_ps_dec->h22_im_prev[bin]; } else { H11i = ptr_ps_dec->h11_im_prev[bin]; H12i = ptr_ps_dec->h12_im_prev[bin]; H21i = ptr_ps_dec->h21_im_prev[bin]; H22i = ptr_ps_dec->h22_im_prev[bin]; } h11r = ptr_ps_dec->h11_re_vec[bin]; h12r = ptr_ps_dec->h12_re_vec[bin]; h21r = ptr_ps_dec->h21_re_vec[bin]; h22r = ptr_ps_dec->h22_re_vec[bin]; if ((NEGATE_IPD_MASK & ptr_ps_dec->ptr_bins_group_map[group]) != 0) { h11i = -ptr_ps_dec->h11_im_vec[bin]; h12i = -ptr_ps_dec->h12_im_vec[bin]; h21i = -ptr_ps_dec->h21_im_vec[bin]; h22i = -ptr_ps_dec->h22_im_vec[bin]; } else { h11i = ptr_ps_dec->h11_im_vec[bin]; h12i = ptr_ps_dec->h12_im_vec[bin]; h21i = ptr_ps_dec->h21_im_vec[bin]; h22i = ptr_ps_dec->h22_im_vec[bin]; } deltaH11r = (h11r - H11r) / L; deltaH12r = (h12r - H12r) / L; deltaH21r = (h21r - H21r) / L; deltaH22r = (h22r - H22r) / L; deltaH11i = (h11i - H11i) / L; deltaH12i = (h12i - H12i) / L; deltaH21i = (h21i - H21i) / L; deltaH22i = (h22i - H22i) / L; for (i = ptr_ps_dec->border_position[env]; i < ptr_ps_dec->border_position[env + 1]; i++) { H11r += deltaH11r; H12r += deltaH12r; H21r += deltaH21r; H22r += deltaH22r; H11i += deltaH11i; H12i += deltaH12i; H21i += deltaH21i; H22i += deltaH22i; for (subband = ptr_ps_dec->ptr_group_borders[group]; subband < max_subband; subband++) { l_left_re = H11r * pp_qmf_buf_re_left[i][subband] - H11i * pp_qmf_buf_im_left[i][subband] + H21r * pp_qmf_buf_re_right[i][subband] - H21i * pp_qmf_buf_im_right[i][subband]; l_left_im = H11i * pp_qmf_buf_re_left[i][subband] + H11r * pp_qmf_buf_im_left[i][subband] + H21i * pp_qmf_buf_re_right[i][subband] + H21r * pp_qmf_buf_im_right[i][subband]; l_right_re = H12r * pp_qmf_buf_re_left[i][subband] - H12i * pp_qmf_buf_im_left[i][subband] + H22r * pp_qmf_buf_re_right[i][subband] - H22i * pp_qmf_buf_im_right[i][subband]; l_right_im = H12i * pp_qmf_buf_re_left[i][subband] + H12r * pp_qmf_buf_im_left[i][subband] + H22i * pp_qmf_buf_re_right[i][subband] + H22r * pp_qmf_buf_im_right[i][subband]; pp_qmf_buf_re_left[i][subband] = l_left_re; pp_qmf_buf_im_left[i][subband] = l_left_im; pp_qmf_buf_re_right[i][subband] = l_right_re; pp_qmf_buf_im_right[i][subband] = l_right_im; } } } for (bin = 0; bin < ptr_ps_dec->num_bins; bin++) { ptr_ps_dec->h11_re_prev[bin] = ptr_ps_dec->h11_re_vec[bin]; ptr_ps_dec->h12_re_prev[bin] = ptr_ps_dec->h12_re_vec[bin]; ptr_ps_dec->h21_re_prev[bin] = ptr_ps_dec->h21_re_vec[bin]; ptr_ps_dec->h22_re_prev[bin] = ptr_ps_dec->h22_re_vec[bin]; ptr_ps_dec->h11_im_prev[bin] = ptr_ps_dec->h11_im_vec[bin]; ptr_ps_dec->h12_im_prev[bin] = ptr_ps_dec->h12_im_vec[bin]; ptr_ps_dec->h21_im_prev[bin] = ptr_ps_dec->h21_im_vec[bin]; ptr_ps_dec->h22_im_prev[bin] = ptr_ps_dec->h22_im_vec[bin]; } for (bin = 0; bin < ptr_ps_tables->ipd_bins_tbl[ptr_ps_dec->freq_res_ipd]; bin++) { ptr_ps_dec->ipd_idx_map_2[bin] = ptr_ps_dec->ipd_idx_map_1[bin]; ptr_ps_dec->opd_idx_map_2[bin] = ptr_ps_dec->opd_idx_map_1[bin]; ptr_ps_dec->ipd_idx_map_1[bin] = ptr_ps_dec->ipd_idx_map[env][bin]; ptr_ps_dec->opd_idx_map_1[bin] = ptr_ps_dec->opd_idx_map[env][bin]; } } }