354 lines
12 KiB
C
354 lines
12 KiB
C
/******************************************************************************
|
|
* *
|
|
* 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 <string.h>
|
|
|
|
#include "ixheaacd_sbr_common.h"
|
|
#include "ixheaacd_type_def.h"
|
|
|
|
#include "ixheaacd_constants.h"
|
|
#include "ixheaacd_basic_ops32.h"
|
|
#include "ixheaacd_basic_ops16.h"
|
|
#include "ixheaacd_basic_ops40.h"
|
|
#include "ixheaacd_basic_ops.h"
|
|
|
|
#include "ixheaacd_intrinsics.h"
|
|
#include "ixheaacd_common_rom.h"
|
|
#include "ixheaacd_bitbuffer.h"
|
|
#include "ixheaacd_sbrdecsettings.h"
|
|
#include "ixheaacd_sbr_scale.h"
|
|
#include "ixheaacd_lpp_tran.h"
|
|
#include "ixheaacd_env_extr_part.h"
|
|
#include "ixheaacd_sbr_rom.h"
|
|
#include "ixheaacd_hybrid.h"
|
|
#include "ixheaacd_ps_dec.h"
|
|
#include "ixheaacd_env_extr.h"
|
|
#include "ixheaacd_qmf_dec.h"
|
|
|
|
#include "ixheaacd_basic_op.h"
|
|
#include "ixheaacd_env_calc.h"
|
|
|
|
#include "ixheaacd_interface.h"
|
|
|
|
#include "ixheaacd_function_selector.h"
|
|
#include "ixheaacd_audioobjtypes.h"
|
|
|
|
#define mult16x16_16(a, b) ixheaacd_mult16((a), (b))
|
|
#define mac16x16(a, b, c) ixheaacd_mac16x16in32_sat((a), (b), (c))
|
|
#define mpy_32x16(a, b) fixmuldiv2_32x16b((a), (b))
|
|
#define mpy_16x16(a, b) ixheaacd_mult16x16in32((a), (b))
|
|
#define mpy_32x32(a, b) ixheaacd_mult32((a), (b))
|
|
#define mpy_32x16H_n(a, b) ixheaacd_mult32x16hin32((a), (b))
|
|
#define msu16x16(a, b, c) msu16x16in32((a), (b), (c))
|
|
|
|
#define DCT3_LEN (32)
|
|
#define DCT2_LEN (64)
|
|
|
|
#define LP_SHIFT_VAL 7
|
|
#define HQ_SHIFT_64 4
|
|
#define RADIXSHIFT 1
|
|
#define ROUNDING_SPECTRA 1
|
|
#define HQ_SHIFT_VAL 4
|
|
|
|
VOID ixheaacd_dct2_64(WORD32 *x, WORD32 *X,
|
|
ia_qmf_dec_tables_struct *qmf_dec_tables_ptr,
|
|
WORD16 *filter_states) {
|
|
ixheaacd_pretwdct2(x, X);
|
|
|
|
ixheaacd_sbr_imdct_using_fft(qmf_dec_tables_ptr->w1024, 32, X, x,
|
|
qmf_dec_tables_ptr->dig_rev_table2_128,
|
|
qmf_dec_tables_ptr->dig_rev_table2_128,
|
|
qmf_dec_tables_ptr->dig_rev_table2_128,
|
|
qmf_dec_tables_ptr->dig_rev_table2_128);
|
|
|
|
ixheaacd_fftposttw(x, qmf_dec_tables_ptr);
|
|
|
|
ixheaacd_posttwdct2(x, filter_states, qmf_dec_tables_ptr);
|
|
|
|
return;
|
|
}
|
|
|
|
VOID ixheaacd_cplx_anal_qmffilt(const WORD16 *time_sample_buf,
|
|
ia_sbr_scale_fact_struct *sbr_scale_factor,
|
|
WORD32 **qmf_real, WORD32 **qmf_imag,
|
|
ia_sbr_qmf_filter_bank_struct *qmf_bank,
|
|
ia_qmf_dec_tables_struct *qmf_dec_tables_ptr,
|
|
WORD32 ch_fac, WORD32 low_pow_flag,
|
|
WORD audio_object_type) {
|
|
WORD32 i, k;
|
|
WORD32 num_time_slots = qmf_bank->num_time_slots;
|
|
|
|
WORD32 analysis_buffer[4 * NO_ANALYSIS_CHANNELS];
|
|
WORD16 *filter_states = qmf_bank->core_samples_buffer;
|
|
|
|
WORD16 *fp1, *fp2, *tmp;
|
|
|
|
WORD16 *filter_1;
|
|
WORD16 *filter_2;
|
|
WORD16 *filt_ptr;
|
|
if (audio_object_type != AOT_ER_AAC_ELD &&
|
|
audio_object_type != AOT_ER_AAC_LD) {
|
|
qmf_bank->filter_pos +=
|
|
(qmf_dec_tables_ptr->qmf_c - qmf_bank->analy_win_coeff);
|
|
qmf_bank->analy_win_coeff = qmf_dec_tables_ptr->qmf_c;
|
|
} else {
|
|
qmf_bank->filter_pos +=
|
|
(qmf_dec_tables_ptr->qmf_c_eld3 - qmf_bank->analy_win_coeff);
|
|
qmf_bank->analy_win_coeff = qmf_dec_tables_ptr->qmf_c_eld3;
|
|
}
|
|
|
|
filter_1 = qmf_bank->filter_pos;
|
|
|
|
if (audio_object_type != AOT_ER_AAC_ELD &&
|
|
audio_object_type != AOT_ER_AAC_LD) {
|
|
filter_2 = filter_1 + 64;
|
|
} else {
|
|
filter_2 = filter_1 + 32;
|
|
}
|
|
|
|
sbr_scale_factor->st_lb_scale = 0;
|
|
sbr_scale_factor->lb_scale = -10;
|
|
if (!low_pow_flag) {
|
|
if (audio_object_type != AOT_ER_AAC_ELD &&
|
|
audio_object_type != AOT_ER_AAC_LD) {
|
|
sbr_scale_factor->lb_scale = -8;
|
|
} else {
|
|
sbr_scale_factor->lb_scale = -9;
|
|
}
|
|
qmf_bank->cos_twiddle =
|
|
(WORD16 *)qmf_dec_tables_ptr->sbr_sin_cos_twiddle_l32;
|
|
qmf_bank->alt_sin_twiddle =
|
|
(WORD16 *)qmf_dec_tables_ptr->sbr_alt_sin_twiddle_l32;
|
|
if (audio_object_type != AOT_ER_AAC_ELD &&
|
|
audio_object_type != AOT_ER_AAC_LD) {
|
|
qmf_bank->t_cos = (WORD16 *)qmf_dec_tables_ptr->sbr_t_cos_sin_l32;
|
|
} else {
|
|
qmf_bank->t_cos =
|
|
(WORD16 *)qmf_dec_tables_ptr->ixheaacd_sbr_t_cos_sin_l32_eld;
|
|
}
|
|
}
|
|
|
|
fp1 = qmf_bank->anal_filter_states;
|
|
fp2 = qmf_bank->anal_filter_states + NO_ANALYSIS_CHANNELS;
|
|
|
|
if (audio_object_type == AOT_ER_AAC_ELD ||
|
|
audio_object_type == AOT_ER_AAC_LD) {
|
|
filter_2 = qmf_bank->filter_2;
|
|
fp1 = qmf_bank->fp1_anal;
|
|
fp2 = qmf_bank->fp2_anal;
|
|
}
|
|
|
|
for (i = 0; i < num_time_slots; i++) {
|
|
for (k = 0; k < NO_ANALYSIS_CHANNELS; k++)
|
|
filter_states[NO_ANALYSIS_CHANNELS - 1 - k] = time_sample_buf[ch_fac * k];
|
|
|
|
if (audio_object_type != AOT_ER_AAC_ELD &&
|
|
audio_object_type != AOT_ER_AAC_LD) {
|
|
ixheaacd_sbr_qmfanal32_winadds(fp1, fp2, filter_1, filter_2,
|
|
analysis_buffer, filter_states,
|
|
time_sample_buf, ch_fac);
|
|
} else {
|
|
ixheaacd_sbr_qmfanal32_winadds_eld(fp1, fp2, filter_1, filter_2,
|
|
analysis_buffer, filter_states,
|
|
time_sample_buf, ch_fac);
|
|
}
|
|
|
|
time_sample_buf += NO_ANALYSIS_CHANNELS * ch_fac;
|
|
|
|
filter_states -= NO_ANALYSIS_CHANNELS;
|
|
if (filter_states < qmf_bank->anal_filter_states) {
|
|
filter_states = qmf_bank->anal_filter_states + 288;
|
|
}
|
|
|
|
tmp = fp1;
|
|
fp1 = fp2;
|
|
fp2 = tmp;
|
|
if (audio_object_type != AOT_ER_AAC_ELD &&
|
|
audio_object_type != AOT_ER_AAC_LD) {
|
|
filter_1 += 64;
|
|
filter_2 += 64;
|
|
} else {
|
|
filter_1 += 32;
|
|
filter_2 += 32;
|
|
}
|
|
|
|
filt_ptr = filter_1;
|
|
filter_1 = filter_2;
|
|
filter_2 = filt_ptr;
|
|
if (audio_object_type != AOT_ER_AAC_ELD &&
|
|
audio_object_type != AOT_ER_AAC_LD) {
|
|
if (filter_2 > (qmf_bank->analy_win_coeff + 640)) {
|
|
filter_1 = (WORD16 *)qmf_bank->analy_win_coeff;
|
|
filter_2 = (WORD16 *)qmf_bank->analy_win_coeff + 64;
|
|
}
|
|
} else {
|
|
if (filter_2 > (qmf_bank->analy_win_coeff + 320)) {
|
|
filter_1 = (WORD16 *)qmf_bank->analy_win_coeff;
|
|
filter_2 = (WORD16 *)qmf_bank->analy_win_coeff + 32;
|
|
}
|
|
}
|
|
|
|
if (!low_pow_flag) {
|
|
ixheaacd_fwd_modulation(analysis_buffer, qmf_real[i], qmf_imag[i],
|
|
qmf_bank, qmf_dec_tables_ptr);
|
|
} else {
|
|
ixheaacd_dct3_32(
|
|
(WORD32 *)analysis_buffer, qmf_real[i], qmf_dec_tables_ptr->dct23_tw,
|
|
qmf_dec_tables_ptr->post_fft_tbl, qmf_dec_tables_ptr->w_16,
|
|
qmf_dec_tables_ptr->dig_rev_table4_16);
|
|
}
|
|
}
|
|
|
|
qmf_bank->filter_pos = filter_1;
|
|
qmf_bank->core_samples_buffer = filter_states;
|
|
|
|
if (audio_object_type == AOT_ER_AAC_ELD || audio_object_type == AOT_ER_AAC_LD)
|
|
|
|
{
|
|
qmf_bank->fp1_anal = fp1;
|
|
qmf_bank->fp2_anal = fp2;
|
|
qmf_bank->filter_2 = filter_2;
|
|
}
|
|
}
|
|
|
|
VOID ixheaacd_inv_modulation_lp(WORD32 *qmf_real, WORD16 *filter_states,
|
|
ia_sbr_qmf_filter_bank_struct *syn_qmf,
|
|
ia_qmf_dec_tables_struct *qmf_dec_tables_ptr) {
|
|
WORD32 L = syn_qmf->no_channels;
|
|
const WORD32 M = (L >> 1);
|
|
WORD32 *dct_in = qmf_real;
|
|
WORD32 time_out[2 * NO_SYNTHESIS_CHANNELS];
|
|
|
|
WORD32 ui_rem = ((WORD32)(&time_out[0]) % 8);
|
|
WORD32 *ptime_out = (pVOID)((WORD8 *)&time_out[0] + 8 - ui_rem);
|
|
|
|
if (L == 64)
|
|
ixheaacd_dec_DCT2_64_asm(dct_in, ptime_out, qmf_dec_tables_ptr->w1024,
|
|
qmf_dec_tables_ptr->dig_rev_table2_128,
|
|
qmf_dec_tables_ptr->post_fft_tbl,
|
|
qmf_dec_tables_ptr->dct23_tw, filter_states + M);
|
|
else
|
|
ixheaacd_dct2_32(dct_in, time_out, qmf_dec_tables_ptr, filter_states);
|
|
|
|
filter_states[3 * M] = 0;
|
|
}
|
|
|
|
VOID ixheaacd_inv_emodulation(WORD32 *qmf_real,
|
|
ia_sbr_qmf_filter_bank_struct *syn_qmf,
|
|
ia_qmf_dec_tables_struct *qmf_dec_tables_ptr) {
|
|
ixheaacd_cos_sin_mod(qmf_real, syn_qmf, (WORD16 *)qmf_dec_tables_ptr->w1024,
|
|
(WORD32 *)qmf_dec_tables_ptr->dig_rev_table2_128);
|
|
}
|
|
|
|
VOID ixheaacd_esbr_cos_sin_mod(WORD32 *subband,
|
|
ia_sbr_qmf_filter_bank_struct *qmf_bank,
|
|
WORD32 *p_twiddle, WORD32 *p_dig_rev_tbl) {
|
|
WORD32 z;
|
|
WORD32 temp[128];
|
|
WORD32 scaleshift = 0;
|
|
|
|
WORD32 M_2;
|
|
WORD32 M = ixheaacd_shr32(qmf_bank->no_channels, 1);
|
|
|
|
const WORD32 *p_sin;
|
|
const WORD32 *p_sin_cos;
|
|
|
|
WORD32 subband_tmp[128];
|
|
|
|
p_sin_cos = qmf_bank->esbr_cos_twiddle;
|
|
ixheaacd_esbr_cos_sin_mod_loop1(subband, M, p_sin_cos, subband_tmp);
|
|
|
|
M_2 = ixheaacd_shr32(M, 1);
|
|
if (M == 32) {
|
|
ixheaacd_esbr_radix4bfly(p_twiddle, subband_tmp, 1, 8);
|
|
ixheaacd_esbr_radix4bfly(p_twiddle + 48, subband_tmp, 4, 2);
|
|
ixheaacd_postradixcompute2(subband, subband_tmp, p_dig_rev_tbl, 32);
|
|
|
|
ixheaacd_esbr_radix4bfly(p_twiddle, &subband_tmp[64], 1, 8);
|
|
ixheaacd_esbr_radix4bfly(p_twiddle + 48, &subband_tmp[64], 4, 2);
|
|
ixheaacd_postradixcompute2(&subband[64], &subband_tmp[64], p_dig_rev_tbl,
|
|
32);
|
|
|
|
}
|
|
|
|
else if (M == 16) {
|
|
ixheaacd_esbr_radix4bfly(p_twiddle, subband_tmp, 1, 4);
|
|
ixheaacd_postradixcompute4(subband, subband_tmp, p_dig_rev_tbl, 16);
|
|
|
|
ixheaacd_esbr_radix4bfly(p_twiddle, &subband_tmp[64], 1, 4);
|
|
ixheaacd_postradixcompute4(&subband[64], &subband_tmp[64], p_dig_rev_tbl,
|
|
16);
|
|
|
|
}
|
|
|
|
else if (M == 12) {
|
|
for (z = 0; z < (qmf_bank->no_channels >> 1); z++) {
|
|
temp[z] = subband_tmp[2 * z];
|
|
temp[12 + z] = subband_tmp[2 * z + 1];
|
|
}
|
|
|
|
ixheaacd_complex_fft_p3(temp, &temp[12], 12, -1, &scaleshift);
|
|
|
|
for (z = 0; z < (qmf_bank->no_channels >> 1); z++) {
|
|
subband[2 * z] = temp[z];
|
|
subband[2 * z + 1] = temp[z + 12];
|
|
}
|
|
scaleshift = 0;
|
|
for (z = 0; z < (qmf_bank->no_channels >> 1); z++) {
|
|
temp[z] = subband_tmp[64 + 2 * z];
|
|
temp[12 + z] = subband_tmp[64 + 2 * z + 1];
|
|
}
|
|
|
|
ixheaacd_complex_fft_p3(temp, &temp[12], 12, -1, &scaleshift);
|
|
|
|
for (z = 0; z < (qmf_bank->no_channels >> 1); z++) {
|
|
subband[64 + 2 * z] = temp[z];
|
|
subband[64 + 2 * z + 1] = temp[z + 12];
|
|
}
|
|
|
|
}
|
|
|
|
else {
|
|
for (z = 0; z < (qmf_bank->no_channels >> 1); z++) {
|
|
temp[z] = subband_tmp[2 * z];
|
|
temp[8 + z] = subband_tmp[2 * z + 1];
|
|
}
|
|
|
|
(*ixheaacd_complex_fft_p2)(temp, &temp[8], 8, -1, &scaleshift);
|
|
|
|
for (z = 0; z < (qmf_bank->no_channels >> 1); z++) {
|
|
subband[2 * z] = temp[z] << scaleshift;
|
|
subband[2 * z + 1] = temp[z + 8] << scaleshift;
|
|
}
|
|
scaleshift = 0;
|
|
for (z = 0; z < (qmf_bank->no_channels >> 1); z++) {
|
|
temp[z] = subband_tmp[64 + 2 * z];
|
|
temp[8 + z] = subband_tmp[64 + 2 * z + 1];
|
|
}
|
|
|
|
(*ixheaacd_complex_fft_p2)(temp, &temp[8], 8, -1, &scaleshift);
|
|
|
|
for (z = 0; z < (qmf_bank->no_channels >> 1); z++) {
|
|
subband[64 + 2 * z] = temp[z] << scaleshift;
|
|
subband[64 + 2 * z + 1] = temp[8 + z] << scaleshift;
|
|
}
|
|
}
|
|
p_sin = qmf_bank->esbr_alt_sin_twiddle;
|
|
ixheaacd_esbr_cos_sin_mod_loop2(subband, p_sin, M);
|
|
} |