/******************************************************************************
* *
* 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 <stdlib.h>
#include <math.h>
#include <string.h>
#include <ixheaacd_type_def.h>
#include "ixheaacd_error_standards.h"
#include "ixheaacd_sbr_const.h"
#include "ixheaacd_sbrdecsettings.h"
#include "ixheaacd_bitbuffer.h"
#include "ixheaacd_sbr_common.h"
#include "ixheaacd_drc_data_struct.h"
#include "ixheaacd_drc_dec.h"
#include "ixheaacd_sbrdecoder.h"
#include "ixheaacd_bitbuffer.h"
#include "ixheaacd_env_extr_part.h"
#include <ixheaacd_sbr_rom.h>
#include "ixheaacd_common_rom.h"
#include "ixheaacd_hybrid.h"
#include "ixheaacd_sbr_scale.h"
#include "ixheaacd_ps_dec.h"
#include "ixheaacd_freq_sca.h"
#include "ixheaacd_lpp_tran.h"
#include "ixheaacd_env_extr.h"
#include "ixheaacd_esbr_rom.h"
VOID ixheaacd_shellsort(WORD32 *in, WORD32 n) {
WORD32 i, j, v;
WORD32 inc = 1;
do
inc = 3 * inc + 1;
while (inc <= n);
do {
inc = inc / 3;
for (i = inc + 1; i <= n; i++) {
v = in[i - 1];
j = i;
while (in[j - inc - 1] > v) {
in[j - 1] = in[j - inc - 1];
j -= inc;
if (j <= inc) break;
}
in[j - 1] = v;
}
} while (inc > 1);
}
WORD32 ixheaacd_sbr_env_calc(ia_sbr_frame_info_data_struct *frame_data,
FLOAT32 input_real[][64], FLOAT32 input_imag[][64],
FLOAT32 input_real1[][64],
FLOAT32 input_imag1[][64],
WORD32 x_over_qmf[MAX_NUM_PATCHES],
FLOAT32 *scratch_buff, FLOAT32 *env_out) {
WORD8 harmonics[64];
FLOAT32(*env_tmp)[48];
FLOAT32(*noise_level_pvc)[48];
FLOAT32(*nrg_est_pvc)[48];
FLOAT32(*nrg_ref_pvc)[48];
FLOAT32(*nrg_gain_pvc)[48];
FLOAT32(*nrg_tone_pvc)[48];
WORD32 n, c, li, ui, i, j, k = 0, l, m = 0, kk = 0, o, next = -1, ui2, flag,
tmp, noise_absc_flag, smooth_length;
WORD32 upsamp_4_flag = frame_data->pstr_sbr_header->is_usf_4;
FLOAT32 *ptr_real_buf, *ptr_imag_buf, nrg = 0, p_ref, p_est, avg_gain, g_max,
p_adj, boost_gain, sb_gain, sb_noise,
temp[64];
WORD32 t;
WORD32 start_pos = 0;
WORD32 end_pos = 0;
WORD32 slot_idx;
FLOAT32 *prev_env_noise_level = frame_data->prev_noise_level;
FLOAT32 *nrg_tone = scratch_buff;
FLOAT32 *noise_level = scratch_buff + 64;
FLOAT32 *nrg_est = scratch_buff + 128;
FLOAT32 *nrg_ref = scratch_buff + 192;
FLOAT32 *nrg_gain = scratch_buff + 256;
const FLOAT32 *smooth_filt;
FLOAT32 *sfb_nrg = frame_data->flt_env_sf_arr;
FLOAT32 *noise_floor = frame_data->flt_noise_floor;
ia_frame_info_struct *p_frame_info = &frame_data->str_frame_info_details;
ia_frame_info_struct *pvc_frame_info = &frame_data->str_pvc_frame_info;
WORD32 smoothing_length = frame_data->pstr_sbr_header->smoothing_mode ? 0 : 4;
WORD32 int_mode = frame_data->pstr_sbr_header->interpol_freq;
WORD32 limiter_band = frame_data->pstr_sbr_header->limiter_bands;
WORD32 limiter_gains = frame_data->pstr_sbr_header->limiter_gains;
WORD32 *add_harmonics = frame_data->add_harmonics;
WORD32 sub_band_start =
frame_data->pstr_sbr_header->pstr_freq_band_data->sub_band_start;
WORD32 sub_band_end =
frame_data->pstr_sbr_header->pstr_freq_band_data->sub_band_end;
WORD32 reset = frame_data->reset_flag;
WORD32 num_subbands = sub_band_end - sub_band_start;
WORD32 bs_num_env = p_frame_info->num_env;
WORD32 trans_env = p_frame_info->transient_env;
WORD32 sbr_mode = frame_data->sbr_mode;
WORD32 prev_sbr_mode = frame_data->prev_sbr_mode;
WORD16 *freq_band_table[2];
const WORD16 *num_sf_bands =
frame_data->pstr_sbr_header->pstr_freq_band_data->num_sf_bands;
WORD16 *freq_band_table_noise =
frame_data->pstr_sbr_header->pstr_freq_band_data->freq_band_tbl_noise;
WORD32 num_nf_bands =
frame_data->pstr_sbr_header->pstr_freq_band_data->num_nf_bands;
WORD32 harm_index = frame_data->harm_index;
WORD32 phase_index = frame_data->phase_index;
WORD32 esbr_start_up = frame_data->pstr_sbr_header->esbr_start_up;
WORD32 esbr_start_up_pvc = frame_data->pstr_sbr_header->esbr_start_up_pvc;
WORD8(*harm_flag_prev)[64] = &frame_data->harm_flag_prev;
FLOAT32(*e_gain)[5][64] = &frame_data->e_gain;
FLOAT32(*noise_buf)[5][64] = &frame_data->noise_buf;
WORD32(*lim_table)[4][12 + 1] = &frame_data->lim_table;
WORD32(*gate_mode)[4] = &frame_data->gate_mode;
WORD32 freq_inv = 1;
WORD8(*harm_flag_varlen_prev)[64] = &frame_data->harm_flag_varlen_prev;
WORD8(*harm_flag_varlen)[64] = &frame_data->harm_flag_varlen;
WORD32 band_loop_end;
WORD32 rate = upsamp_4_flag ? 4 : 2;
env_tmp = frame_data->env_tmp;
noise_level_pvc = frame_data->noise_level_pvc;
nrg_est_pvc = frame_data->nrg_est_pvc;
nrg_ref_pvc = frame_data->nrg_ref_pvc;
nrg_gain_pvc = frame_data->nrg_gain_pvc;
nrg_tone_pvc = frame_data->nrg_tone_pvc;
freq_band_table[0] =
frame_data->pstr_sbr_header->pstr_freq_band_data->freq_band_table[0];
freq_band_table[1] =
frame_data->pstr_sbr_header->pstr_freq_band_data->freq_band_table[1];
if (reset) {
esbr_start_up = 1;
esbr_start_up_pvc = 1;
phase_index = 0;
if (ixheaacd_createlimiterbands(
(*lim_table), (*gate_mode),
frame_data->pstr_sbr_header->pstr_freq_band_data->freq_band_tbl_lo,
num_sf_bands[LOW], x_over_qmf, frame_data->sbr_patching_mode,
upsamp_4_flag, &frame_data->patch_param))
return IA_FATAL_ERROR;
}
if (frame_data->sbr_patching_mode != frame_data->prev_sbr_patching_mode) {
if (ixheaacd_createlimiterbands(
(*lim_table), (*gate_mode),
frame_data->pstr_sbr_header->pstr_freq_band_data->freq_band_tbl_lo,
num_sf_bands[LOW], x_over_qmf, frame_data->sbr_patching_mode,
upsamp_4_flag, &frame_data->patch_param))
return IA_FATAL_ERROR;
frame_data->prev_sbr_patching_mode = frame_data->sbr_patching_mode;
}
memset(harmonics, 0, 64 * sizeof(WORD8));
if (sbr_mode == PVC_SBR) {
for (i = 0; i < num_sf_bands[HIGH]; i++) {
li =
frame_data->pstr_sbr_header->pstr_freq_band_data->freq_band_tbl_hi[i];
ui = frame_data->pstr_sbr_header->pstr_freq_band_data
->freq_band_tbl_hi[i + 1];
tmp = ((ui + li) - (sub_band_start << 1)) >> 1;
if ((tmp >= 64) || (tmp < 0)) return -1;
harmonics[tmp] = add_harmonics[i];
}
for (t = 0; t < p_frame_info->border_vec[0]; t++) {
for (c = 0; c < 64; c++) {
frame_data->qmapped_pvc[c][t] = frame_data->qmapped_pvc[c][t + 16];
}
}
for (i = 0; i < bs_num_env; i++) {
if (p_frame_info->border_vec[i] == p_frame_info->noise_border_vec[kk])
kk++, next++;
start_pos = p_frame_info->border_vec[i];
end_pos = p_frame_info->border_vec[i + 1];
for (t = start_pos; t < end_pos; t++) {
band_loop_end = num_sf_bands[p_frame_info->freq_res[i]];
for (c = 0, o = 0, j = 0; j < band_loop_end; j++) {
li = freq_band_table[p_frame_info->freq_res[i]][j];
ui = freq_band_table[p_frame_info->freq_res[i]][j + 1];
ui2 = frame_data->pstr_sbr_header->pstr_freq_band_data
->freq_band_tbl_noise[o + 1];
for (k = 0; k < ui - li; k++) {
o = (k + li >= ui2) ? o + 1 : o;
ui2 = freq_band_table_noise[o + 1];
frame_data->qmapped_pvc[c][t] =
noise_floor[next * num_nf_bands + o];
c++;
}
}
}
}
kk = 0;
next = -1;
for (i = 0; i < bs_num_env; i++) {
if (p_frame_info->border_vec[i] == p_frame_info->noise_border_vec[kk])
kk++, next++;
start_pos = pvc_frame_info->border_vec[i];
end_pos = pvc_frame_info->border_vec[i + 1];
for (t = start_pos; t < end_pos; t++) {
for (c = 0; c < 64; c++) {
env_tmp[c][t] = env_out[64 * t + c];
}
}
noise_absc_flag =
(i == trans_env || i == frame_data->env_short_flag_prev) ? 1 : 0;
if (prev_sbr_mode == ORIG_SBR) noise_absc_flag = 0;
smooth_length = (noise_absc_flag ? 0 : smoothing_length);
smooth_filt = *ixheaacd_fir_table[smooth_length];
for (t = start_pos; t < frame_data->sin_len_for_cur_top; t++) {
band_loop_end =
num_sf_bands[frame_data->str_frame_info_prev
.freq_res[frame_data->var_len_id_prev]];
for (c = 0, o = 0, j = 0; j < band_loop_end; j++) {
double tmp;
li = freq_band_table[frame_data->str_frame_info_prev
.freq_res[frame_data->var_len_id_prev]][j];
ui = freq_band_table[frame_data->str_frame_info_prev
.freq_res[frame_data->var_len_id_prev]]
[j + 1];
ui2 = frame_data->pstr_sbr_header->pstr_freq_band_data
->freq_band_tbl_noise[o + 1];
for (flag = 0, k = li; k < ui; k++) {
flag = ((*harm_flag_varlen)[c] &&
(t >= frame_data->sin_start_for_cur_top ||
(*harm_flag_varlen_prev)[c + sub_band_start]))
? 1
: flag;
nrg_ref_pvc[c][t] = env_tmp[k][t];
for (nrg = 0, l = 0; l < rate; l++) {
nrg +=
(input_real[rate * t + l][k] * input_real[rate * t + l][k]) +
(input_imag[rate * t + l][k] * input_imag[rate * t + l][k]);
}
nrg_est_pvc[c][t] = nrg / rate;
c++;
}
if (!int_mode) {
for (nrg = 0, k = c - (ui - li); k < c; k++) {
nrg += nrg_est_pvc[k][t];
}
nrg /= (ui - li);
}
c -= (ui - li);
for (k = 0; k < ui - li; k++) {
o = (k + li >= ui2) ? o + 1 : o;
ui2 = freq_band_table_noise[o + 1];
nrg_est_pvc[c][t] = (!int_mode) ? nrg : nrg_est_pvc[c][t];
nrg_tone_pvc[c][t] = 0.0f;
tmp = frame_data->qmapped_pvc[c][t] /
(1 + frame_data->qmapped_pvc[c][t]);
if (flag) {
nrg_gain_pvc[c][t] = (FLOAT32)sqrt(nrg_ref_pvc[c][t] * tmp /
(nrg_est_pvc[c][t] + 1));
nrg_tone_pvc[c][t] = (FLOAT32)(
(harmonics[c] && (t >= frame_data->sine_position ||
(*harm_flag_prev)[c + sub_band_start]))
? sqrt(nrg_ref_pvc[c][t] * tmp /
frame_data->qmapped_pvc[c][t])
: nrg_tone_pvc[c][t]);
nrg_tone_pvc[c][t] = (FLOAT32)(
((*harm_flag_varlen)[c] &&
(t >= frame_data->sin_start_for_cur_top ||
(*harm_flag_varlen_prev)[c + sub_band_start]))
? sqrt(nrg_ref_pvc[c][t] * tmp / prev_env_noise_level[o])
: nrg_tone_pvc[c][t]);
} else {
if (noise_absc_flag) {
nrg_gain_pvc[c][t] =
(FLOAT32)sqrt(nrg_ref_pvc[c][t] / (nrg_est_pvc[c][t] + 1));
} else {
nrg_gain_pvc[c][t] = (FLOAT32)sqrt(
nrg_ref_pvc[c][t] * tmp /
((nrg_est_pvc[c][t] + 1) * frame_data->qmapped_pvc[c][t]));
}
}
noise_level_pvc[c][t] = (FLOAT32)sqrt(nrg_ref_pvc[c][t] * tmp);
c++;
}
}
for (c = 0; c < (*gate_mode)[limiter_band]; c++) {
p_ref = p_est = 0.0f;
p_adj = 0;
for (k = (*lim_table)[limiter_band][c];
k < (*lim_table)[limiter_band][c + 1]; k++) {
p_ref += nrg_ref_pvc[k][t];
p_est += nrg_est_pvc[k][t];
}
avg_gain = (FLOAT32)sqrt((p_ref + EPS) / (p_est + EPS));
g_max = avg_gain * ixheaacd_g_lim_gains[limiter_gains];
g_max > 1.0e5f ? g_max = 1.0e5f : 0;
for (k = (*lim_table)[limiter_band][c];
k < (*lim_table)[limiter_band][c + 1]; k++) {
if (g_max <= nrg_gain_pvc[k][t]) {
noise_level_pvc[k][t] =
noise_level_pvc[k][t] * (g_max / nrg_gain_pvc[k][t]);
nrg_gain_pvc[k][t] = g_max;
}
p_adj +=
nrg_gain_pvc[k][t] * nrg_gain_pvc[k][t] * nrg_est_pvc[k][t];
if (nrg_tone_pvc[k][t]) {
p_adj += nrg_tone_pvc[k][t] * nrg_tone_pvc[k][t];
} else if (!noise_absc_flag) {
p_adj += noise_level_pvc[k][t] * noise_level_pvc[k][t];
}
}
boost_gain = (FLOAT32)sqrt((p_ref + EPS) / (p_adj + EPS));
boost_gain = boost_gain > 1.584893192f ? 1.584893192f : boost_gain;
for (k = (*lim_table)[limiter_band][c];
k < (*lim_table)[limiter_band][c + 1]; k++) {
nrg_gain_pvc[k][t] *= boost_gain;
noise_level_pvc[k][t] *= boost_gain;
nrg_tone_pvc[k][t] *= boost_gain;
}
}
}
for (; t < end_pos; t++) {
band_loop_end = num_sf_bands[pvc_frame_info->freq_res[i]];
for (c = 0, o = 0, j = 0; j < band_loop_end; j++) {
double tmp;
li = freq_band_table[pvc_frame_info->freq_res[i]][j];
ui = freq_band_table[pvc_frame_info->freq_res[i]][j + 1];
ui2 = frame_data->pstr_sbr_header->pstr_freq_band_data
->freq_band_tbl_noise[o + 1];
for (flag = 0, k = li; k < ui; k++) {
flag = (harmonics[c] && (t >= frame_data->sine_position ||
(*harm_flag_prev)[c + sub_band_start]))
? 1
: flag;
nrg_ref_pvc[c][t] = env_tmp[k][t];
for (nrg = 0, l = 0; l < rate; l++) {
nrg +=
(input_real[rate * t + l][k] * input_real[rate * t + l][k]) +
(input_imag[rate * t + l][k] * input_imag[rate * t + l][k]);
}
nrg_est_pvc[c][t] = nrg / rate;
c++;
}
if (!int_mode) {
for (nrg = 0, k = c - (ui - li); k < c; k++) {
nrg += nrg_est_pvc[k][t];
}
nrg /= (ui - li);
}
c -= (ui - li);
for (k = 0; k < ui - li; k++) {
o = (k + li >= ui2) ? o + 1 : o;
ui2 = freq_band_table_noise[o + 1];
nrg_est_pvc[c][t] = (!int_mode) ? nrg : nrg_est_pvc[c][t];
nrg_tone_pvc[c][t] = 0.0f;
tmp = frame_data->qmapped_pvc[c][t] /
(1 + frame_data->qmapped_pvc[c][t]);
if (flag) {
nrg_gain_pvc[c][t] = (FLOAT32)sqrt(nrg_ref_pvc[c][t] * tmp /
(nrg_est_pvc[c][t] + 1));
nrg_tone_pvc[c][t] = (FLOAT32)(
(harmonics[c] && (t >= frame_data->sine_position ||
(*harm_flag_prev)[c + sub_band_start]))
? sqrt(nrg_ref_pvc[c][t] * tmp /
frame_data->qmapped_pvc[c][t])
: nrg_tone_pvc[c][t]);
} else {
if (noise_absc_flag) {
nrg_gain_pvc[c][t] =
(FLOAT32)sqrt(nrg_ref_pvc[c][t] / (nrg_est_pvc[c][t] + 1));
} else {
nrg_gain_pvc[c][t] = (FLOAT32)sqrt(
nrg_ref_pvc[c][t] * tmp /
((nrg_est_pvc[c][t] + 1) * frame_data->qmapped_pvc[c][t]));
}
}
noise_level_pvc[c][t] = (FLOAT32)sqrt(nrg_ref_pvc[c][t] * tmp);
c++;
}
}
for (c = 0; c < (*gate_mode)[limiter_band]; c++) {
p_ref = p_est = 0.0f;
p_adj = 0;
for (k = (*lim_table)[limiter_band][c];
k < (*lim_table)[limiter_band][c + 1]; k++) {
p_ref += nrg_ref_pvc[k][t];
p_est += nrg_est_pvc[k][t];
}
avg_gain = (FLOAT32)sqrt((p_ref + EPS) / (p_est + EPS));
g_max = avg_gain * ixheaacd_g_lim_gains[limiter_gains];
g_max > 1.0e5f ? g_max = 1.0e5f : 0;
for (k = (*lim_table)[limiter_band][c];
k < (*lim_table)[limiter_band][c + 1]; k++) {
if (g_max <= nrg_gain_pvc[k][t]) {
noise_level_pvc[k][t] =
noise_level_pvc[k][t] * (g_max / nrg_gain_pvc[k][t]);
nrg_gain_pvc[k][t] = g_max;
}
p_adj +=
nrg_gain_pvc[k][t] * nrg_gain_pvc[k][t] * nrg_est_pvc[k][t];
if (nrg_tone_pvc[k][t]) {
p_adj += nrg_tone_pvc[k][t] * nrg_tone_pvc[k][t];
} else if (!noise_absc_flag) {
p_adj += noise_level_pvc[k][t] * noise_level_pvc[k][t];
}
}
boost_gain = (FLOAT32)sqrt((p_ref + EPS) / (p_adj + EPS));
boost_gain = boost_gain > 1.584893192f ? 1.584893192f : boost_gain;
for (k = (*lim_table)[limiter_band][c];
k < (*lim_table)[limiter_band][c + 1]; k++) {
nrg_gain_pvc[k][t] *= boost_gain;
noise_level_pvc[k][t] *= boost_gain;
nrg_tone_pvc[k][t] *= boost_gain;
}
}
}
if (esbr_start_up_pvc) {
for (n = 0; n < 4; n++) {
for (c = 0; c < num_subbands; c++) {
(*e_gain)[n][c] = nrg_gain_pvc[c][start_pos];
(*noise_buf)[n][c] = noise_level_pvc[c][start_pos];
}
}
esbr_start_up_pvc = 0;
esbr_start_up = 0;
}
for (l = rate * pvc_frame_info->border_vec[i];
l < rate * pvc_frame_info->border_vec[1 + i]; l++) {
ptr_real_buf = *(input_real + l) + sub_band_start;
ptr_imag_buf = *(input_imag + l) + sub_band_start;
slot_idx = (WORD32)l / rate;
if (sub_band_start & 1) {
freq_inv = -1;
}
for (k = 0; k < num_subbands; k++) {
(*e_gain)[4][k] = nrg_gain_pvc[k][slot_idx];
(*noise_buf)[4][k] = noise_level_pvc[k][slot_idx];
c = 0, sb_gain = 0, sb_noise = 0;
for (n = 4 - smooth_length; n <= 4; n++) {
sb_gain += (*e_gain)[n][k] * smooth_filt[c];
sb_noise += (*noise_buf)[n][k] * smooth_filt[c++];
}
phase_index = (phase_index + 1) & 511;
sb_noise = (nrg_tone_pvc[k][slot_idx] != 0 || noise_absc_flag)
? 0
: sb_noise;
*ptr_real_buf =
*ptr_real_buf * sb_gain +
sb_noise * ixheaacd_random_phase[phase_index][0] +
nrg_tone_pvc[k][slot_idx] * ixheaacd_hphase_tbl[0][harm_index];
*ptr_imag_buf = *ptr_imag_buf * sb_gain +
sb_noise * ixheaacd_random_phase[phase_index][1] +
nrg_tone_pvc[k][slot_idx] * freq_inv *
ixheaacd_hphase_tbl[1][harm_index];
ptr_real_buf++;
ptr_imag_buf++;
freq_inv = -freq_inv;
}
harm_index = (harm_index + 1) & 3;
memcpy(temp, (*e_gain)[0], 64 * sizeof(FLOAT32));
for (n = 0; n < 4; n++) {
memcpy((*e_gain)[n], (*e_gain)[n + 1], 64 * sizeof(FLOAT32));
}
memcpy((*e_gain)[4], temp, 64 * sizeof(FLOAT32));
memcpy(temp, (*noise_buf)[0], 64 * sizeof(FLOAT32));
for (n = 0; n < 4; n++) {
memcpy((*noise_buf)[n], (*noise_buf)[n + 1], 64 * sizeof(FLOAT32));
}
memcpy((*noise_buf)[4], temp, 64 * sizeof(FLOAT32));
}
}
} else {
for (i = 0; i < num_sf_bands[HIGH]; i++) {
li =
frame_data->pstr_sbr_header->pstr_freq_band_data->freq_band_tbl_hi[i];
ui = frame_data->pstr_sbr_header->pstr_freq_band_data
->freq_band_tbl_hi[i + 1];
tmp = ((ui + li) - (sub_band_start << 1)) >> 1;
if ((tmp >= 64) || (tmp < 0)) return -1;
harmonics[tmp] = add_harmonics[i];
}
for (i = 0; i < bs_num_env; i++) {
if (kk > MAX_NOISE_ENVELOPES) return IA_FATAL_ERROR;
if (p_frame_info->border_vec[i] == p_frame_info->noise_border_vec[kk])
kk++, next++;
noise_absc_flag =
(i == trans_env || i == frame_data->env_short_flag_prev) ? 1 : 0;
smooth_length = (noise_absc_flag ? 0 : smoothing_length);
smooth_filt = *ixheaacd_fir_table[smooth_length];
if (sbr_mode == ORIG_SBR) {
for (c = 0, o = 0, j = 0; j < num_sf_bands[p_frame_info->freq_res[i]];
j++) {
double tmp;
li = freq_band_table[p_frame_info->freq_res[i]][j];
ui = freq_band_table[p_frame_info->freq_res[i]][j + 1];
ui2 = frame_data->pstr_sbr_header->pstr_freq_band_data
->freq_band_tbl_noise[o + 1];
for (flag = 0, k = li; k < ui; k++) {
for (nrg = 0, l = rate * p_frame_info->border_vec[i];
l < rate * p_frame_info->border_vec[i + 1]; l++) {
nrg += (input_real[l][k] * input_real[l][k]) +
(input_imag[l][k] * input_imag[l][k]);
}
flag = (harmonics[c] &&
(i >= trans_env || (*harm_flag_prev)[c + sub_band_start]))
? 1
: flag;
nrg_est[c++] = nrg / (rate * p_frame_info->border_vec[i + 1] -
rate * p_frame_info->border_vec[i]);
}
if (!int_mode) {
for (nrg = 0, k = c - (ui - li); k < c; k++) {
nrg += nrg_est[k];
}
nrg /= (ui - li);
}
c -= (ui - li);
for (k = 0; k < ui - li; k++) {
o = (k + li >= ui2) ? o + 1 : o;
ui2 = frame_data->pstr_sbr_header->pstr_freq_band_data
->freq_band_tbl_noise[o + 1];
nrg_ref[c] = sfb_nrg[m];
nrg_est[c] = (!int_mode) ? nrg : nrg_est[c];
nrg_tone[c] = 0;
tmp = noise_floor[next * num_nf_bands + o] /
(1 + noise_floor[next * num_nf_bands + o]);
if (flag) {
nrg_gain[c] = (FLOAT32)sqrt(nrg_ref[c] * tmp / (nrg_est[c] + 1));
nrg_tone[c] = (FLOAT32)(
(harmonics[c] &&
(i >= trans_env || (*harm_flag_prev)[c + sub_band_start]))
? sqrt(nrg_ref[c] * tmp /
noise_floor[next * num_nf_bands + o])
: nrg_tone[c]);
} else {
if (noise_absc_flag)
nrg_gain[c] = (FLOAT32)sqrt(nrg_ref[c] / (nrg_est[c] + 1));
else
nrg_gain[c] =
(FLOAT32)sqrt(nrg_ref[c] * tmp /
((nrg_est[c] + 1) *
(noise_floor[next * num_nf_bands + o])));
}
noise_level[c] = (FLOAT32)sqrt(nrg_ref[c] * tmp);
c++;
}
m++;
}
for (c = 0; c < (*gate_mode)[limiter_band]; c++) {
p_ref = p_est = 0;
for (k = (*lim_table)[limiter_band][c];
k < (*lim_table)[limiter_band][c + 1]; k++) {
p_ref += nrg_ref[k];
p_est += nrg_est[k];
}
avg_gain = (FLOAT32)sqrt((p_ref + EPS) / (p_est + EPS));
g_max = avg_gain * ixheaacd_g_lim_gains[limiter_gains];
g_max > 1.0e5f ? g_max = 1.0e5f : 0;
for (k = (*lim_table)[limiter_band][c];
k < (*lim_table)[limiter_band][c + 1]; k++) {
if (g_max <= nrg_gain[k]) {
noise_level[k] = noise_level[k] * (g_max / nrg_gain[k]);
nrg_gain[k] = g_max;
}
}
p_adj = 0;
for (k = (*lim_table)[limiter_band][c];
k < (*lim_table)[limiter_band][c + 1]; k++) {
p_adj += nrg_gain[k] * nrg_gain[k] * nrg_est[k];
if (nrg_tone[k])
p_adj += nrg_tone[k] * nrg_tone[k];
else if (!noise_absc_flag)
p_adj += noise_level[k] * noise_level[k];
}
boost_gain = (FLOAT32)sqrt((p_ref + EPS) / (p_adj + EPS));
boost_gain = boost_gain > 1.584893192f ? 1.584893192f : boost_gain;
for (k = (*lim_table)[limiter_band][c];
k < (*lim_table)[limiter_band][c + 1]; k++) {
nrg_gain[k] *= boost_gain;
noise_level[k] *= boost_gain;
nrg_tone[k] *= boost_gain;
}
}
if (esbr_start_up) {
for (n = 0; n < 4; n++) {
memcpy((*e_gain)[n], nrg_gain, num_subbands * sizeof(FLOAT32));
memcpy((*noise_buf)[n], noise_level,
num_subbands * sizeof(FLOAT32));
}
esbr_start_up = 0;
esbr_start_up_pvc = 0;
}
for (l = rate * p_frame_info->border_vec[i];
l < rate * p_frame_info->border_vec[i + 1]; l++) {
ptr_real_buf = *(input_real + l) + sub_band_start;
ptr_imag_buf = *(input_imag + l) + sub_band_start;
for (k = 0; k < num_subbands; k++) {
(*e_gain)[4][k] = nrg_gain[k];
(*noise_buf)[4][k] = noise_level[k];
c = 0, sb_gain = 0, sb_noise = 0;
for (n = 4 - smooth_length; n <= 4; n++) {
sb_gain += (*e_gain)[n][k] * smooth_filt[c];
sb_noise += (*noise_buf)[n][k] * smooth_filt[c++];
}
phase_index = (phase_index + 1) & 511;
sb_noise = (nrg_tone[k] != 0 || noise_absc_flag) ? 0 : sb_noise;
*ptr_real_buf = *ptr_real_buf * sb_gain +
sb_noise * ixheaacd_random_phase[phase_index][0];
*ptr_imag_buf = *ptr_imag_buf * sb_gain +
sb_noise * ixheaacd_random_phase[phase_index][1];
ptr_real_buf++;
ptr_imag_buf++;
}
memcpy(temp, (*e_gain)[0], 64 * sizeof(FLOAT32));
for (n = 0; n < 4; n++)
memcpy((*e_gain)[n], (*e_gain)[n + 1], 64 * sizeof(FLOAT32));
memcpy((*e_gain)[4], temp, 64 * sizeof(FLOAT32));
memcpy(temp, (*noise_buf)[0], 64 * sizeof(FLOAT32));
for (n = 0; n < 4; n++)
memcpy((*noise_buf)[n], (*noise_buf)[n + 1], 64 * sizeof(FLOAT32));
memcpy((*noise_buf)[4], temp, 64 * sizeof(FLOAT32));
}
ixheaacd_apply_inter_tes(
*(input_real1 + rate * p_frame_info->border_vec[i]),
*(input_imag1 + rate * p_frame_info->border_vec[i]),
*(input_real + rate * p_frame_info->border_vec[i]),
*(input_imag + rate * p_frame_info->border_vec[i]),
rate * p_frame_info->border_vec[i + 1] -
rate * p_frame_info->border_vec[i],
sub_band_start, num_subbands, frame_data->inter_temp_shape_mode[i]);
for (l = rate * p_frame_info->border_vec[i];
l < rate * p_frame_info->border_vec[i + 1]; l++) {
ptr_real_buf = *(input_real + l) + sub_band_start;
ptr_imag_buf = *(input_imag + l) + sub_band_start;
if (sub_band_start & 1) {
freq_inv = -1;
}
for (k = 0; k < num_subbands; k++) {
*ptr_real_buf += nrg_tone[k] * ixheaacd_hphase_tbl[0][harm_index];
*ptr_imag_buf +=
nrg_tone[k] * freq_inv * ixheaacd_hphase_tbl[1][harm_index];
ptr_real_buf++;
ptr_imag_buf++;
freq_inv = -freq_inv;
}
harm_index = (harm_index + 1) & 3;
}
}
}
}
for (i = 0; i < 64; i++) {
(*harm_flag_varlen_prev)[i] = (*harm_flag_prev)[i];
(*harm_flag_varlen)[i] = harmonics[i];
}
memcpy(&((*harm_flag_prev)[0]) + sub_band_start, harmonics,
(64 - sub_band_start) * sizeof(WORD8));
if (trans_env == bs_num_env) {
frame_data->env_short_flag_prev = 0;
} else {
frame_data->env_short_flag_prev = -1;
}
memcpy((VOID *)&frame_data->str_frame_info_prev,
(VOID *)&frame_data->str_frame_info_details,
sizeof(ia_frame_info_struct));
if (frame_data->str_frame_info_details.num_env == 1) {
frame_data->var_len_id_prev = 0;
} else if (frame_data->str_frame_info_details.num_env == 2) {
frame_data->var_len_id_prev = 1;
}
for (i = 0; i < num_nf_bands; i++) {
prev_env_noise_level[i] =
frame_data->flt_noise_floor
[(frame_data->str_frame_info_details.num_noise_env - 1) *
num_nf_bands +
i];
}
frame_data->harm_index = harm_index;
frame_data->phase_index = phase_index;
frame_data->pstr_sbr_header->esbr_start_up = esbr_start_up;
frame_data->pstr_sbr_header->esbr_start_up_pvc = esbr_start_up_pvc;
return 0;
}
IA_ERRORCODE ixheaacd_createlimiterbands(
WORD32 lim_table[4][12 + 1], WORD32 gate_mode[4], WORD16 *freq_band_tbl,
WORD32 ixheaacd_num_bands, WORD32 x_over_qmf[MAX_NUM_PATCHES],
WORD32 b_patching_mode, WORD32 upsamp_4_flag,
struct ixheaacd_lpp_trans_patch *patch_param) {
WORD32 i, j, k, is_patch_border[2];
WORD32 patch_borders[MAX_NUM_PATCHES + 1];
WORD32 temp_limiter_band_calc[32 + MAX_NUM_PATCHES + 1];
double num_octave;
WORD32 num_patches;
WORD32 sub_band_start = freq_band_tbl[0];
WORD32 sub_band_end = freq_band_tbl[ixheaacd_num_bands];
const double log2 = log(2.0);
const double limbnd_per_oct[4] = {0, 1.2, 2.0, 3.0};
if (!b_patching_mode && (x_over_qmf != NULL)) {
num_patches = 0;
if (upsamp_4_flag) {
for (i = 1; i < MAX_NUM_PATCHES; i++)
if (x_over_qmf[i] != 0) num_patches++;
} else {
for (i = 1; i < 4; i++)
if (x_over_qmf[i] != 0) num_patches++;
}
for (i = 0; i < num_patches; i++) {
patch_borders[i] = x_over_qmf[i] - sub_band_start;
}
} else {
num_patches = patch_param->num_patches;
for (i = 0; i < num_patches; i++) {
patch_borders[i] = patch_param->start_subband[i] - sub_band_start;
}
}
patch_borders[i] = sub_band_end - sub_band_start;
lim_table[0][0] = freq_band_tbl[0] - sub_band_start;
lim_table[0][1] = freq_band_tbl[ixheaacd_num_bands] - sub_band_start;
gate_mode[0] = 1;
for (i = 1; i < 4; i++) {
for (k = 0; k <= ixheaacd_num_bands; k++) {
temp_limiter_band_calc[k] = freq_band_tbl[k] - sub_band_start;
}
for (k = 1; k < num_patches; k++) {
temp_limiter_band_calc[ixheaacd_num_bands + k] = patch_borders[k];
}
gate_mode[i] = ixheaacd_num_bands + num_patches - 1;
ixheaacd_shellsort(temp_limiter_band_calc, gate_mode[i] + 1);
for (j = 1; j <= gate_mode[i]; j++) {
num_octave = log((double)(temp_limiter_band_calc[j] + sub_band_start) /
(temp_limiter_band_calc[j - 1] + sub_band_start)) /
log2;
if (num_octave * limbnd_per_oct[i] < 0.49) {
if (temp_limiter_band_calc[j] == temp_limiter_band_calc[j - 1]) {
temp_limiter_band_calc[j] = sub_band_end;
ixheaacd_shellsort(temp_limiter_band_calc, gate_mode[i] + 1);
gate_mode[i]--;
j--;
continue;
}
is_patch_border[0] = is_patch_border[1] = 0;
for (k = 0; k <= num_patches; k++) {
if (temp_limiter_band_calc[j - 1] == patch_borders[k]) {
is_patch_border[0] = 1;
break;
}
}
for (k = 0; k <= num_patches; k++) {
if (temp_limiter_band_calc[j] == patch_borders[k]) {
is_patch_border[1] = 1;
break;
}
}
if (!is_patch_border[1]) {
temp_limiter_band_calc[j] = sub_band_end;
ixheaacd_shellsort(temp_limiter_band_calc, gate_mode[i] + 1);
gate_mode[i]--;
j--;
} else if (!is_patch_border[0]) {
temp_limiter_band_calc[j - 1] = sub_band_end;
ixheaacd_shellsort(temp_limiter_band_calc, gate_mode[i] + 1);
gate_mode[i]--;
j--;
}
}
}
if (gate_mode[i] > 12) return IA_FATAL_ERROR;
for (k = 0; k <= gate_mode[i]; k++) {
lim_table[i][k] = temp_limiter_band_calc[k];
}
}
return IA_NO_ERROR;
}
VOID ixheaacd_apply_inter_tes(FLOAT32 *qmf_real1, FLOAT32 *qmf_imag1,
FLOAT32 *qmf_real, FLOAT32 *qmf_imag,
WORD32 num_sample, WORD32 sub_band_start,
WORD32 num_subband, WORD32 gamma_idx) {
WORD32 sub_band_end = sub_band_start + num_subband;
FLOAT32 subsample_power_high[TIMESLOT_BUFFER_SIZE],
subsample_power_low[TIMESLOT_BUFFER_SIZE];
FLOAT32 total_power_high = 0.0f;
FLOAT32 total_power_low = 0.0f, total_power_high_after = 1.0e-6f;
FLOAT32 gain[TIMESLOT_BUFFER_SIZE];
FLOAT32 gain_adj, gain_adj_2;
FLOAT32 gamma = ixheaacd_q_gamma_table[gamma_idx];
WORD32 i, j;
if (gamma > 0) {
for (i = 0; i < num_sample; i++) {
memcpy(&qmf_real[64 * i], &qmf_real1[64 * i],
sub_band_start * sizeof(FLOAT32));
memcpy(&qmf_imag[64 * i], &qmf_imag1[64 * i],
sub_band_start * sizeof(FLOAT32));
}
for (i = 0; i < num_sample; i++) {
subsample_power_low[i] = 0.0f;
for (j = 0; j < sub_band_start; j++) {
subsample_power_low[i] += qmf_real[64 * i + j] * qmf_real[64 * i + j];
subsample_power_low[i] += qmf_imag[64 * i + j] * qmf_imag[64 * i + j];
}
subsample_power_high[i] = 0.0f;
for (j = sub_band_start; j < sub_band_end; j++) {
subsample_power_high[i] += qmf_real[64 * i + j] * qmf_real[64 * i + j];
subsample_power_high[i] += qmf_imag[64 * i + j] * qmf_imag[64 * i + j];
}
total_power_low += subsample_power_low[i];
total_power_high += subsample_power_high[i];
}
for (i = 0; i < num_sample; i++) {
gain[i] = (FLOAT32)(sqrt(subsample_power_low[i] * num_sample /
(total_power_low + 1.0e-6f)));
}
for (i = 0; i < num_sample; i++) {
gain[i] = (FLOAT32)(1.0f + gamma * (gain[i] - 1.0f));
}
for (i = 0; i < num_sample; i++) {
if (gain[i] < 0.2f) {
gain[i] = 0.2f;
}
subsample_power_high[i] *= gain[i] * gain[i];
total_power_high_after += subsample_power_high[i];
}
gain_adj_2 = total_power_high / total_power_high_after;
gain_adj = (FLOAT32)(sqrt(gain_adj_2));
for (i = 0; i < num_sample; i++) {
gain[i] *= gain_adj;
for (j = sub_band_start; j < sub_band_end; j++) {
qmf_real[64 * i + j] *= gain[i];
qmf_imag[64 * i + j] *= gain[i];
}
}
}
}