/****************************************************************************** * * Copyright (C) 2023 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 "ixheaacd_type_def.h" #include "ixheaacd_mps_struct_def.h" #include "ixheaacd_error_codes.h" #include "ixheaacd_mps_res_rom.h" #include "ixheaacd_mps_aac_struct.h" #include "ixheaacd_constants.h" #include "ixheaacd_basic_ops32.h" #include "ixheaacd_basic_ops40.h" #include "ixheaacd_bitbuffer.h" #include "ixheaacd_common_rom.h" #include "ixheaacd_sbrdecsettings.h" #include "ixheaacd_sbr_scale.h" #include "ixheaacd_env_extr_part.h" #include "ixheaacd_sbr_rom.h" #include "ixheaacd_hybrid.h" #include "ixheaacd_ps_dec.h" #include "ixheaacd_mps_polyphase.h" #include "ixheaacd_config.h" #include "ixheaacd_qmf_dec.h" #include "ixheaacd_mps_dec.h" #include "ixheaacd_mps_defines.h" #include "ixheaacd_mps_macro_def.h" #include "ixheaacd_mps_basic_op.h" #include "ixheaacd_error_standards.h" static VOID ixheaacd_fft32(WORD32 *vec, const WORD16 *fft_c) { WORD32 tmp0, tmp1, tmp2, tmp3, tmp4, tmp5, tmp6, tmp7, tmp8, tmp9, tmp10, tmp11, tmp12, tmp13, tmp14, tmp15; WORD32 temp10, temp11, temp12, temp13, temp14, temp15, temp16, temp17, temp18, temp19, temp110, temp111, temp112, temp113, temp114, temp115; WORD32 temp20, temp21, temp22, temp23, temp24, temp25, temp26, temp27, temp28, temp29, temp210, temp211, temp212, temp213, temp214, temp215; WORD32 temp30, temp31, temp32, temp33, temp34, temp35, temp36, temp37, temp38, temp39, temp310, temp311, temp312, temp313, temp314, temp315; WORD32 temp316, temp317, temp318, temp319, temp320, temp321, temp322, temp323, temp324, temp325, temp326, temp327, temp328, temp329, temp330, temp331; WORD32 temp40, temp41, temp42, temp43, temp44, temp45, temp46, temp47, temp48, temp49, temp410, temp411, temp412, temp413, temp414, temp415; temp20 = ixheaacd_sub32_sat(vec[2], vec[34]); temp21 = ixheaacd_sub32_sat(vec[3], vec[35]); temp30 = ixheaacd_add32_sat(vec[0], vec[32]); temp31 = ixheaacd_add32_sat(vec[1], vec[33]); temp32 = ixheaacd_add32_sat(vec[2], vec[34]); temp33 = ixheaacd_add32_sat(vec[3], vec[35]); temp22 = ixheaacd_sub32_sat(vec[6], vec[38]); temp23 = ixheaacd_sub32_sat(vec[7], vec[39]); temp34 = ixheaacd_add32_sat(vec[4], vec[36]); temp35 = ixheaacd_add32_sat(vec[5], vec[37]); temp36 = ixheaacd_add32_sat(vec[6], vec[38]); temp37 = ixheaacd_add32_sat(vec[7], vec[39]); temp24 = ixheaacd_sub32_sat(vec[10], vec[42]); temp25 = ixheaacd_sub32_sat(vec[11], vec[43]); temp38 = ixheaacd_add32_sat(vec[8], vec[40]); temp39 = ixheaacd_add32_sat(vec[9], vec[41]); temp310 = ixheaacd_add32_sat(vec[10], vec[42]); temp311 = ixheaacd_add32_sat(vec[11], vec[43]); temp26 = ixheaacd_sub32_sat(vec[14], vec[46]); temp27 = ixheaacd_sub32_sat(vec[15], vec[47]); temp312 = ixheaacd_add32_sat(vec[12], vec[44]); temp313 = ixheaacd_add32_sat(vec[13], vec[45]); temp314 = ixheaacd_add32_sat(vec[14], vec[46]); temp315 = ixheaacd_add32_sat(vec[15], vec[47]); temp28 = ixheaacd_sub32_sat(vec[18], vec[50]); temp29 = ixheaacd_sub32_sat(vec[19], vec[51]); temp316 = ixheaacd_add32_sat(vec[16], vec[48]); temp317 = ixheaacd_add32_sat(vec[17], vec[49]); temp318 = ixheaacd_add32_sat(vec[18], vec[50]); temp319 = ixheaacd_add32_sat(vec[19], vec[51]); temp210 = ixheaacd_sub32_sat(vec[22], vec[54]); temp211 = ixheaacd_sub32_sat(vec[23], vec[55]); temp320 = ixheaacd_add32_sat(vec[20], vec[52]); temp321 = ixheaacd_add32_sat(vec[21], vec[53]); temp322 = ixheaacd_add32_sat(vec[22], vec[54]); temp323 = ixheaacd_add32_sat(vec[23], vec[55]); temp212 = ixheaacd_sub32_sat(vec[26], vec[58]); temp213 = ixheaacd_sub32_sat(vec[27], vec[59]); temp324 = ixheaacd_add32_sat(vec[24], vec[56]); temp325 = ixheaacd_add32_sat(vec[25], vec[57]); temp326 = ixheaacd_add32_sat(vec[26], vec[58]); temp327 = ixheaacd_add32_sat(vec[27], vec[59]); temp214 = ixheaacd_sub32_sat(vec[30], vec[62]); temp215 = ixheaacd_sub32_sat(vec[31], vec[63]); temp328 = ixheaacd_add32_sat(vec[28], vec[60]); temp329 = ixheaacd_add32_sat(vec[29], vec[61]); temp330 = ixheaacd_add32_sat(vec[30], vec[62]); temp331 = ixheaacd_add32_sat(vec[31], vec[63]); temp41 = -ixheaacd_add32_sat(temp20, temp214); temp42 = ixheaacd_sub32_sat(temp20, temp214); temp40 = ixheaacd_add32_sat(temp21, temp215); temp43 = ixheaacd_sub32_sat(temp21, temp215); temp45 = -ixheaacd_add32_sat(temp22, temp212); temp46 = ixheaacd_sub32_sat(temp22, temp212); temp44 = ixheaacd_add32_sat(temp23, temp213); temp47 = ixheaacd_sub32_sat(temp23, temp213); temp49 = -ixheaacd_add32_sat(temp24, temp210); temp410 = ixheaacd_sub32_sat(temp24, temp210); temp48 = ixheaacd_add32_sat(temp25, temp211); temp411 = ixheaacd_sub32_sat(temp25, temp211); temp413 = -ixheaacd_add32_sat(temp26, temp28); temp414 = ixheaacd_sub32_sat(temp26, temp28); temp412 = ixheaacd_add32_sat(temp27, temp29); temp415 = ixheaacd_sub32_sat(temp27, temp29); temp20 = ixheaacd_add32_sat(ixheaacd_add32_sat(ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(temp40, fft_c[3]), ixheaacd_mult32x16in32_shl(temp44, fft_c[2])), ixheaacd_mult32x16in32_shl(temp48, fft_c[1])), ixheaacd_mult32x16in32_shl(temp412, fft_c[0])); temp24 = ixheaacd_sub32_sat(ixheaacd_add32_sat(ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(temp40, fft_c[2]), ixheaacd_mult32x16in32_shl(temp44, fft_c[0])), ixheaacd_mult32x16in32_shl(temp48, fft_c[3])), ixheaacd_mult32x16in32_shl(temp412, fft_c[1])); temp28 = ixheaacd_add32_sat(ixheaacd_sub32_sat(ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(temp40, fft_c[1]), ixheaacd_mult32x16in32_shl(temp44, fft_c[3])), ixheaacd_mult32x16in32_shl(temp48, fft_c[0])), ixheaacd_mult32x16in32_shl(temp412, fft_c[2])); temp212 = ixheaacd_sub32_sat(ixheaacd_add32_sat(ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(temp40, fft_c[0]), ixheaacd_mult32x16in32_shl(temp44, fft_c[1])), ixheaacd_mult32x16in32_shl(temp48, fft_c[2])), ixheaacd_mult32x16in32_shl(temp412, fft_c[3])); temp21 = ixheaacd_add32_sat(ixheaacd_add32_sat(ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(temp41, fft_c[3]), ixheaacd_mult32x16in32_shl(temp45, fft_c[2])), ixheaacd_mult32x16in32_shl(temp49, fft_c[1])), ixheaacd_mult32x16in32_shl(temp413, fft_c[0])); temp25 = ixheaacd_sub32_sat(ixheaacd_add32_sat(ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(temp41, fft_c[2]), ixheaacd_mult32x16in32_shl(temp45, fft_c[0])), ixheaacd_mult32x16in32_shl(temp49, fft_c[3])), ixheaacd_mult32x16in32_shl(temp413, fft_c[1])); temp29 = ixheaacd_add32_sat(ixheaacd_sub32_sat(ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(temp41, fft_c[1]), ixheaacd_mult32x16in32_shl(temp45, fft_c[3])), ixheaacd_mult32x16in32_shl(temp49, fft_c[0])), ixheaacd_mult32x16in32_shl(temp413, fft_c[2])); temp213 = ixheaacd_sub32_sat(ixheaacd_add32_sat(ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(temp41, fft_c[0]), ixheaacd_mult32x16in32_shl(temp45, fft_c[1])), ixheaacd_mult32x16in32_shl(temp49, fft_c[2])), ixheaacd_mult32x16in32_shl(temp413, fft_c[3])); temp22 = ixheaacd_add32_sat(ixheaacd_add32_sat(ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(temp42, fft_c[0]), ixheaacd_mult32x16in32_shl(temp46, fft_c[1])), ixheaacd_mult32x16in32_shl(temp410, fft_c[2])), ixheaacd_mult32x16in32_shl(temp414, fft_c[3])); temp26 = ixheaacd_sub32_sat(ixheaacd_sub32_sat(ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(temp42, fft_c[1]), ixheaacd_mult32x16in32_shl(temp46, fft_c[3])), ixheaacd_mult32x16in32_shl(temp410, fft_c[0])), ixheaacd_mult32x16in32_shl(temp414, fft_c[2])); temp210 = ixheaacd_add32_sat(ixheaacd_add32_sat(ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(temp42, fft_c[2]), ixheaacd_mult32x16in32_shl(temp46, fft_c[0])), ixheaacd_mult32x16in32_shl(temp410, fft_c[3])), ixheaacd_mult32x16in32_shl(temp414, fft_c[1])); temp214 = ixheaacd_sub32_sat(ixheaacd_add32_sat(ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(temp42, fft_c[3]), ixheaacd_mult32x16in32_shl(temp46, fft_c[2])), ixheaacd_mult32x16in32_shl(temp410, fft_c[1])), ixheaacd_mult32x16in32_shl(temp414, fft_c[0])); temp23 = ixheaacd_add32_sat(ixheaacd_add32_sat(ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(temp43, fft_c[0]), ixheaacd_mult32x16in32_shl(temp47, fft_c[1])), ixheaacd_mult32x16in32_shl(temp411, fft_c[2])), ixheaacd_mult32x16in32_shl(temp415, fft_c[3])); temp27 = ixheaacd_sub32_sat(ixheaacd_sub32_sat(ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(temp43, fft_c[1]), ixheaacd_mult32x16in32_shl(temp47, fft_c[3])), ixheaacd_mult32x16in32_shl(temp411, fft_c[0])), ixheaacd_mult32x16in32_shl(temp415, fft_c[2])); temp211 = ixheaacd_add32_sat(ixheaacd_add32_sat(ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(temp43, fft_c[2]), ixheaacd_mult32x16in32_shl(temp47, fft_c[0])), ixheaacd_mult32x16in32_shl(temp411, fft_c[3])), ixheaacd_mult32x16in32_shl(temp415, fft_c[1])); temp215 = ixheaacd_sub32_sat(ixheaacd_add32_sat(ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(temp43, fft_c[3]), ixheaacd_mult32x16in32_shl(temp47, fft_c[2])), ixheaacd_mult32x16in32_shl(temp411, fft_c[1])), ixheaacd_mult32x16in32_shl(temp415, fft_c[0])); temp40 = ixheaacd_add32_sat(temp20, temp22); temp414 = ixheaacd_sub32_sat(temp20, temp22); temp41 = ixheaacd_add32_sat(temp21, temp23); temp415 = ixheaacd_sub32_sat(temp21, temp23); temp42 = ixheaacd_add32_sat(temp24, temp26); temp412 = ixheaacd_sub32_sat(temp24, temp26); temp43 = ixheaacd_add32_sat(temp25, temp27); temp413 = ixheaacd_sub32_sat(temp25, temp27); temp44 = ixheaacd_add32_sat(temp28, temp210); temp410 = ixheaacd_sub32_sat(temp28, temp210); temp45 = ixheaacd_add32_sat(temp29, temp211); temp411 = ixheaacd_sub32_sat(temp29, temp211); temp46 = ixheaacd_add32_sat(temp212, temp214); temp48 = ixheaacd_sub32_sat(temp212, temp214); temp47 = ixheaacd_add32_sat(temp213, temp215); temp49 = ixheaacd_sub32_sat(temp213, temp215); temp10 = ixheaacd_add32_sat(temp30, temp316); temp11 = ixheaacd_add32_sat(temp31, temp317); temp12 = ixheaacd_add32_sat(temp32, temp318); temp13 = ixheaacd_add32_sat(temp33, temp319); temp14 = ixheaacd_add32_sat(temp34, temp320); temp15 = ixheaacd_add32_sat(temp35, temp321); temp16 = ixheaacd_add32_sat(temp36, temp322); temp17 = ixheaacd_add32_sat(temp37, temp323); temp18 = ixheaacd_add32_sat(temp38, temp324); temp19 = ixheaacd_add32_sat(temp39, temp325); temp110 = ixheaacd_add32_sat(temp310, temp326); temp111 = ixheaacd_add32_sat(temp311, temp327); temp112 = ixheaacd_add32_sat(temp312, temp328); temp113 = ixheaacd_add32_sat(temp313, temp329); temp114 = ixheaacd_add32_sat(temp314, temp330); temp115 = ixheaacd_add32_sat(temp315, temp331); tmp0 = ixheaacd_add32_sat(temp10, temp18); tmp2 = ixheaacd_sub32_sat(temp10, temp18); tmp1 = ixheaacd_add32_sat(temp11, temp19); tmp3 = ixheaacd_sub32_sat(temp11, temp19); tmp4 = ixheaacd_add32_sat(temp12, temp110); tmp6 = ixheaacd_sub32_sat(temp12, temp110); tmp5 = ixheaacd_add32_sat(temp13, temp111); tmp7 = ixheaacd_sub32_sat(temp13, temp111); tmp8 = ixheaacd_add32_sat(temp14, temp112); tmp10 = ixheaacd_sub32_sat(temp14, temp112); tmp9 = ixheaacd_add32_sat(temp15, temp113); tmp11 = ixheaacd_sub32_sat(temp15, temp113); tmp12 = ixheaacd_add32_sat(temp16, temp114); tmp14 = ixheaacd_sub32_sat(temp16, temp114); tmp13 = ixheaacd_add32_sat(temp17, temp115); tmp15 = ixheaacd_sub32_sat(temp17, temp115); temp20 = ixheaacd_add32_sat(tmp0, tmp8); temp24 = ixheaacd_sub32_sat(tmp0, tmp8); temp21 = ixheaacd_add32_sat(tmp1, tmp9); temp25 = ixheaacd_sub32_sat(tmp1, tmp9); temp28 = ixheaacd_sub32_sat(tmp2, tmp11); temp210 = ixheaacd_add32_sat(tmp2, tmp11); temp29 = ixheaacd_add32_sat(tmp3, tmp10); temp211 = ixheaacd_sub32_sat(tmp3, tmp10); temp22 = ixheaacd_add32_sat(tmp4, tmp12); temp27 = ixheaacd_sub32_sat(tmp4, tmp12); temp23 = ixheaacd_add32_sat(tmp5, tmp13); temp26 = ixheaacd_sub32_sat(tmp13, tmp5); tmp1 = ixheaacd_add32_sat(tmp6, tmp14); tmp2 = ixheaacd_sub32_sat(tmp6, tmp14); tmp0 = ixheaacd_add32_sat(tmp7, tmp15); tmp3 = ixheaacd_sub32_sat(tmp7, tmp15); temp212 = ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(tmp0, tmp2), INV_SQRT2_Q15); temp214 = ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat(tmp0, tmp2), INV_SQRT2_Q15); temp213 = ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat(tmp3, tmp1), INV_SQRT2_Q15); temp215 = ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(tmp1, tmp3), -INV_SQRT2_Q15); temp10 = ixheaacd_sub32_sat(temp30, temp316); temp11 = ixheaacd_sub32_sat(temp31, temp317); temp12 = ixheaacd_sub32_sat(temp32, temp318); temp13 = ixheaacd_sub32_sat(temp33, temp319); temp14 = ixheaacd_sub32_sat(temp34, temp320); temp15 = ixheaacd_sub32_sat(temp35, temp321); temp16 = ixheaacd_sub32_sat(temp36, temp322); temp17 = ixheaacd_sub32_sat(temp37, temp323); temp18 = ixheaacd_sub32_sat(temp38, temp324); temp19 = ixheaacd_sub32_sat(temp39, temp325); temp110 = ixheaacd_sub32_sat(temp310, temp326); temp111 = ixheaacd_sub32_sat(temp311, temp327); temp112 = ixheaacd_sub32_sat(temp312, temp328); temp113 = ixheaacd_sub32_sat(temp313, temp329); temp114 = ixheaacd_sub32_sat(temp314, temp330); temp115 = ixheaacd_sub32_sat(temp315, temp331); temp30 = ixheaacd_add32_sat(temp20, temp22); temp316 = ixheaacd_sub32_sat(temp20, temp22); temp31 = ixheaacd_add32_sat(temp21, temp23); temp317 = ixheaacd_sub32_sat(temp21, temp23); temp38 = ixheaacd_sub32_sat(temp24, temp26); temp324 = ixheaacd_add32_sat(temp24, temp26); temp39 = ixheaacd_sub32_sat(temp25, temp27); temp325 = ixheaacd_add32_sat(temp25, temp27); temp312 = ixheaacd_add32_sat(temp28, temp214); temp328 = ixheaacd_sub32_sat(temp28, temp214); temp313 = ixheaacd_add32_sat(temp29, temp215); temp329 = ixheaacd_sub32_sat(temp29, temp215); temp34 = ixheaacd_add32_sat(temp210, temp212); temp320 = ixheaacd_sub32_sat(temp210, temp212); temp35 = ixheaacd_add32_sat(temp211, temp213); temp321 = ixheaacd_sub32_sat(temp211, temp213); tmp9 = ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(temp12, temp114), -COS_3PI_BY_8_Q15); tmp10 = ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat(temp12, temp114), COS_PI_BY_8_Q15); tmp8 = ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(temp13, temp115), COS_3PI_BY_8_Q15); tmp11 = ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat(temp13, temp115), COS_PI_BY_8_Q15); tmp5 = ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(temp14, temp112), -INV_SQRT2_Q15); tmp6 = ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat(temp14, temp112), INV_SQRT2_Q15); tmp4 = ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(temp15, temp113), INV_SQRT2_Q15); tmp7 = ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat(temp15, temp113), INV_SQRT2_Q15); tmp13 = ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(temp16, temp110), -COS_PI_BY_8_Q15); tmp14 = ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat(temp16, temp110), COS_3PI_BY_8_Q15); tmp12 = ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(temp17, temp111), COS_PI_BY_8_Q15); tmp15 = ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat(temp17, temp111), COS_3PI_BY_8_Q15); temp12 = ixheaacd_sub32_sat(ixheaacd_shl32(ixheaacd_mult32x16in32(tmp8, SQRT2PLUS1_Q13), 3), ixheaacd_mult32x16in32_shl(tmp12, SQRT2MINUS1_Q15)); temp13 = ixheaacd_sub32_sat(ixheaacd_shl32(ixheaacd_mult32x16in32(tmp9, SQRT2PLUS1_Q13), 3), ixheaacd_mult32x16in32_shl(tmp13, SQRT2MINUS1_Q15)); temp14 = ixheaacd_sub32_sat(ixheaacd_mult32x16in32_shl(tmp10, SQRT2MINUS1_Q15), ixheaacd_shl32(ixheaacd_mult32x16in32(tmp14, SQRT2PLUS1_Q13), 3)); temp15 = ixheaacd_sub32_sat(ixheaacd_mult32x16in32_shl(tmp11, SQRT2MINUS1_Q15), ixheaacd_shl32(ixheaacd_mult32x16in32(tmp15, SQRT2PLUS1_Q13), 3)); tmp8 = ixheaacd_add32_sat(tmp8, tmp12); tmp9 = ixheaacd_add32_sat(tmp9, tmp13); tmp10 = ixheaacd_add32_sat(tmp10, tmp14); tmp11 = ixheaacd_add32_sat(tmp11, tmp15); temp16 = ixheaacd_add32_sat(temp10, tmp4); temp110 = ixheaacd_sub32_sat(temp10, tmp4); temp17 = ixheaacd_add32_sat(temp11, tmp5); temp111 = ixheaacd_sub32_sat(temp11, tmp5); temp112 = ixheaacd_sub32_sat(tmp6, temp19); temp114 = ixheaacd_add32_sat(tmp6, temp19); temp113 = ixheaacd_add32_sat(temp18, tmp7); temp115 = ixheaacd_sub32_sat(temp18, tmp7); tmp0 = ixheaacd_sub32_sat(temp16, temp114); tmp2 = ixheaacd_add32_sat(temp16, temp114); tmp1 = ixheaacd_add32_sat(temp17, temp115); tmp3 = ixheaacd_sub32_sat(temp17, temp115); tmp4 = ixheaacd_add32_sat(temp110, temp112); tmp6 = ixheaacd_sub32_sat(temp110, temp112); tmp5 = ixheaacd_add32_sat(temp111, temp113); tmp7 = ixheaacd_sub32_sat(temp111, temp113); temp110 = ixheaacd_add32_sat(tmp8, tmp10); tmp10 = ixheaacd_sub32_sat(tmp8, tmp10); temp111 = ixheaacd_add32_sat(tmp9, tmp11); tmp11 = ixheaacd_sub32_sat(tmp9, tmp11); tmp12 = ixheaacd_add32_sat(temp12, temp14); tmp14 = ixheaacd_sub32_sat(temp12, temp14); tmp13 = ixheaacd_add32_sat(temp13, temp15); tmp15 = ixheaacd_sub32_sat(temp13, temp15); temp32 = ixheaacd_add32_sat(tmp2, temp110); temp318 = ixheaacd_sub32_sat(tmp2, temp110); temp33 = ixheaacd_add32_sat(tmp3, temp111); temp319 = ixheaacd_sub32_sat(tmp3, temp111); temp36 = ixheaacd_add32_sat(tmp0, tmp12); temp322 = ixheaacd_sub32_sat(tmp0, tmp12); temp37 = ixheaacd_add32_sat(tmp1, tmp13); temp323 = ixheaacd_sub32_sat(tmp1, tmp13); temp314 = ixheaacd_add32_sat(tmp4, tmp10); temp330 = ixheaacd_sub32_sat(tmp4, tmp10); temp315 = ixheaacd_add32_sat(tmp5, tmp11); temp331 = ixheaacd_sub32_sat(tmp5, tmp11); temp310 = ixheaacd_add32_sat(tmp6, tmp14); temp326 = ixheaacd_sub32_sat(tmp6, tmp14); temp311 = ixheaacd_add32_sat(tmp7, tmp15); temp327 = ixheaacd_sub32_sat(tmp7, tmp15); temp10 = ixheaacd_sub32_sat(vec[0], vec[32]); temp11 = ixheaacd_sub32_sat(vec[1], vec[33]); temp12 = ixheaacd_sub32_sat(vec[4], vec[36]); temp13 = ixheaacd_sub32_sat(vec[5], vec[37]); temp14 = ixheaacd_sub32_sat(vec[8], vec[40]); temp15 = ixheaacd_sub32_sat(vec[9], vec[41]); temp16 = ixheaacd_sub32_sat(vec[12], vec[44]); temp17 = ixheaacd_sub32_sat(vec[13], vec[45]); temp18 = ixheaacd_sub32_sat(vec[16], vec[48]); temp19 = ixheaacd_sub32_sat(vec[17], vec[49]); temp110 = ixheaacd_sub32_sat(vec[20], vec[52]); temp111 = ixheaacd_sub32_sat(vec[21], vec[53]); temp112 = ixheaacd_sub32_sat(vec[24], vec[56]); temp113 = ixheaacd_sub32_sat(vec[25], vec[57]); temp114 = ixheaacd_sub32_sat(vec[28], vec[60]); temp115 = ixheaacd_sub32_sat(vec[29], vec[61]); tmp9 = ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(temp12, temp114), -COS_3PI_BY_8_Q15); tmp10 = ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat(temp12, temp114), COS_PI_BY_8_Q15); tmp8 = ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(temp13, temp115), COS_3PI_BY_8_Q15); tmp11 = ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat(temp13, temp115), COS_PI_BY_8_Q15); tmp5 = ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(temp14, temp112), -INV_SQRT2_Q15); tmp6 = ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat(temp14, temp112), INV_SQRT2_Q15); tmp4 = ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(temp15, temp113), INV_SQRT2_Q15); tmp7 = ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat(temp15, temp113), INV_SQRT2_Q15); tmp13 = ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(temp16, temp110), -COS_PI_BY_8_Q15); tmp14 = ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat(temp16, temp110), COS_3PI_BY_8_Q15); tmp12 = ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(temp17, temp111), COS_PI_BY_8_Q15); tmp15 = ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat(temp17, temp111), COS_3PI_BY_8_Q15); temp12 = ixheaacd_sub32_sat(ixheaacd_shl32(ixheaacd_mult32x16in32(tmp8, SQRT2PLUS1_Q13), 3), ixheaacd_mult32x16in32_shl(tmp12, SQRT2MINUS1_Q15)); temp13 = ixheaacd_sub32_sat(ixheaacd_shl32(ixheaacd_mult32x16in32(tmp9, SQRT2PLUS1_Q13), 3), ixheaacd_mult32x16in32_shl(tmp13, SQRT2MINUS1_Q15)); temp14 = ixheaacd_sub32_sat(ixheaacd_mult32x16in32_shl(tmp10, SQRT2MINUS1_Q15), ixheaacd_shl32(ixheaacd_mult32x16in32(tmp14, SQRT2PLUS1_Q13), 3)); temp15 = ixheaacd_sub32_sat(ixheaacd_mult32x16in32_shl(tmp11, SQRT2MINUS1_Q15), ixheaacd_shl32(ixheaacd_mult32x16in32(tmp15, SQRT2PLUS1_Q13), 3)); tmp8 = ixheaacd_add32_sat(tmp8, tmp12); tmp9 = ixheaacd_add32_sat(tmp9, tmp13); tmp10 = ixheaacd_add32_sat(tmp10, tmp14); tmp11 = ixheaacd_add32_sat(tmp11, tmp15); temp16 = ixheaacd_add32_sat(temp10, tmp4); temp110 = ixheaacd_sub32_sat(temp10, tmp4); temp17 = ixheaacd_add32_sat(temp11, tmp5); temp111 = ixheaacd_sub32_sat(temp11, tmp5); temp112 = ixheaacd_sub32_sat(tmp6, temp19); temp114 = ixheaacd_add32_sat(tmp6, temp19); temp113 = ixheaacd_add32_sat(temp18, tmp7); temp115 = ixheaacd_sub32_sat(temp18, tmp7); tmp0 = ixheaacd_sub32_sat(temp16, temp114); tmp2 = ixheaacd_add32_sat(temp16, temp114); tmp1 = ixheaacd_add32_sat(temp17, temp115); tmp3 = ixheaacd_sub32_sat(temp17, temp115); tmp4 = ixheaacd_add32_sat(temp110, temp112); tmp6 = ixheaacd_sub32_sat(temp110, temp112); tmp5 = ixheaacd_add32_sat(temp111, temp113); tmp7 = ixheaacd_sub32_sat(temp111, temp113); temp110 = ixheaacd_add32_sat(tmp8, tmp10); tmp10 = ixheaacd_sub32_sat(tmp8, tmp10); temp111 = ixheaacd_add32_sat(tmp9, tmp11); tmp11 = ixheaacd_sub32_sat(tmp9, tmp11); tmp12 = ixheaacd_add32_sat(temp12, temp14); tmp14 = ixheaacd_sub32_sat(temp12, temp14); tmp13 = ixheaacd_add32_sat(temp13, temp15); tmp15 = ixheaacd_sub32_sat(temp13, temp15); temp10 = ixheaacd_add32_sat(tmp2, temp110); temp18 = ixheaacd_sub32_sat(tmp2, temp110); temp11 = ixheaacd_add32_sat(tmp3, temp111); temp19 = ixheaacd_sub32_sat(tmp3, temp111); temp12 = ixheaacd_add32_sat(tmp0, tmp12); temp110 = ixheaacd_sub32_sat(tmp0, tmp12); temp13 = ixheaacd_add32_sat(tmp1, tmp13); temp111 = ixheaacd_sub32_sat(tmp1, tmp13); temp16 = ixheaacd_add32_sat(tmp4, tmp10); temp114 = ixheaacd_sub32_sat(tmp4, tmp10); temp17 = ixheaacd_add32_sat(tmp5, tmp11); temp115 = ixheaacd_sub32_sat(tmp5, tmp11); temp14 = ixheaacd_add32_sat(tmp6, tmp14); temp112 = ixheaacd_sub32_sat(tmp6, tmp14); temp15 = ixheaacd_add32_sat(tmp7, tmp15); temp113 = ixheaacd_sub32_sat(tmp7, tmp15); *vec++ = temp30; *vec++ = temp31; *vec++ = ixheaacd_add32_sat(temp10, temp40); *vec++ = ixheaacd_add32_sat(temp11, temp41); *vec++ = temp32; *vec++ = temp33; *vec++ = ixheaacd_add32_sat(temp12, temp42); *vec++ = ixheaacd_add32_sat(temp13, temp43); *vec++ = temp34; *vec++ = temp35; *vec++ = ixheaacd_add32_sat(temp14, temp44); *vec++ = ixheaacd_add32_sat(temp15, temp45); *vec++ = temp36; *vec++ = temp37; *vec++ = ixheaacd_add32_sat(temp16, temp46); *vec++ = ixheaacd_add32_sat(temp17, temp47); *vec++ = temp38; *vec++ = temp39; *vec++ = ixheaacd_add32_sat(temp18, temp48); *vec++ = ixheaacd_add32_sat(temp19, temp49); *vec++ = temp310; *vec++ = temp311; *vec++ = ixheaacd_add32_sat(temp110, temp410); *vec++ = ixheaacd_add32_sat(temp111, temp411); *vec++ = temp312; *vec++ = temp313; *vec++ = ixheaacd_add32_sat(temp112, temp412); *vec++ = ixheaacd_add32_sat(temp113, temp413); *vec++ = temp314; *vec++ = temp315; *vec++ = ixheaacd_add32_sat(temp114, temp414); *vec++ = ixheaacd_add32_sat(temp115, temp415); *vec++ = temp316; *vec++ = temp317; *vec++ = ixheaacd_sub32_sat(temp10, temp40); *vec++ = ixheaacd_sub32_sat(temp11, temp41); *vec++ = temp318; *vec++ = temp319; *vec++ = ixheaacd_sub32_sat(temp12, temp42); *vec++ = ixheaacd_sub32_sat(temp13, temp43); *vec++ = temp320; *vec++ = temp321; *vec++ = ixheaacd_sub32_sat(temp14, temp44); *vec++ = ixheaacd_sub32_sat(temp15, temp45); *vec++ = temp322; *vec++ = temp323; *vec++ = ixheaacd_sub32_sat(temp16, temp46); *vec++ = ixheaacd_sub32_sat(temp17, temp47); *vec++ = temp324; *vec++ = temp325; *vec++ = ixheaacd_sub32_sat(temp18, temp48); *vec++ = ixheaacd_sub32_sat(temp19, temp49); *vec++ = temp326; *vec++ = temp327; *vec++ = ixheaacd_sub32_sat(temp110, temp410); *vec++ = ixheaacd_sub32_sat(temp111, temp411); *vec++ = temp328; *vec++ = temp329; *vec++ = ixheaacd_sub32_sat(temp112, temp412); *vec++ = ixheaacd_sub32_sat(temp113, temp413); *vec++ = temp330; *vec++ = temp331; *vec++ = ixheaacd_sub32_sat(temp114, temp414); *vec++ = ixheaacd_sub32_sat(temp115, temp415); } static VOID ixheaacd_cos_mod(WORD32 *subband, ia_mps_dec_qmf_tables_struct *qmf_table_ptr) { WORD32 i, m; WORD16 wim, wre; WORD32 temp_1; const WORD16 *ptr1, *ptr2, *ptr3, *ptr4; WORD32 re1, im1, re2, im2; m = WORD_LENGTH; ptr1 = qmf_table_ptr->sbr_sin_twiddle; ptr2 = qmf_table_ptr->sbr_cos_twiddle; ptr3 = qmf_table_ptr->sbr_sin_twiddle + 31; ptr4 = qmf_table_ptr->sbr_cos_twiddle + 31; for (i = 0; i < 16; i++) { temp_1 = (i << 1); re1 = subband[temp_1]; im2 = subband[temp_1 + 1]; re2 = subband[62 - temp_1]; im1 = subband[63 - temp_1]; wim = *ptr1++; wre = *ptr2++; subband[temp_1] = ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(im1, wim), ixheaacd_mult32x16in32_shl(re1, wre)); subband[temp_1 + 1] = ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(im1, wre), ixheaacd_mult32x16in32_shl(re1, wim)); wim = *ptr3--; wre = *ptr4--; subband[62 - temp_1] = ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(im2, wim), ixheaacd_mult32x16in32_shl(re2, wre)); subband[63 - temp_1] = ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(im2, wre), ixheaacd_mult32x16in32_shl(re2, wim)); } ixheaacd_fft32(subband, qmf_table_ptr->fft_c); ptr1 = qmf_table_ptr->sbr_alt_sin_twiddle; ptr2 = qmf_table_ptr->sbr_alt_sin_twiddle + m; wim = *ptr1++; wre = *ptr2--; for (i = 0; i < 16; i++) { temp_1 = (i << 1); re1 = subband[temp_1]; im1 = subband[temp_1 + 1]; re2 = subband[62 - temp_1]; im2 = subband[63 - temp_1]; subband[temp_1] = ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(re1, wre), ixheaacd_mult32x16in32_shl(im1, wim)); subband[63 - temp_1] = ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(re1, wim), ixheaacd_mult32x16in32_shl(im1, wre)); wim = *ptr1++; wre = *ptr2--; subband[62 - temp_1] = ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(re2, wim), ixheaacd_mult32x16in32_shl(im2, wre)); subband[temp_1 + 1] = ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(re2, wre), ixheaacd_mult32x16in32_shl(im2, wim)); } } static VOID ixheaacd_sin_mod(WORD32 *subband, ia_mps_dec_qmf_tables_struct *qmf_table_ptr) { WORD32 i, m; WORD16 wre, wim; WORD32 temp_1; WORD32 re1, im1, re2, im2; const WORD16 *ptr1, *ptr2, *ptr3, *ptr4; ptr1 = qmf_table_ptr->sbr_sin_twiddle; ptr2 = qmf_table_ptr->sbr_cos_twiddle; ptr3 = qmf_table_ptr->sbr_sin_twiddle + 31; ptr4 = qmf_table_ptr->sbr_cos_twiddle + 31; m = WORD_LENGTH; for (i = 0; i < 16; i++) { temp_1 = (i << 1); re1 = subband[temp_1]; im2 = subband[temp_1 + 1]; re2 = subband[62 - temp_1]; im1 = subband[63 - temp_1]; wre = *ptr1++; wim = *ptr2++; subband[temp_1 + 1] = ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(im1, wim), ixheaacd_mult32x16in32_shl(re1, wre)); subband[temp_1] = ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(im1, wre), ixheaacd_mult32x16in32_shl(re1, wim)); wre = *ptr3--; wim = *ptr4--; subband[63 - temp_1] = ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(im2, wim), ixheaacd_mult32x16in32_shl(re2, wre)); subband[62 - temp_1] = ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(im2, wre), ixheaacd_mult32x16in32_shl(re2, wim)); } ixheaacd_fft32(subband, qmf_table_ptr->fft_c); ptr1 = qmf_table_ptr->sbr_alt_sin_twiddle; ptr2 = qmf_table_ptr->sbr_alt_sin_twiddle + m; wim = *ptr1++; wre = *ptr2--; for (i = 0; i < 16; i++) { temp_1 = (i << 1); re1 = subband[temp_1]; im1 = subband[temp_1 + 1]; re2 = subband[62 - temp_1]; im2 = subband[63 - temp_1]; subband[63 - temp_1] = -ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(re1, wre), ixheaacd_mult32x16in32_shl(im1, wim)); subband[temp_1] = -ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(re1, wim), ixheaacd_mult32x16in32_shl(im1, wre)); wim = *ptr1++; wre = *ptr2--; subband[temp_1 + 1] = -ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(re2, wim), ixheaacd_mult32x16in32_shl(im2, wre)); subband[62 - temp_1] = -ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(re2, wre), ixheaacd_mult32x16in32_shl(im2, wim)); } } static VOID ixheaacd_inverse_modulation(WORD32 *qmf_real, WORD32 *qmf_imag, ia_mps_dec_qmf_tables_struct *qmf_table_ptr) { WORD32 i; const WORD16 *ptr1, *ptr2, *ptr3, *ptr4; const WORD16 *fft = qmf_table_ptr->fft_c; WORD16 wre, wim; WORD32 re1, im1, re2, im2; WORD32 re12, im12, re22, im22; WORD32 temp_1; ptr1 = qmf_table_ptr->sbr_sin_twiddle; ptr2 = qmf_table_ptr->sbr_cos_twiddle; ptr3 = ptr1 + 31; ptr4 = ptr2 + 31; for (i = 0; i < 16; i++) { temp_1 = (i << 1); re1 = qmf_real[temp_1]; im1 = qmf_real[63 - temp_1]; wim = *ptr1++; wre = *ptr2++; qmf_real[temp_1] = ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(im1, wim), ixheaacd_mult32x16in32_shl(re1, wre)); re12 = qmf_imag[temp_1]; im12 = qmf_imag[63 - temp_1]; qmf_imag[temp_1] = ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(im12, wim), ixheaacd_mult32x16in32_shl(re12, wre)); im2 = qmf_real[temp_1 + 1]; qmf_real[temp_1 + 1] = ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(im1, wre), ixheaacd_mult32x16in32_shl(re1, wim)); im22 = qmf_imag[temp_1 + 1]; qmf_imag[temp_1 + 1] = ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(im12, wre), ixheaacd_mult32x16in32_shl(re12, wim)); wim = *ptr3--; wre = *ptr4--; re2 = qmf_real[62 - temp_1]; qmf_real[62 - temp_1] = ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(im2, wim), ixheaacd_mult32x16in32_shl(re2, wre)); re22 = qmf_imag[62 - temp_1]; qmf_imag[62 - temp_1] = ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(im22, wim), ixheaacd_mult32x16in32_shl(re22, wre)); qmf_real[63 - temp_1] = ixheaacd_sub32_sat( ixheaacd_mult32x16in32_shl(im2, wre), ixheaacd_mult32x16in32_shl(re2, wim)); qmf_imag[63 - temp_1] = ixheaacd_add32_sat( ixheaacd_mult32x16in32_shl(im22, wre), ixheaacd_mult32x16in32_shl(re22, wim)); } ixheaacd_fft32(qmf_real, fft); ixheaacd_fft32(qmf_imag, fft); ptr1 = qmf_table_ptr->sbr_alt_sin_twiddle; ptr2 = ptr1 + 32; wim = *ptr1++; wre = *ptr2--; for (i = 0; i < 16; i++) { temp_1 = (i << 1); re1 = qmf_real[temp_1]; im1 = qmf_real[temp_1 + 1]; re12 = qmf_imag[temp_1]; im12 = qmf_imag[temp_1 + 1]; qmf_real[temp_1] = ixheaacd_sub32_sat(ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat( im12, re1), wre), ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(im1, re12), wim)); qmf_imag[temp_1] = ixheaacd_add32_sat(ixheaacd_mult32x16in32_shl((ixheaacd_add32_sat( im12, re1)), wre), ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat(im1, re12), wim)); im2 = qmf_real[63 - temp_1]; im22 = qmf_imag[63 - temp_1]; qmf_real[63 - temp_1] = ixheaacd_sub32_sat(ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat( im1, re12), wre), ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(im12, re1), wim)); qmf_imag[63 - temp_1] = ixheaacd_sub32_sat(ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat( re1, im12), wim), ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(im1, re12), wre)); wim = *ptr1++; wre = *ptr2--; re2 = qmf_real[62 - temp_1]; re22 = qmf_imag[62 - temp_1]; qmf_real[temp_1 + 1] = ixheaacd_sub32_sat(ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat( im2, re22), wim), ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(im22, re2), wre)); qmf_imag[temp_1 + 1] = ixheaacd_sub32_sat(ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat( re2, im22), wre), ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(im2, re22), wim)); qmf_real[62 - temp_1] = ixheaacd_sub32_sat(ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat( im22, re2), wim), ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat(im2, re22), wre)); qmf_imag[62 - temp_1] = ixheaacd_add32_sat(ixheaacd_mult32x16in32_shl(ixheaacd_add32_sat( re2, im22), wim), ixheaacd_mult32x16in32_shl(ixheaacd_sub32_sat(im2, re22), wre)); } } VOID ixheaacd_calculate_syn_filt_bank_res64(ia_mps_dec_qmf_syn_filter_bank *syn, WORD32 *sr, WORD32 *si, WORD32 *time_sig, WORD32 channel, WORD32 resolution, WORD32 nr_samples, ia_mps_dec_qmf_tables_struct *qmf_table_ptr) { WORD32 j, k; WORD32 *synth_buf; WORD32 *syn_buf_p1, *syn_buf_p2, *syn_buf_p3; WORD32 val; const WORD32 *p_filter_1, *p_filter_6; const WORD32 *p_filter_2, *p_filter_7; const WORD32 *p_filter_3, *p_filter_8; const WORD32 *p_filter_4, *p_filter_9; const WORD32 *p_filter_5, *p_filter_10; WORD32 *p_sr, *p_si; WORD32 *sbr_qmf_states_synthesis = syn->sbr_qmf_states_synthesis; synth_buf = &(sbr_qmf_states_synthesis[channel * QMF_FILTER_STATE_SYN_SIZE_MPS]); p_sr = sr; p_si = si; for (k = 0; k < nr_samples; k++) { WORD32 *new_samp = p_si; WORD32 *new_samp1, *new_samp2; ixheaacd_inverse_modulation(p_sr, p_si, qmf_table_ptr); p_filter_1 = syn->p_filter_syn; p_filter_2 = p_filter_1 + 64; p_filter_3 = p_filter_2 + 65; p_filter_4 = p_filter_3 + 65; p_filter_5 = p_filter_4 + 65; syn_buf_p1 = &synth_buf[63]; val = *(p_sr); { WORD32 val1 = *(p_si + 63); syn_buf_p2 = &synth_buf[63]; *time_sig++ = ixheaacd_add32_sat(syn_buf_p1[512], ixheaacd_mps_mult32_shr_30(*(p_filter_5 + 65), val)); syn_buf_p1[512] = ixheaacd_add32_sat(syn_buf_p2[448], ixheaacd_mps_mult32_shr_30(*(p_filter_5 + 64), val1)); syn_buf_p2[448] = ixheaacd_add32_sat(syn_buf_p1[384], ixheaacd_mps_mult32_shr_30(*p_filter_5++, val)); syn_buf_p1[384] = ixheaacd_add32_sat(syn_buf_p2[320], ixheaacd_mps_mult32_shr_30(*(p_filter_4 + 64), val1)); syn_buf_p2[320] = ixheaacd_add32_sat(syn_buf_p1[256], ixheaacd_mps_mult32_shr_30(*p_filter_4++, val)); syn_buf_p1[256] = ixheaacd_add32_sat(syn_buf_p2[192], ixheaacd_mps_mult32_shr_30(*(p_filter_3 + 64), val1)); syn_buf_p2[192] = ixheaacd_add32_sat(syn_buf_p1[128], ixheaacd_mps_mult32_shr_30(*p_filter_3++, val)); syn_buf_p1[128] = ixheaacd_add32_sat(syn_buf_p2[64], ixheaacd_mps_mult32_shr_30(*(p_filter_2 + 64), val1)); syn_buf_p2[64] = ixheaacd_add32_sat(syn_buf_p1[0], ixheaacd_mps_mult32_shr_30(*p_filter_2++, val)); syn_buf_p1[0] = ixheaacd_mps_mult32_shr_30(*(p_filter_1 + 63), val1); } p_filter_6 = p_filter_1 + 62; p_filter_7 = p_filter_2 + 62; p_filter_8 = p_filter_3 + 62; p_filter_9 = p_filter_4 + 62; p_filter_10 = p_filter_5 + 62; time_sig += 62; syn_buf_p2 = synth_buf; syn_buf_p3 = syn_buf_p2; new_samp1 = p_sr + 1; new_samp2 = p_sr + 63; for (j = 0; j < resolution - 1; j++) { *time_sig-- = ixheaacd_add32_sat(syn_buf_p3[512], ixheaacd_mps_mult32_shr_30(*p_filter_6--, (*new_samp2))); syn_buf_p3[512] = ixheaacd_add32_sat(syn_buf_p2[448], ixheaacd_mps_mult32_shr_30(*p_filter_5++, (*new_samp))); syn_buf_p2[448] = ixheaacd_add32_sat(syn_buf_p3[384], ixheaacd_mps_mult32_shr_30(*p_filter_7--, (*new_samp2))); syn_buf_p3[384] = ixheaacd_add32_sat(syn_buf_p2[320], ixheaacd_mps_mult32_shr_30(*p_filter_4++, (*new_samp))); syn_buf_p2[320] = ixheaacd_add32_sat(syn_buf_p3[256], ixheaacd_mps_mult32_shr_30(*p_filter_8--, (*new_samp2))); syn_buf_p3[256] = ixheaacd_add32_sat(syn_buf_p2[192], ixheaacd_mps_mult32_shr_30(*p_filter_3++, (*new_samp))); syn_buf_p2[192] = ixheaacd_add32_sat(syn_buf_p3[128], ixheaacd_mps_mult32_shr_30(*p_filter_9--, (*new_samp2))); syn_buf_p3[128] = ixheaacd_add32_sat(syn_buf_p2[64], ixheaacd_mps_mult32_shr_30(*p_filter_2++, (*new_samp))); syn_buf_p2[64] = ixheaacd_add32_sat(syn_buf_p3[0], ixheaacd_mps_mult32_shr_30(*p_filter_10--, (*new_samp2))); syn_buf_p3[0] = ixheaacd_mps_mult32_shr_30(*p_filter_1++, (*new_samp)); new_samp++; syn_buf_p2++; new_samp1++; new_samp2--; syn_buf_p3++; } time_sig += 64; p_sr += MAX_HYBRID_BANDS; p_si += MAX_HYBRID_BANDS; } } VOID ixheaacd_calculate_syn_filt_bank(ia_mps_dec_qmf_syn_filter_bank *syn, WORD32 *sr, WORD32 *si, WORD32 *time_sig, WORD32 channel, WORD32 resolution, WORD32 nr_samples, ia_mps_dec_qmf_tables_struct *qmf_table_ptr) { WORD32 j, k; WORD32 *synth_buf; WORD32 *p_sr, *p_si; WORD32 *buf_ptr; WORD32 resx2 = resolution << 1; WORD32 *sbr_qmf_states_synthesis = syn->sbr_qmf_states_synthesis; synth_buf = &(sbr_qmf_states_synthesis[channel * QMF_FILTER_STATE_SYN_SIZE_MPS]); p_sr = sr; p_si = si; for (k = 0; k < nr_samples; k++) { WORD32 *new_samp = p_si + 63; const WORD32 *p_filter_1 = syn->p_filter_syn; const WORD32 *p_filter_2 = p_filter_1 + 65; const WORD32 *p_filter_3 = p_filter_2 + 65; const WORD32 *p_filter_4 = p_filter_3 + 65; const WORD32 *p_filter_5 = p_filter_4 + 65; ixheaacd_inverse_modulation(p_sr, p_si, qmf_table_ptr); for (j = 0; j < resolution; j++) { synth_buf[j] = ixheaacd_mps_mult32_shr_30(*p_filter_1++, (*new_samp)); synth_buf[resx2 + j] = ixheaacd_add32_sat(synth_buf[resx2 + j], ixheaacd_mps_mult32_shr_30(*p_filter_2++, (*new_samp))); synth_buf[resx2 * 2 + j] = ixheaacd_add32_sat(synth_buf[resx2 * 2 + j], ixheaacd_mps_mult32_shr_30(*p_filter_3++, (*new_samp))); synth_buf[resx2 * 3 + j] = ixheaacd_add32_sat(synth_buf[resx2 * 3 + j], ixheaacd_mps_mult32_shr_30(*p_filter_4++, (*new_samp))); synth_buf[resx2 * 4 + j] = ixheaacd_add32_sat(synth_buf[resx2 * 4 + j], ixheaacd_mps_mult32_shr_30(*p_filter_5++, (*new_samp))); new_samp--; } synth_buf[resx2 - 1] = ixheaacd_add32_sat(synth_buf[resx2 - 1], ixheaacd_mps_mult32_shr_30(*p_filter_1++, *p_sr)); synth_buf[resx2 * 2 - 1] = ixheaacd_add32_sat(synth_buf[resx2 * 2 - 1], ixheaacd_mps_mult32_shr_30(*p_filter_2++, *p_sr)); synth_buf[3 * resx2 - 1] = ixheaacd_add32_sat(synth_buf[3 * resx2 - 1], ixheaacd_mps_mult32_shr_30(*p_filter_3++, *p_sr)); synth_buf[4 * resx2 - 1] = ixheaacd_add32_sat(synth_buf[4 * resx2 - 1], ixheaacd_mps_mult32_shr_30(*p_filter_4++, *p_sr)); *time_sig++ = ixheaacd_add32_sat(synth_buf[5 * resx2 - 1], ixheaacd_mps_mult32_shr_30(*p_filter_5++, *p_sr)); p_filter_1 -= 2; p_filter_2 -= 2; p_filter_3 -= 2; p_filter_4 -= 2; p_filter_5 -= 2; new_samp = p_sr + resolution - 1; for (j = 0; j < resolution - 1; j++) { synth_buf[resolution + j] = ixheaacd_add32_sat(synth_buf[resolution + j], ixheaacd_mps_mult32_shr_30(*--p_filter_5, (*new_samp))); synth_buf[resolution * (3) + j] = ixheaacd_add32_sat(synth_buf[resolution * (3) + j], ixheaacd_mps_mult32_shr_30(*--p_filter_4, (*new_samp))); synth_buf[resolution * (5) + j] = ixheaacd_add32_sat(synth_buf[resolution * (5) + j], ixheaacd_mps_mult32_shr_30(*--p_filter_3, (*new_samp))); synth_buf[resolution * (7) + j] = ixheaacd_add32_sat(synth_buf[resolution * (7) + j], ixheaacd_mps_mult32_shr_30(*--p_filter_2, (*new_samp))); synth_buf[resolution * (9) + j] = ixheaacd_add32_sat(synth_buf[resolution * (9) + j], ixheaacd_mps_mult32_shr_30(*--p_filter_1, (*new_samp))); new_samp--; } buf_ptr = synth_buf + 9 * resolution + resolution - 2; for (j = 0; j < resolution - 1; j++) { *time_sig++ = *buf_ptr--; } memmove((synth_buf + resolution), synth_buf, (9 * resolution) * sizeof(WORD32)); p_sr += MAX_HYBRID_BANDS; p_si += MAX_HYBRID_BANDS; } } IA_ERRORCODE ixheaacd_syn_filt_bank_init(ia_mps_dec_synthesis_interface_handle self, WORD32 resolution) { switch (resolution) { case QMF_BANDS_32: self->syn_filter_bank = ixheaacd_calculate_syn_filt_bank; break; case QMF_BANDS_64: self->syn_filter_bank = ixheaacd_calculate_syn_filt_bank_res64; break; case QMF_BANDS_128: self->syn_filter_bank = ixheaacd_calculate_syn_filt_bank; break; default: return IA_XHEAAC_MPS_DEC_INIT_NONFATAL_INVALID_QMF_BAND; break; } return IA_NO_ERROR; } static VOID ia_mps_enc_fwd_mod(WORD32 *time_in, WORD32 *r_subband, WORD32 *i_subband, ia_mps_dec_qmf_tables_struct *qmf_table_ptr) { WORD32 i; for (i = 0; i < 64; i++) { r_subband[i] = time_in[i] - time_in[127 - i]; i_subband[i] = time_in[i] + time_in[127 - i]; } ixheaacd_cos_mod(r_subband, qmf_table_ptr); ixheaacd_sin_mod(i_subband, qmf_table_ptr); } VOID ixheaacd_calc_ana_filt_bank(ia_heaac_mps_state_struct *pstr_mps_state, WORD16 *time_in, WORD32 *r_analysis, WORD32 *i_analysis, WORD32 channel) { ia_mps_dec_qmf_ana_filter_bank *qmf_bank = &pstr_mps_state->qmf_bank[channel]; ia_mps_dec_qmf_tables_struct *qmf_table_ptr = pstr_mps_state->ia_mps_dec_mps_table.qmf_table_ptr; WORD32 i, k, m; WORD32 *syn_buffer = pstr_mps_state->mps_scratch_mem_v; WORD64 accu1 = 0, accu2 = 0; WORD16 flag; WORD32 *fp1; WORD32 *fp2; WORD32 *temp; const WORD32 *start_co_eff_ptr_l; const WORD32 *start_co_eff_ptr_r; const WORD32 *ptr_pf_l, *ptr_pf_r; WORD32 *qmf_states_curr_pos; WORD32 offset = 0; WORD32 n_channels = pstr_mps_state->num_input_channels; WORD32 nr_samples = pstr_mps_state->time_slots; WORD32 qmf_bands = pstr_mps_state->qmf_bands; WORD32 shift = pstr_mps_state->bits_per_sample - 16; WORD32 gain = pstr_mps_state->clip_protect_gain; WORD32 *p_ana_real = r_analysis; WORD32 *p_ana_imag = i_analysis; WORD32 *p_ana_re, *p_ana_im; flag = qmf_bank->flag; if (!flag) { fp1 = qmf_bank->qmf_states_buffer; fp2 = qmf_bank->qmf_states_buffer + qmf_bands; } else { fp2 = qmf_bank->qmf_states_buffer; fp1 = qmf_bank->qmf_states_buffer + qmf_bands; } qmf_bank->qmf_states_curr_pos = ((WORD32 *)(qmf_bank->qmf_states_buffer) + (qmf_bank->offset * qmf_bands)); offset = qmf_bank->offset; start_co_eff_ptr_l = qmf_bank->ref_co_eff_ptr_l + qmf_bank->offset_l; start_co_eff_ptr_r = qmf_bank->ref_co_eff_ptr_r - qmf_bank->offset_r; for (i = 0; i < nr_samples; i++) { const WORD16 *pcoz = qmf_table_ptr->ia_qmf_anl_addt_cos, *psin = qmf_table_ptr->ia_qmf_anl_addt_sin; qmf_states_curr_pos = qmf_bank->qmf_states_curr_pos; p_ana_re = p_ana_real; p_ana_im = p_ana_imag; temp = fp1; fp1 = fp2; fp2 = temp; if (flag) { start_co_eff_ptr_l--; if (start_co_eff_ptr_l == qmf_bank->ref_co_eff_ptr_l) start_co_eff_ptr_l += 5; } else { start_co_eff_ptr_r++; if (start_co_eff_ptr_r == qmf_bank->ref_co_eff_ptr_r) start_co_eff_ptr_r -= 5; } flag++; if ((flag & ONE_BIT_MASK) == 0) flag = 0; if (shift == 0) { for (k = 0; k < qmf_bands; k++) { qmf_states_curr_pos[k] = ixheaacd_mps_mult32_shr_15( (WORD32)time_in[n_channels * (i * qmf_bands + k) + channel], gain); } } else { for (k = 0; k < qmf_bands; k++) { WORD32 temp; temp = ixheaacd_mps_mult32_shr_15( (WORD32)time_in[n_channels * (i * qmf_bands + k) + channel], gain); qmf_states_curr_pos[k] = temp >> shift; } } ptr_pf_l = start_co_eff_ptr_l; ptr_pf_r = start_co_eff_ptr_r; for (k = 0; k < qmf_bands; k++) { { accu1 = (WORD64)((WORD64)ptr_pf_l[0] * (WORD64)fp1[k]); accu1 += (WORD64)((WORD64)ptr_pf_l[1] * (WORD64)fp1[128 + k]); accu1 += (WORD64)((WORD64)ptr_pf_l[2] * (WORD64)fp1[256 + k]); accu1 += (WORD64)((WORD64)ptr_pf_l[3] * (WORD64)fp1[384 + k]); accu1 += (WORD64)((WORD64)ptr_pf_l[4] * (WORD64)fp1[512 + k]); accu2 = (WORD64)((WORD64)ptr_pf_r[-1] * (WORD64)fp2[k]); accu2 += (WORD64)((WORD64)ptr_pf_r[-2] * (WORD64)fp2[128 + k]); accu2 += (WORD64)((WORD64)ptr_pf_r[-3] * (WORD64)fp2[256 + k]); accu2 += (WORD64)((WORD64)ptr_pf_r[-4] * (WORD64)fp2[384 + k]); accu2 += (WORD64)((WORD64)ptr_pf_r[-5] * (WORD64)fp2[512 + k]); } syn_buffer[(qmf_bands << 1) - 1 - k] = (WORD32)((WORD64)accu1 >> 21); syn_buffer[qmf_bands - 1 - k] = (WORD32)((WORD64)accu2 >> 21); ptr_pf_l += 10; ptr_pf_r -= 10; } ia_mps_enc_fwd_mod(syn_buffer, p_ana_re, p_ana_im, qmf_table_ptr); for (m = 0; m < (qmf_bands >> 1); m++) { WORD32 a_cos, b_cos, a_sin, b_sin; WORD32 a_cos1, b_cos1, a_sin1, b_sin1; WORD16 coz = *pcoz++, sin = *psin++; a_cos = ixheaacd_mult32x16in32(p_ana_re[m], coz); b_sin = ixheaacd_mult32x16in32(p_ana_im[m], sin); b_cos = ixheaacd_mult32x16in32(p_ana_im[m], coz); a_sin = ixheaacd_mult32x16in32(p_ana_re[m], sin); p_ana_re[m] = ((a_cos + b_sin) << 1); p_ana_im[m] = ((b_cos - a_sin) << 1); a_cos1 = ixheaacd_mult32x16in32(p_ana_re[qmf_bands - 1 - m], coz); b_sin1 = ixheaacd_mult32x16in32(p_ana_im[qmf_bands - 1 - m], sin); a_sin1 = ixheaacd_mult32x16in32(p_ana_re[qmf_bands - 1 - m], sin); p_ana_re[qmf_bands - 1 - m] = ((-a_cos1 + b_sin1) << 1); b_cos1 = ixheaacd_mult32x16in32(p_ana_im[qmf_bands - 1 - m], coz); p_ana_im[qmf_bands - 1 - m] = ((-b_cos1 - a_sin1) << 1); } qmf_bank->qmf_states_curr_pos = qmf_bank->qmf_states_curr_pos + qmf_bands; offset++; if (offset == 10) { offset = 0; qmf_bank->qmf_states_curr_pos = qmf_bank->qmf_states_buffer; } p_ana_real += MAX_NUM_QMF_BANDS; p_ana_imag += MAX_NUM_QMF_BANDS; } qmf_bank->offset_l = (WORD32)(start_co_eff_ptr_l - qmf_bank->ref_co_eff_ptr_l); qmf_bank->offset_r = (WORD32)(qmf_bank->ref_co_eff_ptr_r - start_co_eff_ptr_r); qmf_bank->flag = flag; qmf_bank->offset = offset; }