summaryrefslogtreecommitdiffstats
path: root/media/libstagefright/codecs/aacdec/synthesis_sub_band.cpp
diff options
context:
space:
mode:
Diffstat (limited to 'media/libstagefright/codecs/aacdec/synthesis_sub_band.cpp')
-rw-r--r--media/libstagefright/codecs/aacdec/synthesis_sub_band.cpp483
1 files changed, 483 insertions, 0 deletions
diff --git a/media/libstagefright/codecs/aacdec/synthesis_sub_band.cpp b/media/libstagefright/codecs/aacdec/synthesis_sub_band.cpp
new file mode 100644
index 0000000..c1418e3
--- /dev/null
+++ b/media/libstagefright/codecs/aacdec/synthesis_sub_band.cpp
@@ -0,0 +1,483 @@
+/* ------------------------------------------------------------------
+ * Copyright (C) 1998-2009 PacketVideo
+ *
+ * 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.
+ * -------------------------------------------------------------------
+ */
+/*
+
+ Filename: synthesis_sub_band.c
+
+------------------------------------------------------------------------------
+ REVISION HISTORY
+
+
+ Who: Date: MM/DD/YYYY
+ Description:
+
+------------------------------------------------------------------------------
+ INPUT AND OUTPUT DEFINITIONS
+
+ Int32 vec[], Input vector, 32-bit
+ const Int32 *cosTerms, Cosine Terms
+ Int32 *scratch_mem Scratch memory
+
+
+------------------------------------------------------------------------------
+ FUNCTION DESCRIPTION
+
+ Implement root squared of a number
+
+------------------------------------------------------------------------------
+ REQUIREMENTS
+
+
+------------------------------------------------------------------------------
+ REFERENCES
+
+------------------------------------------------------------------------------
+ PSEUDO-CODE
+
+------------------------------------------------------------------------------
+*/
+
+
+/*----------------------------------------------------------------------------
+; INCLUDES
+----------------------------------------------------------------------------*/
+
+#ifdef AAC_PLUS
+
+
+#include "pv_audio_type_defs.h"
+#include "fxp_mul32.h"
+#include "dct64.h"
+#include "synthesis_sub_band.h"
+#include "mdst.h"
+#include "dct16.h"
+
+
+/*----------------------------------------------------------------------------
+; MACROS
+; Define module specific macros here
+----------------------------------------------------------------------------*/
+
+
+/*----------------------------------------------------------------------------
+; DEFINES
+; Include all pre-processor statements here. Include conditional
+; compile variables also.
+----------------------------------------------------------------------------*/
+
+#define Qfmt_30(x) (Int32)(x*((Int32)(1<<30)) + (x>=0?0.5F:-0.5F))
+#define Qfmt_25(x) (Int32)(x*((Int32)(1<<25))*(1.5625F) + (x>=0?0.5F:-0.5F))
+
+#define SCALE_DOWN_LP Qfmt_30(0.075000F) /* 3/40 */
+#define SCALE_DOWN_HQ Qfmt_30(0.009375F*0.64F) /* 3/40 * 1/8 */
+
+/*----------------------------------------------------------------------------
+; LOCAL FUNCTION DEFINITIONS
+; Function Prototype declaration
+----------------------------------------------------------------------------*/
+
+/*----------------------------------------------------------------------------
+; LOCAL STORE/BUFFER/POINTER DEFINITIONS
+; Variable declaration - defined here and used outside this module
+----------------------------------------------------------------------------*/
+
+const Int32 CosTable_64[64] =
+{
+ Qfmt_25(0.50003765191555F), Qfmt_25(40.74468810335183F), Qfmt_25(0.50033903744282F), Qfmt_25(13.58429025728446F),
+ Qfmt_25(0.50094271763809F), Qfmt_25(8.15384860246681F), Qfmt_25(0.50185051748424F), Qfmt_25(5.82768837784465F),
+ Qfmt_25(0.50306519130137F), Qfmt_25(4.53629093696936F), Qfmt_25(0.50459044322165F), Qfmt_25(3.71524273832697F),
+ Qfmt_25(0.50643095492855F), Qfmt_25(3.14746219178191F), Qfmt_25(0.50859242104981F), Qfmt_25(2.73164502877394F),
+ Qfmt_25(0.51108159270668F), Qfmt_25(2.41416000025008F), Qfmt_25(0.51390632984754F), Qfmt_25(2.16395781875198F),
+ Qfmt_25(0.51707566313349F), Qfmt_25(1.96181784857117F), Qfmt_25(0.52059986630189F), Qfmt_25(1.79520521907789F),
+ Qfmt_25(0.52449054011472F), Qfmt_25(1.65559652426412F), Qfmt_25(0.52876070920749F), Qfmt_25(1.53699410085250F),
+ Qfmt_25(0.53342493339713F), Qfmt_25(1.43505508844143F), Qfmt_25(0.53849943529198F), Qfmt_25(1.34655762820629F),
+ Qfmt_25(0.54400224638178F), Qfmt_25(1.26906117169912F), Qfmt_25(0.54995337418324F), Qfmt_25(1.20068325572942F),
+ Qfmt_25(0.55637499348989F), Qfmt_25(1.13994867510150F), Qfmt_25(0.56329166534170F), Qfmt_25(1.08568506425801F),
+ Qfmt_25(0.57073058801215F), Qfmt_25(1.03694904091039F), Qfmt_25(0.57872188513482F), Qfmt_25(0.99297296126755F),
+ Qfmt_25(0.58729893709379F), Qfmt_25(0.95312587439212F), Qfmt_25(0.59649876302446F), Qfmt_25(0.91688444618465F),
+ Qfmt_25(0.60636246227215F), Qfmt_25(0.88381100455962F), Qfmt_25(0.61693572600507F), Qfmt_25(0.85353675100661F),
+ Qfmt_25(0.62826943197077F), Qfmt_25(0.82574877386279F), Qfmt_25(0.64042033824166F), Qfmt_25(0.80017989562169F),
+ Qfmt_25(0.65345189537513F), Qfmt_25(0.77660065823396F), Qfmt_25(0.66743520092634F), Qfmt_25(0.75481293911653F),
+ Qfmt_25(0.68245012597642F), Qfmt_25(0.73464482364786F), Qfmt_25(0.69858665064723F), Qfmt_25(0.71594645497057F),
+};
+
+
+/*----------------------------------------------------------------------------
+; EXTERNAL FUNCTION REFERENCES
+; Declare functions defined elsewhere and referenced in this module
+----------------------------------------------------------------------------*/
+
+/*----------------------------------------------------------------------------
+; EXTERNAL GLOBAL STORE/BUFFER/POINTER REFERENCES
+; Declare variables used in this module but defined elsewhere
+----------------------------------------------------------------------------*/
+
+/*----------------------------------------------------------------------------
+; FUNCTION CODE
+----------------------------------------------------------------------------*/
+
+
+
+void synthesis_sub_band_LC(Int32 Sr[], Int16 data[])
+{
+
+ Int32 *temp_o1 = (Int32 *) & data[0];
+
+ Int i;
+ Int32 *pt_temp_e;
+ Int32 *pt_temp_o = temp_o1;
+ Int32 *pt_temp_x = &Sr[63];
+ Int32 temp1;
+ Int32 temp2;
+ Int32 temp3;
+ Int32 temp11;
+
+ Int16 *pt_data_1;
+ Int16 *pt_data_2;
+
+ Int32 *pt_Sr_1 = Sr;
+ Int16 tmp1;
+ Int16 tmp2;
+ Int16 tmp11;
+ Int16 tmp22;
+ const Int32 *pt_cosTerms = CosTable_48;
+
+
+ temp2 = *(pt_temp_x--);
+ for (i = 20; i != 0; i--)
+ {
+ temp1 = *(pt_Sr_1);
+ temp3 = *(pt_cosTerms++);
+ *(pt_Sr_1++) = temp1 + temp2;
+ *(pt_temp_o++) = fxp_mul32_Q31((temp1 - temp2), temp3) << 1;
+ temp2 = *(pt_temp_x--);
+ }
+
+ for (i = 12; i != 0; i--)
+ {
+ temp1 = *(pt_Sr_1);
+ temp3 = *(pt_cosTerms++);
+ *(pt_Sr_1++) = temp1 + temp2;
+ *(pt_temp_o++) = fxp_mul32_Q26((temp1 - temp2), temp3);
+ temp2 = *(pt_temp_x--);
+ }
+
+
+ pv_split_LC(temp_o1, &Sr[32]);
+
+ dct_16(temp_o1, 1); // Even terms
+ dct_16(&Sr[32], 1); // Odd terms
+
+ /* merge */
+
+
+ pt_Sr_1 = &temp_o1[31];
+ pt_temp_e = &temp_o1[15];
+ pt_temp_o = &Sr[47];
+
+ temp1 = *(pt_temp_o--);
+ *(pt_Sr_1--) = temp1;
+ for (i = 5; i != 0; i--)
+ {
+ temp2 = *(pt_temp_o--);
+ *(pt_Sr_1--) = *(pt_temp_e--);
+ *(pt_Sr_1--) = temp1 + temp2;
+ temp3 = *(pt_temp_o--);
+ *(pt_Sr_1--) = *(pt_temp_e--);
+ *(pt_Sr_1--) = temp2 + temp3;
+ temp1 = *(pt_temp_o--);
+ *(pt_Sr_1--) = *(pt_temp_e--);
+ *(pt_Sr_1--) = temp1 + temp3;
+ }
+
+
+ pv_split_LC(Sr, &Sr[32]);
+
+ dct_16(Sr, 1); // Even terms
+ dct_16(&Sr[32], 1); // Odd terms
+
+
+ pt_temp_x = &temp_o1[31];
+ pt_temp_e = &Sr[15];
+ pt_temp_o = &Sr[47];
+
+ pt_data_1 = &data[95];
+
+ temp2 = *(pt_temp_x--);
+ temp11 = *(pt_temp_x--);
+ temp1 = *(pt_temp_o--);
+
+ *(pt_data_1--) = (Int16) fxp_mul32_Q31(temp2, SCALE_DOWN_LP);
+ *(pt_data_1--) = (Int16) fxp_mul32_Q31(temp1, SCALE_DOWN_LP);
+
+ for (i = 5; i != 0; i--)
+ {
+ *(pt_data_1--) = (Int16) fxp_mul32_Q31((temp11 + temp2), SCALE_DOWN_LP);
+ temp3 = *(pt_temp_x--);
+ *(pt_data_1--) = (Int16) fxp_mul32_Q31(*(pt_temp_e--), SCALE_DOWN_LP);
+ temp2 = *(pt_temp_o--);
+ *(pt_data_1--) = (Int16) fxp_mul32_Q31((temp11 + temp3), SCALE_DOWN_LP);
+ temp11 = *(pt_temp_x--);
+ *(pt_data_1--) = (Int16) fxp_mul32_Q31((temp1 + temp2), SCALE_DOWN_LP);
+
+
+ *(pt_data_1--) = (Int16) fxp_mul32_Q31((temp11 + temp3), SCALE_DOWN_LP);
+ temp1 = *(pt_temp_x--);
+ *(pt_data_1--) = (Int16) fxp_mul32_Q31(*(pt_temp_e--), SCALE_DOWN_LP);
+ temp3 = *(pt_temp_o--);
+ *(pt_data_1--) = (Int16) fxp_mul32_Q31((temp11 + temp1), SCALE_DOWN_LP);
+ temp11 = *(pt_temp_x--);
+ *(pt_data_1--) = (Int16) fxp_mul32_Q31((temp2 + temp3), SCALE_DOWN_LP);
+
+
+ *(pt_data_1--) = (Int16) fxp_mul32_Q31((temp11 + temp1), SCALE_DOWN_LP);
+ temp2 = *(pt_temp_x--);
+ *(pt_data_1--) = (Int16) fxp_mul32_Q31(*(pt_temp_e--), SCALE_DOWN_LP);
+ temp1 = *(pt_temp_o--);
+ *(pt_data_1--) = (Int16) fxp_mul32_Q31((temp11 + temp2), SCALE_DOWN_LP);
+ temp11 = *(pt_temp_x--);
+ *(pt_data_1--) = (Int16) fxp_mul32_Q31((temp1 + temp3), SCALE_DOWN_LP);
+ }
+
+ *(pt_data_1--) = (Int16) fxp_mul32_Q31((temp11 + temp2), SCALE_DOWN_LP);
+ *(pt_data_1--) = (Int16) fxp_mul32_Q31(*(pt_temp_e), SCALE_DOWN_LP);
+
+ /* ---- merge ends---- */
+
+
+ pt_data_1 = &data[95];
+ pt_data_2 = &data[96];
+
+ *(pt_data_2++) = 0;
+ tmp1 = *(pt_data_1--);
+ tmp2 = *(pt_data_1--);
+ tmp11 = *(pt_data_1--);
+ tmp22 = *(pt_data_1--);
+
+ for (i = 7; i != 0; i--)
+ {
+ *(pt_data_2++) = (-tmp1);
+ *(pt_data_2++) = (-tmp2);
+ *(pt_data_2++) = (-tmp11);
+ *(pt_data_2++) = (-tmp22);
+ tmp1 = *(pt_data_1--);
+ tmp2 = *(pt_data_1--);
+ tmp11 = *(pt_data_1--);
+ tmp22 = *(pt_data_1--);
+ }
+
+
+ *(pt_data_2++) = (-tmp1);
+ *(pt_data_2++) = (-tmp2);
+ *(pt_data_2++) = (-tmp11);
+
+ pt_data_2 = &data[0];
+
+ *(pt_data_2++) = tmp22;
+ tmp1 = *(pt_data_1--);
+ tmp2 = *(pt_data_1--);
+ tmp11 = *(pt_data_1--);
+ tmp22 = *(pt_data_1--);
+
+ for (i = 7; i != 0; i--)
+ {
+ *(pt_data_2++) = tmp1;
+ *(pt_data_2++) = tmp2;
+ *(pt_data_2++) = tmp11;
+ *(pt_data_2++) = tmp22;
+ tmp1 = *(pt_data_1--);
+ tmp2 = *(pt_data_1--);
+ tmp11 = *(pt_data_1--);
+ tmp22 = *(pt_data_1--);
+ }
+
+ *(pt_data_2++) = tmp1;
+ *(pt_data_2++) = tmp2;
+ *(pt_data_2++) = tmp11;
+ *(pt_data_2) = tmp22;
+
+}
+
+
+void synthesis_sub_band_LC_down_sampled(Int32 Sr[], Int16 data[])
+{
+
+ Int i ;
+ Int16 *pt_data_1;
+
+ pt_data_1 = &data[0];
+
+ dct_32(Sr);
+
+ for (i = 0; i < 16; i++)
+ {
+ pt_data_1[ i] = (Int16)(Sr[16-i] >> 5);
+ pt_data_1[16+i] = (Int16)(Sr[i] >> 5);
+ pt_data_1[32+i] = (Int16)(Sr[16+i] >> 5);
+ }
+ for (i = 0; i < 15; i++)
+ {
+ pt_data_1[49+i] = (Int16)(-Sr[31-i] >> 5);
+ }
+ pt_data_1[48] = 0;
+}
+
+
+#ifdef HQ_SBR
+
+void synthesis_sub_band(Int32 Sr[], Int32 Si[], Int16 data[])
+{
+
+
+ Int32 i ;
+ Int16 *pt_data_1;
+ Int16 *pt_data_2;
+ Int32 *pt_Sr_1;
+ Int32 *pt_Sr_2;
+ Int32 *pt_Si_1;
+ Int32 *pt_Si_2;
+
+ Int32 tmp1;
+ Int32 tmp2;
+ Int32 tmp3;
+ Int32 tmp4;
+
+ Int32 cosx;
+ const Int32 *pt_CosTable = CosTable_64;
+
+
+ pt_Sr_1 = &Sr[0];
+ pt_Sr_2 = &Sr[63];
+
+ pt_Si_1 = &Si[0];
+ pt_Si_2 = &Si[63];
+
+
+ tmp3 = *pt_Sr_1;
+
+ for (i = 32; i != 0; i--)
+ {
+ tmp4 = *pt_Si_2;
+ cosx = *(pt_CosTable++);
+ *(pt_Sr_1++) = fxp_mul32_Q31(tmp3, cosx);
+ tmp3 = *pt_Si_1;
+ *(pt_Si_1++) = fxp_mul32_Q31(tmp4, cosx);
+ tmp4 = *pt_Sr_2;
+ cosx = *(pt_CosTable++);
+ *(pt_Si_2--) = fxp_mul32_Q31(tmp3, cosx);
+ *(pt_Sr_2--) = fxp_mul32_Q31(tmp4, cosx);
+ tmp3 = *pt_Sr_1;
+ }
+
+
+ dct_64(Sr, (Int32 *)data);
+ dct_64(Si, (Int32 *)data);
+
+
+ pt_data_1 = &data[0];
+ pt_data_2 = &data[127];
+
+ pt_Sr_1 = &Sr[0];
+ pt_Si_1 = &Si[0];
+
+ tmp1 = *(pt_Sr_1++);
+ tmp3 = *(pt_Sr_1++);
+ tmp2 = *(pt_Si_1++);
+ tmp4 = *(pt_Si_1++);
+
+ for (i = 32; i != 0; i--)
+ {
+ *(pt_data_1++) = (Int16) fxp_mul32_Q31((tmp2 - tmp1), SCALE_DOWN_HQ);
+ *(pt_data_1++) = (Int16) fxp_mul32_Q31(-(tmp3 + tmp4), SCALE_DOWN_HQ);
+ *(pt_data_2--) = (Int16) fxp_mul32_Q31((tmp1 + tmp2), SCALE_DOWN_HQ);
+ *(pt_data_2--) = (Int16) fxp_mul32_Q31((tmp3 - tmp4), SCALE_DOWN_HQ);
+
+ tmp1 = *(pt_Sr_1++);
+ tmp3 = *(pt_Sr_1++);
+ tmp2 = *(pt_Si_1++);
+ tmp4 = *(pt_Si_1++);
+ }
+
+}
+
+
+const Int32 exp_m0_25_phi[32] =
+{
+
+ 0x7FFEFE6E, 0x7FEAFB4A, 0x7FC2F827, 0x7F87F505,
+ 0x7F38F1E4, 0x7ED6EEC6, 0x7E60EBAB, 0x7DD6E892,
+ 0x7D3AE57D, 0x7C89E26D, 0x7BC6DF61, 0x7AEFDC59,
+ 0x7A06D958, 0x790AD65C, 0x77FBD367, 0x76D9D079,
+ 0x75A6CD92, 0x7460CAB2, 0x7308C7DB, 0x719EC50D,
+ 0x7023C248, 0x6E97BF8C, 0x6CF9BCDA, 0x6B4BBA33,
+ 0x698CB796, 0x67BDB505, 0x65DEB27F, 0x63EFB005,
+ 0x61F1AD97, 0x5FE4AB36, 0x5DC8A8E2, 0x5B9DA69C
+};
+
+void synthesis_sub_band_down_sampled(Int32 Sr[], Int32 Si[], Int16 data[])
+{
+
+ Int16 k;
+ Int16 *pt_data_1;
+ Int32 exp_m0_25;
+ const Int32 *pt_exp = exp_m0_25_phi;
+
+ Int32 *XX = Sr;
+ Int32 *YY = (Int32 *)data;
+ Int32 tmp1;
+ Int32 tmp2;
+
+ for (k = 0; k < 32; k++)
+ {
+ exp_m0_25 = *(pt_exp++);
+ tmp1 = Sr[k];
+ tmp2 = Si[k];
+ XX[k] = cmplx_mul32_by_16(-tmp1, tmp2, exp_m0_25);
+ YY[31-k] = cmplx_mul32_by_16(tmp2, tmp1, exp_m0_25);
+ }
+
+ mdct_32(XX);
+ mdct_32(YY);
+
+ for (k = 0; k < 32; k++)
+ {
+ Si[k] = YY[k];
+ }
+
+ pt_data_1 = data;
+
+ for (k = 0; k < 16; k++)
+ {
+ *(pt_data_1++) = (Int16)((XX[2*k ] + Si[2*k ]) >> 14);
+ *(pt_data_1++) = (Int16)((XX[2*k+1] - Si[2*k+1]) >> 14);
+ }
+
+ for (k = 15; k > -1; k--)
+ {
+ *(pt_data_1++) = (Int16)(-(XX[2*k+1] + Si[2*k+1]) >> 14);
+ *(pt_data_1++) = (Int16)(-(XX[2*k ] - Si[2*k ]) >> 14);
+ }
+
+}
+
+
+#endif /* HQ_SBR */
+
+#endif /* AAC_PLUS */
+
+
generated by cgit v1.1 at 2024-05-28 18:56:42 +0000