You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
835 lines
29 KiB
835 lines
29 KiB
/******************************************************************************
|
|
* *
|
|
* 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 <math.h>
|
|
#include "ixheaacd_sbr_common.h"
|
|
#include "ixheaacd_type_def.h"
|
|
#include "ixheaacd_error_standards.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_basic_op.h"
|
|
#include "ixheaacd_intrinsics.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_common_rom.h"
|
|
#include "ixheaacd_env_dec.h"
|
|
#include "ixheaacd_sbr_const.h"
|
|
#include "ixheaacd_basic_funcs.h"
|
|
|
|
#define add16_m(a, b) ((a) + (b))
|
|
#define sub16_m(a, b) ((a) - (b))
|
|
|
|
#define mult16x16_16(a, b) ixheaacd_mult16((a), (b))
|
|
|
|
static VOID ixheaacd_dequant_esbr_env_data(FLOAT32 *ptr_env_sf,
|
|
WORD32 num_env_sf,
|
|
WORD32 num_noise_fac, WORD32 amp_res,
|
|
FLOAT32 *ptr_noise_floor) {
|
|
WORD32 i;
|
|
static const FLOAT32 array[2] = {0.5f, 1.0f};
|
|
FLOAT32 a_flt = array[amp_res];
|
|
|
|
for (i = 0; i < num_env_sf; i++) {
|
|
ptr_env_sf[i] = (FLOAT32)(pow(2, ptr_env_sf[i] * a_flt) * 64);
|
|
}
|
|
|
|
for (i = 0; i < num_noise_fac; i++) {
|
|
FLOAT32 temp = ptr_noise_floor[i];
|
|
|
|
temp = NOISE_FLOOR_OFFSET - temp;
|
|
temp = (FLOAT32)pow(2.0f, temp);
|
|
|
|
ptr_noise_floor[i] = temp;
|
|
}
|
|
}
|
|
|
|
static VOID ixheaacd_dequant_pvc_env_data(WORD32 num_noise_fac,
|
|
FLOAT32 *ptr_noise_floor) {
|
|
WORD32 i;
|
|
|
|
for (i = 0; i < num_noise_fac; i++) {
|
|
FLOAT32 temp = ptr_noise_floor[i];
|
|
|
|
temp = NOISE_FLOOR_OFFSET - temp;
|
|
temp = (FLOAT32)pow(2.0f, temp);
|
|
|
|
ptr_noise_floor[i] = temp;
|
|
}
|
|
}
|
|
|
|
VOID ixheaacd_map_res_energy(WORD16 curr_val, WORD16 *prev_data,
|
|
WORD32 ixheaacd_drc_offset, WORD32 index,
|
|
WORD32 res) {
|
|
if (res == LOW) {
|
|
if (ixheaacd_drc_offset >= 0) {
|
|
if (index < ixheaacd_drc_offset) {
|
|
prev_data[index] = curr_val;
|
|
} else {
|
|
WORD32 index_2;
|
|
index_2 = ((index + index) - ixheaacd_drc_offset);
|
|
prev_data[index_2] = curr_val;
|
|
prev_data[index_2 + 1] = curr_val;
|
|
}
|
|
} else {
|
|
ixheaacd_drc_offset = -(ixheaacd_drc_offset);
|
|
|
|
if (index < ixheaacd_drc_offset) {
|
|
WORD32 index_3;
|
|
index_3 = ((index + index) + index);
|
|
prev_data[index_3] = curr_val;
|
|
prev_data[index_3 + 1] = curr_val;
|
|
prev_data[index_3 + 2] = curr_val;
|
|
} else {
|
|
WORD32 index_2;
|
|
index_2 = ((index + index) + ixheaacd_drc_offset);
|
|
prev_data[index_2] = curr_val;
|
|
prev_data[index_2 + 1] = curr_val;
|
|
}
|
|
}
|
|
} else {
|
|
prev_data[index] = curr_val;
|
|
}
|
|
}
|
|
|
|
VOID ixheaacd_process_del_cod_env_data(
|
|
ia_sbr_header_data_struct *ptr_header_data,
|
|
ia_sbr_frame_info_data_struct *ptr_sbr_data,
|
|
ia_sbr_prev_frame_data_struct *ptr_prev_data) {
|
|
WORD32 i, dtdf_dir, num_sf_bands, band, freq_res;
|
|
WORD16 temp_val;
|
|
WORD16 *ptr_prev_env_sf = ptr_prev_data->sfb_nrg_prev;
|
|
WORD16 *ptr_env_sf = ptr_sbr_data->int_env_sf_arr;
|
|
|
|
FLOAT32 *ptr_env_sf_float = ptr_sbr_data->flt_env_sf_arr;
|
|
|
|
WORD32 ixheaacd_drc_offset;
|
|
band = 0;
|
|
|
|
ixheaacd_drc_offset =
|
|
((ptr_header_data->pstr_freq_band_data->num_sf_bands[LOW] << 1) -
|
|
ptr_header_data->pstr_freq_band_data->num_sf_bands[HIGH]);
|
|
|
|
for (i = 0; i < ptr_sbr_data->str_frame_info_details.num_env; i++) {
|
|
dtdf_dir = ptr_sbr_data->del_cod_dir_arr[i];
|
|
freq_res = ptr_sbr_data->str_frame_info_details.freq_res[i];
|
|
|
|
num_sf_bands = ptr_header_data->pstr_freq_band_data->num_sf_bands[freq_res];
|
|
|
|
if (dtdf_dir == DTDF_DIR_FREQ) {
|
|
ixheaacd_map_res_energy(*ptr_env_sf, ptr_prev_env_sf, ixheaacd_drc_offset,
|
|
0, freq_res);
|
|
ptr_env_sf++;
|
|
|
|
ptr_env_sf_float++;
|
|
|
|
for (band = 1; band < num_sf_bands; band++) {
|
|
*ptr_env_sf = *ptr_env_sf + *(ptr_env_sf - 1);
|
|
ixheaacd_map_res_energy(*ptr_env_sf, ptr_prev_env_sf,
|
|
ixheaacd_drc_offset, band, freq_res);
|
|
|
|
*ptr_env_sf_float = (FLOAT32)(*ptr_env_sf);
|
|
ptr_env_sf_float++;
|
|
|
|
ptr_env_sf++;
|
|
}
|
|
|
|
} else {
|
|
if (freq_res == LOW) {
|
|
if (ixheaacd_drc_offset < 0) {
|
|
WORD32 tar, index_3;
|
|
ixheaacd_drc_offset = -ixheaacd_drc_offset;
|
|
tar = ixheaacd_min32(ixheaacd_drc_offset, band);
|
|
|
|
for (band = 0; band < tar; band++) {
|
|
index_3 = ((band + band) + band);
|
|
temp_val = add16_m(*ptr_env_sf, ptr_prev_env_sf[index_3]);
|
|
|
|
ptr_prev_env_sf[index_3] = temp_val;
|
|
ptr_prev_env_sf[index_3 + 1] = temp_val;
|
|
ptr_prev_env_sf[index_3 + 2] = temp_val;
|
|
*ptr_env_sf++ = temp_val;
|
|
|
|
*ptr_env_sf_float = (FLOAT32)temp_val;
|
|
ptr_env_sf_float++;
|
|
}
|
|
|
|
for (; band < num_sf_bands; band++) {
|
|
index_3 = (band << 1) + ixheaacd_drc_offset;
|
|
temp_val = add16_m(*ptr_env_sf, ptr_prev_env_sf[index_3]);
|
|
ptr_prev_env_sf[index_3] = temp_val;
|
|
ptr_prev_env_sf[index_3 + 1] = temp_val;
|
|
*ptr_env_sf++ = temp_val;
|
|
*ptr_env_sf_float = (FLOAT32)temp_val;
|
|
ptr_env_sf_float++;
|
|
}
|
|
} else {
|
|
WORD32 tar, index_2;
|
|
WORD16 *ptr2 = ptr_prev_env_sf;
|
|
tar = ixheaacd_min32(ixheaacd_drc_offset, band);
|
|
for (band = 0; band < tar; band++) {
|
|
*ptr_env_sf = add16_m(*ptr_env_sf, *ptr2);
|
|
*ptr2 = *ptr_env_sf;
|
|
|
|
*ptr_env_sf_float = (FLOAT32)(*ptr_env_sf);
|
|
ptr_env_sf_float++;
|
|
|
|
ptr2++;
|
|
ptr_env_sf++;
|
|
}
|
|
|
|
for (; band < num_sf_bands; band++) {
|
|
index_2 = (band < ixheaacd_drc_offset)
|
|
? band
|
|
: ((band << 1) - ixheaacd_drc_offset);
|
|
temp_val = add16_m(*ptr_env_sf, ptr_prev_env_sf[index_2]);
|
|
ptr_prev_env_sf[index_2] = temp_val;
|
|
ptr_prev_env_sf[index_2 + 1] = temp_val;
|
|
*ptr_env_sf++ = temp_val;
|
|
|
|
*ptr_env_sf_float = (FLOAT32)temp_val;
|
|
ptr_env_sf_float++;
|
|
}
|
|
}
|
|
|
|
} else {
|
|
WORD16 *ptr2 = ptr_prev_env_sf;
|
|
for (band = num_sf_bands - 1; band >= 0; band--) {
|
|
*ptr_env_sf = add16_m(*ptr_env_sf, *ptr2);
|
|
*ptr2 = *ptr_env_sf;
|
|
*ptr_env_sf_float = (FLOAT32)(*ptr_env_sf);
|
|
ptr_env_sf_float++;
|
|
ptr2++;
|
|
ptr_env_sf++;
|
|
}
|
|
band = num_sf_bands;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
static PLATFORM_INLINE WORD32
|
|
ixheaacd_wrong_timing_compensate(ia_sbr_header_data_struct *ptr_header_data,
|
|
ia_sbr_frame_info_data_struct *ptr_sbr_data,
|
|
ia_sbr_prev_frame_data_struct *ptr_prev_data,
|
|
ixheaacd_misc_tables *pstr_common_tables) {
|
|
WORD32 i, num_env_sf;
|
|
ia_frame_info_struct *p_frame_info = &ptr_sbr_data->str_frame_info_details;
|
|
WORD16 *num_sf_bands = ptr_header_data->pstr_freq_band_data->num_sf_bands;
|
|
WORD32 start_pos_est;
|
|
WORD32 ref_len, new_len, shift;
|
|
WORD16 delta_exp;
|
|
|
|
start_pos_est =
|
|
(ptr_prev_data->end_position - ptr_header_data->num_time_slots);
|
|
|
|
ref_len = (p_frame_info->border_vec[1] - p_frame_info->border_vec[0]);
|
|
|
|
new_len = (p_frame_info->border_vec[1] - start_pos_est);
|
|
|
|
if (new_len <= 0) {
|
|
new_len = ref_len;
|
|
start_pos_est = p_frame_info->border_vec[0];
|
|
}
|
|
|
|
delta_exp = pstr_common_tables->log_dual_is_table[ref_len];
|
|
delta_exp -= pstr_common_tables->log_dual_is_table[new_len];
|
|
|
|
shift = (SHORT_BITS - ENV_EXP_FRACT - 3 - ptr_sbr_data->amp_res);
|
|
delta_exp = ixheaacd_shr16(delta_exp, (WORD16)shift);
|
|
p_frame_info->border_vec[0] = start_pos_est;
|
|
p_frame_info->noise_border_vec[0] = start_pos_est;
|
|
|
|
if (start_pos_est < 0) return -1;
|
|
|
|
if (ptr_sbr_data->coupling_mode != COUPLING_BAL) {
|
|
num_env_sf =
|
|
((p_frame_info->freq_res[0]) ? num_sf_bands[HIGH] : num_sf_bands[LOW]);
|
|
|
|
for (i = 0; i < num_env_sf; i++) {
|
|
ptr_sbr_data->int_env_sf_arr[i] =
|
|
add16_m(ptr_sbr_data->int_env_sf_arr[i], delta_exp);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
WORD16 ixheaacd_check_env_data(ia_sbr_header_data_struct *ptr_header_data,
|
|
ia_sbr_frame_info_data_struct *ptr_sbr_data,
|
|
ia_sbr_prev_frame_data_struct *ptr_prev_data) {
|
|
WORD16 *ptr_evn_sf = ptr_sbr_data->int_env_sf_arr;
|
|
WORD16 *ptr_prev_evn_sf = ptr_prev_data->sfb_nrg_prev;
|
|
WORD32 i;
|
|
FLAG error_code = 0;
|
|
WORD16 sbr_max_env_sf;
|
|
WORD32 amp_res = ptr_sbr_data->amp_res;
|
|
|
|
sbr_max_env_sf = (SBR_ENV_SF_MAX_VAL_1_5 >> amp_res);
|
|
|
|
for (i = 0; i < ptr_sbr_data->num_env_sfac; i++) {
|
|
if (ptr_evn_sf[i] > sbr_max_env_sf) {
|
|
error_code = 1;
|
|
}
|
|
if (ptr_evn_sf[i] < 0) {
|
|
ptr_evn_sf[i] = 0;
|
|
}
|
|
}
|
|
|
|
for (i = 0; i < ptr_header_data->pstr_freq_band_data->num_sf_bands[HIGH];
|
|
i++) {
|
|
if (ptr_prev_evn_sf[i] < 0) {
|
|
ptr_prev_evn_sf[i] = 0;
|
|
} else {
|
|
if (ptr_prev_evn_sf[i] > sbr_max_env_sf)
|
|
ptr_prev_evn_sf[i] = sbr_max_env_sf;
|
|
}
|
|
}
|
|
return (WORD16)(error_code);
|
|
}
|
|
|
|
VOID ixheaacd_dequant_env_data(ia_sbr_frame_info_data_struct *ptr_sbr_data,
|
|
WORD32 amp_res) {
|
|
WORD32 i;
|
|
WORD32 num_env_sf = ptr_sbr_data->num_env_sfac;
|
|
WORD32 mantissa;
|
|
WORD32 amp_res_1;
|
|
WORD32 exponent;
|
|
WORD32 exp_add = (7 + NRG_EXP_OFFSET);
|
|
WORD16 *ptr_env_sf = ptr_sbr_data->int_env_sf_arr;
|
|
static const WORD32 mant_arr[2] = {0x4000, 0x5a80};
|
|
|
|
amp_res_1 = (1 - amp_res);
|
|
|
|
for (i = num_env_sf - 1; i >= 0; i--) {
|
|
exponent = *ptr_env_sf;
|
|
mantissa = mant_arr[(exponent & amp_res_1)];
|
|
exponent = (exponent >> amp_res_1);
|
|
exponent = (exponent + exp_add);
|
|
*ptr_env_sf++ = (WORD16)(mantissa | (exponent & MASK_FOR_EXP));
|
|
}
|
|
}
|
|
|
|
static PLATFORM_INLINE VOID
|
|
ixheaacd_limit_noise_floor_fac(ia_sbr_header_data_struct *ptr_header_data,
|
|
ia_sbr_frame_info_data_struct *ptr_sbr_data) {
|
|
WORD32 i, tot_nf_bands;
|
|
WORD32 value;
|
|
WORD32 num_nf_bands;
|
|
WORD16 *ptr_noise_floor;
|
|
|
|
num_nf_bands = ptr_header_data->pstr_freq_band_data->num_nf_bands;
|
|
|
|
tot_nf_bands =
|
|
ptr_sbr_data->str_frame_info_details.num_noise_env * num_nf_bands;
|
|
|
|
ptr_noise_floor = ptr_sbr_data->int_noise_floor;
|
|
|
|
for (i = tot_nf_bands - 1; i >= 0; i--) {
|
|
value = *ptr_noise_floor;
|
|
if (value > MAX_NOISE_FLOOR_FAC_VAL) {
|
|
*ptr_noise_floor = MAX_NOISE_FLOOR_FAC_VAL;
|
|
} else {
|
|
if (value < MIN_NOISE_FLOOR_FAC_VAL) {
|
|
*ptr_noise_floor = MIN_NOISE_FLOOR_FAC_VAL;
|
|
}
|
|
}
|
|
ptr_noise_floor++;
|
|
}
|
|
}
|
|
|
|
VOID ixheaacd_add_arr(WORD16 *ptr1, WORD16 *ptr2, WORD32 num) {
|
|
WORD32 i;
|
|
for (i = num - 1; i >= 0; i--) {
|
|
*ptr2 = (*ptr2 + *ptr1);
|
|
ptr2++;
|
|
ptr1++;
|
|
}
|
|
}
|
|
|
|
IA_ERRORCODE ixheaacd_calc_noise_floor(
|
|
ia_sbr_header_data_struct *ptr_header_data,
|
|
ia_sbr_frame_info_data_struct *ptr_sbr_data,
|
|
ia_sbr_prev_frame_data_struct *ptr_prev_data) {
|
|
WORD32 i;
|
|
WORD32 num_nf_bands;
|
|
WORD32 num_noise_env;
|
|
WORD32 ixheaacd_drc_offset;
|
|
WORD16 *ptr_noise_floor = ptr_sbr_data->int_noise_floor;
|
|
|
|
WORD16 *ptr_prev_noise_floor = ptr_prev_data->prev_noise_level;
|
|
WORD16 *ptr1, *ptr2;
|
|
WORD32 num;
|
|
FLOAT32 *ptr_noise_floor_float = ptr_sbr_data->flt_noise_floor;
|
|
|
|
num_nf_bands = ptr_header_data->pstr_freq_band_data->num_nf_bands;
|
|
num_noise_env = ptr_sbr_data->str_frame_info_details.num_noise_env;
|
|
|
|
if (ptr_sbr_data->del_cod_dir_noise_arr[0] == DTDF_DIR_FREQ) {
|
|
ptr1 = ptr_noise_floor++;
|
|
ptr2 = ptr_noise_floor;
|
|
num = num_nf_bands - 1;
|
|
} else {
|
|
ptr1 = ptr_prev_noise_floor;
|
|
ptr2 = ptr_sbr_data->int_noise_floor;
|
|
num = num_nf_bands;
|
|
}
|
|
|
|
ixheaacd_add_arr(ptr1, ptr2, num);
|
|
|
|
if (num_noise_env > 1) {
|
|
if (ptr_sbr_data->del_cod_dir_noise_arr[1] == DTDF_DIR_FREQ) {
|
|
ptr1 = &ptr_sbr_data->int_noise_floor[num_nf_bands];
|
|
ptr2 = &ptr_sbr_data->int_noise_floor[(num_nf_bands + 1)];
|
|
|
|
num = num_nf_bands - 1;
|
|
} else {
|
|
ptr1 = &ptr_sbr_data->int_noise_floor[0];
|
|
ptr2 = &ptr_sbr_data->int_noise_floor[num_nf_bands];
|
|
|
|
num = num_nf_bands;
|
|
}
|
|
ixheaacd_add_arr(ptr1, ptr2, num);
|
|
}
|
|
|
|
ixheaacd_limit_noise_floor_fac(ptr_header_data, ptr_sbr_data);
|
|
|
|
ixheaacd_drc_offset = num_nf_bands * (num_noise_env - 1);
|
|
if (ixheaacd_drc_offset < 0 || ixheaacd_drc_offset >= MAX_NUM_NOISE_VALUES)
|
|
return IA_FATAL_ERROR;
|
|
ptr1 = &ptr_sbr_data->int_noise_floor[ixheaacd_drc_offset];
|
|
ptr2 = ptr_prev_noise_floor;
|
|
|
|
memcpy(ptr2, ptr1, sizeof(WORD16) * (num_nf_bands));
|
|
|
|
if ((ptr_sbr_data->coupling_mode != COUPLING_BAL) ||
|
|
(ptr_header_data->usac_flag)) {
|
|
WORD32 noise_floor_exp, tot_nf_bands;
|
|
|
|
tot_nf_bands = (num_nf_bands * num_noise_env);
|
|
ptr_noise_floor = &ptr_sbr_data->int_noise_floor[0];
|
|
|
|
for (i = 0; i < tot_nf_bands; i++) {
|
|
noise_floor_exp =
|
|
(NOISE_FLOOR_OFFSET_INT + 1 + NOISE_EXP_OFFSET - *ptr_noise_floor);
|
|
|
|
*ptr_noise_floor_float++ = *ptr_noise_floor;
|
|
*ptr_noise_floor++ = (WORD16)(0x4000 + (noise_floor_exp & MASK_FOR_EXP));
|
|
}
|
|
}
|
|
return IA_NO_ERROR;
|
|
}
|
|
|
|
IA_ERRORCODE ixheaacd_dec_sbrdata_for_pvc(
|
|
ia_sbr_header_data_struct *ptr_header_data,
|
|
ia_sbr_frame_info_data_struct *ptr_sbr_data,
|
|
ia_sbr_prev_frame_data_struct *ptr_prev_data) {
|
|
WORD32 err = 0;
|
|
err = ixheaacd_calc_noise_floor(ptr_header_data, ptr_sbr_data, ptr_prev_data);
|
|
if (err) return err;
|
|
|
|
if (!ptr_sbr_data->coupling_mode) {
|
|
ptr_sbr_data->num_noise_sfac =
|
|
ptr_header_data->pstr_freq_band_data->num_nf_bands *
|
|
ptr_sbr_data->str_frame_info_details.num_noise_env;
|
|
ixheaacd_dequant_pvc_env_data(ptr_sbr_data->num_noise_sfac,
|
|
ptr_sbr_data->flt_noise_floor);
|
|
}
|
|
return IA_NO_ERROR;
|
|
}
|
|
|
|
VOID ixheaacd_sbr_env_dequant_coup_fix(
|
|
ia_sbr_header_data_struct *ptr_header_data,
|
|
ia_sbr_frame_info_data_struct *ptr_data_left,
|
|
ia_sbr_frame_info_data_struct *ptr_data_right,
|
|
ixheaacd_misc_tables *pstr_common_tables) {
|
|
WORD32 i;
|
|
WORD32 num_env_sf = ptr_data_left->num_env_sfac;
|
|
WORD16 temp_left_mant, temp_right_mant, temp_right_plus1_mant, new_left_mant,
|
|
new_right_mant;
|
|
WORD16 temp_left_exp, temp_right_exp, temp_rightplus1_exp, new_left_exp,
|
|
new_right_exp;
|
|
WORD32 i_end;
|
|
WORD16 *r_data = ptr_data_right->int_env_sf_arr;
|
|
WORD16 *l_data = ptr_data_left->int_env_sf_arr;
|
|
|
|
for (i = 0; i < num_env_sf; i++) {
|
|
temp_right_mant = (WORD16)(*r_data & MASK_M);
|
|
temp_right_exp = (WORD16)(*r_data & MASK_FOR_EXP);
|
|
|
|
temp_right_exp = sub16_m(temp_right_exp, add16_m(18, NRG_EXP_OFFSET));
|
|
temp_left_mant = (WORD16)(*l_data & MASK_M);
|
|
temp_left_exp = (WORD16)(*l_data & MASK_FOR_EXP);
|
|
|
|
temp_left_exp = sub16_m(temp_left_exp, NRG_EXP_OFFSET);
|
|
|
|
ixheaacd_fix_mant_exp_add(temp_right_mant, temp_right_exp, 0x4000, 1,
|
|
&temp_right_plus1_mant, &temp_rightplus1_exp);
|
|
|
|
new_right_exp = ixheaacd_fix_mant_div(temp_left_mant, temp_right_plus1_mant,
|
|
&new_right_mant, pstr_common_tables);
|
|
|
|
new_right_exp += temp_left_exp - temp_rightplus1_exp + 2;
|
|
|
|
new_left_mant = ixheaacd_mult16_shl(temp_right_mant, new_right_mant);
|
|
|
|
new_left_exp = add16_m(temp_right_exp, new_right_exp);
|
|
|
|
*r_data++ = (WORD16)(((new_right_mant + ROUNDING) & MASK_M) +
|
|
((new_right_exp + NRG_EXP_OFFSET) & MASK_FOR_EXP));
|
|
*l_data++ = (WORD16)(((new_left_mant + ROUNDING) & MASK_M) +
|
|
((new_left_exp + NRG_EXP_OFFSET) & MASK_FOR_EXP));
|
|
}
|
|
|
|
i_end = ptr_header_data->pstr_freq_band_data->num_nf_bands *
|
|
ptr_data_left->str_frame_info_details.num_noise_env;
|
|
r_data = ptr_data_right->int_noise_floor;
|
|
l_data = ptr_data_left->int_noise_floor;
|
|
|
|
for (i = i_end - 1; i >= 0; i--) {
|
|
temp_left_exp =
|
|
sub16_m((WORD16)(*l_data & (WORD16)MASK_FOR_EXP), NOISE_EXP_OFFSET);
|
|
temp_right_exp = sub16_m(*r_data, 12);
|
|
|
|
ixheaacd_fix_mant_exp_add(0x4000, ixheaacd_add16(1, temp_right_exp), 0x4000,
|
|
1, &temp_right_plus1_mant, &temp_rightplus1_exp);
|
|
|
|
new_right_exp = ixheaacd_fix_mant_div(0x4000, temp_right_plus1_mant,
|
|
&new_right_mant, pstr_common_tables);
|
|
|
|
new_right_exp += temp_left_exp - temp_rightplus1_exp + 2;
|
|
|
|
new_left_mant = new_right_mant;
|
|
new_left_exp = add16_m(new_right_exp, temp_right_exp);
|
|
*r_data++ = (WORD16)(((new_right_mant + ROUNDING) & MASK_M) +
|
|
((new_right_exp + NOISE_EXP_OFFSET) & MASK_FOR_EXP));
|
|
*l_data++ = (WORD16)(((new_left_mant + ROUNDING) & MASK_M) +
|
|
((new_left_exp + NOISE_EXP_OFFSET) & MASK_FOR_EXP));
|
|
}
|
|
}
|
|
|
|
VOID ixheaacd_sbr_env_dequant_coup(
|
|
ia_sbr_frame_info_data_struct *ptr_data_ch_0,
|
|
ia_sbr_frame_info_data_struct *ptr_data_ch_1) {
|
|
FLOAT32 *ptr_env_sf_left = ptr_data_ch_0->flt_env_sf_arr;
|
|
FLOAT32 *ptr_env_sf_right = ptr_data_ch_1->flt_env_sf_arr;
|
|
FLOAT32 *ptr_noise_floor_left = ptr_data_ch_0->flt_noise_floor;
|
|
FLOAT32 *ptr_noise_floor_right = ptr_data_ch_1->flt_noise_floor;
|
|
WORD32 num_env_sf = ptr_data_ch_0->num_env_sfac;
|
|
WORD32 num_noise_fac = ptr_data_ch_0->num_noise_sfac;
|
|
WORD32 amp_res = ptr_data_ch_0->amp_res;
|
|
|
|
WORD32 i;
|
|
FLOAT32 temp_l, temp_r;
|
|
static const FLOAT32 pan_offset[2] = {24.0f, 12.0f};
|
|
static const FLOAT32 a_arr[2] = {0.5f, 1.0f};
|
|
|
|
FLOAT32 a = a_arr[amp_res];
|
|
|
|
for (i = 0; i < num_env_sf; i++) {
|
|
temp_l = ptr_env_sf_left[i];
|
|
temp_r = ptr_env_sf_right[i];
|
|
|
|
ptr_env_sf_left[i] =
|
|
(FLOAT32)(64 * (pow(2, temp_l * a + 1) /
|
|
(1 + pow(2, (pan_offset[amp_res] - temp_r) * a))));
|
|
ptr_env_sf_right[i] =
|
|
(FLOAT32)(64 * (pow(2, temp_l * a + 1) /
|
|
(1 + pow(2, (temp_r - pan_offset[amp_res]) * a))));
|
|
}
|
|
|
|
for (i = 0; i < num_noise_fac; i++) {
|
|
temp_l = ptr_noise_floor_left[i];
|
|
temp_r = ptr_noise_floor_right[i];
|
|
|
|
ptr_noise_floor_left[i] =
|
|
(FLOAT32)(pow(2, NOISE_FLOOR_OFFSET - temp_l + 1) /
|
|
(1 + pow(2, pan_offset[1] - temp_r)));
|
|
ptr_noise_floor_right[i] =
|
|
(FLOAT32)(pow(2, NOISE_FLOOR_OFFSET - temp_l + 1) /
|
|
(1 + pow(2, temp_r - pan_offset[1])));
|
|
}
|
|
}
|
|
WORD32 ixheaacd_dec_sbrdata(ia_sbr_header_data_struct *ptr_header_data_ch_0,
|
|
ia_sbr_header_data_struct *ptr_header_data_ch_1,
|
|
ia_sbr_frame_info_data_struct *ptr_sbr_data_ch_0,
|
|
ia_sbr_prev_frame_data_struct *ptr_prev_data_ch_0,
|
|
ia_sbr_frame_info_data_struct *ptr_sbr_data_ch_1,
|
|
ia_sbr_prev_frame_data_struct *ptr_prev_data_ch_1,
|
|
ixheaacd_misc_tables *ptr_common_tables) {
|
|
FLAG error_code;
|
|
WORD32 err = 0;
|
|
WORD32 usac_flag = ptr_header_data_ch_0->usac_flag;
|
|
|
|
err = ixheaacd_dec_envelope(ptr_header_data_ch_0, ptr_sbr_data_ch_0,
|
|
ptr_prev_data_ch_0, ptr_prev_data_ch_1,
|
|
ptr_common_tables);
|
|
|
|
if (err) return err;
|
|
|
|
err = ixheaacd_calc_noise_floor(ptr_header_data_ch_0, ptr_sbr_data_ch_0,
|
|
ptr_prev_data_ch_0);
|
|
|
|
if (err == (WORD32)IA_FATAL_ERROR) return (WORD32)IA_FATAL_ERROR;
|
|
|
|
if (!ptr_sbr_data_ch_0->coupling_mode && usac_flag) {
|
|
ptr_sbr_data_ch_0->num_noise_sfac =
|
|
ptr_header_data_ch_0->pstr_freq_band_data->num_nf_bands *
|
|
ptr_sbr_data_ch_0->str_frame_info_details.num_noise_env;
|
|
|
|
ixheaacd_dequant_esbr_env_data(
|
|
ptr_sbr_data_ch_0->flt_env_sf_arr, ptr_sbr_data_ch_0->num_env_sfac,
|
|
ptr_sbr_data_ch_0->num_noise_sfac, ptr_sbr_data_ch_0->amp_res,
|
|
ptr_sbr_data_ch_0->flt_noise_floor);
|
|
}
|
|
|
|
if (ptr_sbr_data_ch_1 != NULL) {
|
|
error_code = ptr_header_data_ch_0->err_flag;
|
|
err = ixheaacd_dec_envelope(ptr_header_data_ch_1, ptr_sbr_data_ch_1,
|
|
ptr_prev_data_ch_1, ptr_prev_data_ch_0,
|
|
ptr_common_tables);
|
|
|
|
if (err) return err;
|
|
|
|
err = ixheaacd_calc_noise_floor(ptr_header_data_ch_1, ptr_sbr_data_ch_1,
|
|
ptr_prev_data_ch_1);
|
|
|
|
if (err) return err;
|
|
|
|
if (!ptr_sbr_data_ch_1->coupling_mode && usac_flag) {
|
|
ptr_sbr_data_ch_1->num_noise_sfac =
|
|
ptr_header_data_ch_1->pstr_freq_band_data->num_nf_bands *
|
|
ptr_sbr_data_ch_1->str_frame_info_details.num_noise_env;
|
|
|
|
ixheaacd_dequant_esbr_env_data(
|
|
ptr_sbr_data_ch_1->flt_env_sf_arr, ptr_sbr_data_ch_1->num_env_sfac,
|
|
ptr_sbr_data_ch_1->num_noise_sfac, ptr_sbr_data_ch_1->amp_res,
|
|
ptr_sbr_data_ch_1->flt_noise_floor);
|
|
}
|
|
|
|
if (!usac_flag) {
|
|
if (!error_code && ptr_header_data_ch_0->err_flag) {
|
|
err = ixheaacd_dec_envelope(ptr_header_data_ch_0, ptr_sbr_data_ch_0,
|
|
ptr_prev_data_ch_0, ptr_prev_data_ch_1,
|
|
ptr_common_tables);
|
|
|
|
if (err) return err;
|
|
}
|
|
}
|
|
|
|
if (ptr_sbr_data_ch_0->coupling_mode) {
|
|
ptr_sbr_data_ch_0->num_noise_sfac =
|
|
ptr_header_data_ch_1->pstr_freq_band_data->num_nf_bands *
|
|
ptr_sbr_data_ch_1->str_frame_info_details.num_noise_env;
|
|
ixheaacd_sbr_env_dequant_coup_fix(ptr_header_data_ch_0, ptr_sbr_data_ch_0,
|
|
ptr_sbr_data_ch_1, ptr_common_tables);
|
|
|
|
ixheaacd_sbr_env_dequant_coup(ptr_sbr_data_ch_0, ptr_sbr_data_ch_1);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
WORD32 ixheaacd_dec_envelope(ia_sbr_header_data_struct *ptr_header_data,
|
|
ia_sbr_frame_info_data_struct *ptr_sbr_data,
|
|
ia_sbr_prev_frame_data_struct *ptr_prev_data_ch_0,
|
|
ia_sbr_prev_frame_data_struct *ptr_prev_data_ch_1,
|
|
ixheaacd_misc_tables *pstr_common_tables) {
|
|
FLAG error_code;
|
|
WORD32 err;
|
|
WORD16 env_sf_local_arr[MAX_FREQ_COEFFS];
|
|
WORD32 usac_flag = ptr_header_data->usac_flag;
|
|
WORD32 temp_1 =
|
|
ptr_prev_data_ch_0->end_position - ptr_header_data->num_time_slots;
|
|
if (temp_1 < 0) return -1;
|
|
temp_1 = ptr_sbr_data->str_frame_info_details.border_vec[0] - temp_1;
|
|
|
|
if ((!ptr_header_data->err_flag_prev) && (!ptr_header_data->err_flag) &&
|
|
(temp_1 != 0)) {
|
|
if (ptr_sbr_data->del_cod_dir_arr[0] == DTDF_DIR_TIME) {
|
|
ptr_header_data->err_flag = 1;
|
|
} else {
|
|
ptr_header_data->err_flag_prev = 1;
|
|
}
|
|
}
|
|
|
|
if (ptr_header_data->err_flag && !usac_flag) {
|
|
ixheaacd_lean_sbrconcealment(ptr_header_data, ptr_sbr_data,
|
|
ptr_prev_data_ch_0);
|
|
|
|
ixheaacd_process_del_cod_env_data(ptr_header_data, ptr_sbr_data,
|
|
ptr_prev_data_ch_0);
|
|
} else {
|
|
WORD32 num = ptr_header_data->pstr_freq_band_data->num_sf_bands[HIGH];
|
|
if (ptr_header_data->err_flag_prev && !usac_flag) {
|
|
WORD16 *ptr1, *ptr2;
|
|
WORD32 i;
|
|
|
|
err = ixheaacd_wrong_timing_compensate(ptr_header_data, ptr_sbr_data,
|
|
ptr_prev_data_ch_0,
|
|
pstr_common_tables);
|
|
|
|
if (err) return err;
|
|
|
|
if (ptr_sbr_data->coupling_mode !=
|
|
(WORD16)ptr_prev_data_ch_0->coupling_mode) {
|
|
if (ptr_prev_data_ch_0->coupling_mode == COUPLING_BAL) {
|
|
memcpy(ptr_prev_data_ch_0->sfb_nrg_prev,
|
|
ptr_prev_data_ch_1->sfb_nrg_prev, sizeof(WORD16) * num);
|
|
} else {
|
|
if (ptr_sbr_data->coupling_mode == COUPLING_LEVEL) {
|
|
ptr1 = ptr_prev_data_ch_0->sfb_nrg_prev;
|
|
ptr2 = ptr_prev_data_ch_1->sfb_nrg_prev;
|
|
|
|
for (i = 0; i < num; i++) {
|
|
*ptr1 = (add16_m(*ptr1, *ptr2) >> 1);
|
|
ptr2++;
|
|
ptr1++;
|
|
}
|
|
} else {
|
|
if (ptr_sbr_data->coupling_mode == COUPLING_BAL) {
|
|
memset(ptr_prev_data_ch_0->sfb_nrg_prev, SBR_ENERGY_PAN_OFFSET,
|
|
sizeof(WORD16) * num);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
memcpy(env_sf_local_arr, ptr_prev_data_ch_0->sfb_nrg_prev,
|
|
sizeof(WORD16) * MAX_FREQ_COEFFS);
|
|
|
|
ixheaacd_process_del_cod_env_data(ptr_header_data, ptr_sbr_data,
|
|
ptr_prev_data_ch_0);
|
|
|
|
if (!usac_flag) {
|
|
error_code = ixheaacd_check_env_data(ptr_header_data, ptr_sbr_data,
|
|
ptr_prev_data_ch_0);
|
|
|
|
if (error_code) {
|
|
ptr_header_data->err_flag = 1;
|
|
|
|
memcpy(ptr_prev_data_ch_0->sfb_nrg_prev, env_sf_local_arr,
|
|
sizeof(WORD16) * MAX_FREQ_COEFFS);
|
|
|
|
err = ixheaacd_dec_envelope(ptr_header_data, ptr_sbr_data,
|
|
ptr_prev_data_ch_0, ptr_prev_data_ch_1,
|
|
pstr_common_tables);
|
|
|
|
if (err) return err;
|
|
return 0;
|
|
}
|
|
}
|
|
}
|
|
if (!usac_flag)
|
|
ixheaacd_dequant_env_data(ptr_sbr_data, ptr_sbr_data->amp_res);
|
|
|
|
return 0;
|
|
}
|
|
|
|
VOID ixheaacd_adj_timeslot(WORD32 *ptr_buf_real, WORD32 *ptr_buf_imag,
|
|
WORD16 *ptr_filt_buf, WORD16 *ptr_filt_buf_noise,
|
|
WORD16 *ptr_gain_buf, WORD16 *ptr_noise_floor,
|
|
WORD16 *ptr_sine_lvl_buf, WORD16 noise_floor_exp,
|
|
WORD16 *ptr_harm_index, WORD16 sub_band_start,
|
|
WORD16 num_sub_bands, WORD16 scale_change,
|
|
WORD16 smooth_ratio, FLAG num_noise_flg,
|
|
WORD16 *ptr_phase_index,
|
|
ia_sbr_tables_struct *ptr_sbr_tables) {
|
|
WORD16 k;
|
|
WORD16 *ptr_smoothed_gain, *ptr_smoothed_noise;
|
|
WORD16 direct_ratio;
|
|
WORD32 index = *ptr_phase_index;
|
|
WORD32 harm_idx = *ptr_harm_index;
|
|
WORD32 freq_inv_flag;
|
|
const WORD32 *ptr_rand_ph_buf;
|
|
WORD32 factor = 0;
|
|
|
|
direct_ratio = ixheaacd_sub16_sat(0x7fff, smooth_ratio);
|
|
freq_inv_flag = (sub_band_start & 1);
|
|
|
|
scale_change = scale_change - 1;
|
|
|
|
ptr_rand_ph_buf = &ptr_sbr_tables->sbr_rand_ph[index];
|
|
*ptr_phase_index =
|
|
(WORD16)((index + num_sub_bands) & (SBR_NF_NO_RANDOM_VAL - 1));
|
|
|
|
if (smooth_ratio) {
|
|
WORD16 *ptr_filt_buf_local = &ptr_filt_buf[0];
|
|
WORD16 *ptr_gain_buf_local = &ptr_gain_buf[0];
|
|
WORD16 *ptr_filt_noise_local = &ptr_filt_buf_noise[0];
|
|
WORD16 *ptr_noise_floor_local = &ptr_noise_floor[0];
|
|
|
|
WORD16 tmp, tmp1;
|
|
|
|
for (k = 0; k < num_sub_bands; k++) {
|
|
tmp = add16_m(mult16x16_16(smooth_ratio, *ptr_filt_buf_local),
|
|
mult16x16_16(direct_ratio, *ptr_gain_buf_local++));
|
|
|
|
ptr_gain_buf_local++;
|
|
|
|
tmp1 = add16_m(mult16x16_16(smooth_ratio, *ptr_filt_noise_local),
|
|
mult16x16_16(direct_ratio, *ptr_noise_floor_local++));
|
|
|
|
ptr_noise_floor_local++;
|
|
|
|
*ptr_filt_buf_local++ = tmp << 1;
|
|
ptr_filt_buf_local++;
|
|
*ptr_filt_noise_local++ = tmp1 << 1;
|
|
}
|
|
ptr_smoothed_gain = ptr_filt_buf;
|
|
ptr_smoothed_noise = ptr_filt_buf_noise;
|
|
factor = 1;
|
|
} else {
|
|
ptr_smoothed_gain = ptr_gain_buf;
|
|
ptr_smoothed_noise = ptr_noise_floor;
|
|
factor = 2;
|
|
}
|
|
|
|
switch (harm_idx) {
|
|
case 0:
|
|
case 2:
|
|
ixheaacd_harm_idx_zerotwo(num_noise_flg, num_sub_bands, ptr_buf_real,
|
|
ptr_buf_imag, ptr_smoothed_gain,
|
|
ptr_smoothed_noise, factor, ptr_gain_buf,
|
|
scale_change, ptr_rand_ph_buf, ptr_sine_lvl_buf,
|
|
noise_floor_exp, harm_idx);
|
|
break;
|
|
case 1:
|
|
case 3:
|
|
ixheaacd_harm_idx_onethree(
|
|
num_noise_flg, num_sub_bands, ptr_buf_real, ptr_buf_imag,
|
|
ptr_smoothed_gain, ptr_smoothed_noise, factor, ptr_gain_buf,
|
|
scale_change, ptr_rand_ph_buf, ptr_sine_lvl_buf, noise_floor_exp,
|
|
freq_inv_flag, harm_idx);
|
|
break;
|
|
}
|
|
*ptr_harm_index = (WORD16)((harm_idx + 1) & 3);
|
|
}
|