summaryrefslogtreecommitdiffstats
path: root/media/libstagefright/codecs/aacdec/calc_auto_corr.cpp
diff options
context:
space:
mode:
Diffstat (limited to 'media/libstagefright/codecs/aacdec/calc_auto_corr.cpp')
-rw-r--r--media/libstagefright/codecs/aacdec/calc_auto_corr.cpp416
1 files changed, 416 insertions, 0 deletions
diff --git a/media/libstagefright/codecs/aacdec/calc_auto_corr.cpp b/media/libstagefright/codecs/aacdec/calc_auto_corr.cpp
new file mode 100644
index 0000000..ee32398
--- /dev/null
+++ b/media/libstagefright/codecs/aacdec/calc_auto_corr.cpp
@@ -0,0 +1,416 @@
+/* ------------------------------------------------------------------
+ * 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: calc_auto_corr.c
+
+
+------------------------------------------------------------------------------
+ REVISION HISTORY
+
+
+ Who: Date: MM/DD/YYYY
+ Description:
+
+------------------------------------------------------------------------------
+ INPUT AND OUTPUT DEFINITIONS
+
+
+
+------------------------------------------------------------------------------
+ FUNCTION DESCRIPTION
+
+
+------------------------------------------------------------------------------
+ REQUIREMENTS
+
+
+------------------------------------------------------------------------------
+ REFERENCES
+
+SC 29 Software Copyright Licencing Disclaimer:
+
+This software module was originally developed by
+ Coding Technologies
+
+and edited by
+ -
+
+in the course of development of the ISO/IEC 13818-7 and ISO/IEC 14496-3
+standards for reference purposes and its performance may not have been
+optimized. This software module is an implementation of one or more tools as
+specified by the ISO/IEC 13818-7 and ISO/IEC 14496-3 standards.
+ISO/IEC gives users free license to this software module or modifications
+thereof for use in products claiming conformance to audiovisual and
+image-coding related ITU Recommendations and/or ISO/IEC International
+Standards. ISO/IEC gives users the same free license to this software module or
+modifications thereof for research purposes and further ISO/IEC standardisation.
+Those intending to use this software module in products are advised that its
+use may infringe existing patents. ISO/IEC have no liability for use of this
+software module or modifications thereof. Copyright is not released for
+products that do not conform to audiovisual and image-coding related ITU
+Recommendations and/or ISO/IEC International Standards.
+The original developer retains full right to modify and use the code for its
+own purpose, assign or donate the code to a third party and to inhibit third
+parties from using the code for products that do not conform to audiovisual and
+image-coding related ITU Recommendations and/or ISO/IEC International Standards.
+This copyright notice must be included in all copies or derivative works.
+Copyright (c) ISO/IEC 2002.
+
+------------------------------------------------------------------------------
+ PSEUDO-CODE
+
+------------------------------------------------------------------------------
+*/
+
+
+/*----------------------------------------------------------------------------
+; INCLUDES
+----------------------------------------------------------------------------*/
+#ifdef AAC_PLUS
+
+
+#include "calc_auto_corr.h"
+#include "aac_mem_funcs.h"
+
+/*----------------------------------------------------------------------------
+; MACROS
+; Define module specific macros here
+----------------------------------------------------------------------------*/
+
+
+/*----------------------------------------------------------------------------
+; DEFINES
+; Include all pre-processor statements here. Include conditional
+; compile variables also.
+----------------------------------------------------------------------------*/
+#include "fxp_mul32.h"
+#include "pv_normalize.h"
+
+#define N 2
+
+/*----------------------------------------------------------------------------
+; LOCAL FUNCTION DEFINITIONS
+; Function Prototype declaration
+----------------------------------------------------------------------------*/
+
+/*----------------------------------------------------------------------------
+; LOCAL STORE/BUFFER/POINTER DEFINITIONS
+; Variable declaration - defined here and used outside this module
+----------------------------------------------------------------------------*/
+
+
+/*----------------------------------------------------------------------------
+; 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 calc_auto_corr_LC(struct ACORR_COEFS *ac,
+ Int32 realBuf[][32],
+ Int32 bd,
+ Int32 len)
+{
+ Int32 j;
+ Int32 temp1;
+ Int32 temp3;
+ Int32 temp5;
+
+ int64_t temp_r01r;
+ int64_t temp_r02r;
+ int64_t temp_r11r;
+ int64_t temp_r12r;
+ int64_t temp_r22r;
+ int64_t max = 0;
+
+
+ temp1 = (realBuf[ 0][bd]) >> N;
+ temp3 = (realBuf[-1][bd]) >> N;
+ temp5 = (realBuf[-2][bd]) >> N;
+
+
+ temp_r11r = fxp_mac64_Q31(0, temp3, temp3); /* [j-1]*[j-1] */
+ temp_r12r = fxp_mac64_Q31(0, temp3, temp5); /* [j-1]*[j-2] */
+ temp_r22r = fxp_mac64_Q31(0, temp5, temp5); /* [j-2]*[j-2] */
+
+ temp_r01r = 0;
+ temp_r02r = 0;
+
+ for (j = 1; j < len; j++)
+ {
+ temp_r01r = fxp_mac64_Q31(temp_r01r, temp1, temp3); /* [j ]*[j-1] */
+ temp_r02r = fxp_mac64_Q31(temp_r02r, temp1, temp5); /* [j ]*[j-2] */
+ temp_r11r = fxp_mac64_Q31(temp_r11r, temp1, temp1); /* [j-1]*[j-1] */
+
+ temp5 = temp3;
+ temp3 = temp1;
+ temp1 = (realBuf[j][bd]) >> N;
+ }
+
+
+ temp_r22r += temp_r11r;
+ temp_r12r += temp_r01r; /* [j-1]*[j-2] */
+
+ temp_r22r = fxp_mac64_Q31(temp_r22r, -temp3, temp3);
+
+ temp_r01r = fxp_mac64_Q31(temp_r01r, temp1, temp3);
+ temp_r02r = fxp_mac64_Q31(temp_r02r, temp1, temp5);
+
+ max |= temp_r01r ^(temp_r01r >> 63);
+ max |= temp_r02r ^(temp_r02r >> 63);
+ max |= temp_r11r;
+ max |= temp_r12r ^(temp_r12r >> 63);
+ max |= temp_r22r;
+
+ if (max)
+ {
+ temp1 = (UInt32)(max >> 32);
+ if (temp1)
+ {
+ temp3 = 33 - pv_normalize(temp1);
+ ac->r01r = (Int32)(temp_r01r >> temp3);
+ ac->r02r = (Int32)(temp_r02r >> temp3);
+ ac->r11r = (Int32)(temp_r11r >> temp3);
+ ac->r12r = (Int32)(temp_r12r >> temp3);
+ ac->r22r = (Int32)(temp_r22r >> temp3);
+
+ }
+ else
+ {
+ temp3 = pv_normalize(((UInt32)max) >> 1) - 2;
+
+ if (temp3 > 0)
+ {
+ ac->r01r = (Int32)(temp_r01r << temp3);
+ ac->r02r = (Int32)(temp_r02r << temp3);
+ ac->r11r = (Int32)(temp_r11r << temp3);
+ ac->r12r = (Int32)(temp_r12r << temp3);
+ ac->r22r = (Int32)(temp_r22r << temp3);
+ }
+ else
+ {
+ temp3 = -temp3;
+ ac->r01r = (Int32)(temp_r01r >> temp3);
+ ac->r02r = (Int32)(temp_r02r >> temp3);
+ ac->r11r = (Int32)(temp_r11r >> temp3);
+ ac->r12r = (Int32)(temp_r12r >> temp3);
+ ac->r22r = (Int32)(temp_r22r >> temp3);
+ }
+
+ }
+
+ /*
+ * ac->det = ac->r11r*ac->r22r - rel*(ac->r12r*ac->r12r);
+ */
+ /* 1/(1 + 1e-6) == 1 - 1e-6 */
+ /* 2^-20 == 1e-6 */
+ ac->det = fxp_mul32_Q30(ac->r12r, ac->r12r);
+
+ ac->det -= ac->det >> 20;
+
+ ac->det = fxp_mul32_Q30(ac->r11r, ac->r22r) - ac->det;
+ }
+ else
+ {
+ pv_memset((void *)ac, 0, sizeof(struct ACORR_COEFS));
+ }
+
+
+}
+
+
+#ifdef HQ_SBR
+
+
+void calc_auto_corr(struct ACORR_COEFS *ac,
+ Int32 realBuf[][32],
+ Int32 imagBuf[][32],
+ Int32 bd,
+ Int32 len)
+{
+
+
+ Int32 j;
+ Int32 temp1;
+ Int32 temp2;
+ Int32 temp3;
+ Int32 temp4;
+ Int32 temp5;
+ Int32 temp6;
+
+ int64_t accu1 = 0;
+ int64_t accu2 = 0;
+ int64_t accu3 = 0;
+ int64_t accu4 = 0;
+ int64_t accu5 = 0;
+
+
+ int64_t temp_r12r;
+ int64_t temp_r12i;
+ int64_t temp_r22r;
+ int64_t max = 0;
+
+
+ temp1 = realBuf[0 ][bd] >> N;
+ temp2 = imagBuf[0 ][bd] >> N;
+ temp3 = realBuf[0-1][bd] >> N;
+ temp4 = imagBuf[0-1][bd] >> N;
+ temp5 = realBuf[0-2][bd] >> N;
+ temp6 = imagBuf[0-2][bd] >> N;
+
+ temp_r22r = fxp_mac64_Q31(0, temp5, temp5);
+ temp_r22r = fxp_mac64_Q31(temp_r22r, temp6, temp6);
+ temp_r12r = fxp_mac64_Q31(0, temp3, temp5);
+ temp_r12r = fxp_mac64_Q31(temp_r12r, temp4, temp6);
+ temp_r12i = -fxp_mac64_Q31(0, temp3, temp6);
+ temp_r12i = fxp_mac64_Q31(temp_r12i, temp4, temp5);
+
+ for (j = 1; j < len; j++)
+ {
+ accu1 = fxp_mac64_Q31(accu1, temp3, temp3);
+ accu1 = fxp_mac64_Q31(accu1, temp4, temp4);
+ accu2 = fxp_mac64_Q31(accu2, temp1, temp3);
+ accu2 = fxp_mac64_Q31(accu2, temp2, temp4);
+ accu3 = fxp_mac64_Q31(accu3, temp2, temp3);
+ accu3 = fxp_mac64_Q31(accu3, -temp1, temp4);
+ accu4 = fxp_mac64_Q31(accu4, temp1, temp5);
+ accu4 = fxp_mac64_Q31(accu4, temp2, temp6);
+ accu5 = fxp_mac64_Q31(accu5, temp2, temp5);
+ accu5 = fxp_mac64_Q31(accu5, -temp1, temp6);
+
+ temp5 = temp3;
+ temp6 = temp4;
+ temp3 = temp1;
+ temp4 = temp2;
+ temp1 = realBuf[j][bd] >> N;
+ temp2 = imagBuf[j][bd] >> N;
+ }
+
+
+ temp_r22r += accu1;
+ temp_r12r += accu2;
+ temp_r12i += accu3;
+
+
+ accu1 = fxp_mac64_Q31(accu1, temp3, temp3);
+ accu1 = fxp_mac64_Q31(accu1, temp4, temp4);
+ accu2 = fxp_mac64_Q31(accu2, temp1, temp3);
+ accu2 = fxp_mac64_Q31(accu2, temp2, temp4);
+ accu3 = fxp_mac64_Q31(accu3, temp2, temp3);
+ accu3 = fxp_mac64_Q31(accu3, -temp1, temp4);
+ accu4 = fxp_mac64_Q31(accu4, temp1, temp5);
+ accu4 = fxp_mac64_Q31(accu4, temp2, temp6);
+ accu5 = fxp_mac64_Q31(accu5, temp2, temp5);
+ accu5 = fxp_mac64_Q31(accu5, -temp1, temp6);
+
+
+ max |= accu5 ^(accu5 >> 63);
+ max |= accu4 ^(accu4 >> 63);
+ max |= accu3 ^(accu3 >> 63);
+ max |= accu2 ^(accu2 >> 63);
+ max |= accu1;
+ max |= temp_r12r ^(temp_r12r >> 63);
+ max |= temp_r12i ^(temp_r12i >> 63);
+ max |= temp_r22r;
+
+ if (max)
+ {
+
+ temp1 = (UInt32)(max >> 32);
+ if (temp1)
+ {
+ temp1 = 34 - pv_normalize(temp1);
+ ac->r11r = (Int32)(accu1 >> temp1);
+ ac->r01r = (Int32)(accu2 >> temp1);
+ ac->r01i = (Int32)(accu3 >> temp1);
+ ac->r02r = (Int32)(accu4 >> temp1);
+ ac->r02i = (Int32)(accu5 >> temp1);
+ ac->r12r = (Int32)(temp_r12r >> temp1);
+ ac->r12i = (Int32)(temp_r12i >> temp1);
+ ac->r22r = (Int32)(temp_r22r >> temp1);
+ }
+ else
+ {
+ temp1 = pv_normalize(((UInt32)max) >> 1) - 3;
+
+ if (temp1 > 0)
+ {
+ ac->r11r = (Int32)(accu1 << temp1);
+ ac->r01r = (Int32)(accu2 << temp1);
+ ac->r01i = (Int32)(accu3 << temp1);
+ ac->r02r = (Int32)(accu4 << temp1);
+ ac->r02i = (Int32)(accu5 << temp1);
+ ac->r12r = (Int32)(temp_r12r << temp1);
+ ac->r12i = (Int32)(temp_r12i << temp1);
+ ac->r22r = (Int32)(temp_r22r << temp1);
+ }
+ else
+ {
+ temp1 = -temp1;
+ ac->r11r = (Int32)(accu1 >> temp1);
+ ac->r01r = (Int32)(accu2 >> temp1);
+ ac->r01i = (Int32)(accu3 >> temp1);
+ ac->r02r = (Int32)(accu4 >> temp1);
+ ac->r02i = (Int32)(accu5 >> temp1);
+ ac->r12r = (Int32)(temp_r12r >> temp1);
+ ac->r12i = (Int32)(temp_r12i >> temp1);
+ ac->r22r = (Int32)(temp_r22r >> temp1);
+ }
+
+ }
+
+ /*
+ * ac->det = ac->r11r*ac->r22r - rel*(ac->r12r*ac->r12r);
+ */
+ /* 1/(1 + 1e-6) == 1 - 1e-6 */
+ /* 2^-20 == 1e-6 */
+
+ ac->det = fxp_mul32_Q29(ac->r12i, ac->r12i);
+ ac->det = fxp_mac32_Q29(ac->r12r, ac->r12r, ac->det);
+
+ ac->det -= ac->det >> 20;
+
+ ac->det = -fxp_msu32_Q29(ac->r11r, ac->r22r, ac->det);
+
+ }
+ else
+ {
+ pv_memset((void *)ac, 0, sizeof(struct ACORR_COEFS));
+ }
+
+}
+
+#endif
+
+
+
+
+
+#endif
+
+