werunplugged/unplugged-system
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
06ee9615ad
unplugged-system/external/libxaac/decoder/ixheaacd_mps_calc_m1m2_tree_727x.c

834 lines
35 KiB
C
Raw Normal View History

Initial commit: AOSP 14 with modifications for Unplugged OS
2025-10-06 13:59:42 +00:00
/******************************************************************************
*
* Copyright (C) 2023 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_type_def.h"
#include "ixheaacd_mps_struct_def.h"
#include "ixheaacd_mps_res_rom.h"
#include "ixheaacd_mps_aac_struct.h"
#include "ixheaacd_constants.h"
#include "ixheaacd_basic_ops32.h"
#include "ixheaacd_basic_ops40.h"
#include "ixheaacd_bitbuffer.h"
#include "ixheaacd_common_rom.h"
#include "ixheaacd_sbrdecsettings.h"
#include "ixheaacd_sbr_scale.h"
#include "ixheaacd_env_extr_part.h"
#include "ixheaacd_sbr_rom.h"
#include "ixheaacd_hybrid.h"
#include "ixheaacd_ps_dec.h"
#include "ixheaacd_error_standards.h"
#include "ixheaacd_mps_polyphase.h"
#include "ixheaacd_config.h"
#include "ixheaacd_qmf_dec.h"
#include "ixheaacd_mps_dec.h"
#include "ixheaacd_mps_macro_def.h"
#include "ixheaacd_mps_basic_op.h"
#include "ixheaacd_mps_calc_m1m2_common.h"
VOID ixheaacd_calc_m1m2_7271(ia_heaac_mps_state_struct *pstr_mps_state) {
ia_mps_dec_auxilary_struct *p_aux_struct = pstr_mps_state->aux_struct;
ia_mps_dec_m2_param_struct *m2_param = p_aux_struct->m2_param;
ia_mps_dec_m1_param_struct *m1_param = pstr_mps_state->array_struct->m1_param;
ia_heaac_mps_state_struct *curr_state = pstr_mps_state;
WORD32 ps, pb, col, row, i;
WORD32 m_pre[3][5];
WORD32 m_ttt[3][3];
WORD32 g_real[2];
WORD32 temp_1, temp_2;
WORD64 acc;
WORD32 *h11_l, *h11_r, *h12_l, *h12_r, *h21_l, *h21_r, *h22_l, *h22_r, *h12_res_l, *h12_res_r,
*h22_res_l, *h22_res_r;
WORD32 *c_l_clfe, *c_r_clfe, *kappa, *g_dd;
WORD16 *c_f_l, *c_f_r, *dummy;
WORD32 *h11_lc, *h11_rc, *h12_lc, *h12_rc, *h21_lc, *h21_rc, *h22_lc, *h22_rc, *h12_res_lc,
*h12_res_rc, *h22_res_lc, *h22_res_rc;
WORD16 *c_f_lc, *c_f_rc;
WORD32 idx;
WORD32 residual_coding = pstr_mps_state->residual_coding;
WORD32 *res_bands = pstr_mps_state->res_bands;
WORD32 num_parameter_bands = pstr_mps_state->num_parameter_bands;
WORD32 m1_param_imag_present = pstr_mps_state->m1_param_imag_present;
WORD32 num_input_channels = pstr_mps_state->num_input_channels;
WORD32 num_parameter_sets = pstr_mps_state->num_parameter_sets;
WORD32 arbitrary_downmix = pstr_mps_state->arbitrary_downmix;
WORD32 mode_0 = p_aux_struct->ttt_config[0][0].mode;
WORD32 mode_1 = p_aux_struct->ttt_config[1][0].mode;
WORD32 enable_additionals = ((mode_0 == 0) || (mode_1 == 0));
WORD32 pos[5] = {0};
WORD32 pos_resid[5] = {0};
h11_l = pstr_mps_state->mps_scratch_mem_v;
h11_r = h11_l + MAX_PARAMETER_BANDS;
h12_l = h11_r + MAX_PARAMETER_BANDS;
h12_r = h12_l + MAX_PARAMETER_BANDS;
h21_l = h12_r + MAX_PARAMETER_BANDS;
h21_r = h21_l + MAX_PARAMETER_BANDS;
h22_l = h21_r + MAX_PARAMETER_BANDS;
h22_r = h22_l + MAX_PARAMETER_BANDS;
h12_res_l = h22_r + MAX_PARAMETER_BANDS;
h12_res_r = h12_res_l + MAX_PARAMETER_BANDS;
h22_res_l = h12_res_r + MAX_PARAMETER_BANDS;
h22_res_r = h22_res_l + MAX_PARAMETER_BANDS;
c_l_clfe = h22_res_r + MAX_PARAMETER_BANDS;
c_r_clfe = c_l_clfe + MAX_PARAMETER_BANDS;
kappa = c_r_clfe + MAX_PARAMETER_BANDS;
g_dd = kappa + MAX_PARAMETER_BANDS;
h11_lc = g_dd + MAX_PARAMETER_BANDS;
h11_rc = h11_lc + MAX_PARAMETER_BANDS;
h12_lc = h11_rc + MAX_PARAMETER_BANDS;
h12_rc = h12_lc + MAX_PARAMETER_BANDS;
h21_lc = h12_rc + MAX_PARAMETER_BANDS;
h21_rc = h21_lc + MAX_PARAMETER_BANDS;
h22_lc = h21_rc + MAX_PARAMETER_BANDS;
h22_rc = h22_lc + MAX_PARAMETER_BANDS;
h12_res_lc = h22_rc + MAX_PARAMETER_BANDS;
h12_res_rc = h12_res_lc + MAX_PARAMETER_BANDS;
h22_res_lc = h12_res_rc + MAX_PARAMETER_BANDS;
h22_res_rc = h22_res_lc + MAX_PARAMETER_BANDS;
c_f_l = (WORD16 *)pstr_mps_state->mps_scratch_mem_v + PARAMETER_BANDSX56;
c_f_r = c_f_l + MAX_PARAMETER_BANDS;
dummy = c_f_r + MAX_PARAMETER_BANDS;
c_f_lc = dummy + MAX_PARAMETER_BANDS;
c_f_rc = c_f_lc + MAX_PARAMETER_BANDS;
if (enable_additionals) {
if (mode_1 == 0 &&
(p_aux_struct->ttt_config[1][0].start_band >= p_aux_struct->ttt_config[1][0].stop_band))
enable_additionals = 0;
else if (mode_0 == 0 && (p_aux_struct->ttt_config[0][0].start_band >=
p_aux_struct->ttt_config[0][0].stop_band))
enable_additionals = 0;
}
for (ps = 0; ps < num_parameter_sets; ps++) {
ixheaacd_param_2_umx_ps(pstr_mps_state, h11_l, h12_l, h21_l, h22_l, h12_res_l, h22_res_l,
c_f_l, dummy, 1, ps, res_bands[1]);
ixheaacd_param_2_umx_ps(pstr_mps_state, h11_r, h12_r, h21_r, h22_r, h12_res_r, h22_res_r,
c_f_r, dummy, 2, ps, res_bands[2]);
ixheaacd_param_2_umx_ps(pstr_mps_state, h11_lc, h12_lc, h21_lc, h22_lc, h12_res_lc,
h22_res_lc, c_f_lc, dummy, 3, ps, res_bands[3]);
ixheaacd_param_2_umx_ps(pstr_mps_state, h11_rc, h12_rc, h21_rc, h22_rc, h12_res_rc,
h22_res_rc, c_f_rc, dummy, 4, ps, res_bands[4]);
for (i = 0; i < 2; i++) {
for (pb = p_aux_struct->ttt_config[i][0].start_band;
pb < p_aux_struct->ttt_config[i][0].stop_band; pb++) {
WORD32 mtx_inversion = pstr_mps_state->mtx_inversion;
memset(m_pre, 0, sizeof(m_pre));
if (p_aux_struct->ttt_config[i][0].mode >= 2) {
mtx_inversion = mtx_inversion && (p_aux_struct->ttt_config[i][0].mode == 2 ||
p_aux_struct->ttt_config[i][0].mode == 4);
}
ixheaacd_calculate_ttt(pstr_mps_state, ps, pb, p_aux_struct->ttt_config[i][0].mode,
m_ttt);
for (row = 0; row < 3; row++) {
for (col = 0; col < 3; col++) {
m_pre[row][col] = m_ttt[row][col];
}
}
if (arbitrary_downmix != 0) {
WORD32 ch;
ixheaacd_calculate_arb_dmx_mtx(pstr_mps_state, ps, pb, g_real);
for (ch = 0; ch < num_input_channels; ch++) {
for (row = 0; row < 3; row++) {
m_pre[row][col] = ixheaacd_mps_mult32_shr_15(m_pre[row][col], g_real[ch]);
if (arbitrary_downmix == 2 && pb < pstr_mps_state->arbdmx_residual_bands) {
m_pre[row][3 + ch] = m_ttt[row][ch];
}
}
}
}
if (mtx_inversion) {
WORD32 h_real[2][2], h_imag[2][2];
ixheaacd_calculate_mtx_inv(pstr_mps_state, ps, pb, p_aux_struct->ttt_config[i][0].mode,
h_real, h_imag);
acc = (WORD64)((WORD64)m_pre[0][0] * (WORD64)h_real[0][0] +
(WORD64)m_pre[0][1] * (WORD64)h_real[1][0]);
acc >>= 15;
m1_param->m1_param_real[0][0][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[0][0] * (WORD64)h_real[0][1] +
(WORD64)m_pre[0][1] * (WORD64)h_real[1][1]);
acc >>= 15;
m1_param->m1_param_real[0][1][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[1][0] * (WORD64)h_real[0][0] +
(WORD64)m_pre[1][1] * (WORD64)h_real[1][0]);
acc >>= 15;
m1_param->m1_param_real[1][0][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[1][0] * (WORD64)h_real[0][1] +
(WORD64)m_pre[1][1] * (WORD64)h_real[1][1]);
acc >>= 15;
m1_param->m1_param_real[1][1][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[2][0] * (WORD64)h_real[0][0] +
(WORD64)m_pre[2][1] * (WORD64)h_real[1][0]);
acc >>= 15;
m1_param->m1_param_real[2][0][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[2][0] * (WORD64)h_real[0][1] +
(WORD64)m_pre[2][1] * (WORD64)h_real[1][1]);
acc >>= 15;
m1_param->m1_param_real[2][1][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[0][0] * (WORD64)h_imag[0][0] +
(WORD64)m_pre[0][1] * (WORD64)h_imag[1][0]);
acc >>= 15;
m1_param->m1_param_imag[0][0][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[0][0] * (WORD64)h_imag[0][1] +
(WORD64)m_pre[0][1] * (WORD64)h_imag[1][1]);
acc >>= 15;
m1_param->m1_param_imag[0][1][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[1][0] * (WORD64)h_imag[0][0] +
(WORD64)m_pre[1][1] * (WORD64)h_imag[1][0]);
acc >>= 15;
m1_param->m1_param_imag[1][0][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[1][0] * (WORD64)h_imag[0][1] +
(WORD64)m_pre[1][1] * (WORD64)h_imag[1][1]);
acc >>= 15;
m1_param->m1_param_imag[1][1][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[2][0] * (WORD64)h_imag[0][0] +
(WORD64)m_pre[2][1] * (WORD64)h_imag[1][0]);
acc >>= 15;
m1_param->m1_param_imag[2][0][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[2][0] * (WORD64)h_imag[0][1] +
(WORD64)m_pre[2][1] * (WORD64)h_imag[1][1]);
acc >>= 15;
m1_param->m1_param_imag[2][1][ps][pb] = (WORD32)acc;
} else if (pstr_mps_state->_3d_stereo_inversion) {
} else {
m1_param->m1_param_real[0][0][ps][pb] = m_pre[0][0];
m1_param->m1_param_real[0][1][ps][pb] = m_pre[0][1];
m1_param->m1_param_real[1][0][ps][pb] = m_pre[1][0];
m1_param->m1_param_real[1][1][ps][pb] = m_pre[1][1];
m1_param->m1_param_real[2][0][ps][pb] = m_pre[2][0];
m1_param->m1_param_real[2][1][ps][pb] = m_pre[2][1];
}
m1_param->m1_param_real[0][2][ps][pb] = m_pre[0][2];
m1_param->m1_param_real[0][3][ps][pb] = m_pre[0][3];
m1_param->m1_param_real[0][4][ps][pb] = m_pre[0][4];
m1_param->m1_param_real[1][2][ps][pb] = m_pre[1][2];
m1_param->m1_param_real[1][3][ps][pb] = m_pre[1][3];
m1_param->m1_param_real[1][4][ps][pb] = m_pre[1][4];
m1_param->m1_param_real[2][2][ps][pb] = m_pre[2][2];
m1_param->m1_param_real[2][3][ps][pb] = m_pre[2][3];
m1_param->m1_param_real[2][4][ps][pb] = m_pre[2][4];
for (col = 0; col < pstr_mps_state->num_x_channels; col++) {
m1_param->m1_param_real[3][col][ps][pb] = m1_param->m1_param_real[0][col][ps][pb];
m1_param->m1_param_real[4][col][ps][pb] = m1_param->m1_param_real[1][col][ps][pb];
curr_state->m1_param_present[3][col] = 1;
curr_state->m1_param_present[4][col] = 1;
if (m1_param_imag_present) {
m1_param->m1_param_imag[3][col][ps][pb] = m1_param->m1_param_imag[0][col][ps][pb];
m1_param->m1_param_imag[4][col][ps][pb] = m1_param->m1_param_imag[1][col][ps][pb];
}
if (p_aux_struct->ttt_config[i][0].use_ttt_decorr) {
m1_param->m1_param_real[5][col][ps][pb] = m1_param->m1_param_real[2][col][ps][pb];
if (m1_param_imag_present)
m1_param->m1_param_imag[5][col][ps][pb] = m1_param->m1_param_imag[2][col][ps][pb];
curr_state->m1_param_present[5][col] = 1;
} else {
m1_param->m1_param_real[5][col][ps][pb] = 0;
if (m1_param_imag_present) m1_param->m1_param_imag[5][col][ps][pb] = 0;
}
m1_param->m1_param_real[6][col][ps][pb] =
ixheaacd_mps_mult32_shr_15(c_f_l[pb], m1_param->m1_param_real[0][col][ps][pb]);
m1_param->m1_param_real[7][col][ps][pb] =
ixheaacd_mps_mult32_shr_15(c_f_r[pb], m1_param->m1_param_real[1][col][ps][pb]);
if (m1_param_imag_present) {
m1_param->m1_param_imag[6][col][ps][pb] =
ixheaacd_mps_mult32_shr_15(c_f_l[pb], m1_param->m1_param_imag[0][col][ps][pb]);
m1_param->m1_param_imag[7][col][ps][pb] =
ixheaacd_mps_mult32_shr_15(c_f_r[pb], m1_param->m1_param_imag[1][col][ps][pb]);
}
curr_state->m1_param_present[6][col] = 1;
curr_state->m1_param_present[7][col] = 1;
}
}
}
for (pb = 0; pb < p_aux_struct->num_ott_bands[0]; pb++) {
ia_mps_dec_spatial_bs_frame_struct *p_cur_bs = pstr_mps_state->bs_frame;
c_l_clfe[pb] = pstr_mps_state->ia_mps_dec_mps_table.m1_m2_table_ptr
->r1_matrix_l[p_cur_bs->ott_cld_idx[0][ps][pb] + 15];
c_r_clfe[pb] = pstr_mps_state->ia_mps_dec_mps_table.m1_m2_table_ptr
->r1_matrix_l[15 - p_cur_bs->ott_cld_idx[0][ps][pb]];
}
for (pb = p_aux_struct->num_ott_bands[0]; pb < num_parameter_bands; pb++) {
c_l_clfe[pb] = ONE_IN_Q15;
c_r_clfe[pb] = 0;
}
for (pb = 0; pb < num_parameter_bands; pb++) {
idx = 0;
m2_param->m2_decor_real[idx++][ps][pb] = ixheaacd_mps_mult32_shr_15(h11_lc[pb], h12_l[pb]);
if (enable_additionals) {
pos[0] = idx++;
}
m2_param->m2_decor_real[idx++][ps][pb] = h12_lc[pb];
m2_param->m2_decor_real[idx++][ps][pb] = ixheaacd_mps_mult32_shr_15(h21_lc[pb], h12_l[pb]);
if (enable_additionals) {
pos[1] = idx++;
}
m2_param->m2_decor_real[idx++][ps][pb] = h22_lc[pb];
m2_param->m2_decor_real[idx++][ps][pb] = h22_l[pb];
m2_param->m2_decor_real[idx++][ps][pb] = ixheaacd_mps_mult32_shr_15(h11_rc[pb], h12_r[pb]);
if (enable_additionals) {
pos[2] = idx++;
}
m2_param->m2_decor_real[idx++][ps][pb] = h12_rc[pb];
m2_param->m2_decor_real[idx++][ps][pb] = ixheaacd_mps_mult32_shr_15(h21_rc[pb], h12_r[pb]);
if (enable_additionals) {
pos[3] = idx++;
}
m2_param->m2_decor_real[idx++][ps][pb] = h22_rc[pb];
m2_param->m2_decor_real[idx++][ps][pb] = h22_r[pb];
if (enable_additionals) {
pos[4] = idx++;
}
}
for (pb = 0; pb < num_parameter_bands; pb++) {
idx = 0;
m2_param->m2_resid_real[idx][ps][pb] = ixheaacd_mps_mult32_shr_15(h11_lc[pb], h11_l[pb]);
pos_resid[0] = idx++;
if (residual_coding) {
m2_param->m2_resid_real[idx++][ps][pb] =
ixheaacd_mps_mult32_shr_15(h11_lc[pb], h12_res_l[pb]);
m2_param->m2_resid_real[idx++][ps][pb] = h12_res_lc[pb];
}
m2_param->m2_resid_real[idx][ps][pb] = ixheaacd_mps_mult32_shr_15(h21_lc[pb], h11_l[pb]);
pos_resid[1] = idx++;
if (residual_coding) {
m2_param->m2_resid_real[idx++][ps][pb] =
ixheaacd_mps_mult32_shr_15(h21_lc[pb], h12_res_l[pb]);
m2_param->m2_resid_real[idx++][ps][pb] = h22_res_lc[pb];
}
m2_param->m2_resid_real[idx++][ps][pb] = h21_l[pb];
if (residual_coding) m2_param->m2_resid_real[idx++][ps][pb] = h22_res_l[pb];
m2_param->m2_resid_real[idx][ps][pb] = ixheaacd_mps_mult32_shr_15(h11_rc[pb], h11_r[pb]);
pos_resid[2] = idx++;
if (residual_coding) {
m2_param->m2_resid_real[idx++][ps][pb] =
ixheaacd_mps_mult32_shr_15(h11_rc[pb], h12_res_r[pb]);
m2_param->m2_resid_real[idx++][ps][pb] = h12_res_rc[pb];
}
m2_param->m2_resid_real[idx][ps][pb] = ixheaacd_mps_mult32_shr_15(h21_rc[pb], h11_r[pb]);
pos_resid[3] = idx++;
if (residual_coding) {
m2_param->m2_resid_real[idx++][ps][pb] =
ixheaacd_mps_mult32_shr_15(h21_rc[pb], h12_res_r[pb]);
m2_param->m2_resid_real[idx++][ps][pb] = h22_res_rc[pb];
}
m2_param->m2_resid_real[idx++][ps][pb] = h21_r[pb];
if (residual_coding) m2_param->m2_resid_real[idx++][ps][pb] = h22_res_r[pb];
m2_param->m2_resid_real[idx][ps][pb] = c_l_clfe[pb];
pos_resid[4] = idx++;
m2_param->m2_resid_real[idx][ps][pb] = c_r_clfe[pb];
}
for (pb = 0; pb < num_parameter_bands; pb++) {
ia_mps_dec_spatial_bs_frame_struct *p_cur_bs = pstr_mps_state->bs_frame;
kappa[pb] = p_aux_struct->ttt_icc[0][ps][pb];
g_dd[pb] = pstr_mps_state->ia_mps_dec_mps_table.m1_m2_table_ptr
->table_kappa[p_cur_bs->ttt_icc_idx[0][ps][pb]];
}
for (i = 0; i < 2; i++) {
for (pb = p_aux_struct->ttt_config[i][0].start_band;
pb < p_aux_struct->ttt_config[i][0].stop_band; pb++) {
if (p_aux_struct->ttt_config[i][0].mode == 0 && pb >= pstr_mps_state->res_bands[5]) {
if (p_aux_struct->ttt_config[i][0].use_ttt_decorr) {
temp_1 = ixheaacd_mps_mult32_shr_15(g_dd[pb], c_f_l[pb]);
m2_param->m2_decor_real[pos[0]][ps][pb] =
ixheaacd_mps_mult32_shr_15(temp_1, h11_lc[pb]);
temp_1 = ixheaacd_mps_mult32_shr_15(g_dd[pb], c_f_l[pb]);
m2_param->m2_decor_real[pos[1]][ps][pb] =
ixheaacd_mps_mult32_shr_15(temp_1, h21_lc[pb]);
temp_1 = ixheaacd_mps_mult32_shr_15(g_dd[pb], c_f_r[pb]);
m2_param->m2_decor_real[pos[2]][ps][pb] =
ixheaacd_mps_mult32_shr_15(temp_1, h11_rc[pb]);
temp_1 = ixheaacd_mps_mult32_shr_15(g_dd[pb], c_f_r[pb]);
m2_param->m2_decor_real[pos[3]][ps][pb] =
ixheaacd_mps_mult32_shr_15(temp_1, h21_rc[pb]);
temp_1 = ixheaacd_mps_mult32_shr_15(g_dd[pb], c_l_clfe[pb]);
temp_2 = MINUS_SQRT_2_Q30;
m2_param->m2_decor_real[pos[4]][ps][pb] = ixheaacd_mps_mult32_shr_30(temp_1, temp_2);
pstr_mps_state->m2_param_present[0][5] = 1;
pstr_mps_state->m2_param_present[1][5] = 1;
pstr_mps_state->m2_param_present[3][5] = 1;
pstr_mps_state->m2_param_present[4][5] = 1;
pstr_mps_state->m2_param_present[6][5] = 1;
m2_param->m2_resid_real[pos_resid[0]][ps][pb] = ixheaacd_mps_mult32_shr_15(
m2_param->m2_resid_real[pos_resid[0]][ps][pb], kappa[pb]);
m2_param->m2_resid_real[pos_resid[1]][ps][pb] = ixheaacd_mps_mult32_shr_15(
m2_param->m2_resid_real[pos_resid[1]][ps][pb], kappa[pb]);
m2_param->m2_resid_real[pos_resid[2]][ps][pb] = ixheaacd_mps_mult32_shr_15(
m2_param->m2_resid_real[pos_resid[2]][ps][pb], kappa[pb]);
m2_param->m2_resid_real[pos_resid[3]][ps][pb] = ixheaacd_mps_mult32_shr_15(
m2_param->m2_resid_real[pos_resid[3]][ps][pb], kappa[pb]);
m2_param->m2_resid_real[pos_resid[4]][ps][pb] = ixheaacd_mps_mult32_shr_15(
m2_param->m2_resid_real[pos_resid[4]][ps][pb], kappa[pb]);
}
}
}
}
}
return;
}
VOID ixheaacd_calc_m1m2_7272(ia_heaac_mps_state_struct *pstr_mps_state) {
ia_mps_dec_auxilary_struct *p_aux_struct = pstr_mps_state->aux_struct;
ia_mps_dec_m2_param_struct *m2_param = p_aux_struct->m2_param;
ia_mps_dec_m1_param_struct *m1_param = pstr_mps_state->array_struct->m1_param;
ia_heaac_mps_state_struct *curr_state = pstr_mps_state;
WORD32 ps, pb, col, row, i;
WORD32 m_pre[3][5];
WORD32 m_ttt[3][3];
WORD32 g_real[2];
WORD32 temp_1, temp_2;
WORD64 acc;
WORD32 *h11_l, *h11_r, *h12_l, *h12_r, *h21_l, *h21_r, *h22_l, *h22_r, *h12_res_l, *h12_res_r,
*h22_res_l, *h22_res_r;
WORD32 *c_l_clfe, *c_r_clfe, *kappa, *g_dd;
WORD16 *c_1_L, *c_1_R, *c_2_L, *c_2_R;
WORD32 *h11_ls, *h11_rs, *h12_ls, *h12_rs, *h21_ls, *h21_rs, *h22_ls, *h22_rs, *h12_res_ls,
*h12_res_rs, *h22_res_ls, *h22_res_rs;
WORD16 *c_f_ls, *c_f_rs, *dummy;
WORD32 idx;
WORD32 mode_0 = p_aux_struct->ttt_config[0][0].mode;
WORD32 mode_1 = p_aux_struct->ttt_config[1][0].mode;
WORD32 num_parameter_bands = pstr_mps_state->num_parameter_bands;
WORD32 m1_param_imag_present = pstr_mps_state->m1_param_imag_present;
WORD32 num_parameter_sets = pstr_mps_state->num_parameter_sets;
WORD32 arbitrary_downmix = pstr_mps_state->arbitrary_downmix;
WORD32 enable_additionals = ((mode_0 == 0) || (mode_1 == 0));
WORD32 pos[3] = {0};
WORD32 pos_resid[3] = {0};
WORD32 residual_coding = pstr_mps_state->residual_coding;
h11_l = pstr_mps_state->mps_scratch_mem_v;
h11_r = h11_l + MAX_PARAMETER_BANDS;
h12_l = h11_r + MAX_PARAMETER_BANDS;
h12_r = h12_l + MAX_PARAMETER_BANDS;
h21_l = h12_r + MAX_PARAMETER_BANDS;
h21_r = h21_l + MAX_PARAMETER_BANDS;
h22_l = h21_r + MAX_PARAMETER_BANDS;
h22_r = h22_l + MAX_PARAMETER_BANDS;
h12_res_l = h22_r + MAX_PARAMETER_BANDS;
h12_res_r = h12_res_l + MAX_PARAMETER_BANDS;
h22_res_l = h12_res_r + MAX_PARAMETER_BANDS;
h22_res_r = h22_res_l + MAX_PARAMETER_BANDS;
c_l_clfe = h22_res_r + MAX_PARAMETER_BANDS;
c_r_clfe = c_l_clfe + MAX_PARAMETER_BANDS;
kappa = c_r_clfe + MAX_PARAMETER_BANDS;
g_dd = kappa + MAX_PARAMETER_BANDS;
h11_ls = g_dd + MAX_PARAMETER_BANDS;
h11_rs = h11_ls + MAX_PARAMETER_BANDS;
h12_ls = h11_rs + MAX_PARAMETER_BANDS;
h12_rs = h12_ls + MAX_PARAMETER_BANDS;
h21_ls = h12_rs + MAX_PARAMETER_BANDS;
h21_rs = h21_ls + MAX_PARAMETER_BANDS;
h22_ls = h21_rs + MAX_PARAMETER_BANDS;
h22_rs = h22_ls + MAX_PARAMETER_BANDS;
h12_res_ls = h22_rs + MAX_PARAMETER_BANDS;
h12_res_rs = h12_res_ls + MAX_PARAMETER_BANDS;
h22_res_ls = h12_res_rs + MAX_PARAMETER_BANDS;
h22_res_rs = h22_res_ls + MAX_PARAMETER_BANDS;
c_1_L = (WORD16 *)pstr_mps_state->mps_scratch_mem_v + PARAMETER_BANDSX56;
c_1_R = c_1_L + MAX_PARAMETER_BANDS;
c_2_L = c_1_R + MAX_PARAMETER_BANDS;
c_2_R = c_2_L + MAX_PARAMETER_BANDS;
c_f_ls = c_2_R + MAX_PARAMETER_BANDS;
c_f_rs = c_f_ls + MAX_PARAMETER_BANDS;
dummy = c_f_rs + MAX_PARAMETER_BANDS;
if (enable_additionals) {
if (mode_1 == 0 &&
(p_aux_struct->ttt_config[1][0].start_band >= p_aux_struct->ttt_config[1][0].stop_band))
enable_additionals = 0;
else if (mode_0 == 0 && (p_aux_struct->ttt_config[0][0].start_band >=
p_aux_struct->ttt_config[0][0].stop_band))
enable_additionals = 0;
}
for (ps = 0; ps < num_parameter_sets; ps++) {
ixheaacd_param_2_umx_ps(pstr_mps_state, h11_l, h12_l, h21_l, h22_l, h12_res_l, h22_res_l,
c_1_L, c_2_L, 1, ps, pstr_mps_state->res_bands[1]);
ixheaacd_param_2_umx_ps(pstr_mps_state, h11_r, h12_r, h21_r, h22_r, h12_res_r, h22_res_r,
c_1_R, c_2_R, 2, ps, pstr_mps_state->res_bands[2]);
ixheaacd_param_2_umx_ps(pstr_mps_state, h11_ls, h12_ls, h21_ls, h22_ls, h12_res_ls,
h22_res_ls, dummy, c_f_ls, 3, ps, pstr_mps_state->res_bands[3]);
ixheaacd_param_2_umx_ps(pstr_mps_state, h11_rs, h12_rs, h21_rs, h22_rs, h12_res_rs,
h22_res_rs, dummy, c_f_rs, 4, ps, pstr_mps_state->res_bands[4]);
for (i = 0; i < 2; i++) {
for (pb = p_aux_struct->ttt_config[i][0].start_band;
pb < p_aux_struct->ttt_config[i][0].stop_band; pb++) {
WORD32 mtx_inversion = pstr_mps_state->mtx_inversion;
memset(m_pre, 0, sizeof(m_pre));
if (p_aux_struct->ttt_config[i][0].mode >= 2) {
mtx_inversion = mtx_inversion && (p_aux_struct->ttt_config[i][0].mode == 2 ||
p_aux_struct->ttt_config[i][0].mode == 4);
}
ixheaacd_calculate_ttt(pstr_mps_state, ps, pb, p_aux_struct->ttt_config[i][0].mode,
m_ttt);
for (row = 0; row < 3; row++) {
for (col = 0; col < 3; col++) {
m_pre[row][col] = m_ttt[row][col];
}
}
if (arbitrary_downmix != 0) {
WORD32 ch;
ixheaacd_calculate_arb_dmx_mtx(pstr_mps_state, ps, pb, g_real);
for (ch = 0; ch < pstr_mps_state->num_input_channels; ch++) {
for (row = 0; row < 3; row++) {
m_pre[row][col] = ixheaacd_mps_mult32_shr_15(m_pre[row][col], g_real[ch]);
if (arbitrary_downmix == 2 && pb < pstr_mps_state->arbdmx_residual_bands) {
m_pre[row][3 + ch] = m_ttt[row][ch];
}
}
}
}
if (mtx_inversion) {
WORD32 h_real[2][2], h_imag[2][2];
ixheaacd_calculate_mtx_inv(pstr_mps_state, ps, pb, p_aux_struct->ttt_config[i][0].mode,
h_real, h_imag);
acc = (WORD64)((WORD64)m_pre[0][0] * (WORD64)h_real[0][0] +
(WORD64)m_pre[0][1] * (WORD64)h_real[1][0]);
acc >>= 15;
m1_param->m1_param_real[0][0][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[0][0] * (WORD64)h_real[0][1] +
(WORD64)m_pre[0][1] * (WORD64)h_real[1][1]);
acc >>= 15;
m1_param->m1_param_real[0][1][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[1][0] * (WORD64)h_real[0][0] +
(WORD64)m_pre[1][1] * (WORD64)h_real[1][0]);
acc >>= 15;
m1_param->m1_param_real[1][0][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[1][0] * (WORD64)h_real[0][1] +
(WORD64)m_pre[1][1] * (WORD64)h_real[1][1]);
acc >>= 15;
m1_param->m1_param_real[1][1][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[2][0] * (WORD64)h_real[0][0] +
(WORD64)m_pre[2][1] * (WORD64)h_real[1][0]);
acc >>= 15;
m1_param->m1_param_real[2][0][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[2][0] * (WORD64)h_real[0][1] +
(WORD64)m_pre[2][1] * (WORD64)h_real[1][1]);
acc >>= 15;
m1_param->m1_param_real[2][1][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[0][0] * (WORD64)h_imag[0][0] +
(WORD64)m_pre[0][1] * (WORD64)h_imag[1][0]);
acc >>= 15;
m1_param->m1_param_imag[0][0][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[0][0] * (WORD64)h_imag[0][1] +
(WORD64)m_pre[0][1] * (WORD64)h_imag[1][1]);
acc >>= 15;
m1_param->m1_param_imag[0][1][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[1][0] * (WORD64)h_imag[0][0] +
(WORD64)m_pre[1][1] * (WORD64)h_imag[1][0]);
acc >>= 15;
m1_param->m1_param_imag[1][0][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[1][0] * (WORD64)h_imag[0][1] +
(WORD64)m_pre[1][1] * (WORD64)h_imag[1][1]);
acc >>= 15;
m1_param->m1_param_imag[1][1][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[2][0] * (WORD64)h_imag[0][0] +
(WORD64)m_pre[2][1] * (WORD64)h_imag[1][0]);
acc >>= 15;
m1_param->m1_param_imag[2][0][ps][pb] = (WORD32)acc;
acc = (WORD64)((WORD64)m_pre[2][0] * (WORD64)h_imag[0][1] +
(WORD64)m_pre[2][1] * (WORD64)h_imag[1][1]);
acc >>= 15;
m1_param->m1_param_imag[2][1][ps][pb] = (WORD32)acc;
} else if (pstr_mps_state->_3d_stereo_inversion) {
} else {
m1_param->m1_param_real[0][0][ps][pb] = m_pre[0][0];
m1_param->m1_param_real[0][1][ps][pb] = m_pre[0][1];
m1_param->m1_param_real[1][0][ps][pb] = m_pre[1][0];
m1_param->m1_param_real[1][1][ps][pb] = m_pre[1][1];
m1_param->m1_param_real[2][0][ps][pb] = m_pre[2][0];
m1_param->m1_param_real[2][1][ps][pb] = m_pre[2][1];
}
m1_param->m1_param_real[0][2][ps][pb] = m_pre[0][2];
m1_param->m1_param_real[0][3][ps][pb] = m_pre[0][3];
m1_param->m1_param_real[0][4][ps][pb] = m_pre[0][4];
m1_param->m1_param_real[1][2][ps][pb] = m_pre[1][2];
m1_param->m1_param_real[1][3][ps][pb] = m_pre[1][3];
m1_param->m1_param_real[1][4][ps][pb] = m_pre[1][4];
m1_param->m1_param_real[2][2][ps][pb] = m_pre[2][2];
m1_param->m1_param_real[2][3][ps][pb] = m_pre[2][3];
m1_param->m1_param_real[2][4][ps][pb] = m_pre[2][4];
for (col = 0; col < pstr_mps_state->num_x_channels; col++) {
m1_param->m1_param_real[3][col][ps][pb] = m1_param->m1_param_real[0][col][ps][pb];
m1_param->m1_param_real[4][col][ps][pb] = m1_param->m1_param_real[1][col][ps][pb];
if (m1_param_imag_present) {
m1_param->m1_param_imag[3][col][ps][pb] = m1_param->m1_param_imag[0][col][ps][pb];
m1_param->m1_param_imag[4][col][ps][pb] = m1_param->m1_param_imag[1][col][ps][pb];
}
curr_state->m1_param_present[3][col] = 1;
curr_state->m1_param_present[4][col] = 1;
if (p_aux_struct->ttt_config[i][0].use_ttt_decorr) {
m1_param->m1_param_real[5][col][ps][pb] = m1_param->m1_param_real[2][col][ps][pb];
if (m1_param_imag_present)
m1_param->m1_param_imag[5][col][ps][pb] = m1_param->m1_param_imag[2][col][ps][pb];
curr_state->m1_param_present[5][col] = 1;
} else {
m1_param->m1_param_real[5][col][ps][pb] = 0;
if (m1_param_imag_present) m1_param->m1_param_imag[5][col][ps][pb] = 0;
}
m1_param->m1_param_real[6][col][ps][pb] =
ixheaacd_mps_mult32_shr_15(m1_param->m1_param_real[0][col][ps][pb], c_2_L[pb]);
m1_param->m1_param_real[7][col][ps][pb] =
ixheaacd_mps_mult32_shr_15(m1_param->m1_param_real[1][col][ps][pb], c_2_R[pb]);
if (m1_param_imag_present) {
m1_param->m1_param_imag[6][col][ps][pb] =
ixheaacd_mps_mult32_shr_15(m1_param->m1_param_imag[0][col][ps][pb], c_2_L[pb]);
m1_param->m1_param_imag[7][col][ps][pb] =
ixheaacd_mps_mult32_shr_15(m1_param->m1_param_imag[1][col][ps][pb], c_2_R[pb]);
}
curr_state->m1_param_present[6][col] = 1;
curr_state->m1_param_present[7][col] = 1;
}
}
}
for (pb = 0; pb < p_aux_struct->num_ott_bands[0]; pb++) {
ia_mps_dec_spatial_bs_frame_struct *p_cur_bs = pstr_mps_state->bs_frame;
c_l_clfe[pb] = pstr_mps_state->ia_mps_dec_mps_table.m1_m2_table_ptr
->r1_matrix_l[p_cur_bs->ott_cld_idx[0][ps][pb] + 15];
c_r_clfe[pb] = pstr_mps_state->ia_mps_dec_mps_table.m1_m2_table_ptr
->r1_matrix_l[15 - p_cur_bs->ott_cld_idx[0][ps][pb]];
}
for (pb = p_aux_struct->num_ott_bands[0]; pb < num_parameter_bands; pb++) {
c_l_clfe[pb] = ONE_IN_Q15;
c_r_clfe[pb] = 0;
}
for (pb = 0; pb < num_parameter_bands; pb++) {
idx = 0;
m2_param->m2_decor_real[idx++][ps][pb] = h12_l[pb];
if (enable_additionals) {
pos[0] = idx++;
}
m2_param->m2_decor_real[idx++][ps][pb] = ixheaacd_mps_mult32_shr_15(h11_ls[pb], h22_l[pb]);
m2_param->m2_decor_real[idx++][ps][pb] = h12_ls[pb];
m2_param->m2_decor_real[idx++][ps][pb] = ixheaacd_mps_mult32_shr_15(h21_ls[pb], h22_l[pb]);
m2_param->m2_decor_real[idx++][ps][pb] = h22_ls[pb];
m2_param->m2_decor_real[idx++][ps][pb] = h12_r[pb];
if (enable_additionals) {
pos[1] = idx++;
}
m2_param->m2_decor_real[idx++][ps][pb] = ixheaacd_mps_mult32_shr_15(h11_rs[pb], h22_r[pb]);
m2_param->m2_decor_real[idx++][ps][pb] = h12_rs[pb];
m2_param->m2_decor_real[idx++][ps][pb] = ixheaacd_mps_mult32_shr_15(h21_rs[pb], h22_r[pb]);
m2_param->m2_decor_real[idx++][ps][pb] = h22_rs[pb];
if (enable_additionals) {
pos[2] = idx++;
}
}
for (pb = 0; pb < num_parameter_bands; pb++) {
idx = 0;
m2_param->m2_resid_real[idx][ps][pb] = h11_l[pb];
pos_resid[0] = idx++;
if (residual_coding) m2_param->m2_resid_real[idx++][ps][pb] = h12_res_l[pb];
m2_param->m2_resid_real[idx++][ps][pb] = ixheaacd_mps_mult32_shr_15(h11_ls[pb], h21_l[pb]);
if (residual_coding) {
m2_param->m2_resid_real[idx++][ps][pb] =
ixheaacd_mps_mult32_shr_15(h11_ls[pb], h22_res_l[pb]);
m2_param->m2_resid_real[idx++][ps][pb] = h12_res_ls[pb];
}
m2_param->m2_resid_real[idx++][ps][pb] = ixheaacd_mps_mult32_shr_15(h21_ls[pb], h21_l[pb]);
if (residual_coding) {
m2_param->m2_resid_real[idx++][ps][pb] =
ixheaacd_mps_mult32_shr_15(h21_ls[pb], h22_res_l[pb]);
m2_param->m2_resid_real[idx++][ps][pb] = h22_res_ls[pb];
}
m2_param->m2_resid_real[idx][ps][pb] = h11_r[pb];
pos_resid[1] = idx++;
if (residual_coding) m2_param->m2_resid_real[idx++][ps][pb] = h12_res_r[pb];
m2_param->m2_resid_real[idx++][ps][pb] = ixheaacd_mps_mult32_shr_15(h11_rs[pb], h21_r[pb]);
if (residual_coding) {
m2_param->m2_resid_real[idx++][ps][pb] =
ixheaacd_mps_mult32_shr_15(h11_rs[pb], h22_res_r[pb]);
m2_param->m2_resid_real[idx++][ps][pb] = h12_res_rs[pb];
}
m2_param->m2_resid_real[idx++][ps][pb] = ixheaacd_mps_mult32_shr_15(h21_rs[pb], h21_r[pb]);
if (residual_coding) {
m2_param->m2_resid_real[idx++][ps][pb] =
ixheaacd_mps_mult32_shr_15(h21_rs[pb], h22_res_r[pb]);
m2_param->m2_resid_real[idx++][ps][pb] = h22_res_rs[pb];
}
m2_param->m2_resid_real[idx][ps][pb] = c_l_clfe[pb];
pos_resid[2] = idx++;
m2_param->m2_resid_real[idx++][ps][pb] = c_r_clfe[pb];
}
for (pb = 0; pb < num_parameter_bands; pb++) {
ia_mps_dec_spatial_bs_frame_struct *p_cur_bs = pstr_mps_state->bs_frame;
kappa[pb] = p_aux_struct->ttt_icc[0][ps][pb];
g_dd[pb] = pstr_mps_state->ia_mps_dec_mps_table.m1_m2_table_ptr
->table_kappa[p_cur_bs->ttt_icc_idx[0][ps][pb]];
}
for (i = 0; i < 2; i++) {
for (pb = p_aux_struct->ttt_config[i][0].start_band;
pb < p_aux_struct->ttt_config[i][0].stop_band; pb++) {
if (p_aux_struct->ttt_config[i][0].mode == 0 && pb >= pstr_mps_state->res_bands[5]) {
if (p_aux_struct->ttt_config[i][0].use_ttt_decorr) {
m2_param->m2_decor_real[pos[0]][ps][pb] =
ixheaacd_mps_mult32_shr_15(g_dd[pb], c_1_L[pb]);
m2_param->m2_decor_real[pos[1]][ps][pb] =
ixheaacd_mps_mult32_shr_15(g_dd[pb], c_1_R[pb]);
temp_1 = ixheaacd_mps_mult32_shr_15(g_dd[pb], c_l_clfe[pb]);
temp_2 = MINUS_SQRT_2_Q30;
m2_param->m2_decor_real[pos[2]][ps][pb] = ixheaacd_mps_mult32_shr_30(temp_1, temp_2);
pstr_mps_state->m2_param_present[0][5] = 1;
pstr_mps_state->m2_param_present[3][5] = 1;
pstr_mps_state->m2_param_present[6][5] = 1;
m2_param->m2_resid_real[pos_resid[0]][ps][pb] = ixheaacd_mps_mult32_shr_15(
m2_param->m2_resid_real[pos_resid[0]][ps][pb], kappa[pb]);
m2_param->m2_resid_real[pos_resid[1]][ps][pb] = ixheaacd_mps_mult32_shr_15(
m2_param->m2_resid_real[pos_resid[1]][ps][pb], kappa[pb]);
m2_param->m2_resid_real[pos_resid[2]][ps][pb] = ixheaacd_mps_mult32_shr_15(
m2_param->m2_resid_real[pos_resid[2]][ps][pb], kappa[pb]);
}
}
}
}
}
return;
}
Reference in New Issue Copy Permalink