/src/libxaac/decoder/ixheaacd_hbe_trans.c
Line | Count | Source |
1 | | /****************************************************************************** |
2 | | * * |
3 | | * Copyright (C) 2018 The Android Open Source Project |
4 | | * |
5 | | * Licensed under the Apache License, Version 2.0 (the "License"); |
6 | | * you may not use this file except in compliance with the License. |
7 | | * You may obtain a copy of the License at: |
8 | | * |
9 | | * http://www.apache.org/licenses/LICENSE-2.0 |
10 | | * |
11 | | * Unless required by applicable law or agreed to in writing, software |
12 | | * distributed under the License is distributed on an "AS IS" BASIS, |
13 | | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
14 | | * See the License for the specific language governing permissions and |
15 | | * limitations under the License. |
16 | | * |
17 | | ***************************************************************************** |
18 | | * Originally developed and contributed by Ittiam Systems Pvt. Ltd, Bangalore |
19 | | */ |
20 | | #include <math.h> |
21 | | #include <stdlib.h> |
22 | | #include <string.h> |
23 | | |
24 | | #include "ixheaac_type_def.h" |
25 | | |
26 | | #include "ixheaacd_bitbuffer.h" |
27 | | |
28 | | #include "ixheaacd_interface.h" |
29 | | |
30 | | #include "ixheaacd_tns_usac.h" |
31 | | #include "ixheaacd_cnst.h" |
32 | | |
33 | | #include "ixheaacd_acelp_info.h" |
34 | | |
35 | | #include "ixheaacd_sbrdecsettings.h" |
36 | | #include "ixheaacd_info.h" |
37 | | #include "ixheaacd_sbr_common.h" |
38 | | #include "ixheaacd_drc_data_struct.h" |
39 | | #include "ixheaacd_drc_dec.h" |
40 | | #include "ixheaacd_sbrdecoder.h" |
41 | | #include "ixheaacd_mps_polyphase.h" |
42 | | #include "ixheaac_sbr_const.h" |
43 | | |
44 | | #include "ixheaacd_env_extr_part.h" |
45 | | #include "ixheaacd_sbr_rom.h" |
46 | | #include "ixheaacd_common_rom.h" |
47 | | #include "ixheaacd_hybrid.h" |
48 | | #include "ixheaacd_sbr_scale.h" |
49 | | #include "ixheaacd_ps_dec.h" |
50 | | #include "ixheaacd_freq_sca.h" |
51 | | #include "ixheaacd_lpp_tran.h" |
52 | | #include "ixheaacd_bitbuffer.h" |
53 | | #include "ixheaacd_env_extr.h" |
54 | | #include "ixheaacd_qmf_dec.h" |
55 | | #include "ixheaacd_env_calc.h" |
56 | | #include "ixheaacd_pvc_dec.h" |
57 | | |
58 | | #include "ixheaacd_sbr_dec.h" |
59 | | #include "ixheaac_error_standards.h" |
60 | | #include "ixheaacd_sbrqmftrans.h" |
61 | | #include "ixheaacd_qmf_poly.h" |
62 | | |
63 | | #include "ixheaac_constants.h" |
64 | | #include "ixheaac_basic_ops32.h" |
65 | | #include "ixheaac_basic_op.h" |
66 | | |
67 | | #include "ixheaac_esbr_rom.h" |
68 | | |
69 | 325k | #define SBR_CONST_PMIN 1.0f |
70 | | |
71 | 145k | static FLOAT32 *ixheaacd_map_prot_filter(WORD32 filt_length) { |
72 | 145k | switch (filt_length) { |
73 | 130 | case 4: |
74 | 130 | return (FLOAT32 *)&ixheaac_sub_samp_qmf_window_coeff[0]; |
75 | 0 | break; |
76 | 17.5k | case 8: |
77 | 17.5k | return (FLOAT32 *)&ixheaac_sub_samp_qmf_window_coeff[40]; |
78 | 0 | break; |
79 | 18.5k | case 12: |
80 | 18.5k | return (FLOAT32 *)&ixheaac_sub_samp_qmf_window_coeff[120]; |
81 | 0 | break; |
82 | 25.1k | case 16: |
83 | 25.1k | return (FLOAT32 *)&ixheaac_sub_samp_qmf_window_coeff[240]; |
84 | 0 | break; |
85 | 28.6k | case 20: |
86 | 28.6k | return (FLOAT32 *)&ixheaac_sub_samp_qmf_window_coeff[400]; |
87 | 0 | break; |
88 | 18.5k | case 24: |
89 | 18.5k | return (FLOAT32 *)&ixheaac_sub_samp_qmf_window_coeff[600]; |
90 | 0 | break; |
91 | 7.70k | case 32: |
92 | 7.70k | return (FLOAT32 *)&ixheaac_sub_samp_qmf_window_coeff[840]; |
93 | 0 | break; |
94 | 28.6k | case 40: |
95 | 28.6k | return (FLOAT32 *)&ixheaac_sub_samp_qmf_window_coeff[1160]; |
96 | 0 | break; |
97 | 0 | default: |
98 | 0 | return (FLOAT32 *)&ixheaac_sub_samp_qmf_window_coeff[0]; |
99 | 145k | } |
100 | 145k | } |
101 | | |
102 | | WORD32 ixheaacd_qmf_hbe_data_reinit(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, |
103 | | WORD16 *p_freq_band_tab[2], |
104 | 72.5k | WORD16 *p_num_sfb, WORD32 upsamp_4_flag) { |
105 | 72.5k | WORD32 synth_size, sfb, patch, stop_patch; |
106 | | |
107 | 72.5k | if (ptr_hbe_txposer != NULL) { |
108 | 72.5k | ptr_hbe_txposer->start_band = p_freq_band_tab[LOW][0]; |
109 | 72.5k | ptr_hbe_txposer->end_band = p_freq_band_tab[LOW][p_num_sfb[LOW]]; |
110 | | |
111 | 72.5k | ptr_hbe_txposer->synth_size = |
112 | 72.5k | 4 * ((ptr_hbe_txposer->start_band + 4) / 8 + 1); |
113 | 72.5k | ptr_hbe_txposer->k_start = |
114 | 72.5k | ixheaac_start_subband2kL_tbl[ptr_hbe_txposer->start_band]; |
115 | | |
116 | 72.5k | ptr_hbe_txposer->upsamp_4_flag = upsamp_4_flag; |
117 | 72.5k | ptr_hbe_txposer->esbr_hq = 0; |
118 | | |
119 | 72.5k | if (upsamp_4_flag) { |
120 | 4.14k | if (ptr_hbe_txposer->k_start + ptr_hbe_txposer->synth_size > 16) |
121 | 93 | ptr_hbe_txposer->k_start = 16 - ptr_hbe_txposer->synth_size; |
122 | 68.3k | } else if (ptr_hbe_txposer->core_frame_length == 768) { |
123 | 5.53k | if (ptr_hbe_txposer->k_start + ptr_hbe_txposer->synth_size > 24) |
124 | 2.58k | ptr_hbe_txposer->k_start = 24 - ptr_hbe_txposer->synth_size; |
125 | 5.53k | } |
126 | | |
127 | 72.5k | memset(ptr_hbe_txposer->synth_buf, 0, 1280 * sizeof(FLOAT32)); |
128 | 72.5k | synth_size = ptr_hbe_txposer->synth_size; |
129 | 72.5k | ptr_hbe_txposer->synth_buf_offset = 18 * synth_size; |
130 | 72.5k | switch (synth_size) { |
131 | 130 | case 4: |
132 | 130 | ptr_hbe_txposer->synth_cos_tab = |
133 | 130 | (FLOAT32 *)ixheaac_synth_cos_table_kl_4; |
134 | 130 | ptr_hbe_txposer->analy_cos_sin_tab = |
135 | 130 | (FLOAT32 *)ixheaac_analy_cos_sin_table_kl_8; |
136 | 130 | ptr_hbe_txposer->ixheaacd_real_synth_fft = &ixheaac_real_synth_fft_p2; |
137 | 130 | ptr_hbe_txposer->ixheaacd_cmplx_anal_fft = &ixheaac_cmplx_anal_fft_p2; |
138 | 130 | break; |
139 | 17.4k | case 8: |
140 | 17.4k | ptr_hbe_txposer->synth_cos_tab = |
141 | 17.4k | (FLOAT32 *)ixheaac_synth_cos_table_kl_8; |
142 | 17.4k | ptr_hbe_txposer->analy_cos_sin_tab = |
143 | 17.4k | (FLOAT32 *)ixheaac_analy_cos_sin_table_kl_16; |
144 | 17.4k | ptr_hbe_txposer->ixheaacd_real_synth_fft = &ixheaac_real_synth_fft_p2; |
145 | 17.4k | ptr_hbe_txposer->ixheaacd_cmplx_anal_fft = &ixheaac_cmplx_anal_fft_p2; |
146 | 17.4k | break; |
147 | 18.5k | case 12: |
148 | 18.5k | ptr_hbe_txposer->synth_cos_tab = |
149 | 18.5k | (FLOAT32 *)ixheaac_synth_cos_table_kl_12; |
150 | 18.5k | ptr_hbe_txposer->analy_cos_sin_tab = |
151 | 18.5k | (FLOAT32 *)ixheaac_analy_cos_sin_table_kl_24; |
152 | 18.5k | ptr_hbe_txposer->ixheaacd_real_synth_fft = &ixheaac_real_synth_fft_p3; |
153 | 18.5k | ptr_hbe_txposer->ixheaacd_cmplx_anal_fft = &ixheaac_cmplx_anal_fft_p3; |
154 | 18.5k | break; |
155 | 7.70k | case 16: |
156 | 7.70k | ptr_hbe_txposer->synth_cos_tab = |
157 | 7.70k | (FLOAT32 *)ixheaac_synth_cos_table_kl_16; |
158 | 7.70k | ptr_hbe_txposer->analy_cos_sin_tab = |
159 | 7.70k | (FLOAT32 *)ixheaac_analy_cos_sin_table_kl_32; |
160 | 7.70k | ptr_hbe_txposer->ixheaacd_real_synth_fft = &ixheaac_real_synth_fft_p2; |
161 | 7.70k | ptr_hbe_txposer->ixheaacd_cmplx_anal_fft = &ixheaac_cmplx_anal_fft_p2; |
162 | 7.70k | break; |
163 | 28.6k | case 20: |
164 | 28.6k | ptr_hbe_txposer->synth_cos_tab = |
165 | 28.6k | (FLOAT32 *)ixheaac_synth_cos_table_kl_20; |
166 | 28.6k | ptr_hbe_txposer->analy_cos_sin_tab = |
167 | 28.6k | (FLOAT32 *)ixheaac_analy_cos_sin_table_kl_40; |
168 | 28.6k | break; |
169 | 0 | default: |
170 | 0 | ptr_hbe_txposer->synth_cos_tab = |
171 | 0 | (FLOAT32 *)ixheaac_synth_cos_table_kl_4; |
172 | 0 | ptr_hbe_txposer->analy_cos_sin_tab = |
173 | 0 | (FLOAT32 *)ixheaac_analy_cos_sin_table_kl_8; |
174 | 0 | ptr_hbe_txposer->ixheaacd_real_synth_fft = &ixheaac_real_synth_fft_p2; |
175 | 0 | ptr_hbe_txposer->ixheaacd_cmplx_anal_fft = &ixheaac_cmplx_anal_fft_p2; |
176 | 72.5k | } |
177 | | |
178 | 72.5k | ptr_hbe_txposer->synth_wind_coeff = ixheaacd_map_prot_filter(synth_size); |
179 | | |
180 | 72.5k | memset(ptr_hbe_txposer->analy_buf, 0, 640 * sizeof(FLOAT32)); |
181 | 72.5k | synth_size = 2 * ptr_hbe_txposer->synth_size; |
182 | 72.5k | ptr_hbe_txposer->analy_wind_coeff = ixheaacd_map_prot_filter(synth_size); |
183 | | |
184 | 72.5k | memset(ptr_hbe_txposer->x_over_qmf, 0, MAX_NUM_PATCHES * sizeof(WORD32)); |
185 | 72.5k | sfb = 0; |
186 | 72.5k | if (upsamp_4_flag) { |
187 | 4.14k | stop_patch = MAX_NUM_PATCHES; |
188 | 4.14k | ptr_hbe_txposer->max_stretch = MAX_STRETCH; |
189 | 68.3k | } else { |
190 | 68.3k | stop_patch = MAX_STRETCH; |
191 | 68.3k | } |
192 | | |
193 | 211k | for (patch = 1; patch <= stop_patch; patch++) { |
194 | 718k | while (sfb <= p_num_sfb[LOW] && |
195 | 653k | p_freq_band_tab[LOW][sfb] <= patch * ptr_hbe_txposer->start_band) |
196 | 514k | sfb++; |
197 | 204k | if (sfb <= p_num_sfb[LOW]) { |
198 | 139k | if ((patch * ptr_hbe_txposer->start_band - |
199 | 139k | p_freq_band_tab[LOW][sfb - 1]) <= 3) { |
200 | 123k | ptr_hbe_txposer->x_over_qmf[patch - 1] = |
201 | 123k | p_freq_band_tab[LOW][sfb - 1]; |
202 | 123k | } else { |
203 | 15.9k | WORD32 sfb = 0; |
204 | 201k | while (sfb <= p_num_sfb[HIGH] && |
205 | 201k | p_freq_band_tab[HIGH][sfb] <= |
206 | 201k | patch * ptr_hbe_txposer->start_band) |
207 | 185k | sfb++; |
208 | 15.9k | ptr_hbe_txposer->x_over_qmf[patch - 1] = |
209 | 15.9k | p_freq_band_tab[HIGH][sfb - 1]; |
210 | 15.9k | } |
211 | 139k | } else { |
212 | 65.3k | ptr_hbe_txposer->x_over_qmf[patch - 1] = ptr_hbe_txposer->end_band; |
213 | 65.3k | ptr_hbe_txposer->max_stretch = min(patch, MAX_STRETCH); |
214 | 65.3k | break; |
215 | 65.3k | } |
216 | 204k | } |
217 | 72.5k | if (ptr_hbe_txposer->k_start < 0) { |
218 | 0 | return -1; |
219 | 0 | } |
220 | 72.5k | } |
221 | 72.5k | return 0; |
222 | 72.5k | } |
223 | | |
224 | | WORD32 ixheaacd_qmf_hbe_apply(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, |
225 | | FLOAT32 qmf_buf_real[][64], |
226 | | FLOAT32 qmf_buf_imag[][64], WORD32 num_columns, |
227 | | FLOAT32 pv_qmf_buf_real[][64], |
228 | | FLOAT32 pv_qmf_buf_imag[][64], |
229 | | WORD32 pitch_in_bins, |
230 | 325k | ia_sbr_header_data_struct *ptr_header_data) { |
231 | 325k | WORD32 i, qmf_band_idx; |
232 | 325k | WORD32 qmf_voc_columns = ptr_hbe_txposer->no_bins / 2; |
233 | 325k | WORD32 err_code = 0; |
234 | | |
235 | 325k | memcpy(ptr_hbe_txposer->ptr_input_buf, |
236 | 325k | ptr_hbe_txposer->ptr_input_buf + |
237 | 325k | ptr_hbe_txposer->no_bins * ptr_hbe_txposer->synth_size, |
238 | 325k | ptr_hbe_txposer->synth_size * sizeof(FLOAT32)); |
239 | | |
240 | 325k | if (ptr_hbe_txposer->ixheaacd_cmplx_anal_fft == NULL) { |
241 | 18.9k | WORD32 err = ixheaacd_qmf_hbe_data_reinit( |
242 | 18.9k | ptr_hbe_txposer, |
243 | 18.9k | ptr_header_data->pstr_freq_band_data->freq_band_table, |
244 | 18.9k | ptr_header_data->pstr_freq_band_data->num_sf_bands, |
245 | 18.9k | ptr_header_data->is_usf_4); |
246 | 18.9k | if (err) |
247 | 0 | return err; |
248 | 18.9k | } |
249 | | |
250 | 325k | err_code = ixheaacd_real_synth_filt(ptr_hbe_txposer, num_columns, |
251 | 325k | qmf_buf_real, qmf_buf_imag); |
252 | 325k | if (err_code) return err_code; |
253 | | |
254 | 4.23M | for (i = 0; i < HBE_OPER_WIN_LEN - 1; i++) { |
255 | 3.90M | memcpy(ptr_hbe_txposer->qmf_in_buf[i], |
256 | 3.90M | ptr_hbe_txposer->qmf_in_buf[i + qmf_voc_columns], |
257 | 3.90M | TWICE_QMF_SYNTH_CHANNELS_NUM * sizeof(FLOAT32)); |
258 | 3.90M | } |
259 | | |
260 | 325k | err_code = ixheaacd_complex_anal_filt(ptr_hbe_txposer); |
261 | 325k | if (err_code) return err_code; |
262 | | |
263 | 11.7M | for (i = 0; i < (ptr_hbe_txposer->hbe_qmf_out_len - ptr_hbe_txposer->no_bins); |
264 | 11.4M | i++) { |
265 | 11.4M | memcpy(ptr_hbe_txposer->qmf_out_buf[i], |
266 | 11.4M | ptr_hbe_txposer->qmf_out_buf[i + ptr_hbe_txposer->no_bins], |
267 | 11.4M | TWICE_QMF_SYNTH_CHANNELS_NUM * sizeof(FLOAT32)); |
268 | 11.4M | } |
269 | | |
270 | 11.7M | for (; i < ptr_hbe_txposer->hbe_qmf_out_len; i++) { |
271 | 11.4M | memset(ptr_hbe_txposer->qmf_out_buf[i], 0, |
272 | 11.4M | TWICE_QMF_SYNTH_CHANNELS_NUM * sizeof(FLOAT32)); |
273 | 11.4M | } |
274 | | |
275 | 325k | err_code = ixheaacd_hbe_post_anal_process(ptr_hbe_txposer, pitch_in_bins, |
276 | 325k | ptr_hbe_txposer->upsamp_4_flag); |
277 | 325k | if (err_code) return err_code; |
278 | | |
279 | 11.7M | for (i = 0; i < ptr_hbe_txposer->no_bins; i++) { |
280 | 11.4M | for (qmf_band_idx = ptr_hbe_txposer->start_band; |
281 | 264M | qmf_band_idx < ptr_hbe_txposer->end_band; qmf_band_idx++) { |
282 | 253M | pv_qmf_buf_real[i][qmf_band_idx] = |
283 | 253M | (FLOAT32)(ptr_hbe_txposer->qmf_out_buf[i][2 * qmf_band_idx] * |
284 | 253M | ixheaac_phase_vocoder_cos_table[qmf_band_idx] - |
285 | 253M | ptr_hbe_txposer->qmf_out_buf[i][2 * qmf_band_idx + 1] * |
286 | 253M | ixheaac_phase_vocoder_sin_table[qmf_band_idx]); |
287 | | |
288 | 253M | pv_qmf_buf_imag[i][qmf_band_idx] = |
289 | 253M | (FLOAT32)(ptr_hbe_txposer->qmf_out_buf[i][2 * qmf_band_idx] * |
290 | 253M | ixheaac_phase_vocoder_sin_table[qmf_band_idx] + |
291 | 253M | ptr_hbe_txposer->qmf_out_buf[i][2 * qmf_band_idx + 1] * |
292 | 253M | ixheaac_phase_vocoder_cos_table[qmf_band_idx]); |
293 | 253M | } |
294 | 11.4M | } |
295 | 325k | return 0; |
296 | 325k | } |
297 | | |
298 | | VOID ixheaacd_norm_qmf_in_buf_4(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, |
299 | 115k | WORD32 qmf_band_idx) { |
300 | 115k | WORD32 i; |
301 | 115k | FLOAT32 *in_buf = &ptr_hbe_txposer->qmf_in_buf[0][2 * qmf_band_idx]; |
302 | 115k | FLOAT32 *norm_buf = &ptr_hbe_txposer->norm_qmf_in_buf[0][2 * qmf_band_idx]; |
303 | | |
304 | 3.19M | for (; qmf_band_idx <= ptr_hbe_txposer->x_over_qmf[3]; qmf_band_idx++) { |
305 | 109M | for (i = 0; i < ptr_hbe_txposer->hbe_qmf_in_len; i++) { |
306 | 106M | FLOAT32 mag_scaling_fac = 0.0f; |
307 | 106M | FLOAT32 x_r, x_i, temp; |
308 | 106M | FLOAT64 base = 1e-17; |
309 | 106M | x_r = in_buf[0]; |
310 | 106M | x_i = in_buf[1]; |
311 | | |
312 | 106M | temp = x_r * x_r; |
313 | 106M | base = base + temp; |
314 | 106M | temp = x_i * x_i; |
315 | 106M | base = base + temp; |
316 | | |
317 | 106M | temp = (FLOAT32)sqrt(sqrt(base)); |
318 | 106M | mag_scaling_fac = temp * (FLOAT32)(sqrt(temp)); |
319 | | |
320 | 106M | mag_scaling_fac = 1 / mag_scaling_fac; |
321 | | |
322 | 106M | x_r *= mag_scaling_fac; |
323 | 106M | x_i *= mag_scaling_fac; |
324 | | |
325 | 106M | norm_buf[0] = x_r; |
326 | 106M | norm_buf[1] = x_i; |
327 | | |
328 | 106M | in_buf += 128; |
329 | 106M | norm_buf += 128; |
330 | 106M | } |
331 | | |
332 | 3.07M | in_buf -= (128 * (ptr_hbe_txposer->hbe_qmf_in_len) - 2); |
333 | 3.07M | norm_buf -= (128 * (ptr_hbe_txposer->hbe_qmf_in_len) - 2); |
334 | 3.07M | } |
335 | 115k | } |
336 | | |
337 | | VOID ixheaacd_norm_qmf_in_buf_2(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, |
338 | 286k | WORD32 qmf_band_idx) { |
339 | 286k | WORD32 i; |
340 | 286k | FLOAT32 *in_buf = &ptr_hbe_txposer->qmf_in_buf[0][2 * qmf_band_idx]; |
341 | 286k | FLOAT32 *norm_buf = &ptr_hbe_txposer->norm_qmf_in_buf[0][2 * qmf_band_idx]; |
342 | | |
343 | 3.64M | for (; qmf_band_idx <= ptr_hbe_txposer->x_over_qmf[1]; qmf_band_idx++) { |
344 | 117M | for (i = 0; i < ptr_hbe_txposer->hbe_qmf_in_len; i++) { |
345 | 114M | FLOAT32 mag_scaling_fac = 0.0f; |
346 | 114M | FLOAT32 x_r, x_i, temp; |
347 | 114M | FLOAT64 base = 1e-17; |
348 | 114M | x_r = in_buf[0]; |
349 | 114M | x_i = in_buf[1]; |
350 | | |
351 | 114M | temp = x_r * x_r; |
352 | 114M | base = base + temp; |
353 | 114M | temp = x_i * x_i; |
354 | 114M | base = base + x_i * x_i; |
355 | | |
356 | 114M | mag_scaling_fac = (FLOAT32)(1.0f / base); |
357 | 114M | mag_scaling_fac = (FLOAT32)sqrt(sqrt(mag_scaling_fac)); |
358 | | |
359 | 114M | x_r *= mag_scaling_fac; |
360 | 114M | x_i *= mag_scaling_fac; |
361 | | |
362 | 114M | norm_buf[0] = x_r; |
363 | 114M | norm_buf[1] = x_i; |
364 | | |
365 | 114M | in_buf += 128; |
366 | 114M | norm_buf += 128; |
367 | 114M | } |
368 | | |
369 | 3.35M | in_buf -= (128 * (ptr_hbe_txposer->hbe_qmf_in_len) - 2); |
370 | 3.35M | norm_buf -= (128 * (ptr_hbe_txposer->hbe_qmf_in_len) - 2); |
371 | 3.35M | } |
372 | 286k | } |
373 | | |
374 | | VOID ixheaacd_hbe_xprod_proc_3(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, |
375 | | WORD32 qmf_band_idx, WORD32 qmf_col_idx, |
376 | 1.35M | FLOAT32 p, WORD32 pitch_in_bins_idx) { |
377 | 1.35M | WORD32 tr, n1, n2, max_trans_fac, max_n1, max_n2; |
378 | 1.35M | WORD32 k, addrshift; |
379 | 1.35M | WORD32 inp_band_idx = 2 * qmf_band_idx / 3; |
380 | | |
381 | 1.35M | FLOAT64 temp_fac; |
382 | 1.35M | FLOAT32 max_mag_value; |
383 | 1.35M | FLOAT32 mag_zero_band, mag_n1_band, mag_n2_band, temp; |
384 | 1.35M | FLOAT32 temp_r, temp_i; |
385 | 1.35M | FLOAT32 mag_cmplx_gain = 1.8856f; |
386 | | |
387 | 1.35M | FLOAT32 *qmf_in_buf_ri = |
388 | 1.35M | ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + HBE_ZERO_BAND_IDX]; |
389 | | |
390 | 1.35M | mag_zero_band = |
391 | 1.35M | qmf_in_buf_ri[2 * inp_band_idx] * qmf_in_buf_ri[2 * inp_band_idx] + |
392 | 1.35M | qmf_in_buf_ri[2 * inp_band_idx + 1] * qmf_in_buf_ri[2 * inp_band_idx + 1]; |
393 | 1.35M | max_mag_value = 0; |
394 | 1.35M | max_n1 = max_n2 = max_trans_fac = 0; |
395 | | |
396 | 4.05M | for (tr = 1; tr < 3; tr++) { |
397 | 2.70M | temp_fac = (2.0f * qmf_band_idx + 1 - tr * p) * 0.3333334; |
398 | | |
399 | 2.70M | n1 = (WORD32)(temp_fac); |
400 | 2.70M | n2 = (WORD32)(temp_fac + p); |
401 | | |
402 | 2.70M | mag_n1_band = qmf_in_buf_ri[2 * n1] * qmf_in_buf_ri[2 * n1] + |
403 | 2.70M | qmf_in_buf_ri[2 * n1 + 1] * qmf_in_buf_ri[2 * n1 + 1]; |
404 | 2.70M | mag_n2_band = qmf_in_buf_ri[2 * n2] * qmf_in_buf_ri[2 * n2] + |
405 | 2.70M | qmf_in_buf_ri[2 * n2 + 1] * qmf_in_buf_ri[2 * n2 + 1]; |
406 | 2.70M | temp = min(mag_n1_band, mag_n2_band); |
407 | | |
408 | 2.70M | if (temp > max_mag_value) { |
409 | 1.68M | max_mag_value = temp; |
410 | 1.68M | max_trans_fac = tr; |
411 | 1.68M | max_n1 = n1; |
412 | 1.68M | max_n2 = n2; |
413 | 1.68M | } |
414 | 2.70M | } |
415 | | |
416 | 1.35M | if (max_mag_value > mag_zero_band && max_n1 >= 0 && |
417 | 405k | max_n2 < NO_QMF_SYNTH_CHANNELS) { |
418 | 405k | FLOAT32 vec_y_r[2], vec_y_i[2], vec_o_r[2], vec_o_i[2]; |
419 | 405k | FLOAT32 coeff_real[2], coeff_imag[2]; |
420 | 405k | FLOAT32 d1, d2; |
421 | 405k | WORD32 mid_trans_fac, idx; |
422 | 405k | FLOAT64 base = 1e-17; |
423 | 405k | FLOAT32 mag_scaling_fac = 0; |
424 | 405k | FLOAT32 x_zero_band_r; |
425 | 405k | FLOAT32 x_zero_band_i; |
426 | | |
427 | 405k | x_zero_band_r = 0; |
428 | 405k | x_zero_band_i = 0; |
429 | 405k | mid_trans_fac = 3 - max_trans_fac; |
430 | 405k | if (max_trans_fac == 1) { |
431 | 181k | WORD32 idx; |
432 | 181k | d1 = 0; |
433 | 181k | d2 = 1.5; |
434 | 181k | x_zero_band_r = qmf_in_buf_ri[2 * max_n1]; |
435 | 181k | x_zero_band_i = qmf_in_buf_ri[2 * max_n1 + 1]; |
436 | | |
437 | 181k | idx = max_n2 & 3; |
438 | 181k | idx = (idx + 1) & 3; |
439 | 181k | coeff_real[0] = ixheaac_hbe_post_anal_proc_interp_coeff[idx][0]; |
440 | 181k | coeff_imag[0] = ixheaac_hbe_post_anal_proc_interp_coeff[idx][1]; |
441 | | |
442 | 181k | coeff_real[1] = coeff_real[0]; |
443 | 181k | coeff_imag[1] = -coeff_imag[0]; |
444 | | |
445 | 181k | vec_y_r[1] = qmf_in_buf_ri[2 * max_n2]; |
446 | 181k | vec_y_i[1] = qmf_in_buf_ri[2 * max_n2 + 1]; |
447 | | |
448 | 181k | addrshift = -2; |
449 | 181k | temp_r = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + addrshift + |
450 | 181k | HBE_ZERO_BAND_IDX][2 * max_n2]; |
451 | 181k | temp_i = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + addrshift + |
452 | 181k | HBE_ZERO_BAND_IDX][2 * max_n2 + 1]; |
453 | | |
454 | 181k | vec_y_r[0] = coeff_real[1] * temp_r - coeff_imag[1] * temp_i; |
455 | 181k | vec_y_i[0] = coeff_imag[1] * temp_r + coeff_real[1] * temp_i; |
456 | | |
457 | 181k | temp_r = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + addrshift + 1 + |
458 | 181k | HBE_ZERO_BAND_IDX][2 * max_n2]; |
459 | 181k | temp_i = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + addrshift + 1 + |
460 | 181k | HBE_ZERO_BAND_IDX][2 * max_n2 + 1]; |
461 | | |
462 | 181k | vec_y_r[0] += coeff_real[0] * temp_r - coeff_imag[0] * temp_i; |
463 | 181k | vec_y_i[0] += coeff_imag[0] * temp_r + coeff_real[0] * temp_i; |
464 | | |
465 | 223k | } else { |
466 | 223k | WORD32 idx; |
467 | 223k | d1 = 1.5; |
468 | 223k | d2 = 0; |
469 | 223k | mid_trans_fac = max_trans_fac; |
470 | 223k | max_trans_fac = 3 - max_trans_fac; |
471 | | |
472 | 223k | x_zero_band_r = qmf_in_buf_ri[2 * max_n2]; |
473 | 223k | x_zero_band_i = qmf_in_buf_ri[2 * max_n2 + 1]; |
474 | | |
475 | 223k | idx = (max_n1 & 3); |
476 | 223k | idx = (idx + 1) & 3; |
477 | 223k | coeff_real[0] = ixheaac_hbe_post_anal_proc_interp_coeff[idx][0]; |
478 | 223k | coeff_imag[0] = ixheaac_hbe_post_anal_proc_interp_coeff[idx][1]; |
479 | | |
480 | 223k | coeff_real[1] = coeff_real[0]; |
481 | 223k | coeff_imag[1] = -coeff_imag[0]; |
482 | | |
483 | 223k | vec_y_r[1] = qmf_in_buf_ri[2 * max_n1]; |
484 | 223k | vec_y_i[1] = qmf_in_buf_ri[2 * max_n1 + 1]; |
485 | | |
486 | 223k | addrshift = -2; |
487 | | |
488 | 223k | temp_r = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + addrshift + |
489 | 223k | HBE_ZERO_BAND_IDX][2 * max_n1]; |
490 | 223k | temp_i = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + addrshift + |
491 | 223k | HBE_ZERO_BAND_IDX][2 * max_n1 + 1]; |
492 | | |
493 | 223k | vec_y_r[0] = coeff_real[1] * temp_r - coeff_imag[1] * temp_i; |
494 | 223k | vec_y_i[0] = coeff_imag[1] * temp_r + coeff_real[1] * temp_i; |
495 | | |
496 | 223k | temp_r = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + addrshift + 1 + |
497 | 223k | HBE_ZERO_BAND_IDX][2 * max_n1]; |
498 | 223k | temp_i = ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + addrshift + 1 + |
499 | 223k | HBE_ZERO_BAND_IDX][2 * max_n1 + 1]; |
500 | | |
501 | 223k | vec_y_r[0] += coeff_real[0] * temp_r - coeff_imag[0] * temp_i; |
502 | 223k | vec_y_i[0] += coeff_imag[0] * temp_r + coeff_real[0] * temp_i; |
503 | 223k | } |
504 | | |
505 | 405k | base = 1e-17; |
506 | 405k | base = base + x_zero_band_r * x_zero_band_r; |
507 | 405k | base = base + x_zero_band_i * x_zero_band_i; |
508 | 405k | mag_scaling_fac = (FLOAT32)(ixheaac_cbrt_calc((FLOAT32)base)); |
509 | 405k | x_zero_band_r *= mag_scaling_fac; |
510 | 405k | x_zero_band_i *= mag_scaling_fac; |
511 | 1.21M | for (k = 0; k < 2; k++) { |
512 | 810k | base = 1e-17; |
513 | 810k | base = base + vec_y_r[k] * vec_y_r[k]; |
514 | 810k | base = base + vec_y_i[k] * vec_y_i[k]; |
515 | 810k | mag_scaling_fac = (FLOAT32)(ixheaac_cbrt_calc((FLOAT32)base)); |
516 | 810k | vec_y_r[k] *= mag_scaling_fac; |
517 | 810k | vec_y_i[k] *= mag_scaling_fac; |
518 | 810k | } |
519 | | |
520 | 405k | temp_r = x_zero_band_r; |
521 | 405k | temp_i = x_zero_band_i; |
522 | 810k | for (idx = 0; idx < mid_trans_fac - 1; idx++) { |
523 | 405k | FLOAT32 tmp = x_zero_band_r; |
524 | 405k | x_zero_band_r = x_zero_band_r * temp_r - x_zero_band_i * temp_i; |
525 | 405k | x_zero_band_i = tmp * temp_i + x_zero_band_i * temp_r; |
526 | 405k | } |
527 | | |
528 | 1.21M | for (k = 0; k < 2; k++) { |
529 | 810k | temp_r = vec_y_r[k]; |
530 | 810k | temp_i = vec_y_i[k]; |
531 | 810k | for (idx = 0; idx < max_trans_fac - 1; idx++) { |
532 | 0 | FLOAT32 tmp = vec_y_r[k]; |
533 | 0 | vec_y_r[k] = vec_y_r[k] * temp_r - vec_y_i[k] * temp_i; |
534 | 0 | vec_y_i[k] = tmp * temp_i + vec_y_i[k] * temp_r; |
535 | 0 | } |
536 | 810k | } |
537 | | |
538 | 1.21M | for (k = 0; k < 2; k++) { |
539 | 810k | vec_o_r[k] = vec_y_r[k] * x_zero_band_r - vec_y_i[k] * x_zero_band_i; |
540 | 810k | vec_o_i[k] = vec_y_r[k] * x_zero_band_i + vec_y_i[k] * x_zero_band_r; |
541 | 810k | } |
542 | | |
543 | 405k | { |
544 | 405k | FLOAT32 cos_theta = |
545 | 405k | ixheaac_hbe_x_prod_cos_table_trans_3[(pitch_in_bins_idx << 1) + 0]; |
546 | 405k | FLOAT32 sin_theta = |
547 | 405k | ixheaac_hbe_x_prod_cos_table_trans_3[(pitch_in_bins_idx << 1) + 1]; |
548 | 405k | if (d2 < d1) { |
549 | 223k | sin_theta = -sin_theta; |
550 | 223k | } |
551 | 405k | temp_r = vec_o_r[0]; |
552 | 405k | temp_i = vec_o_i[0]; |
553 | 405k | vec_o_r[0] = (FLOAT32)(cos_theta * temp_r - sin_theta * temp_i); |
554 | 405k | vec_o_i[0] = (FLOAT32)(cos_theta * temp_i + sin_theta * temp_r); |
555 | 405k | } |
556 | | |
557 | 1.21M | for (k = 0; k < 2; k++) { |
558 | 810k | ptr_hbe_txposer->qmf_out_buf[qmf_col_idx * 2 + (k + HBE_ZERO_BAND_IDX - |
559 | 810k | 1)][2 * qmf_band_idx] += |
560 | 810k | (FLOAT32)(mag_cmplx_gain * vec_o_r[k]); |
561 | 810k | ptr_hbe_txposer |
562 | 810k | ->qmf_out_buf[qmf_col_idx * 2 + (k + HBE_ZERO_BAND_IDX - 1)] |
563 | 810k | [2 * qmf_band_idx + 1] += |
564 | 810k | (FLOAT32)(mag_cmplx_gain * vec_o_i[k]); |
565 | 810k | } |
566 | 405k | } |
567 | 1.35M | } |
568 | | |
569 | | VOID ixheaacd_hbe_xprod_proc_4(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, |
570 | | WORD32 qmf_band_idx, WORD32 qmf_col_idx, |
571 | 961k | FLOAT32 p, WORD32 pitch_in_bins_idx) { |
572 | 961k | WORD32 k; |
573 | 961k | WORD32 inp_band_idx = qmf_band_idx >> 1; |
574 | 961k | WORD32 tr, n1, n2, max_trans_fac, max_n1, max_n2; |
575 | | |
576 | 961k | FLOAT64 temp_fac; |
577 | 961k | FLOAT32 max_mag_value, mag_zero_band, mag_n1_band, mag_n2_band, temp; |
578 | 961k | FLOAT32 temp_r, temp_i; |
579 | 961k | FLOAT32 mag_cmplx_gain = 2.0f; |
580 | | |
581 | 961k | FLOAT32 *qmf_in_buf_ri = |
582 | 961k | ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + HBE_ZERO_BAND_IDX]; |
583 | | |
584 | 961k | mag_zero_band = |
585 | 961k | qmf_in_buf_ri[2 * inp_band_idx] * qmf_in_buf_ri[2 * inp_band_idx] + |
586 | 961k | qmf_in_buf_ri[2 * inp_band_idx + 1] * qmf_in_buf_ri[2 * inp_band_idx + 1]; |
587 | | |
588 | 961k | max_mag_value = 0; |
589 | 961k | max_n1 = max_n2 = max_trans_fac = 0; |
590 | | |
591 | 3.84M | for (tr = 1; tr < 4; tr++) { |
592 | 2.88M | temp_fac = (2.0 * qmf_band_idx + 1 - tr * p) * 0.25; |
593 | 2.88M | n1 = ((WORD32)(temp_fac)) << 1; |
594 | 2.88M | n2 = ((WORD32)(temp_fac + p)) << 1; |
595 | | |
596 | 2.88M | mag_n1_band = qmf_in_buf_ri[n1] * qmf_in_buf_ri[n1] + |
597 | 2.88M | qmf_in_buf_ri[n1 + 1] * qmf_in_buf_ri[n1 + 1]; |
598 | 2.88M | mag_n2_band = qmf_in_buf_ri[n2] * qmf_in_buf_ri[n2] + |
599 | 2.88M | qmf_in_buf_ri[n2 + 1] * qmf_in_buf_ri[n2 + 1]; |
600 | | |
601 | 2.88M | temp = min(mag_n1_band, mag_n2_band); |
602 | | |
603 | 2.88M | if (temp > max_mag_value) { |
604 | 1.40M | max_mag_value = temp; |
605 | 1.40M | max_trans_fac = tr; |
606 | 1.40M | max_n1 = n1; |
607 | 1.40M | max_n2 = n2; |
608 | 1.40M | } |
609 | 2.88M | } |
610 | 961k | if (max_mag_value > mag_zero_band && max_n1 >= 0 && |
611 | 346k | max_n2 < TWICE_QMF_SYNTH_CHANNELS_NUM) { |
612 | 346k | FLOAT32 vec_y_r[2], vec_y_i[2], vec_o_r[2], vec_o_i[2]; |
613 | 346k | FLOAT32 d1, d2; |
614 | 346k | WORD32 mid_trans_fac, idx; |
615 | 346k | FLOAT32 x_zero_band_r; |
616 | 346k | FLOAT32 x_zero_band_i; |
617 | 346k | FLOAT64 base = 1e-17; |
618 | 346k | FLOAT32 mag_scaling_fac = 0.0f; |
619 | | |
620 | 346k | x_zero_band_r = 0; |
621 | 346k | x_zero_band_i = 0; |
622 | 346k | mid_trans_fac = 4 - max_trans_fac; |
623 | | |
624 | 346k | if (max_trans_fac == 1) { |
625 | 116k | d1 = 0; |
626 | 116k | d2 = 2; |
627 | 116k | x_zero_band_r = qmf_in_buf_ri[max_n1]; |
628 | 116k | x_zero_band_i = qmf_in_buf_ri[max_n1 + 1]; |
629 | 350k | for (k = 0; k < 2; k++) { |
630 | 233k | vec_y_r[k] = |
631 | 233k | ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + HBE_ZERO_BAND_IDX + |
632 | 233k | 2 * (k - 1)][max_n2]; |
633 | 233k | vec_y_i[k] = |
634 | 233k | ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + HBE_ZERO_BAND_IDX + |
635 | 233k | 2 * (k - 1)][max_n2 + 1]; |
636 | 233k | } |
637 | 229k | } else if (max_trans_fac == 2) { |
638 | 112k | d1 = 0; |
639 | 112k | d2 = 1; |
640 | 112k | x_zero_band_r = qmf_in_buf_ri[max_n1]; |
641 | 112k | x_zero_band_i = qmf_in_buf_ri[max_n1 + 1]; |
642 | 336k | for (k = 0; k < 2; k++) { |
643 | 224k | vec_y_r[k] = |
644 | 224k | ptr_hbe_txposer |
645 | 224k | ->qmf_in_buf[qmf_col_idx + HBE_ZERO_BAND_IDX + (k - 1)][max_n2]; |
646 | 224k | vec_y_i[k] = |
647 | 224k | ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + HBE_ZERO_BAND_IDX + |
648 | 224k | (k - 1)][max_n2 + 1]; |
649 | 224k | } |
650 | 117k | } else { |
651 | 117k | d1 = 2; |
652 | 117k | d2 = 0; |
653 | 117k | mid_trans_fac = max_trans_fac; |
654 | 117k | max_trans_fac = 4 - max_trans_fac; |
655 | 117k | x_zero_band_r = qmf_in_buf_ri[max_n2]; |
656 | 117k | x_zero_band_i = qmf_in_buf_ri[max_n2 + 1]; |
657 | 351k | for (k = 0; k < 2; k++) { |
658 | 234k | vec_y_r[k] = |
659 | 234k | ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + HBE_ZERO_BAND_IDX + |
660 | 234k | 2 * (k - 1)][max_n1]; |
661 | 234k | vec_y_i[k] = |
662 | 234k | ptr_hbe_txposer->qmf_in_buf[qmf_col_idx + HBE_ZERO_BAND_IDX + |
663 | 234k | 2 * (k - 1)][max_n1 + 1]; |
664 | 234k | } |
665 | 117k | } |
666 | | |
667 | 346k | base = 1e-17; |
668 | 346k | base = base + x_zero_band_r * x_zero_band_r; |
669 | 346k | base = base + x_zero_band_i * x_zero_band_i; |
670 | 346k | { |
671 | 346k | temp = (FLOAT32)sqrt(sqrt(base)); |
672 | 346k | mag_scaling_fac = temp * (FLOAT32)(sqrt(temp)); |
673 | 346k | mag_scaling_fac = 1 / mag_scaling_fac; |
674 | 346k | } |
675 | | |
676 | 346k | x_zero_band_r *= mag_scaling_fac; |
677 | 346k | x_zero_band_i *= mag_scaling_fac; |
678 | 1.03M | for (k = 0; k < 2; k++) { |
679 | 692k | base = 1e-17; |
680 | 692k | base = base + vec_y_r[k] * vec_y_r[k]; |
681 | 692k | base = base + vec_y_i[k] * vec_y_i[k]; |
682 | 692k | { |
683 | 692k | temp = (FLOAT32)sqrt(sqrt(base)); |
684 | 692k | mag_scaling_fac = temp * (FLOAT32)(sqrt(temp)); |
685 | | |
686 | 692k | mag_scaling_fac = 1 / mag_scaling_fac; |
687 | 692k | } |
688 | 692k | vec_y_r[k] *= mag_scaling_fac; |
689 | 692k | vec_y_i[k] *= mag_scaling_fac; |
690 | 692k | } |
691 | | |
692 | 346k | temp_r = x_zero_band_r; |
693 | 346k | temp_i = x_zero_band_i; |
694 | 926k | for (idx = 0; idx < mid_trans_fac - 1; idx++) { |
695 | 580k | FLOAT32 tmp = x_zero_band_r; |
696 | 580k | x_zero_band_r = x_zero_band_r * temp_r - x_zero_band_i * temp_i; |
697 | 580k | x_zero_band_i = tmp * temp_i + x_zero_band_i * temp_r; |
698 | 580k | } |
699 | | |
700 | 1.03M | for (k = 0; k < 2; k++) { |
701 | 692k | temp_r = vec_y_r[k]; |
702 | 692k | temp_i = vec_y_i[k]; |
703 | 917k | for (idx = 0; idx < max_trans_fac - 1; idx++) { |
704 | 224k | FLOAT32 tmp = vec_y_r[k]; |
705 | 224k | vec_y_r[k] = vec_y_r[k] * temp_r - vec_y_i[k] * temp_i; |
706 | 224k | vec_y_i[k] = tmp * temp_i + vec_y_i[k] * temp_r; |
707 | 224k | } |
708 | 692k | } |
709 | | |
710 | 1.03M | for (k = 0; k < 2; k++) { |
711 | 692k | vec_o_r[k] = vec_y_r[k] * x_zero_band_r - vec_y_i[k] * x_zero_band_i; |
712 | 692k | vec_o_i[k] = vec_y_r[k] * x_zero_band_i + vec_y_i[k] * x_zero_band_r; |
713 | 692k | } |
714 | | |
715 | 346k | { |
716 | 346k | FLOAT32 cos_theta; |
717 | 346k | FLOAT32 sin_theta; |
718 | | |
719 | 346k | if (d2 == 1) { |
720 | 112k | cos_theta = |
721 | 112k | ixheaac_hbe_x_prod_cos_table_trans_4_1[(pitch_in_bins_idx << 1) + |
722 | 112k | 0]; |
723 | 112k | sin_theta = |
724 | 112k | ixheaac_hbe_x_prod_cos_table_trans_4_1[(pitch_in_bins_idx << 1) + |
725 | 112k | 1]; |
726 | 234k | } else { |
727 | 234k | cos_theta = |
728 | 234k | ixheaac_hbe_x_prod_cos_table_trans_4[(pitch_in_bins_idx << 1) + 0]; |
729 | 234k | sin_theta = |
730 | 234k | ixheaac_hbe_x_prod_cos_table_trans_4[(pitch_in_bins_idx << 1) + 1]; |
731 | 234k | if (d2 < d1) { |
732 | 117k | sin_theta = -sin_theta; |
733 | 117k | } |
734 | 234k | } |
735 | 346k | temp_r = vec_o_r[0]; |
736 | 346k | temp_i = vec_o_i[0]; |
737 | 346k | vec_o_r[0] = (FLOAT32)(cos_theta * temp_r - sin_theta * temp_i); |
738 | 346k | vec_o_i[0] = (FLOAT32)(cos_theta * temp_i + sin_theta * temp_r); |
739 | 346k | } |
740 | | |
741 | 1.03M | for (k = 0; k < 2; k++) { |
742 | 692k | ptr_hbe_txposer->qmf_out_buf[qmf_col_idx * 2 + (k + HBE_ZERO_BAND_IDX - |
743 | 692k | 1)][2 * qmf_band_idx] += |
744 | 692k | (FLOAT32)(mag_cmplx_gain * vec_o_r[k]); |
745 | 692k | ptr_hbe_txposer |
746 | 692k | ->qmf_out_buf[qmf_col_idx * 2 + (k + HBE_ZERO_BAND_IDX - 1)] |
747 | 692k | [2 * qmf_band_idx + 1] += |
748 | 692k | (FLOAT32)(mag_cmplx_gain * vec_o_i[k]); |
749 | 692k | } |
750 | 346k | } |
751 | 961k | } |
752 | | |
753 | | VOID ixheaacd_hbe_post_anal_prod2(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, |
754 | 274k | WORD32 qmf_voc_columns, WORD32 qmf_band_idx) { |
755 | 274k | WORD32 i; |
756 | 274k | FLOAT32 *norm_ptr = &ptr_hbe_txposer->norm_qmf_in_buf[1][2 * qmf_band_idx]; |
757 | 274k | FLOAT32 *out_ptr = &ptr_hbe_txposer->qmf_out_buf[1][2 * qmf_band_idx]; |
758 | 274k | FLOAT32 *x_norm_ptr = |
759 | 274k | &ptr_hbe_txposer->norm_qmf_in_buf[HBE_ZERO_BAND_IDX][2 * qmf_band_idx]; |
760 | | |
761 | 274k | ixheaacd_norm_qmf_in_buf_2(ptr_hbe_txposer, qmf_band_idx); |
762 | | |
763 | 3.22M | for (; qmf_band_idx < ptr_hbe_txposer->x_over_qmf[1]; qmf_band_idx++) { |
764 | 53.0M | for (i = 0; i < qmf_voc_columns; i++) { |
765 | 50.0M | WORD32 k; |
766 | 50.0M | FLOAT32 x_zero_band_r, x_zero_band_i; |
767 | | |
768 | 50.0M | x_zero_band_r = *x_norm_ptr++; |
769 | 50.0M | x_zero_band_i = *x_norm_ptr++; |
770 | | |
771 | 550M | for (k = 0; k < HBE_OPER_BLK_LEN_2; k++) { |
772 | 500M | register FLOAT32 tmp_r, tmp_i; |
773 | 500M | tmp_r = *norm_ptr++; |
774 | 500M | tmp_i = *norm_ptr++; |
775 | | |
776 | 500M | *out_ptr++ += |
777 | 500M | ((tmp_r * x_zero_band_r - tmp_i * x_zero_band_i) * 0.3333333f); |
778 | | |
779 | 500M | *out_ptr++ += |
780 | 500M | ((tmp_r * x_zero_band_i + tmp_i * x_zero_band_r) * 0.3333333f); |
781 | | |
782 | 500M | norm_ptr += 126; |
783 | 500M | out_ptr += 126; |
784 | 500M | } |
785 | | |
786 | 50.0M | norm_ptr -= 128 * 9; |
787 | 50.0M | out_ptr -= 128 * 8; |
788 | 50.0M | x_norm_ptr += 126; |
789 | 50.0M | } |
790 | 2.95M | out_ptr -= (128 * 2 * qmf_voc_columns) - 2; |
791 | 2.95M | norm_ptr -= (128 * qmf_voc_columns) - 2; |
792 | 2.95M | x_norm_ptr -= (128 * qmf_voc_columns) - 2; |
793 | 2.95M | } |
794 | 274k | } |
795 | | |
796 | | VOID ixheaacd_hbe_post_anal_prod3(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, |
797 | 180k | WORD32 qmf_voc_columns, WORD32 qmf_band_idx) { |
798 | 180k | WORD32 i, inp_band_idx, rem; |
799 | | |
800 | 180k | FLOAT32 *out_buf = &ptr_hbe_txposer->qmf_out_buf[2][2 * qmf_band_idx]; |
801 | | |
802 | 1.82M | for (; qmf_band_idx < ptr_hbe_txposer->x_over_qmf[2]; qmf_band_idx++) { |
803 | 1.64M | FLOAT32 temp_r, temp_i; |
804 | 1.64M | FLOAT32 temp_r1, temp_i1; |
805 | 1.64M | const FLOAT32 *ptr_sel, *ptr_sel1; |
806 | | |
807 | 1.64M | inp_band_idx = (2 * qmf_band_idx) / 3; |
808 | 1.64M | ptr_sel = &ixheaac_sel_case[(inp_band_idx + 1) & 3][0]; |
809 | 1.64M | ptr_sel1 = &ixheaac_sel_case[((inp_band_idx + 1) & 3) + 1][0]; |
810 | 1.64M | rem = 2 * qmf_band_idx - 3 * inp_band_idx; |
811 | | |
812 | 1.64M | if (rem == 0 || rem == 1) { |
813 | 1.10M | FLOAT32 *in_buf = &ptr_hbe_txposer->qmf_in_buf[0][2 * inp_band_idx]; |
814 | | |
815 | 20.2M | for (i = 0; i < qmf_voc_columns; i += 1) { |
816 | 19.1M | WORD32 k; |
817 | 19.1M | FLOAT32 vec_x[2 * HBE_OPER_WIN_LEN]; |
818 | 19.1M | FLOAT32 *ptr_vec_x = &vec_x[0]; |
819 | 19.1M | FLOAT32 x_zero_band_r, x_zero_band_i; |
820 | | |
821 | 19.1M | FLOAT32 mag_scaling_fac; |
822 | | |
823 | 95.5M | for (k = 0; k < (HBE_OPER_BLK_LEN_3); k += 2) { |
824 | 76.4M | FLOAT64 base1; |
825 | 76.4M | FLOAT64 base = 1e-17; |
826 | | |
827 | 76.4M | temp_r = in_buf[0]; |
828 | 76.4M | temp_i = in_buf[1]; |
829 | | |
830 | 76.4M | in_buf += 256; |
831 | | |
832 | 76.4M | base1 = base + temp_r * temp_r; |
833 | 76.4M | base1 = base1 + temp_i * temp_i; |
834 | | |
835 | 76.4M | mag_scaling_fac = (FLOAT32)(ixheaac_cbrt_calc((FLOAT32)base1)); |
836 | | |
837 | 76.4M | ptr_vec_x[0] = temp_r * mag_scaling_fac; |
838 | 76.4M | ptr_vec_x[1] = temp_i * mag_scaling_fac; |
839 | | |
840 | 76.4M | temp_r = in_buf[0]; |
841 | 76.4M | temp_i = in_buf[1]; |
842 | | |
843 | 76.4M | in_buf -= 128; |
844 | | |
845 | 76.4M | temp_r1 = ptr_sel[0] * temp_r + ptr_sel[1] * temp_i; |
846 | 76.4M | temp_i1 = ptr_sel[2] * temp_r + ptr_sel[3] * temp_i; |
847 | | |
848 | 76.4M | temp_r = in_buf[0]; |
849 | 76.4M | temp_i = in_buf[1]; |
850 | | |
851 | 76.4M | temp_r1 += ptr_sel[4] * temp_r + ptr_sel[5] * temp_i; |
852 | 76.4M | temp_i1 += ptr_sel[6] * temp_r + ptr_sel[7] * temp_i; |
853 | | |
854 | 76.4M | temp_r1 *= 0.3984033437f; |
855 | 76.4M | temp_i1 *= 0.3984033437f; |
856 | | |
857 | 76.4M | base1 = base + temp_r1 * temp_r1; |
858 | 76.4M | base1 = base1 + temp_i1 * temp_i1; |
859 | 76.4M | mag_scaling_fac = (FLOAT32)(ixheaac_cbrt_calc((FLOAT32)base1)); |
860 | | |
861 | 76.4M | ptr_vec_x[2] = temp_r1 * mag_scaling_fac; |
862 | 76.4M | ptr_vec_x[3] = temp_i1 * mag_scaling_fac; |
863 | | |
864 | 76.4M | ptr_vec_x += 4; |
865 | 76.4M | in_buf += 256; |
866 | 76.4M | } |
867 | 19.1M | ptr_vec_x = &vec_x[0]; |
868 | 19.1M | temp_r = vec_x[2 * (HBE_ZERO_BAND_IDX - 2)]; |
869 | 19.1M | temp_i = vec_x[(2 * (HBE_ZERO_BAND_IDX - 2)) + 1]; |
870 | | |
871 | 19.1M | x_zero_band_r = temp_r * temp_r - temp_i * temp_i; |
872 | 19.1M | x_zero_band_i = temp_r * temp_i + temp_i * temp_r; |
873 | | |
874 | 172M | for (k = 0; k < (HBE_OPER_BLK_LEN_3); k++) { |
875 | 152M | temp_r = ptr_vec_x[0] * x_zero_band_r - ptr_vec_x[1] * x_zero_band_i; |
876 | 152M | temp_i = ptr_vec_x[0] * x_zero_band_i + ptr_vec_x[1] * x_zero_band_r; |
877 | | |
878 | 152M | out_buf[0] += (temp_r * 0.4714045f); |
879 | 152M | out_buf[1] += (temp_i * 0.4714045f); |
880 | | |
881 | 152M | ptr_vec_x += 2; |
882 | 152M | out_buf += 128; |
883 | 152M | } |
884 | | |
885 | 19.1M | in_buf -= 128 * 11; |
886 | 19.1M | out_buf -= 128 * 6; |
887 | 19.1M | } |
888 | 1.10M | } else { |
889 | 537k | FLOAT32 *in_buf = &ptr_hbe_txposer->qmf_in_buf[0][2 * inp_band_idx]; |
890 | 537k | FLOAT32 *in_buf1 = |
891 | 537k | &ptr_hbe_txposer->qmf_in_buf[0][2 * (inp_band_idx + 1)]; |
892 | | |
893 | 9.84M | for (i = 0; i < qmf_voc_columns; i++) { |
894 | 9.31M | WORD32 k; |
895 | 9.31M | FLOAT32 vec_x[2 * HBE_OPER_WIN_LEN]; |
896 | 9.31M | FLOAT32 vec_x_cap[2 * HBE_OPER_WIN_LEN]; |
897 | | |
898 | 9.31M | FLOAT32 x_zero_band_r, x_zero_band_i; |
899 | 9.31M | FLOAT32 *ptr_vec_x = &vec_x[0]; |
900 | 9.31M | FLOAT32 *ptr_vec_x_cap = &vec_x_cap[0]; |
901 | | |
902 | 9.31M | FLOAT32 mag_scaling_fac; |
903 | | |
904 | 46.5M | for (k = 0; k < (HBE_OPER_BLK_LEN_3); k += 2) { |
905 | 37.2M | FLOAT32 tmp_vr, tmp_vi; |
906 | 37.2M | FLOAT32 tmp_cr, tmp_ci; |
907 | 37.2M | FLOAT64 base1; |
908 | 37.2M | FLOAT64 base = 1e-17; |
909 | | |
910 | 37.2M | temp_r1 = in_buf[0]; |
911 | 37.2M | temp_i1 = in_buf[1]; |
912 | 37.2M | temp_r = in_buf1[0]; |
913 | 37.2M | temp_i = in_buf1[1]; |
914 | | |
915 | 37.2M | base1 = base + temp_r * temp_r; |
916 | 37.2M | base1 = base1 + temp_i * temp_i; |
917 | | |
918 | 37.2M | mag_scaling_fac = (FLOAT32)(ixheaac_cbrt_calc((FLOAT32)base1)); |
919 | | |
920 | 37.2M | ptr_vec_x[0] = temp_r * mag_scaling_fac; |
921 | 37.2M | ptr_vec_x[1] = temp_i * mag_scaling_fac; |
922 | | |
923 | 37.2M | base1 = base + temp_r1 * temp_r1; |
924 | 37.2M | base1 = base1 + temp_i1 * temp_i1; |
925 | | |
926 | 37.2M | mag_scaling_fac = (FLOAT32)(ixheaac_cbrt_calc((FLOAT32)base1)); |
927 | | |
928 | 37.2M | ptr_vec_x_cap[0] = temp_r1 * mag_scaling_fac; |
929 | 37.2M | ptr_vec_x_cap[1] = temp_i1 * mag_scaling_fac; |
930 | | |
931 | 37.2M | in_buf += 256; |
932 | | |
933 | 37.2M | temp_r = in_buf[0]; |
934 | 37.2M | temp_i = in_buf[1]; |
935 | | |
936 | 37.2M | temp_r1 = ptr_sel[0] * temp_r + ptr_sel[1] * temp_i; |
937 | 37.2M | temp_i1 = ptr_sel[2] * temp_r + ptr_sel[3] * temp_i; |
938 | | |
939 | 37.2M | in_buf -= 128; |
940 | | |
941 | 37.2M | temp_r = in_buf[0]; |
942 | 37.2M | temp_i = in_buf[1]; |
943 | | |
944 | 37.2M | tmp_cr = temp_r1 + ptr_sel[4] * temp_r + ptr_sel[5] * temp_i; |
945 | 37.2M | tmp_ci = temp_i1 + ptr_sel[6] * temp_r + ptr_sel[7] * temp_i; |
946 | | |
947 | 37.2M | in_buf1 += 256; |
948 | | |
949 | 37.2M | temp_r = in_buf1[0]; |
950 | 37.2M | temp_i = in_buf1[1]; |
951 | | |
952 | 37.2M | temp_r1 = ptr_sel1[0] * temp_r + ptr_sel1[1] * temp_i; |
953 | 37.2M | temp_i1 = ptr_sel1[2] * temp_r + ptr_sel1[3] * temp_i; |
954 | | |
955 | 37.2M | in_buf1 -= 128; |
956 | | |
957 | 37.2M | temp_r = in_buf1[0]; |
958 | 37.2M | temp_i = in_buf1[1]; |
959 | | |
960 | 37.2M | tmp_vr = temp_r1 + ptr_sel1[4] * temp_r + ptr_sel1[5] * temp_i; |
961 | 37.2M | tmp_vi = temp_i1 + ptr_sel1[6] * temp_r + ptr_sel1[7] * temp_i; |
962 | | |
963 | 37.2M | tmp_cr *= 0.3984033437f; |
964 | 37.2M | tmp_ci *= 0.3984033437f; |
965 | | |
966 | 37.2M | tmp_vr *= 0.3984033437f; |
967 | 37.2M | tmp_vi *= 0.3984033437f; |
968 | | |
969 | 37.2M | base1 = base + tmp_vr * tmp_vr; |
970 | 37.2M | base1 = base1 + tmp_vi * tmp_vi; |
971 | | |
972 | 37.2M | mag_scaling_fac = (FLOAT32)(ixheaac_cbrt_calc((FLOAT32)base1)); |
973 | | |
974 | 37.2M | ptr_vec_x[2] = tmp_vr * mag_scaling_fac; |
975 | 37.2M | ptr_vec_x[3] = tmp_vi * mag_scaling_fac; |
976 | | |
977 | 37.2M | base1 = base + tmp_cr * tmp_cr; |
978 | 37.2M | base1 = base1 + tmp_ci * tmp_ci; |
979 | | |
980 | 37.2M | mag_scaling_fac = (FLOAT32)(ixheaac_cbrt_calc((FLOAT32)base1)); |
981 | | |
982 | 37.2M | ptr_vec_x_cap[2] = tmp_cr * mag_scaling_fac; |
983 | 37.2M | ptr_vec_x_cap[3] = tmp_ci * mag_scaling_fac; |
984 | | |
985 | 37.2M | in_buf += 256; |
986 | 37.2M | in_buf1 += 256; |
987 | 37.2M | ptr_vec_x += 4; |
988 | 37.2M | ptr_vec_x_cap += 4; |
989 | 37.2M | } |
990 | 9.31M | ptr_vec_x = &vec_x[0]; |
991 | 9.31M | ptr_vec_x_cap = &vec_x_cap[0]; |
992 | | |
993 | 9.31M | temp_r = vec_x_cap[2 * (HBE_ZERO_BAND_IDX - 2)]; |
994 | 9.31M | temp_i = vec_x_cap[2 * (HBE_ZERO_BAND_IDX - 2) + 1]; |
995 | 9.31M | temp_r1 = vec_x[2 * (HBE_ZERO_BAND_IDX - 2)]; |
996 | 9.31M | temp_i1 = vec_x[2 * (HBE_ZERO_BAND_IDX - 2) + 1]; |
997 | | |
998 | 9.31M | x_zero_band_r = temp_r * temp_r - temp_i * temp_i; |
999 | 9.31M | x_zero_band_i = temp_r * temp_i + temp_i * temp_r; |
1000 | | |
1001 | 9.31M | temp_r = temp_r1 * temp_r1 - temp_i1 * temp_i1; |
1002 | 9.31M | temp_i = temp_r1 * temp_i1 + temp_i1 * temp_r1; |
1003 | | |
1004 | 83.7M | for (k = 0; k < (HBE_OPER_BLK_LEN_3); k++) { |
1005 | 74.4M | temp_r1 = ptr_vec_x[0] * x_zero_band_r - ptr_vec_x[1] * x_zero_band_i; |
1006 | 74.4M | temp_i1 = ptr_vec_x[0] * x_zero_band_i + ptr_vec_x[1] * x_zero_band_r; |
1007 | | |
1008 | 74.4M | temp_r1 += ptr_vec_x_cap[0] * temp_r - ptr_vec_x_cap[1] * temp_i; |
1009 | 74.4M | temp_i1 += ptr_vec_x_cap[0] * temp_i + ptr_vec_x_cap[1] * temp_r; |
1010 | | |
1011 | 74.4M | out_buf[0] += (temp_r1 * 0.23570225f); |
1012 | 74.4M | out_buf[1] += (temp_i1 * 0.23570225f); |
1013 | | |
1014 | 74.4M | out_buf += 128; |
1015 | 74.4M | ptr_vec_x += 2; |
1016 | 74.4M | ptr_vec_x_cap += 2; |
1017 | 74.4M | } |
1018 | | |
1019 | 9.31M | in_buf -= 128 * 11; |
1020 | 9.31M | in_buf1 -= 128 * 11; |
1021 | 9.31M | out_buf -= 128 * 6; |
1022 | 9.31M | } |
1023 | 537k | } |
1024 | | |
1025 | 1.64M | out_buf -= (256 * qmf_voc_columns) - 2; |
1026 | 1.64M | } |
1027 | 180k | } |
1028 | | |
1029 | | VOID ixheaacd_hbe_post_anal_prod4(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, |
1030 | 108k | WORD32 qmf_voc_columns, WORD32 qmf_band_idx) { |
1031 | 108k | WORD32 i, inp_band_idx; |
1032 | 108k | FLOAT32 *out_ptr = &ptr_hbe_txposer->qmf_out_buf[3][2 * qmf_band_idx]; |
1033 | | |
1034 | 108k | ixheaacd_norm_qmf_in_buf_4(ptr_hbe_txposer, ((qmf_band_idx >> 1) - 1)); |
1035 | | |
1036 | 1.02M | for (; qmf_band_idx < ptr_hbe_txposer->x_over_qmf[3]; qmf_band_idx++) { |
1037 | 916k | WORD32 ip_idx; |
1038 | 916k | FLOAT32 temp, temp_r, temp_i; |
1039 | 916k | FLOAT32 *norm_ptr, *x_norm_ptr; |
1040 | 916k | inp_band_idx = qmf_band_idx >> 1; |
1041 | 916k | ip_idx = (qmf_band_idx & 1) ? (inp_band_idx + 1) : (inp_band_idx - 1); |
1042 | | |
1043 | 916k | norm_ptr = &ptr_hbe_txposer->norm_qmf_in_buf[0][2 * ip_idx]; |
1044 | 916k | x_norm_ptr = |
1045 | 916k | &ptr_hbe_txposer->norm_qmf_in_buf[HBE_ZERO_BAND_IDX][2 * inp_band_idx]; |
1046 | | |
1047 | 16.7M | for (i = 0; i < qmf_voc_columns; i++) { |
1048 | 15.7M | WORD32 k; |
1049 | 15.7M | FLOAT32 x_zero_band_r, x_zero_band_i; |
1050 | | |
1051 | 15.7M | temp_r = x_zero_band_r = *x_norm_ptr++; |
1052 | 15.7M | temp_i = x_zero_band_i = *x_norm_ptr++; |
1053 | | |
1054 | 15.7M | temp = x_zero_band_r * x_zero_band_r - x_zero_band_i * x_zero_band_i; |
1055 | 15.7M | x_zero_band_i = |
1056 | 15.7M | x_zero_band_r * x_zero_band_i + x_zero_band_i * x_zero_band_r; |
1057 | | |
1058 | 15.7M | x_zero_band_r = temp_r * temp - temp_i * x_zero_band_i; |
1059 | 15.7M | x_zero_band_i = temp_r * x_zero_band_i + temp_i * temp; |
1060 | | |
1061 | 110M | for (k = 0; k < HBE_OPER_BLK_LEN_4; k++) { |
1062 | 94.7M | temp = *norm_ptr++; |
1063 | 94.7M | temp_i = *norm_ptr++; |
1064 | | |
1065 | 94.7M | temp_r = temp * x_zero_band_r - temp_i * x_zero_band_i; |
1066 | 94.7M | temp_i = temp * x_zero_band_i + temp_i * x_zero_band_r; |
1067 | | |
1068 | 94.7M | *out_ptr++ += (temp_r * 0.6666667f); |
1069 | 94.7M | *out_ptr++ += (temp_i * 0.6666667f); |
1070 | | |
1071 | 94.7M | norm_ptr += 254; |
1072 | 94.7M | out_ptr += 126; |
1073 | 94.7M | } |
1074 | | |
1075 | 15.7M | norm_ptr -= 128 * 11; |
1076 | 15.7M | out_ptr -= 128 * 4; |
1077 | 15.7M | x_norm_ptr += 126; |
1078 | 15.7M | } |
1079 | | |
1080 | 916k | out_ptr -= (128 * 2 * qmf_voc_columns) - 2; |
1081 | 916k | } |
1082 | 108k | } |
1083 | | |
1084 | | VOID ixheaacd_hbe_post_anal_xprod2(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, |
1085 | | WORD32 qmf_voc_columns, WORD32 qmf_band_idx, |
1086 | 12.3k | FLOAT32 p, FLOAT32 *cos_sin_theta) { |
1087 | 12.3k | WORD32 i; |
1088 | 12.3k | FLOAT32 *norm_ptr = &ptr_hbe_txposer->norm_qmf_in_buf[1][2 * qmf_band_idx]; |
1089 | 12.3k | FLOAT32 *out_ptr = &ptr_hbe_txposer->qmf_out_buf[1][2 * qmf_band_idx]; |
1090 | 12.3k | FLOAT32 *x_norm_ptr = |
1091 | 12.3k | &ptr_hbe_txposer->norm_qmf_in_buf[HBE_ZERO_BAND_IDX][2 * qmf_band_idx]; |
1092 | | |
1093 | 12.3k | ixheaacd_norm_qmf_in_buf_2(ptr_hbe_txposer, qmf_band_idx); |
1094 | | |
1095 | 130k | for (; qmf_band_idx < ptr_hbe_txposer->x_over_qmf[1]; qmf_band_idx++) { |
1096 | 118k | WORD32 n1, n2; |
1097 | 118k | FLOAT64 temp_fac; |
1098 | 118k | FLOAT32 mag_cmplx_gain = 1.666666667f; |
1099 | 118k | temp_fac = (2.0 * qmf_band_idx + 1 - p) * 0.5; |
1100 | 118k | n1 = ((WORD32)(temp_fac)) << 1; |
1101 | 118k | n2 = ((WORD32)(temp_fac + p)) << 1; |
1102 | | |
1103 | 2.12M | for (i = 0; i < qmf_voc_columns; i++) { |
1104 | 2.00M | WORD32 k; |
1105 | 2.00M | FLOAT32 x_zero_band_r, x_zero_band_i; |
1106 | | |
1107 | 2.00M | x_zero_band_r = *x_norm_ptr++; |
1108 | 2.00M | x_zero_band_i = *x_norm_ptr++; |
1109 | | |
1110 | 22.0M | for (k = 1; k < (HBE_OPER_BLK_LEN_2 + 1); k++) { |
1111 | 20.0M | register FLOAT32 tmp_r, tmp_i; |
1112 | 20.0M | tmp_r = *norm_ptr++; |
1113 | 20.0M | tmp_i = *norm_ptr++; |
1114 | | |
1115 | 20.0M | *out_ptr++ += |
1116 | 20.0M | ((tmp_r * x_zero_band_r - tmp_i * x_zero_band_i) * 0.3333333f); |
1117 | | |
1118 | 20.0M | *out_ptr++ += |
1119 | 20.0M | ((tmp_r * x_zero_band_i + tmp_i * x_zero_band_r) * 0.3333333f); |
1120 | | |
1121 | 20.0M | norm_ptr += 126; |
1122 | 20.0M | out_ptr += 126; |
1123 | 20.0M | } |
1124 | 2.00M | norm_ptr -= 128 * 9; |
1125 | 2.00M | out_ptr -= 128 * 8; |
1126 | 2.00M | x_norm_ptr += 126; |
1127 | | |
1128 | 2.00M | { |
1129 | 2.00M | WORD32 max_trans_fac, max_n1, max_n2; |
1130 | 2.00M | FLOAT32 max_mag_value; |
1131 | 2.00M | FLOAT32 mag_zero_band, mag_n1_band, mag_n2_band, temp; |
1132 | | |
1133 | 2.00M | FLOAT32 *qmf_in_buf_ri = |
1134 | 2.00M | ptr_hbe_txposer->qmf_in_buf[i + HBE_ZERO_BAND_IDX]; |
1135 | | |
1136 | 2.00M | mag_zero_band = |
1137 | 2.00M | qmf_in_buf_ri[2 * qmf_band_idx] * qmf_in_buf_ri[2 * qmf_band_idx] + |
1138 | 2.00M | qmf_in_buf_ri[2 * qmf_band_idx + 1] * |
1139 | 2.00M | qmf_in_buf_ri[2 * qmf_band_idx + 1]; |
1140 | | |
1141 | 2.00M | mag_n1_band = qmf_in_buf_ri[n1] * qmf_in_buf_ri[n1] + |
1142 | 2.00M | qmf_in_buf_ri[n1 + 1] * qmf_in_buf_ri[n1 + 1]; |
1143 | 2.00M | mag_n2_band = qmf_in_buf_ri[n2] * qmf_in_buf_ri[n2] + |
1144 | 2.00M | qmf_in_buf_ri[n2 + 1] * qmf_in_buf_ri[n2 + 1]; |
1145 | | |
1146 | 2.00M | temp = min(mag_n1_band, mag_n2_band); |
1147 | | |
1148 | 2.00M | max_mag_value = 0; |
1149 | 2.00M | max_trans_fac = 0; |
1150 | 2.00M | max_n1 = 0; |
1151 | 2.00M | max_n2 = 0; |
1152 | | |
1153 | 2.00M | if (temp > 0) { |
1154 | 1.60M | max_mag_value = temp; |
1155 | 1.60M | max_trans_fac = 1; |
1156 | 1.60M | max_n1 = n1; |
1157 | 1.60M | max_n2 = n2; |
1158 | 1.60M | } |
1159 | | |
1160 | 2.00M | if (max_mag_value > mag_zero_band && max_n1 >= 0 && |
1161 | 440k | max_n2 < TWICE_QMF_SYNTH_CHANNELS_NUM) { |
1162 | 440k | FLOAT32 vec_y_r[2], vec_y_i[2]; |
1163 | 440k | FLOAT32 temp_r, temp_i, tmp_r1; |
1164 | 440k | WORD32 mid_trans_fac, idx; |
1165 | 440k | FLOAT64 base; |
1166 | 440k | WORD32 k; |
1167 | 440k | FLOAT32 mag_scaling_fac = 0.0f; |
1168 | 440k | FLOAT32 x_zero_band_r = 0; |
1169 | 440k | FLOAT32 x_zero_band_i = 0; |
1170 | | |
1171 | 440k | mid_trans_fac = 2 - max_trans_fac; |
1172 | | |
1173 | 440k | x_zero_band_r = qmf_in_buf_ri[max_n1]; |
1174 | 440k | x_zero_band_i = qmf_in_buf_ri[max_n1 + 1]; |
1175 | 440k | base = 1e-17; |
1176 | 440k | base = base + x_zero_band_r * x_zero_band_r; |
1177 | 440k | base = base + x_zero_band_i * x_zero_band_i; |
1178 | | |
1179 | 440k | mag_scaling_fac = (FLOAT32)(1.0f / base); |
1180 | 440k | mag_scaling_fac = (FLOAT32)sqrt(sqrt(mag_scaling_fac)); |
1181 | | |
1182 | 440k | x_zero_band_r *= mag_scaling_fac; |
1183 | 440k | x_zero_band_i *= mag_scaling_fac; |
1184 | | |
1185 | 440k | temp_r = x_zero_band_r; |
1186 | 440k | temp_i = x_zero_band_i; |
1187 | 440k | for (idx = 0; idx < mid_trans_fac - 1; idx++) { |
1188 | 0 | FLOAT32 tmp = x_zero_band_r; |
1189 | 0 | x_zero_band_r = x_zero_band_r * temp_r - x_zero_band_i * temp_i; |
1190 | 0 | x_zero_band_i = tmp * temp_i + x_zero_band_i * temp_r; |
1191 | 0 | } |
1192 | | |
1193 | 1.32M | for (k = 0; k < 2; k++) { |
1194 | 880k | temp_r = ptr_hbe_txposer |
1195 | 880k | ->qmf_in_buf[i + HBE_ZERO_BAND_IDX - 1 + k][max_n2]; |
1196 | 880k | temp_i = |
1197 | 880k | ptr_hbe_txposer |
1198 | 880k | ->qmf_in_buf[i + HBE_ZERO_BAND_IDX - 1 + k][max_n2 + 1]; |
1199 | | |
1200 | 880k | base = 1e-17; |
1201 | 880k | base = base + temp_r * temp_r; |
1202 | 880k | base = base + temp_i * temp_i; |
1203 | | |
1204 | 880k | mag_scaling_fac = (FLOAT32)(1.0f / base); |
1205 | 880k | mag_scaling_fac = (FLOAT32)sqrt(sqrt(mag_scaling_fac)); |
1206 | | |
1207 | 880k | temp_r *= mag_scaling_fac; |
1208 | 880k | temp_i *= mag_scaling_fac; |
1209 | | |
1210 | 880k | vec_y_r[k] = temp_r; |
1211 | 880k | vec_y_i[k] = temp_i; |
1212 | 880k | } |
1213 | | |
1214 | 440k | temp_r = vec_y_r[0] * x_zero_band_r - vec_y_i[0] * x_zero_band_i; |
1215 | 440k | temp_i = vec_y_r[0] * x_zero_band_i + vec_y_i[0] * x_zero_band_r; |
1216 | | |
1217 | 440k | tmp_r1 = |
1218 | 440k | (FLOAT32)(cos_sin_theta[0] * temp_r - cos_sin_theta[1] * temp_i); |
1219 | 440k | temp_i = |
1220 | 440k | (FLOAT32)(cos_sin_theta[0] * temp_i + cos_sin_theta[1] * temp_r); |
1221 | | |
1222 | 440k | ptr_hbe_txposer->qmf_out_buf[i * 2 + (HBE_ZERO_BAND_IDX - 1)] |
1223 | 440k | [2 * qmf_band_idx] += |
1224 | 440k | (FLOAT32)(mag_cmplx_gain * tmp_r1); |
1225 | | |
1226 | 440k | ptr_hbe_txposer->qmf_out_buf[i * 2 + (HBE_ZERO_BAND_IDX - 1)] |
1227 | 440k | [2 * qmf_band_idx + 1] += |
1228 | 440k | (FLOAT32)(mag_cmplx_gain * temp_i); |
1229 | | |
1230 | 440k | temp_r = vec_y_r[1] * x_zero_band_r - vec_y_i[1] * x_zero_band_i; |
1231 | 440k | temp_i = vec_y_r[1] * x_zero_band_i + vec_y_i[1] * x_zero_band_r; |
1232 | | |
1233 | 440k | ptr_hbe_txposer->qmf_out_buf[i * 2 + (1 + HBE_ZERO_BAND_IDX - 1)] |
1234 | 440k | [2 * qmf_band_idx] += |
1235 | 440k | (FLOAT32)(mag_cmplx_gain * temp_r); |
1236 | | |
1237 | 440k | ptr_hbe_txposer->qmf_out_buf[i * 2 + (1 + HBE_ZERO_BAND_IDX - 1)] |
1238 | 440k | [2 * qmf_band_idx + 1] += |
1239 | 440k | (FLOAT32)(mag_cmplx_gain * temp_i); |
1240 | 440k | } |
1241 | 2.00M | } |
1242 | 2.00M | } |
1243 | | |
1244 | 118k | out_ptr -= (128 * 2 * qmf_voc_columns) - 2; |
1245 | 118k | norm_ptr -= (128 * qmf_voc_columns) - 2; |
1246 | 118k | x_norm_ptr -= (128 * qmf_voc_columns) - 2; |
1247 | 118k | } |
1248 | 12.3k | } |
1249 | | |
1250 | | VOID ixheaacd_hbe_post_anal_xprod3(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, |
1251 | | WORD32 qmf_voc_columns, WORD32 qmf_band_idx, |
1252 | 10.0k | FLOAT32 p, WORD32 pitch_in_bins_idx) { |
1253 | 10.0k | WORD32 i, inp_band_idx, rem; |
1254 | | |
1255 | 10.0k | FLOAT32 *out_buf = &ptr_hbe_txposer->qmf_out_buf[2][2 * qmf_band_idx]; |
1256 | | |
1257 | 87.9k | for (; qmf_band_idx < ptr_hbe_txposer->x_over_qmf[2]; qmf_band_idx++) { |
1258 | 77.8k | FLOAT32 temp_r, temp_i; |
1259 | 77.8k | FLOAT32 temp_r1, temp_i1; |
1260 | 77.8k | const FLOAT32 *ptr_sel, *ptr_sel1; |
1261 | | |
1262 | 77.8k | inp_band_idx = (2 * qmf_band_idx) / 3; |
1263 | 77.8k | ptr_sel = &ixheaac_sel_case[(inp_band_idx + 1) & 3][0]; |
1264 | 77.8k | ptr_sel1 = &ixheaac_sel_case[((inp_band_idx + 1) & 3) + 1][0]; |
1265 | 77.8k | rem = 2 * qmf_band_idx - 3 * inp_band_idx; |
1266 | | |
1267 | 77.8k | if (rem == 0 || rem == 1) { |
1268 | 52.2k | FLOAT32 *in_buf = &ptr_hbe_txposer->qmf_in_buf[0][2 * inp_band_idx]; |
1269 | | |
1270 | 956k | for (i = 0; i < qmf_voc_columns; i += 1) { |
1271 | 904k | WORD32 k; |
1272 | 904k | FLOAT32 vec_x[2 * HBE_OPER_WIN_LEN]; |
1273 | 904k | FLOAT32 *ptr_vec_x = &vec_x[0]; |
1274 | 904k | FLOAT32 x_zero_band_r, x_zero_band_i; |
1275 | | |
1276 | 904k | FLOAT32 mag_scaling_fac; |
1277 | | |
1278 | 4.52M | for (k = 0; k < (HBE_OPER_BLK_LEN_3); k += 2) { |
1279 | 3.61M | FLOAT64 base1; |
1280 | 3.61M | FLOAT64 base = 1e-17; |
1281 | | |
1282 | 3.61M | temp_r = in_buf[0]; |
1283 | 3.61M | temp_i = in_buf[1]; |
1284 | | |
1285 | 3.61M | in_buf += 256; |
1286 | | |
1287 | 3.61M | base1 = base + temp_r * temp_r; |
1288 | 3.61M | base1 = base1 + temp_i * temp_i; |
1289 | | |
1290 | 3.61M | mag_scaling_fac = (FLOAT32)(ixheaac_cbrt_calc((FLOAT32)base1)); |
1291 | | |
1292 | 3.61M | ptr_vec_x[0] = temp_r * mag_scaling_fac; |
1293 | 3.61M | ptr_vec_x[1] = temp_i * mag_scaling_fac; |
1294 | | |
1295 | 3.61M | temp_r = in_buf[0]; |
1296 | 3.61M | temp_i = in_buf[1]; |
1297 | | |
1298 | 3.61M | in_buf -= 128; |
1299 | | |
1300 | 3.61M | temp_r1 = ptr_sel[0] * temp_r + ptr_sel[1] * temp_i; |
1301 | 3.61M | temp_i1 = ptr_sel[2] * temp_r + ptr_sel[3] * temp_i; |
1302 | | |
1303 | 3.61M | temp_r = in_buf[0]; |
1304 | 3.61M | temp_i = in_buf[1]; |
1305 | | |
1306 | 3.61M | temp_r1 += ptr_sel[4] * temp_r + ptr_sel[5] * temp_i; |
1307 | 3.61M | temp_i1 += ptr_sel[6] * temp_r + ptr_sel[7] * temp_i; |
1308 | | |
1309 | 3.61M | temp_r1 *= 0.3984033437f; |
1310 | 3.61M | temp_i1 *= 0.3984033437f; |
1311 | | |
1312 | 3.61M | base1 = base + temp_r1 * temp_r1; |
1313 | 3.61M | base1 = base1 + temp_i1 * temp_i1; |
1314 | 3.61M | mag_scaling_fac = (FLOAT32)(ixheaac_cbrt_calc((FLOAT32)base1)); |
1315 | | |
1316 | 3.61M | ptr_vec_x[2] = temp_r1 * mag_scaling_fac; |
1317 | 3.61M | ptr_vec_x[3] = temp_i1 * mag_scaling_fac; |
1318 | | |
1319 | 3.61M | ptr_vec_x += 4; |
1320 | 3.61M | in_buf += 256; |
1321 | 3.61M | } |
1322 | 904k | ptr_vec_x = &vec_x[0]; |
1323 | 904k | temp_r = vec_x[2 * (HBE_ZERO_BAND_IDX - 2)]; |
1324 | 904k | temp_i = vec_x[(2 * (HBE_ZERO_BAND_IDX - 2)) + 1]; |
1325 | | |
1326 | 904k | x_zero_band_r = temp_r * temp_r - temp_i * temp_i; |
1327 | 904k | x_zero_band_i = temp_r * temp_i + temp_i * temp_r; |
1328 | | |
1329 | 8.14M | for (k = 0; k < (HBE_OPER_BLK_LEN_3); k++) { |
1330 | 7.23M | temp_r = ptr_vec_x[0] * x_zero_band_r - ptr_vec_x[1] * x_zero_band_i; |
1331 | 7.23M | temp_i = ptr_vec_x[0] * x_zero_band_i + ptr_vec_x[1] * x_zero_band_r; |
1332 | | |
1333 | 7.23M | out_buf[0] += (temp_r * 0.4714045f); |
1334 | 7.23M | out_buf[1] += (temp_i * 0.4714045f); |
1335 | | |
1336 | 7.23M | ptr_vec_x += 2; |
1337 | 7.23M | out_buf += 128; |
1338 | 7.23M | } |
1339 | | |
1340 | 904k | ixheaacd_hbe_xprod_proc_3(ptr_hbe_txposer, qmf_band_idx, i, p, |
1341 | 904k | pitch_in_bins_idx); |
1342 | | |
1343 | 904k | in_buf -= 128 * 11; |
1344 | 904k | out_buf -= 128 * 6; |
1345 | 904k | } |
1346 | 52.2k | } else { |
1347 | 25.6k | FLOAT32 *in_buf = &ptr_hbe_txposer->qmf_in_buf[0][2 * inp_band_idx]; |
1348 | 25.6k | FLOAT32 *in_buf1 = |
1349 | 25.6k | &ptr_hbe_txposer->qmf_in_buf[0][2 * (inp_band_idx + 1)]; |
1350 | | |
1351 | 473k | for (i = 0; i < qmf_voc_columns; i++) { |
1352 | 448k | WORD32 k; |
1353 | 448k | FLOAT32 vec_x[2 * HBE_OPER_WIN_LEN]; |
1354 | 448k | FLOAT32 vec_x_cap[2 * HBE_OPER_WIN_LEN]; |
1355 | | |
1356 | 448k | FLOAT32 x_zero_band_r, x_zero_band_i; |
1357 | 448k | FLOAT32 *ptr_vec_x = &vec_x[0]; |
1358 | 448k | FLOAT32 *ptr_vec_x_cap = &vec_x_cap[0]; |
1359 | | |
1360 | 448k | FLOAT32 mag_scaling_fac; |
1361 | | |
1362 | 2.24M | for (k = 0; k < (HBE_OPER_BLK_LEN_3); k += 2) { |
1363 | 1.79M | FLOAT32 tmp_vr, tmp_vi; |
1364 | 1.79M | FLOAT32 tmp_cr, tmp_ci; |
1365 | 1.79M | FLOAT64 base1; |
1366 | 1.79M | FLOAT64 base = 1e-17; |
1367 | | |
1368 | 1.79M | temp_r1 = in_buf[0]; |
1369 | 1.79M | temp_i1 = in_buf[1]; |
1370 | 1.79M | temp_r = in_buf1[0]; |
1371 | 1.79M | temp_i = in_buf1[1]; |
1372 | | |
1373 | 1.79M | base1 = base + temp_r * temp_r; |
1374 | 1.79M | base1 = base1 + temp_i * temp_i; |
1375 | | |
1376 | 1.79M | mag_scaling_fac = (FLOAT32)(ixheaac_cbrt_calc((FLOAT32)base1)); |
1377 | | |
1378 | 1.79M | ptr_vec_x[0] = temp_r * mag_scaling_fac; |
1379 | 1.79M | ptr_vec_x[1] = temp_i * mag_scaling_fac; |
1380 | | |
1381 | 1.79M | base1 = base + temp_r1 * temp_r1; |
1382 | 1.79M | base1 = base1 + temp_i1 * temp_i1; |
1383 | | |
1384 | 1.79M | mag_scaling_fac = (FLOAT32)(ixheaac_cbrt_calc((FLOAT32)base1)); |
1385 | | |
1386 | 1.79M | ptr_vec_x_cap[0] = temp_r1 * mag_scaling_fac; |
1387 | 1.79M | ptr_vec_x_cap[1] = temp_i1 * mag_scaling_fac; |
1388 | | |
1389 | 1.79M | in_buf += 256; |
1390 | | |
1391 | 1.79M | temp_r = in_buf[0]; |
1392 | 1.79M | temp_i = in_buf[1]; |
1393 | | |
1394 | 1.79M | temp_r1 = ptr_sel[0] * temp_r + ptr_sel[1] * temp_i; |
1395 | 1.79M | temp_i1 = ptr_sel[2] * temp_r + ptr_sel[3] * temp_i; |
1396 | | |
1397 | 1.79M | in_buf -= 128; |
1398 | | |
1399 | 1.79M | temp_r = in_buf[0]; |
1400 | 1.79M | temp_i = in_buf[1]; |
1401 | | |
1402 | 1.79M | tmp_cr = temp_r1 + ptr_sel[4] * temp_r + ptr_sel[5] * temp_i; |
1403 | 1.79M | tmp_ci = temp_i1 + ptr_sel[6] * temp_r + ptr_sel[7] * temp_i; |
1404 | | |
1405 | 1.79M | in_buf1 += 256; |
1406 | | |
1407 | 1.79M | temp_r = in_buf1[0]; |
1408 | 1.79M | temp_i = in_buf1[1]; |
1409 | | |
1410 | 1.79M | temp_r1 = ptr_sel1[0] * temp_r + ptr_sel1[1] * temp_i; |
1411 | 1.79M | temp_i1 = ptr_sel1[2] * temp_r + ptr_sel1[3] * temp_i; |
1412 | | |
1413 | 1.79M | in_buf1 -= 128; |
1414 | | |
1415 | 1.79M | temp_r = in_buf1[0]; |
1416 | 1.79M | temp_i = in_buf1[1]; |
1417 | | |
1418 | 1.79M | tmp_vr = temp_r1 + ptr_sel1[4] * temp_r + ptr_sel1[5] * temp_i; |
1419 | 1.79M | tmp_vi = temp_i1 + ptr_sel1[6] * temp_r + ptr_sel1[7] * temp_i; |
1420 | | |
1421 | 1.79M | tmp_cr *= 0.3984033437f; |
1422 | 1.79M | tmp_ci *= 0.3984033437f; |
1423 | | |
1424 | 1.79M | tmp_vr *= 0.3984033437f; |
1425 | 1.79M | tmp_vi *= 0.3984033437f; |
1426 | | |
1427 | 1.79M | base1 = base + tmp_vr * tmp_vr; |
1428 | 1.79M | base1 = base1 + tmp_vi * tmp_vi; |
1429 | | |
1430 | 1.79M | mag_scaling_fac = (FLOAT32)(ixheaac_cbrt_calc((FLOAT32)base1)); |
1431 | | |
1432 | 1.79M | ptr_vec_x[2] = tmp_vr * mag_scaling_fac; |
1433 | 1.79M | ptr_vec_x[3] = tmp_vi * mag_scaling_fac; |
1434 | | |
1435 | 1.79M | base1 = base + tmp_cr * tmp_cr; |
1436 | 1.79M | base1 = base1 + tmp_ci * tmp_ci; |
1437 | | |
1438 | 1.79M | mag_scaling_fac = (FLOAT32)(ixheaac_cbrt_calc((FLOAT32)base1)); |
1439 | | |
1440 | 1.79M | ptr_vec_x_cap[2] = tmp_cr * mag_scaling_fac; |
1441 | 1.79M | ptr_vec_x_cap[3] = tmp_ci * mag_scaling_fac; |
1442 | | |
1443 | 1.79M | in_buf += 256; |
1444 | 1.79M | in_buf1 += 256; |
1445 | 1.79M | ptr_vec_x += 4; |
1446 | 1.79M | ptr_vec_x_cap += 4; |
1447 | 1.79M | } |
1448 | 448k | ptr_vec_x = &vec_x[0]; |
1449 | 448k | ptr_vec_x_cap = &vec_x_cap[0]; |
1450 | | |
1451 | 448k | temp_r = vec_x_cap[2 * (HBE_ZERO_BAND_IDX - 2)]; |
1452 | 448k | temp_i = vec_x_cap[2 * (HBE_ZERO_BAND_IDX - 2) + 1]; |
1453 | 448k | temp_r1 = vec_x[2 * (HBE_ZERO_BAND_IDX - 2)]; |
1454 | 448k | temp_i1 = vec_x[2 * (HBE_ZERO_BAND_IDX - 2) + 1]; |
1455 | | |
1456 | 448k | x_zero_band_r = temp_r * temp_r - temp_i * temp_i; |
1457 | 448k | x_zero_band_i = temp_r * temp_i + temp_i * temp_r; |
1458 | | |
1459 | 448k | temp_r = temp_r1 * temp_r1 - temp_i1 * temp_i1; |
1460 | 448k | temp_i = temp_r1 * temp_i1 + temp_i1 * temp_r1; |
1461 | | |
1462 | 4.03M | for (k = 0; k < (HBE_OPER_BLK_LEN_3); k++) { |
1463 | 3.58M | temp_r1 = ptr_vec_x[0] * x_zero_band_r - ptr_vec_x[1] * x_zero_band_i; |
1464 | 3.58M | temp_i1 = ptr_vec_x[0] * x_zero_band_i + ptr_vec_x[1] * x_zero_band_r; |
1465 | | |
1466 | 3.58M | temp_r1 += ptr_vec_x_cap[0] * temp_r - ptr_vec_x_cap[1] * temp_i; |
1467 | 3.58M | temp_i1 += ptr_vec_x_cap[0] * temp_i + ptr_vec_x_cap[1] * temp_r; |
1468 | | |
1469 | 3.58M | out_buf[0] += (temp_r1 * 0.23570225f); |
1470 | 3.58M | out_buf[1] += (temp_i1 * 0.23570225f); |
1471 | | |
1472 | 3.58M | out_buf += 128; |
1473 | 3.58M | ptr_vec_x += 2; |
1474 | 3.58M | ptr_vec_x_cap += 2; |
1475 | 3.58M | } |
1476 | | |
1477 | 448k | ixheaacd_hbe_xprod_proc_3(ptr_hbe_txposer, qmf_band_idx, i, p, |
1478 | 448k | pitch_in_bins_idx); |
1479 | | |
1480 | 448k | in_buf -= 128 * 11; |
1481 | 448k | in_buf1 -= 128 * 11; |
1482 | 448k | out_buf -= 128 * 6; |
1483 | 448k | } |
1484 | 25.6k | } |
1485 | | |
1486 | 77.8k | out_buf -= (256 * qmf_voc_columns) - 2; |
1487 | 77.8k | } |
1488 | 10.0k | } |
1489 | | |
1490 | | VOID ixheaacd_hbe_post_anal_xprod4(ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, |
1491 | | WORD32 qmf_voc_columns, WORD32 qmf_band_idx, |
1492 | 7.68k | FLOAT32 p, WORD32 pitch_in_bins_idx) { |
1493 | 7.68k | WORD32 i, inp_band_idx; |
1494 | 7.68k | FLOAT32 *out_ptr = &ptr_hbe_txposer->qmf_out_buf[3][2 * qmf_band_idx]; |
1495 | | |
1496 | 7.68k | ixheaacd_norm_qmf_in_buf_4(ptr_hbe_txposer, ((qmf_band_idx >> 1) - 1)); |
1497 | | |
1498 | 65.4k | for (; qmf_band_idx < ptr_hbe_txposer->x_over_qmf[3]; qmf_band_idx++) { |
1499 | 57.7k | WORD32 ip_idx; |
1500 | 57.7k | FLOAT32 temp, temp_r, temp_i; |
1501 | 57.7k | FLOAT32 *norm_ptr, *x_norm_ptr; |
1502 | 57.7k | inp_band_idx = qmf_band_idx >> 1; |
1503 | 57.7k | ip_idx = (qmf_band_idx & 1) ? (inp_band_idx + 1) : (inp_band_idx - 1); |
1504 | | |
1505 | 57.7k | norm_ptr = &ptr_hbe_txposer->norm_qmf_in_buf[0][2 * ip_idx]; |
1506 | 57.7k | x_norm_ptr = |
1507 | 57.7k | &ptr_hbe_txposer->norm_qmf_in_buf[HBE_ZERO_BAND_IDX][2 * inp_band_idx]; |
1508 | | |
1509 | 1.01M | for (i = 0; i < qmf_voc_columns; i++) { |
1510 | 961k | WORD32 k; |
1511 | 961k | FLOAT32 x_zero_band_r, x_zero_band_i; |
1512 | | |
1513 | 961k | temp_r = x_zero_band_r = *x_norm_ptr++; |
1514 | 961k | temp_i = x_zero_band_i = *x_norm_ptr++; |
1515 | | |
1516 | 961k | temp = x_zero_band_r * x_zero_band_r - x_zero_band_i * x_zero_band_i; |
1517 | 961k | x_zero_band_i = |
1518 | 961k | x_zero_band_r * x_zero_band_i + x_zero_band_i * x_zero_band_r; |
1519 | | |
1520 | 961k | x_zero_band_r = temp_r * temp - temp_i * x_zero_band_i; |
1521 | 961k | x_zero_band_i = temp_r * x_zero_band_i + temp_i * temp; |
1522 | | |
1523 | 6.73M | for (k = 0; k < HBE_OPER_BLK_LEN_4; k++) { |
1524 | 5.76M | temp = *norm_ptr++; |
1525 | 5.76M | temp_i = *norm_ptr++; |
1526 | | |
1527 | 5.76M | temp_r = temp * x_zero_band_r - temp_i * x_zero_band_i; |
1528 | 5.76M | temp_i = temp * x_zero_band_i + temp_i * x_zero_band_r; |
1529 | | |
1530 | 5.76M | *out_ptr++ += (temp_r * 0.6666667f); |
1531 | 5.76M | *out_ptr++ += (temp_i * 0.6666667f); |
1532 | | |
1533 | 5.76M | norm_ptr += 254; |
1534 | 5.76M | out_ptr += 126; |
1535 | 5.76M | } |
1536 | | |
1537 | 961k | norm_ptr -= 128 * 11; |
1538 | 961k | out_ptr -= 128 * 4; |
1539 | 961k | x_norm_ptr += 126; |
1540 | | |
1541 | 961k | ixheaacd_hbe_xprod_proc_4(ptr_hbe_txposer, qmf_band_idx, i, p, |
1542 | 961k | pitch_in_bins_idx); |
1543 | 961k | } |
1544 | | |
1545 | 57.7k | out_ptr -= (128 * 2 * qmf_voc_columns) - 2; |
1546 | 57.7k | } |
1547 | 7.68k | } |
1548 | | |
1549 | | IA_ERRORCODE ixheaacd_hbe_post_anal_process( |
1550 | | ia_esbr_hbe_txposer_struct *ptr_hbe_txposer, WORD32 pitch_in_bins, |
1551 | 325k | WORD32 sbr_upsamp_4_flg) { |
1552 | 325k | FLOAT32 p; |
1553 | 325k | WORD32 trans_fac; |
1554 | 325k | WORD32 qmf_voc_columns = ptr_hbe_txposer->no_bins / 2; |
1555 | 325k | FLOAT32 cos_sin_theta[2]; |
1556 | | |
1557 | 325k | p = (sbr_upsamp_4_flg) ? (FLOAT32)(pitch_in_bins * 0.04166666666666) |
1558 | 325k | : (FLOAT32)(pitch_in_bins * 0.08333333333333); |
1559 | | |
1560 | 325k | if (p < SBR_CONST_PMIN) { |
1561 | 312k | trans_fac = 2; |
1562 | 312k | if (trans_fac <= ptr_hbe_txposer->max_stretch) |
1563 | 274k | ixheaacd_hbe_post_anal_prod2(ptr_hbe_txposer, qmf_voc_columns, |
1564 | 274k | ptr_hbe_txposer->x_over_qmf[0]); |
1565 | | |
1566 | 312k | trans_fac = 3; |
1567 | 312k | if (trans_fac <= ptr_hbe_txposer->max_stretch) |
1568 | 180k | ixheaacd_hbe_post_anal_prod3(ptr_hbe_txposer, qmf_voc_columns, |
1569 | 180k | ptr_hbe_txposer->x_over_qmf[1]); |
1570 | | |
1571 | 312k | trans_fac = 4; |
1572 | 312k | if (trans_fac <= ptr_hbe_txposer->max_stretch) { |
1573 | 108k | if (ptr_hbe_txposer->x_over_qmf[2] <= 1) return IA_FATAL_ERROR; |
1574 | 108k | ixheaacd_hbe_post_anal_prod4(ptr_hbe_txposer, qmf_voc_columns, |
1575 | 108k | ptr_hbe_txposer->x_over_qmf[2]); |
1576 | 108k | } |
1577 | | |
1578 | 312k | } else { |
1579 | 13.3k | trans_fac = 2; |
1580 | 13.3k | if (trans_fac <= ptr_hbe_txposer->max_stretch) { |
1581 | 12.3k | cos_sin_theta[0] = ixheaac_hbe_x_prod_cos_table_trans_2 |
1582 | 12.3k | [((pitch_in_bins + sbr_upsamp_4_flg * 128) << 1) + 0]; |
1583 | 12.3k | cos_sin_theta[1] = ixheaac_hbe_x_prod_cos_table_trans_2 |
1584 | 12.3k | [((pitch_in_bins + sbr_upsamp_4_flg * 128) << 1) + 1]; |
1585 | | |
1586 | 12.3k | ixheaacd_hbe_post_anal_xprod2(ptr_hbe_txposer, qmf_voc_columns, |
1587 | 12.3k | ptr_hbe_txposer->x_over_qmf[0], p, |
1588 | 12.3k | cos_sin_theta); |
1589 | 12.3k | } |
1590 | | |
1591 | 13.3k | trans_fac = 3; |
1592 | 13.3k | if (trans_fac <= ptr_hbe_txposer->max_stretch) |
1593 | 10.0k | ixheaacd_hbe_post_anal_xprod3(ptr_hbe_txposer, qmf_voc_columns, |
1594 | 10.0k | ptr_hbe_txposer->x_over_qmf[1], p, |
1595 | 10.0k | (pitch_in_bins + sbr_upsamp_4_flg * 128)); |
1596 | | |
1597 | 13.3k | trans_fac = 4; |
1598 | 13.3k | if (trans_fac <= ptr_hbe_txposer->max_stretch) { |
1599 | 7.68k | if (ptr_hbe_txposer->x_over_qmf[2] <= 1) return IA_FATAL_ERROR; |
1600 | 7.68k | ixheaacd_hbe_post_anal_xprod4(ptr_hbe_txposer, qmf_voc_columns, |
1601 | 7.68k | ptr_hbe_txposer->x_over_qmf[2], p, |
1602 | 7.68k | (pitch_in_bins + sbr_upsamp_4_flg * 128)); |
1603 | 7.68k | } |
1604 | 13.3k | } |
1605 | 325k | return IA_NO_ERROR; |
1606 | 325k | } |