247 lines
		
	
	
		
			8.7 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			247 lines
		
	
	
		
			8.7 KiB
		
	
	
	
		
			C
		
	
	
	
| /******************************************************************************
 | |
|  *                                                                            *
 | |
|  * 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;
 | |
| }
 |