| /****************************************************************************** |
| * * |
| * 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 <math.h> |
| #include <stdlib.h> |
| #include <string.h> |
| |
| #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)); |
| |
| ixheaacd_real_synth_filt(ptr_hbe_txposer, num_columns, qmf_buf_real, |
| qmf_buf_imag); |
| |
| 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; |
| } |
