/****************************************************************************** * * * 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 #include #include #include "ixheaacd_sbr_common.h" #include #include "ixheaacd_constants.h" #include #include #include #include "ixheaacd_basic_ops.h" #include #include "ixheaacd_intrinsics.h" #include "ixheaacd_common_rom.h" #include "ixheaacd_basic_funcs.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 #include "ixheaacd_hybrid.h" #include "ixheaacd_ps_dec.h" #include "ixheaacd_env_extr.h" #include "ixheaacd_sbr_const.h" #include "ixheaacd_env_extr.h" #include "ixheaacd_freq_sca.h" #include "ixheaacd_intrinsics.h" WORD32 ixheaacd_samp_rate_table[12] = {92017, 75132, 55426, 46009, 37566, 27713, 23004, 18783, 13856, 11502, 9391, 16428320}; WORD32 ixheaacd_v_offset_40[16] = {3 + 1, 2 + 1, 2 + 1, 2 + 1, 2 + 1, 2 + 1, 2 + 1, 2 + 1, 2 + 1, 2 + 1, 2 + 1, 2 + 1, 2 + 1, 2 + 1, 1 + 1, 0}; static WORD32 ixheaacd_int_div(WORD32 num, WORD32 den) { if (den != 0) { WORD32 result = 0; WORD32 temp = 0; while (den <= num) { temp = 0; while (num >= (den << (temp + 1))) { temp++; } result = result + (1 << temp); num = num - (den * (1 << temp)); } return result; } else { return 0; } } VOID ixheaacd_aac_shellsort(WORD16 *in, WORD32 n) { WORD32 i, j; WORD32 inc; WORD32 v, w; inc = 1; do { inc = (((inc << 1) + inc) + 1); } while (inc <= n); do { inc = (ixheaacd_int_div(inc, 3)); for (i = inc; i < n; i++) { v = in[i]; j = i; while ((w = in[(j - inc)]) > v) { in[j] = w; j = (j - inc); if (j < inc) break; } in[j] = v; } } while (inc > 1); } WORD32 ixheaacd_calc_start_band(WORD32 fs, const WORD32 start_freq, FLOAT32 upsamp_fac) { WORD32 k0_min; WORD32 fs_mapped = 0; if (upsamp_fac == 4) { fs = fs / 2; } if (fs >= 0 && fs < 18783) { fs_mapped = 16000; } else if (fs >= 18783 && fs < 23004) { fs_mapped = 22050; } else if (fs >= 23004 && fs < 27713) { fs_mapped = 24000; } else if (fs >= 27713 && fs < 35777) { fs_mapped = 32000; } else if (fs >= 35777 && fs < 42000) { fs_mapped = 40000; } else if (fs >= 42000 && fs < 46009) { fs_mapped = 44100; } else if (fs >= 46009 && fs < 55426) { fs_mapped = 48000; } else if (fs >= 55426 && fs < 75132) { fs_mapped = 64000; } else if (fs >= 75132 && fs < 92017) { fs_mapped = 88200; } else if (fs >= 92017) { fs_mapped = 96000; } else { return -1; } if (upsamp_fac == 4) { if (fs_mapped < 32000) { k0_min = (WORD32)(((FLOAT32)(3000 * 2 * 32) / fs_mapped) + 0.5); } else { if (fs_mapped < 64000) { k0_min = (WORD32)(((FLOAT32)(4000 * 2 * 32) / fs_mapped) + 0.5); } else { k0_min = (WORD32)(((FLOAT32)(5000 * 2 * 32) / fs_mapped) + 0.5); } } } else { if (fs_mapped < 32000) { k0_min = (WORD32)(((FLOAT32)(3000 * 2 * 64) / fs_mapped) + 0.5); } else { if (fs_mapped < 64000) { k0_min = (WORD32)(((FLOAT32)(4000 * 2 * 64) / fs_mapped) + 0.5); } else { k0_min = (WORD32)(((FLOAT32)(5000 * 2 * 64) / fs_mapped) + 0.5); } } } switch (fs_mapped) { case 16000: { WORD32 v_offset[] = {-8, -7, -6, -5, -4, -3, -2, -1, 0, 1, 2, 3, 4, 5, 6, 7}; return (k0_min + v_offset[start_freq]); } break; case 22050: { WORD32 v_offset[] = {-5, -4, -3, -2, -1, 0, 1, 2, 3, 4, 5, 6, 7, 9, 11, 13}; return (k0_min + v_offset[start_freq]); } break; case 24000: { WORD32 v_offset[] = {-5, -3, -2, -1, 0, 1, 2, 3, 4, 5, 6, 7, 9, 11, 13, 16}; return (k0_min + v_offset[start_freq]); } break; case 32000: { WORD32 v_offset[] = {-6, -4, -2, -1, 0, 1, 2, 3, 4, 5, 6, 7, 9, 11, 13, 16}; return (k0_min + v_offset[start_freq]); } break; case 40000: { WORD32 v_offset[] = {-1, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 11, 13, 15, 17, 19}; return (k0_min + v_offset[start_freq]); } break; case 44100: case 48000: case 64000: { WORD32 v_offset[] = {-4, -2, -1, 0, 1, 2, 3, 4, 5, 6, 7, 9, 11, 13, 16, 20}; return (k0_min + v_offset[start_freq]); } break; case 88200: case 96000: { WORD32 v_offset[] = {-2, -1, 0, 1, 2, 3, 4, 5, 6, 7, 9, 11, 13, 16, 20, 24}; return (k0_min + v_offset[start_freq]); } break; default: { WORD32 v_offset[] = {0, 1, 2, 3, 4, 5, 6, 7, 9, 11, 13, 16, 20, 24, 28, 33}; return (k0_min + v_offset[start_freq]); } } } WORD32 ixheaacd_calc_stop_band(WORD32 fs, const WORD32 stop_freq, FLOAT32 upsamp_fac) { WORD32 result, i; WORD16 arr_stop_freq[14]; WORD32 k1_min; WORD16 arr_diff_stop_freq[13]; if (upsamp_fac == 4) { fs = fs / 2; if (fs < 32000) { k1_min = (WORD32)(((FLOAT32)(6000 * 2 * 32) / fs) + 0.5); } else { if (fs < 64000) { k1_min = (WORD32)(((FLOAT32)(8000 * 2 * 32) / fs) + 0.5); } else { k1_min = (WORD32)(((FLOAT32)(10000 * 2 * 32) / fs) + 0.5); } } } else { if (fs < 32000) { k1_min = (WORD32)(((FLOAT32)(6000 * 2 * 64) / fs) + 0.5); } else { if (fs < 64000) { k1_min = (WORD32)(((FLOAT32)(8000 * 2 * 64) / fs) + 0.5); } else { k1_min = (WORD32)(((FLOAT32)(10000 * 2 * 64) / fs) + 0.5); } } } /*Calculate stop frequency vector*/ for (i = 0; i <= 13; i++) { arr_stop_freq[i] = (WORD32)(k1_min * pow(64.0 / k1_min, i / 13.0) + 0.5); } /*Ensure increasing bandwidth */ for (i = 0; i <= 12; i++) { arr_diff_stop_freq[i] = arr_stop_freq[i + 1] - arr_stop_freq[i]; } ixheaacd_aac_shellsort(&arr_diff_stop_freq[0], 13); /*Sort bandwidth changes */ result = k1_min; for (i = 0; i < stop_freq; i++) { result = result + arr_diff_stop_freq[i]; } return (result); } void ixheaacd_calc_k0_k2_bands(const WORD32 samp_freq, const WORD32 start_freq, const WORD32 stop_freq, FLOAT32 upsamp_fac, WORD16 *ptr_k0, WORD16 *ptr_k2) { /* Update start_freq struct */ *ptr_k0 = ixheaacd_calc_start_band(samp_freq, start_freq, upsamp_fac); /*Update stop_freq struct */ if (stop_freq < 14) { *ptr_k2 = ixheaacd_calc_stop_band(samp_freq, stop_freq, upsamp_fac); } else if (stop_freq == 14) { *ptr_k2 = 2 * (*ptr_k0); } else { *ptr_k2 = 3 * (*ptr_k0); } /* limit to Nyqvist */ if (*ptr_k2 > 64) { *ptr_k2 = 64; } } WORD16 ixheaacd_calc_master_frq_bnd_tbl( ia_freq_band_data_struct *pstr_freq_band_data, ia_sbr_header_data_struct *ptr_header_data, ixheaacd_misc_tables *pstr_common_tables) { WORD32 k; WORD32 fs = ptr_header_data->out_sampling_freq; WORD16 bands; WORD16 k0 = 0, k2 = 0, k1; WORD32 k2_achived; WORD32 k2_diff; WORD32 incr; WORD32 dk; WORD16 vec_dk[MAX_OCTAVE + MAX_SECOND_REGION]; WORD16 *vec_dk0 = &vec_dk[0]; WORD16 *vec_dk1 = &vec_dk[MAX_OCTAVE]; WORD16 upsamp_fac = ptr_header_data->upsamp_fac; WORD16 *f_master_tbl = pstr_freq_band_data->f_master_tbl; WORD16 num_mf_bands; k1 = 0; incr = 0; dk = 0; ixheaacd_calc_k0_k2_bands(fs, ptr_header_data->start_freq, ptr_header_data->stop_freq, upsamp_fac, &k0, &k2); if (k2 > NO_SYNTHESIS_CHANNELS) { k2 = NO_SYNTHESIS_CHANNELS; } if (upsamp_fac == 4) { if ((sub_d(k2, k0) > MAX_FREQ_COEFFS) || (k2 <= k0)) { return -1; } if ((2 * fs == 44100) && (sub_d(k2, k0) > MAX_FREQ_COEFFS)) { return -1; } if ((2 * fs >= 48000) && (sub_d(k2, k0) > MAX_FREQ_COEFFS)) { return -1; } } else { if ((sub_d(k2, k0) > MAX_FREQ_COEFFS_SBR) || (k2 <= k0)) { return -1; } if ((fs == 44100) && (sub_d(k2, k0) > MAX_FREQ_COEFFS_FS44100)) { return -1; } if ((fs >= 48000) && (sub_d(k2, k0) > MAX_FREQ_COEFFS_FS48000)) { return -1; } } if (ptr_header_data->freq_scale == 0) { WORD16 num_bands; if (ptr_header_data->alter_scale == 0) { dk = 1; num_bands = (WORD16)(k2 - k0); num_bands = num_bands - (num_bands & 0x1); } else { dk = 2; num_bands = (WORD16)((k2 - k0) + 2) >> 2; num_bands = num_bands << 1; } if (num_bands < 1) { return -1; } k2_achived = k0 + (num_bands << (dk - 1)); k2_diff = k2 - k2_achived; for (k = 0; k < num_bands; k++) { vec_dk[k] = dk; } if (k2_diff < 0) { incr = 1; k = 0; } if (k2_diff > 0) { incr = -1; k = sub_d(num_bands, 1); } while (k2_diff != 0) { vec_dk[k] = vec_dk[k] - incr; k = (WORD16)(k + incr); k2_diff = k2_diff + incr; } f_master_tbl[0] = k0; for (k = 1; k <= num_bands; k++) f_master_tbl[k] = f_master_tbl[k - 1] + vec_dk[k - 1]; num_mf_bands = num_bands; } else { WORD32 num_bands0; WORD32 num_bands1; switch (ptr_header_data->freq_scale) { case 1: bands = 12; break; case 2: bands = 10; break; case 3: bands = 8; break; default: bands = 8; }; if ((upsamp_fac == 4) && (k0 < bands)) { bands = ((WORD32)(k0 - (k0 & 1))); } if ((WORD32)(10000 * k2) > (WORD32)(22449 * k0)) { k1 = k0 << 1; num_bands0 = bands; num_bands1 = pstr_common_tables->log_dual_is_table[k2] - pstr_common_tables->log_dual_is_table[k1]; num_bands1 = bands * num_bands1; if (ptr_header_data->alter_scale) { num_bands1 = num_bands1 * (0x6276); num_bands1 = num_bands1 >> 15; } num_bands1 = num_bands1 + 0x1000; num_bands1 = num_bands1 >> 13; num_bands1 = num_bands1 << 1; if (num_bands0 < 1) { return -1; } if (num_bands1 < 1) { return -1; } ixheaacd_calc_bands(vec_dk0, k0, k1, (WORD16)num_bands0); ixheaacd_aac_shellsort(vec_dk0, num_bands0); if (vec_dk0[0] == 0) { return -1; } f_master_tbl[0] = k0; for (k = 1; k <= num_bands0; k++) f_master_tbl[k] = f_master_tbl[k - 1] + vec_dk0[k - 1]; ixheaacd_calc_bands(vec_dk1, k1, k2, (WORD16)num_bands1); ixheaacd_aac_shellsort(vec_dk1, num_bands1); if (vec_dk1[0] < vec_dk0[num_bands0 - 1]) { WORD16 change = vec_dk0[num_bands0 - 1] - vec_dk1[0]; WORD16 temp = vec_dk1[num_bands1 - 1] - vec_dk1[0]; temp = temp >> 1; if (change > temp) { change = temp; } vec_dk1[0] = vec_dk1[0] + change; vec_dk1[num_bands1 - 1] = vec_dk1[num_bands1 - 1] - change; ixheaacd_aac_shellsort(vec_dk1, num_bands1); } f_master_tbl[num_bands0] = k1; for (k = 1; k <= num_bands1; k++) f_master_tbl[num_bands0 + k] = f_master_tbl[num_bands0 + k - 1] + vec_dk1[k - 1]; num_mf_bands = add_d(num_bands0, num_bands1); } else { k1 = k2; num_bands0 = pstr_common_tables->log_dual_is_table[k1] - pstr_common_tables->log_dual_is_table[k0]; num_bands0 = bands * num_bands0; num_bands0 = num_bands0 + 0x1000; num_bands0 = num_bands0 >> 13; num_bands0 = num_bands0 << 1; if (num_bands0 < 1) { return -1; } ixheaacd_calc_bands(vec_dk0, k0, k1, (WORD16)num_bands0); ixheaacd_aac_shellsort(vec_dk0, num_bands0); if (vec_dk0[0] == 0) { return -1; } f_master_tbl[0] = k0; for (k = 1; k <= num_bands0; k++) f_master_tbl[k] = f_master_tbl[k - 1] + vec_dk0[k - 1]; num_mf_bands = num_bands0; } } if (num_mf_bands < 1) { return -1; } pstr_freq_band_data->num_mf_bands = num_mf_bands; return 0; } static WORD16 ixheaacd_calc_freq_ratio(WORD16 k_start, WORD16 k_stop, WORD16 num_bands) { WORD32 bandfactor; WORD32 step; WORD32 direction; WORD32 start; WORD32 stop; WORD32 temp; WORD32 j, i; bandfactor = 0x3f000000L; step = 0x20000000L; direction = 1; start = ixheaacd_shl32(ixheaacd_deposit16l_in32(k_start), INT_BITS - 8); stop = ixheaacd_shl32(ixheaacd_deposit16l_in32(k_stop), INT_BITS - 8); i = 0; do { i = i + 1; temp = stop; for (j = 0; j < num_bands; j++) temp = ixheaacd_mult16x16in32_shl(ixheaacd_extract16h(temp), ixheaacd_extract16h(bandfactor)); if (temp < start) { if (direction == 0) step = ixheaacd_shr32(step, 1); direction = 1; bandfactor = ixheaacd_add32_sat(bandfactor, step); } else { if (direction == 1) step = ixheaacd_shr32(step, 1); direction = 0; bandfactor = ixheaacd_sub32_sat(bandfactor, step); } if (i > 100) { step = 0; } } while (step > 0); return ixheaacd_extract16h(bandfactor); } VOID ixheaacd_calc_bands(WORD16 *diff, WORD16 start, WORD16 stop, WORD16 num_bands) { WORD32 i; WORD32 previous; WORD32 current; WORD32 temp, exact; WORD16 bandfactor = ixheaacd_calc_freq_ratio(start, stop, num_bands); previous = stop; exact = ixheaacd_shl32_sat(ixheaacd_deposit16l_in32(stop), INT_BITS - 8); for (i = num_bands - 1; i >= 0; i--) { exact = ixheaacd_mult16x16in32(ixheaacd_extract16h(exact), bandfactor); temp = ixheaacd_add32_sat(exact, 0x00400000); exact = exact << 1; current = ixheaacd_extract16l(ixheaacd_shr32(temp, (INT_BITS - 9))); diff[i] = sub_d(previous, current); previous = current; } } static VOID ixheaacd_derive_hi_lo_freq_bnd_tbls( ia_freq_band_data_struct *pstr_freq_band_data, ia_sbr_header_data_struct *ptr_header_data) { WORD16 k; WORD16 xover_band = ptr_header_data->xover_band; WORD16 *f_master_tbl = pstr_freq_band_data->f_master_tbl + xover_band; WORD16 *f_low_tbl = pstr_freq_band_data->freq_band_table[LOW]; WORD16 *f_high_tbl = pstr_freq_band_data->freq_band_table[HIGH]; WORD16 num_mf_bands = pstr_freq_band_data->num_mf_bands; WORD16 num_lf_bands, num_hf_bands; num_hf_bands = num_mf_bands - xover_band; k = 0; *f_low_tbl = *f_high_tbl = *f_master_tbl; f_low_tbl++; f_high_tbl++; f_master_tbl++; k++; if ((num_hf_bands & 1)) { *f_low_tbl = *f_high_tbl = *f_master_tbl; f_high_tbl++; f_master_tbl++; f_low_tbl++; k++; } for (; k <= num_hf_bands; k++) { *f_high_tbl = *f_master_tbl; f_high_tbl++; f_master_tbl++; k++; *f_low_tbl = *f_high_tbl = *f_master_tbl; f_high_tbl++; f_master_tbl++; f_low_tbl++; } num_lf_bands = ((num_hf_bands + 1) >> 1); pstr_freq_band_data->num_sf_bands[LOW] = num_lf_bands; pstr_freq_band_data->num_sf_bands[HIGH] = num_hf_bands; } WORD32 ixheaacd_derive_noise_freq_bnd_tbl( ia_sbr_header_data_struct *ptr_header_data, ixheaacd_misc_tables *pstr_common_tables, ia_freq_band_data_struct *pstr_freq_band_data) { WORD16 k2, kx; WORD32 temp; WORD32 num_lf_bands = pstr_freq_band_data->num_sf_bands[LOW]; WORD32 num_hf_bands = pstr_freq_band_data->num_sf_bands[HIGH]; k2 = pstr_freq_band_data->freq_band_table[HIGH][num_hf_bands]; kx = pstr_freq_band_data->freq_band_table[HIGH][0]; if (ptr_header_data->noise_bands == 0) { pstr_freq_band_data->num_nf_bands = 1; } else { temp = pstr_common_tables->log_dual_is_table[k2] - pstr_common_tables->log_dual_is_table[kx]; temp = temp * ptr_header_data->noise_bands; temp = temp + 0x800; temp = temp >> 12; if (temp == 0) { temp = 1; } pstr_freq_band_data->num_nf_bands = temp; } pstr_freq_band_data->num_if_bands = pstr_freq_band_data->num_nf_bands; if (pstr_freq_band_data->num_nf_bands > MAX_NOISE_COEFFS) { return -1; } { WORD16 i_k, k; WORD16 num, den; WORD16 *f_noise_tbl = pstr_freq_band_data->freq_band_tbl_noise; WORD16 *f_low_tbl = pstr_freq_band_data->freq_band_table[LOW]; WORD32 num_nf_bands = pstr_freq_band_data->num_nf_bands; num = num_lf_bands; den = num_nf_bands; k = 0; *f_noise_tbl = f_low_tbl[0]; f_noise_tbl++; k++; i_k = 0; for (; k <= num_nf_bands; k++) { i_k = i_k + (WORD16)ixheaacd_int_div(num, den); *f_noise_tbl = f_low_tbl[i_k]; num = num_lf_bands - i_k; den = den - 1; f_noise_tbl++; } } return 0; } WORD32 ixheaacd_calc_frq_bnd_tbls(ia_sbr_header_data_struct *ptr_header_data, ixheaacd_misc_tables *pstr_common_tables) { WORD32 err; WORD16 num_lf_bands, num_hf_bands, lsb, usb; ia_freq_band_data_struct *pstr_freq_band_data = ptr_header_data->pstr_freq_band_data; err = ixheaacd_calc_master_frq_bnd_tbl(pstr_freq_band_data, ptr_header_data, pstr_common_tables); if (err || (ptr_header_data->xover_band > pstr_freq_band_data->num_mf_bands)) { return -1; } ixheaacd_derive_hi_lo_freq_bnd_tbls(pstr_freq_band_data, ptr_header_data); num_lf_bands = pstr_freq_band_data->num_sf_bands[LOW]; num_hf_bands = pstr_freq_band_data->num_sf_bands[HIGH]; if ((num_lf_bands <= 0) || (num_lf_bands > ixheaacd_shr16(MAX_FREQ_COEFFS, 1))) { return -1; } lsb = pstr_freq_band_data->freq_band_table[LOW][0]; usb = pstr_freq_band_data->freq_band_table[LOW][num_lf_bands]; pstr_freq_band_data->sub_band_start = lsb; ptr_header_data->status = 1; if ((lsb > NO_ANALYSIS_CHANNELS) || (lsb >= usb)) { return -1; } if (ixheaacd_derive_noise_freq_bnd_tbl(ptr_header_data, pstr_common_tables, pstr_freq_band_data)) { return -1; } pstr_freq_band_data->sub_band_start = lsb; pstr_freq_band_data->sub_band_end = usb; return 0; }