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.
247 lines
8.7 KiB
247 lines
8.7 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 <stdlib.h>
|
|
#include <math.h>
|
|
|
|
#include "ixheaacd_type_def.h"
|
|
|
|
#include "ixheaacd_bitbuffer.h"
|
|
#include "ixheaacd_interface.h"
|
|
|
|
#include "ixheaacd_tns_usac.h"
|
|
#include "ixheaacd_cnst.h"
|
|
|
|
#include "ixheaacd_acelp_info.h"
|
|
|
|
#include "ixheaacd_td_mdct.h"
|
|
|
|
#include "ixheaacd_sbrdecsettings.h"
|
|
#include "ixheaacd_info.h"
|
|
#include "ixheaacd_sbr_common.h"
|
|
#include "ixheaacd_drc_data_struct.h"
|
|
#include "ixheaacd_drc_dec.h"
|
|
#include "ixheaacd_sbrdecoder.h"
|
|
#include "ixheaacd_mps_polyphase.h"
|
|
#include "ixheaacd_sbr_const.h"
|
|
|
|
#include "ixheaacd_main.h"
|
|
#include "ixheaacd_arith_dec.h"
|
|
|
|
#include "ixheaacd_func_def.h"
|
|
#include "ixheaacd_constants.h"
|
|
#include "ixheaacd_basic_ops32.h"
|
|
#include "ixheaacd_basic_ops40.h"
|
|
|
|
extern const WORD32 ixheaacd_pre_post_twid_cos_sin_512[4][512];
|
|
extern const WORD32 ixheaacd_pre_post_twid_cos_sin_384[4][384];
|
|
extern const WORD32 ixheaacd_pre_post_twid_cos_sin_256[4][256];
|
|
extern const WORD32 ixheaacd_pre_post_twid_cos_sin_192[4][192];
|
|
extern const WORD32 ixheaacd_pre_post_twid_cos_sin_128[4][128];
|
|
extern const WORD32 ixheaacd_pre_post_twid_cos_sin_96[4][96];
|
|
extern const WORD32 ixheaacd_pre_post_twid_cos_sin_64[4][64];
|
|
extern const WORD32 ixheaacd_pre_post_twid_cos_sin_48[4][48];
|
|
extern const WORD32 ixheaacd_pre_post_twid_cos_sin_32[4][32];
|
|
extern const WORD32 ixheaacd_pre_post_twid_cos_sin_24[4][24];
|
|
|
|
static PLATFORM_INLINE WORD32 ixheaacd_mul_sub64_sat_32(WORD32 a, WORD32 b,
|
|
WORD32 c, WORD32 d) {
|
|
WORD64 diff;
|
|
WORD64 temp_result1;
|
|
WORD64 temp_result2;
|
|
|
|
temp_result1 = (WORD64)a * (WORD64)c;
|
|
temp_result2 = (WORD64)b * (WORD64)d;
|
|
|
|
diff = (temp_result1 - temp_result2) >> 32;
|
|
|
|
if (diff >= 2147483647)
|
|
diff = 2147483647;
|
|
else if (diff <= -2147483647 - 1)
|
|
diff = -2147483647 - 1;
|
|
|
|
return ((WORD32)diff);
|
|
}
|
|
|
|
static PLATFORM_INLINE WORD32 ixheaacd_mul_add64_sat_32(WORD32 a, WORD32 b,
|
|
WORD32 c, WORD32 d) {
|
|
WORD64 sum;
|
|
WORD64 temp_result1;
|
|
WORD64 temp_result2;
|
|
|
|
temp_result1 = (WORD64)a * (WORD64)c;
|
|
temp_result2 = (WORD64)b * (WORD64)d;
|
|
|
|
sum = (temp_result1 + temp_result2) >> 32;
|
|
|
|
if (sum >= 2147483647)
|
|
sum = 2147483647;
|
|
else if (sum <= -2147483647 - 1)
|
|
sum = -2147483647 - 1;
|
|
|
|
return ((WORD32)sum);
|
|
}
|
|
|
|
static void ixheaacd_pre_twid(WORD32 *in, WORD32 *r_ptr, WORD32 *i_ptr,
|
|
WORD32 nlength, const WORD32 *ptr_pre_cos_sin) {
|
|
WORD32 i;
|
|
|
|
const WORD32 *cos_ptr = &ptr_pre_cos_sin[0];
|
|
const WORD32 *sin_ptr = &ptr_pre_cos_sin[nlength];
|
|
|
|
for (i = 0; i < nlength; i += 4) {
|
|
*r_ptr++ = ixheaacd_mul_sub64_sat_32(in[i], in[nlength + i], cos_ptr[i],
|
|
sin_ptr[i]);
|
|
*i_ptr++ = ixheaacd_mul_add64_sat_32(in[i], in[nlength + i], sin_ptr[i],
|
|
cos_ptr[i]);
|
|
|
|
*r_ptr++ = ixheaacd_mul_sub64_sat_32(in[i + 1], in[nlength + i + 1],
|
|
cos_ptr[i + 1], sin_ptr[i + 1]);
|
|
*i_ptr++ = ixheaacd_mul_add64_sat_32(in[i + 1], in[nlength + i + 1],
|
|
sin_ptr[i + 1], cos_ptr[i + 1]);
|
|
|
|
*r_ptr++ = ixheaacd_mul_sub64_sat_32(in[i + 2], in[nlength + i + 2],
|
|
cos_ptr[i + 2], sin_ptr[i + 2]);
|
|
*i_ptr++ = ixheaacd_mul_add64_sat_32(in[i + 2], in[nlength + i + 2],
|
|
sin_ptr[i + 2], cos_ptr[i + 2]);
|
|
|
|
*r_ptr++ = ixheaacd_mul_sub64_sat_32(in[i + 3], in[nlength + i + 3],
|
|
cos_ptr[i + 3], sin_ptr[i + 3]);
|
|
*i_ptr++ = ixheaacd_mul_add64_sat_32(in[i + 3], in[nlength + i + 3],
|
|
sin_ptr[i + 3], cos_ptr[i + 3]);
|
|
}
|
|
}
|
|
|
|
static void ixheaacd_post_twid(WORD32 *data_re, WORD32 *data_im, WORD32 *out,
|
|
WORD32 nlength, const WORD32 *ptr_post_cos_sin) {
|
|
WORD32 i;
|
|
|
|
const WORD32 *cos_ptr = &ptr_post_cos_sin[nlength * 2];
|
|
const WORD32 *sin_ptr = &ptr_post_cos_sin[nlength * 3];
|
|
|
|
WORD32 *out_ptr = &out[2 * nlength - 1];
|
|
for (i = 0; i < nlength; i += 4) {
|
|
out[0] = ixheaacd_mul_sub64_sat_32(data_re[i], data_im[i], cos_ptr[i],
|
|
sin_ptr[i]);
|
|
out_ptr[0] = -ixheaacd_mul_add64_sat_32(data_re[i], data_im[i], sin_ptr[i],
|
|
cos_ptr[i]);
|
|
|
|
out[2] = ixheaacd_mul_sub64_sat_32(data_re[i + 1], data_im[i + 1],
|
|
cos_ptr[i + 1], sin_ptr[i + 1]);
|
|
out_ptr[-2] = -ixheaacd_mul_add64_sat_32(data_re[i + 1], data_im[i + 1],
|
|
sin_ptr[i + 1], cos_ptr[i + 1]);
|
|
|
|
out[4] = ixheaacd_mul_sub64_sat_32(data_re[i + 2], data_im[i + 2],
|
|
cos_ptr[i + 2], sin_ptr[i + 2]);
|
|
out_ptr[-4] = -ixheaacd_mul_add64_sat_32(data_re[i + 2], data_im[i + 2],
|
|
sin_ptr[i + 2], cos_ptr[i + 2]);
|
|
|
|
out[6] = ixheaacd_mul_sub64_sat_32(data_re[i + 3], data_im[i + 3],
|
|
cos_ptr[i + 3], sin_ptr[i + 3]);
|
|
out_ptr[-6] = -ixheaacd_mul_add64_sat_32(data_re[i + 3], data_im[i + 3],
|
|
sin_ptr[i + 3], cos_ptr[i + 3]);
|
|
out += 8;
|
|
out_ptr -= 8;
|
|
}
|
|
}
|
|
|
|
WORD32 ixheaacd_acelp_mdct(WORD32 *ptr_in, WORD32 *ptr_out, WORD32 *preshift,
|
|
WORD32 length, WORD32 *ptr_scratch) {
|
|
WORD32 *ptr_data_r = ptr_scratch;
|
|
WORD32 *ptr_data_i = ptr_scratch + 512;
|
|
const WORD32 *ptr_pre_post_twid;
|
|
WORD32 err = 0;
|
|
|
|
switch (length) {
|
|
case 1024:
|
|
ptr_pre_post_twid = &ixheaacd_pre_post_twid_cos_sin_512[0][0];
|
|
break;
|
|
case 768:
|
|
ptr_pre_post_twid = &ixheaacd_pre_post_twid_cos_sin_384[0][0];
|
|
break;
|
|
case 512:
|
|
ptr_pre_post_twid = &ixheaacd_pre_post_twid_cos_sin_256[0][0];
|
|
break;
|
|
case 384:
|
|
ptr_pre_post_twid = &ixheaacd_pre_post_twid_cos_sin_192[0][0];
|
|
break;
|
|
case 256:
|
|
ptr_pre_post_twid = &ixheaacd_pre_post_twid_cos_sin_128[0][0];
|
|
break;
|
|
case 192:
|
|
ptr_pre_post_twid = &ixheaacd_pre_post_twid_cos_sin_96[0][0];
|
|
break;
|
|
case 128:
|
|
ptr_pre_post_twid = &ixheaacd_pre_post_twid_cos_sin_64[0][0];
|
|
break;
|
|
case 96:
|
|
ptr_pre_post_twid = &ixheaacd_pre_post_twid_cos_sin_48[0][0];
|
|
break;
|
|
case 64:
|
|
ptr_pre_post_twid = &ixheaacd_pre_post_twid_cos_sin_32[0][0];
|
|
break;
|
|
case 48:
|
|
ptr_pre_post_twid = &ixheaacd_pre_post_twid_cos_sin_24[0][0];
|
|
break;
|
|
default:
|
|
ptr_pre_post_twid = &ixheaacd_pre_post_twid_cos_sin_24[0][0];
|
|
break;
|
|
}
|
|
|
|
ixheaacd_pre_twid(ptr_in, ptr_data_r, ptr_data_i, length / 2,
|
|
ptr_pre_post_twid);
|
|
|
|
err = ixheaacd_complex_fft(ptr_data_r, ptr_data_i, length / 2, -1, preshift);
|
|
if (err) return err;
|
|
*preshift += 1;
|
|
|
|
ixheaacd_post_twid(ptr_data_r, ptr_data_i, ptr_out, length / 2,
|
|
ptr_pre_post_twid);
|
|
*preshift += 1;
|
|
return err;
|
|
}
|
|
|
|
WORD32 ixheaacd_acelp_mdct_main(ia_usac_data_struct *usac_data, WORD32 *in,
|
|
WORD32 *out, WORD32 l, WORD32 m,
|
|
WORD32 *preshift) {
|
|
WORD32 i;
|
|
WORD32 *ptr_scratch = &usac_data->scratch_buffer[0];
|
|
WORD32 *output_buffer = &usac_data->x_ac_dec[0];
|
|
WORD32 err = 0;
|
|
|
|
err = ixheaacd_acelp_mdct(in, output_buffer, preshift, l + m, ptr_scratch);
|
|
if (err == -1) return err;
|
|
|
|
for (i = 0; i < m / 2; i++) {
|
|
out[l + m / 2 - 1 - i] = -output_buffer[m / 2 + l / 2 + i];
|
|
}
|
|
for (i = 0; i < l / 2; i++) {
|
|
out[i] = output_buffer[m + l / 2 + i];
|
|
out[l - 1 - i] = -output_buffer[m + l / 2 + i];
|
|
}
|
|
for (i = 0; i < m / 2; i++) {
|
|
out[l + m / 2 + i] = -output_buffer[m / 2 + l / 2 - 1 - i];
|
|
}
|
|
for (i = 0; i < l / 2; i++) {
|
|
out[l + m + i] = -output_buffer[l / 2 - 1 - i];
|
|
out[2 * l + m - 1 - i] = -output_buffer[l / 2 - 1 - i];
|
|
}
|
|
return err;
|
|
}
|