/******************************************************************************
* *
* 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.0f * 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.0f * 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;
}