| /* ------------------------------------------------------------------ |
| * Copyright (C) 2008 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 |
| |
| Date: 07/22/2003 |
| |
| ------------------------------------------------------------------------------ |
| REVISION HISTORY |
| |
| |
| 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 temp_r01r; |
| int64 temp_r02r; |
| int64 temp_r11r; |
| int64 temp_r12r; |
| int64 temp_r22r; |
| int64 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 accu1 = 0; |
| int64 accu2 = 0; |
| int64 accu3 = 0; |
| int64 accu4 = 0; |
| int64 accu5 = 0; |
| |
| |
| int64 temp_r12r; |
| int64 temp_r12i; |
| int64 temp_r22r; |
| int64 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 |
| |
| |