werunplugged/unplugged-system
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
main
unplugged-system/external/libxaac/decoder/ixheaacd_mps_polyphase.c

1183 lines
48 KiB
C
Raw Permalink Normal View History

Initial commit: AOSP 14 with modifications for Unplugged OS
2025-10-06 13:59:42 +00:00
/******************************************************************************
*
* 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 <string.h>
#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;
}
Reference in New Issue Copy Permalink