From 2228e360595641dd906bf1773307f43d304f5b2e Mon Sep 17 00:00:00 2001 From: The Android Open Source Project Date: Wed, 11 Jul 2012 10:15:24 -0700 Subject: Snapshot 2bda038c163298531d47394bc2c09e1409c5d0db Change-Id: If584e579464f28b97d50e51fc76ba654a5536c54 --- libSBRenc/src/mh_det.cpp | 1438 ++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 1438 insertions(+) create mode 100644 libSBRenc/src/mh_det.cpp (limited to 'libSBRenc/src/mh_det.cpp') diff --git a/libSBRenc/src/mh_det.cpp b/libSBRenc/src/mh_det.cpp new file mode 100644 index 0000000..a7fa208 --- /dev/null +++ b/libSBRenc/src/mh_det.cpp @@ -0,0 +1,1438 @@ + +/* ----------------------------------------------------------------------------------------------------------- +Software License for The Fraunhofer FDK AAC Codec Library for Android + +© Copyright 1995 - 2012 Fraunhofer-Gesellschaft zur Förderung der angewandten Forschung e.V. + All rights reserved. + + 1. INTRODUCTION +The Fraunhofer FDK AAC Codec Library for Android ("FDK AAC Codec") is software that implements +the MPEG Advanced Audio Coding ("AAC") encoding and decoding scheme for digital audio. +This FDK AAC Codec software is intended to be used on a wide variety of Android devices. + +AAC's HE-AAC and HE-AAC v2 versions are regarded as today's most efficient general perceptual +audio codecs. AAC-ELD is considered the best-performing full-bandwidth communications codec by +independent studies and is widely deployed. AAC has been standardized by ISO and IEC as part +of the MPEG specifications. + +Patent licenses for necessary patent claims for the FDK AAC Codec (including those of Fraunhofer) +may be obtained through Via Licensing (www.vialicensing.com) or through the respective patent owners +individually for the purpose of encoding or decoding bit streams in products that are compliant with +the ISO/IEC MPEG audio standards. Please note that most manufacturers of Android devices already license +these patent claims through Via Licensing or directly from the patent owners, and therefore FDK AAC Codec +software may already be covered under those patent licenses when it is used for those licensed purposes only. + +Commercially-licensed AAC software libraries, including floating-point versions with enhanced sound quality, +are also available from Fraunhofer. Users are encouraged to check the Fraunhofer website for additional +applications information and documentation. + +2. COPYRIGHT LICENSE + +Redistribution and use in source and binary forms, with or without modification, are permitted without +payment of copyright license fees provided that you satisfy the following conditions: + +You must retain the complete text of this software license in redistributions of the FDK AAC Codec or +your modifications thereto in source code form. + +You must retain the complete text of this software license in the documentation and/or other materials +provided with redistributions of the FDK AAC Codec or your modifications thereto in binary form. +You must make available free of charge copies of the complete source code of the FDK AAC Codec and your +modifications thereto to recipients of copies in binary form. + +The name of Fraunhofer may not be used to endorse or promote products derived from this library without +prior written permission. + +You may not charge copyright license fees for anyone to use, copy or distribute the FDK AAC Codec +software or your modifications thereto. + +Your modified versions of the FDK AAC Codec must carry prominent notices stating that you changed the software +and the date of any change. For modified versions of the FDK AAC Codec, the term +"Fraunhofer FDK AAC Codec Library for Android" must be replaced by the term +"Third-Party Modified Version of the Fraunhofer FDK AAC Codec Library for Android." + +3. NO PATENT LICENSE + +NO EXPRESS OR IMPLIED LICENSES TO ANY PATENT CLAIMS, including without limitation the patents of Fraunhofer, +ARE GRANTED BY THIS SOFTWARE LICENSE. Fraunhofer provides no warranty of patent non-infringement with +respect to this software. + +You may use this FDK AAC Codec software or modifications thereto only for purposes that are authorized +by appropriate patent licenses. + +4. DISCLAIMER + +This FDK AAC Codec software is provided by Fraunhofer on behalf of the copyright holders and contributors +"AS IS" and WITHOUT ANY EXPRESS OR IMPLIED WARRANTIES, including but not limited to the implied warranties +of merchantability and fitness for a particular purpose. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR +CONTRIBUTORS BE LIABLE for any direct, indirect, incidental, special, exemplary, or consequential damages, +including but not limited to procurement of substitute goods or services; loss of use, data, or profits, +or business interruption, however caused and on any theory of liability, whether in contract, strict +liability, or tort (including negligence), arising in any way out of the use of this software, even if +advised of the possibility of such damage. + +5. CONTACT INFORMATION + +Fraunhofer Institute for Integrated Circuits IIS +Attention: Audio and Multimedia Departments - FDK AAC LL +Am Wolfsmantel 33 +91058 Erlangen, Germany + +www.iis.fraunhofer.de/amm +amm-info@iis.fraunhofer.de +----------------------------------------------------------------------------------------------------------- */ + +#include "mh_det.h" + +#include "sbr_ram.h" +#include "sbr_misc.h" + + +#include "genericStds.h" + +#define SFM_SHIFT 2 /* Attention: SFM_SCALE depends on SFM_SHIFT */ +#define SFM_SCALE (MAXVAL_DBL >> SFM_SHIFT) /* 1.0 >> SFM_SHIFT */ + + +/*!< Detector Parameters for AAC core codec. */ +static const DETECTOR_PARAMETERS_MH paramsAac = { +9, /*!< deltaTime */ +{ +FL2FXCONST_DBL(20.0f*RELAXATION_FLOAT), /*!< thresHoldDiff */ +FL2FXCONST_DBL(1.26f*RELAXATION_FLOAT), /*!< thresHoldDiffGuide */ +FL2FXCONST_DBL(15.0f*RELAXATION_FLOAT), /*!< thresHoldTone */ +FL2FXCONST_DBL((1.0f/15.0f)*RELAXATION_FLOAT), /*!< invThresHoldTone */ +FL2FXCONST_DBL(1.26f*RELAXATION_FLOAT), /*!< thresHoldToneGuide */ +FL2FXCONST_DBL(0.3f)>>SFM_SHIFT, /*!< sfmThresSbr */ +FL2FXCONST_DBL(0.1f)>>SFM_SHIFT, /*!< sfmThresOrig */ +FL2FXCONST_DBL(0.3f), /*!< decayGuideOrig */ +FL2FXCONST_DBL(0.5f), /*!< decayGuideDiff */ +FL2FXCONST_DBL(-0.000112993269), /* LD64(FL2FXCONST_DBL(0.995f)) */ /*!< derivThresMaxLD64 */ +FL2FXCONST_DBL(-0.000112993269), /* LD64(FL2FXCONST_DBL(0.995f)) */ /*!< derivThresBelowLD64 */ +FL2FXCONST_DBL(-0.005030126483f) /* LD64(FL2FXCONST_DBL(0.8f)) */ /*!< derivThresAboveLD64 */ +}, +50 /*!< maxComp */ +}; + +/*!< Detector Parameters for AAC LD core codec. */ +static const DETECTOR_PARAMETERS_MH paramsAacLd = { +16, /*!< Delta time. */ +{ +FL2FXCONST_DBL(25.0f*RELAXATION_FLOAT), /*!< thresHoldDiff */ +FL2FXCONST_DBL(1.26f*RELAXATION_FLOAT), /*!< tresHoldDiffGuide */ +FL2FXCONST_DBL(15.0f*RELAXATION_FLOAT), /*!< thresHoldTone */ +FL2FXCONST_DBL((1.0f/15.0f)*RELAXATION_FLOAT), /*!< invThresHoldTone */ +FL2FXCONST_DBL(1.26f*RELAXATION_FLOAT), /*!< thresHoldToneGuide */ +FL2FXCONST_DBL(0.3f)>>SFM_SHIFT, /*!< sfmThresSbr */ +FL2FXCONST_DBL(0.1f)>>SFM_SHIFT, /*!< sfmThresOrig */ +FL2FXCONST_DBL(0.3f), /*!< decayGuideOrig */ +FL2FXCONST_DBL(0.2f), /*!< decayGuideDiff */ +FL2FXCONST_DBL(-0.000112993269), /* LD64(FL2FXCONST_DBL(0.995f)) */ /*!< derivThresMaxLD64 */ +FL2FXCONST_DBL(-0.000112993269), /* LD64(FL2FXCONST_DBL(0.995f)) */ /*!< derivThresBelowLD64 */ +FL2FXCONST_DBL(-0.005030126483f) /* LD64(FL2FXCONST_DBL(0.8f)) */ /*!< derivThresAboveLD64 */ +}, +50 /*!< maxComp */ +}; + + +/**************************************************************************/ +/*! + \brief Calculates the difference in tonality between original and SBR + for a given time and frequency region. + + The values for pDiffMapped2Scfb are scaled by RELAXATION + + \return none. + +*/ +/**************************************************************************/ +static void diff(FIXP_DBL *RESTRICT pTonalityOrig, + FIXP_DBL *pDiffMapped2Scfb, + const UCHAR *RESTRICT pFreqBandTable, + INT nScfb, + SCHAR *indexVector) +{ + UCHAR i, ll, lu, k; + FIXP_DBL maxValOrig, maxValSbr, tmp; + INT scale; + + for(i=0; i < nScfb; i++){ + ll = pFreqBandTable[i]; + lu = pFreqBandTable[i+1]; + + maxValOrig = FL2FXCONST_DBL(0.0f); + maxValSbr = FL2FXCONST_DBL(0.0f); + + for(k=ll;k= RELAXATION)) { + tmp = fDivNorm(maxValOrig, maxValSbr, &scale); + pDiffMapped2Scfb[i] = scaleValue(fMult(tmp,RELAXATION_FRACT), fixMax(-(DFRACT_BITS-1),(scale-RELAXATION_SHIFT))); + } + else { + pDiffMapped2Scfb[i] = maxValOrig; + } + } +} + + +/**************************************************************************/ +/*! + \brief Calculates a flatness measure of the tonality measures. + + Calculation of the power function and using scalefactor for basis: + Using log2: + z = (2^k * x)^y; + z' = CalcLd(z) = y*CalcLd(x) + y*k; + z = CalcInvLd(z'); + + Using ld64: + z = (2^k * x)^y; + z' = CalcLd64(z) = y*CalcLd64(x)/64 + y*k/64; + z = CalcInvLd64(z'); + + The values pSfmOrigVec and pSfmSbrVec are scaled by the factor 1/4.0 + + \return none. + +*/ +/**************************************************************************/ +static void calculateFlatnessMeasure(FIXP_DBL *pQuotaBuffer, + SCHAR *indexVector, + FIXP_DBL *pSfmOrigVec, + FIXP_DBL *pSfmSbrVec, + const UCHAR *pFreqBandTable, + INT nSfb) +{ + INT i,j; + FIXP_DBL invBands,tmp1,tmp2; + INT shiftFac0,shiftFacSum0; + INT shiftFac1,shiftFacSum1; + FIXP_DBL accu; + + for(i=0;i>2); + pSfmSbrVec[i] = (FIXP_DBL)(MAXVAL_DBL>>2); + + if(lu - ll > 1){ + FIXP_DBL amOrig,amTransp,gmOrig,gmTransp,sfmOrig,sfmTransp; + invBands = GetInvInt(lu-ll); + shiftFacSum0 = 0; + shiftFacSum1 = 0; + amOrig = amTransp = FL2FXCONST_DBL(0.0f); + gmOrig = gmTransp = (FIXP_DBL)MAXVAL_DBL; + + for(j= ll; j FL2FXCONST_DBL(0.0f)) { + + tmp1 = CalcLdData(gmOrig); /* CalcLd64(x)/64 */ + tmp1 = fMult(invBands, tmp1); /* y*CalcLd64(x)/64 */ + + /* y*k/64 */ + accu = (FIXP_DBL)-shiftFacSum0 << (DFRACT_BITS-1-8); + tmp2 = fMultDiv2(invBands, accu) << (2+1); + + tmp2 = tmp1 + tmp2; /* y*CalcLd64(x)/64 + y*k/64 */ + gmOrig = CalcInvLdData(tmp2); /* CalcInvLd64(z'); */ + } + else { + gmOrig = FL2FXCONST_DBL(0.0f); + } + + if (gmTransp > FL2FXCONST_DBL(0.0f)) { + + tmp1 = CalcLdData(gmTransp); /* CalcLd64(x)/64 */ + tmp1 = fMult(invBands, tmp1); /* y*CalcLd64(x)/64 */ + + /* y*k/64 */ + accu = (FIXP_DBL)-shiftFacSum1 << (DFRACT_BITS-1-8); + tmp2 = fMultDiv2(invBands, accu) << (2+1); + + tmp2 = tmp1 + tmp2; /* y*CalcLd64(x)/64 + y*k/64 */ + gmTransp = CalcInvLdData(tmp2); /* CalcInvLd64(z'); */ + } + else { + gmTransp = FL2FXCONST_DBL(0.0f); + } + if ( amOrig != FL2FXCONST_DBL(0.0f) ) + pSfmOrigVec[i] = FDKsbrEnc_LSI_divide_scale_fract(gmOrig,amOrig,SFM_SCALE); + + if ( amTransp != FL2FXCONST_DBL(0.0f) ) + pSfmSbrVec[i] = FDKsbrEnc_LSI_divide_scale_fract(gmTransp,amTransp,SFM_SCALE); + } + } +} + +/**************************************************************************/ +/*! + \brief Calculates the input to the missing harmonics detection. + + + \return none. + +*/ +/**************************************************************************/ +static void calculateDetectorInput(FIXP_DBL **RESTRICT pQuotaBuffer, /*!< Pointer to tonality matrix. */ + SCHAR *RESTRICT indexVector, + FIXP_DBL **RESTRICT tonalityDiff, + FIXP_DBL **RESTRICT pSfmOrig, + FIXP_DBL **RESTRICT pSfmSbr, + const UCHAR *freqBandTable, + INT nSfb, + INT noEstPerFrame, + INT move) +{ + INT est; + + /* + New estimate. + */ + for (est=0; est < noEstPerFrame; est++) { + + diff(pQuotaBuffer[est+move], + tonalityDiff[est+move], + freqBandTable, + nSfb, + indexVector); + + calculateFlatnessMeasure(pQuotaBuffer[est+ move], + indexVector, + pSfmOrig[est + move], + pSfmSbr[est + move], + freqBandTable, + nSfb); + } +} + + +/**************************************************************************/ +/*! + \brief Checks that the detection is not due to a LP filter + + This function determines if a newly detected missing harmonics is not + in fact just a low-pass filtere input signal. If so, the detection is + removed. + + \return none. + +*/ +/**************************************************************************/ +static void removeLowPassDetection(UCHAR *RESTRICT pAddHarmSfb, + UCHAR **RESTRICT pDetectionVectors, + INT start, + INT stop, + INT nSfb, + const UCHAR *RESTRICT pFreqBandTable, + FIXP_DBL *RESTRICT pNrgVector, + THRES_HOLDS mhThresh) + +{ + INT i,est; + INT maxDerivPos = pFreqBandTable[nSfb]; + INT numBands = pFreqBandTable[nSfb]; + FIXP_DBL nrgLow,nrgHigh; + FIXP_DBL nrgLD64,nrgLowLD64,nrgHighLD64,nrgDiffLD64; + FIXP_DBL valLD64,maxValLD64,maxValAboveLD64; + INT bLPsignal = 0; + + maxValLD64 = FL2FXCONST_DBL(-1.0f); + for(i = numBands - 1 - 2; i > pFreqBandTable[0];i--){ + nrgLow = pNrgVector[i]; + nrgHigh = pNrgVector[i + 2]; + + if(nrgLow != FL2FXCONST_DBL(0.0f) && nrgLow > nrgHigh){ + nrgLowLD64 = CalcLdData(nrgLow>>1); + nrgDiffLD64 = CalcLdData((nrgLow>>1)-(nrgHigh>>1)); + valLD64 = nrgDiffLD64-nrgLowLD64; + if(valLD64 > maxValLD64){ + maxDerivPos = i; + maxValLD64 = valLD64; + } + if(maxValLD64 > mhThresh.derivThresMaxLD64) { + break; + } + } + } + + /* Find the largest "gradient" above. (should be relatively flat, hence we expect a low value + if the signal is LP.*/ + maxValAboveLD64 = FL2FXCONST_DBL(-1.0f); + for(i = numBands - 1 - 2; i > maxDerivPos + 2;i--){ + nrgLow = pNrgVector[i]; + nrgHigh = pNrgVector[i + 2]; + + if(nrgLow != FL2FXCONST_DBL(0.0f) && nrgLow > nrgHigh){ + nrgLowLD64 = CalcLdData(nrgLow>>1); + nrgDiffLD64 = CalcLdData((nrgLow>>1)-(nrgHigh>>1)); + valLD64 = nrgDiffLD64-nrgLowLD64; + if(valLD64 > maxValAboveLD64){ + maxValAboveLD64 = valLD64; + } + } + else { + if(nrgHigh != FL2FXCONST_DBL(0.0f) && nrgHigh > nrgLow){ + nrgHighLD64 = CalcLdData(nrgHigh>>1); + nrgDiffLD64 = CalcLdData((nrgHigh>>1)-(nrgLow>>1)); + valLD64 = nrgDiffLD64-nrgHighLD64; + if(valLD64 > maxValAboveLD64){ + maxValAboveLD64 = valLD64; + } + } + } + } + + if(maxValLD64 > mhThresh.derivThresMaxLD64 && maxValAboveLD64 < mhThresh.derivThresAboveLD64){ + bLPsignal = 1; + + for(i = maxDerivPos - 1; i > maxDerivPos - 5 && i >= 0 ; i--){ + if(pNrgVector[i] != FL2FXCONST_DBL(0.0f) && pNrgVector[i] > pNrgVector[maxDerivPos + 2]){ + nrgDiffLD64 = CalcLdData((pNrgVector[i]>>1)-(pNrgVector[maxDerivPos + 2]>>1)); + nrgLD64 = CalcLdData(pNrgVector[i]>>1); + valLD64 = nrgDiffLD64-nrgLD64; + if(valLD64 < mhThresh.derivThresBelowLD64) { + bLPsignal = 0; + break; + } + } + else{ + bLPsignal = 0; + break; + } + } + } + + if(bLPsignal){ + for(i=0;i= pFreqBandTable[i] && maxDerivPos < pFreqBandTable[i+1]) + break; + } + + if(pAddHarmSfb[i]){ + pAddHarmSfb[i] = 0; + for(est = start; est < stop ; est++){ + pDetectionVectors[est][i] = 0; + } + } + } +} + +/**************************************************************************/ +/*! + \brief Checks if it is allowed to detect a missing tone, that wasn't + detected previously. + + + \return newDetectionAllowed flag. + +*/ +/**************************************************************************/ +static INT isDetectionOfNewToneAllowed(const SBR_FRAME_INFO *pFrameInfo, + INT *pDetectionStartPos, + INT noEstPerFrame, + INT prevTransientFrame, + INT prevTransientPos, + INT prevTransientFlag, + INT transientPosOffset, + INT transientFlag, + INT transientPos, + INT deltaTime, + HANDLE_SBR_MISSING_HARMONICS_DETECTOR h_sbrMissingHarmonicsDetector) +{ + INT transientFrame, newDetectionAllowed; + + + /* Determine if this is a frame where a transient starts... + * If the transient flag was set the previous frame but not the + * transient frame flag, the transient frame flag is set in the current frame. + *****************************************************************************/ + transientFrame = 0; + if(transientFlag){ + if(transientPos + transientPosOffset < pFrameInfo->borders[pFrameInfo->nEnvelopes]) + transientFrame = 1; + if(noEstPerFrame > 1){ + if(transientPos + transientPosOffset > h_sbrMissingHarmonicsDetector->timeSlots >> 1){ + *pDetectionStartPos = noEstPerFrame; + } + else{ + *pDetectionStartPos = noEstPerFrame >> 1; + } + + } + else{ + *pDetectionStartPos = noEstPerFrame; + } + } + else{ + if(prevTransientFlag && !prevTransientFrame){ + transientFrame = 1; + *pDetectionStartPos = 0; + } + } + + /* + * Determine if detection of new missing harmonics are allowed. + * If the frame contains a transient it's ok. If the previous + * frame contained a transient it needs to be sufficiently close + * to the start of the current frame. + ****************************************************************/ + newDetectionAllowed = 0; + if(transientFrame){ + newDetectionAllowed = 1; + } + else { + if(prevTransientFrame && + fixp_abs(pFrameInfo->borders[0] - (prevTransientPos + transientPosOffset - + h_sbrMissingHarmonicsDetector->timeSlots)) < deltaTime) + newDetectionAllowed = 1; + *pDetectionStartPos = 0; + } + + h_sbrMissingHarmonicsDetector->previousTransientFlag = transientFlag; + h_sbrMissingHarmonicsDetector->previousTransientFrame = transientFrame; + h_sbrMissingHarmonicsDetector->previousTransientPos = transientPos; + + return (newDetectionAllowed); +} + + +/**************************************************************************/ +/*! + \brief Cleans up the detection after a transient. + + + \return none. + +*/ +/**************************************************************************/ +static void transientCleanUp(FIXP_DBL **quotaBuffer, + INT nSfb, + UCHAR **detectionVectors, + UCHAR *pAddHarmSfb, + UCHAR *pPrevAddHarmSfb, + INT ** signBuffer, + const UCHAR *pFreqBandTable, + INT start, + INT stop, + INT newDetectionAllowed, + FIXP_DBL *pNrgVector, + THRES_HOLDS mhThresh) +{ + INT i,j,li, ui,est; + + for(est=start; est < stop; est++) { + for(i=0; i maxVal1){ + maxVal1 = quotaBuffer[est][j]; + maxPos1 = j; + maxPosTime1 = est; + } + } + } + + li = pFreqBandTable[i+1]; + ui = pFreqBandTable[i+2]; + + /* Find maximum tonality in the the two scf bands.*/ + maxPosTime2 = start; + maxPos2 = li; + maxVal2 = quotaBuffer[start][li]; + for(est = start; est < stop; est++){ + for(j = li; j maxVal2){ + maxVal2 = quotaBuffer[est][j]; + maxPos2 = j; + maxPosTime2 = est; + } + } + } + + /* If the maximum values are in adjacent QMF-channels, we need to remove + the lowest of the two.*/ + if(maxPos2-maxPos1 < 2){ + + if(pPrevAddHarmSfb[i] == 1 && pPrevAddHarmSfb[i+1] == 0){ + /* Keep the lower, remove the upper.*/ + pAddHarmSfb[i+1] = 0; + for(est=start; est maxVal2){ + if(signBuffer[maxPosTime1][maxPos2] < 0 && signBuffer[maxPosTime1][maxPos1] > 0){ + /* Keep the lower, remove the upper.*/ + pAddHarmSfb[i+1] = 0; + for(est=start; est 0){ + /* Keep the upper, remove the lower.*/ + pAddHarmSfb[i] = 0; + for(est=start; est 0) + pAddHarmSfb[i] = 0; + } + } +} + + +/**************************************************************************/ +/*! + \brief Do detection for one tonality estimate. + + + \return none. + +*/ +/**************************************************************************/ +static void detection(FIXP_DBL *quotaBuffer, + FIXP_DBL *pDiffVecScfb, + INT nSfb, + UCHAR *pHarmVec, + const UCHAR *pFreqBandTable, + FIXP_DBL *sfmOrig, + FIXP_DBL *sfmSbr, + GUIDE_VECTORS guideVectors, + GUIDE_VECTORS newGuideVectors, + THRES_HOLDS mhThresh) +{ + + INT i,j,ll, lu; + FIXP_DBL thresTemp,thresOrig; + + /* + * Do detection on the difference vector, i.e. the difference between + * the original and the transposed. + *********************************************************************/ + for(i=0;i thresTemp){ + pHarmVec[i] = 1; + newGuideVectors.guideVectorDiff[i] = pDiffVecScfb[i]; + } + else{ + /* If the guide wasn't zero, but the current level is to low, + start tracking the decay on the tone in the original rather + than the difference.*/ + if(guideVectors.guideVectorDiff[i] != FL2FXCONST_DBL(0.0f)){ + guideVectors.guideVectorOrig[i] = mhThresh.thresHoldToneGuide; + } + } + } + + /* + * Trace tones in the original signal that at one point + * have been detected because they will be replaced by + * multiple tones in the sbr signal. + ****************************************************/ + + for(i=0;i thresOrig){ + pHarmVec[i] = 1; + newGuideVectors.guideVectorOrig[i] = quotaBuffer[j]; + } + } + } + } + + /* + * Check for multiple sines in the transposed signal, + * where there is only one in the original. + ****************************************************/ + thresOrig = mhThresh.thresHoldTone; + + for(i=0;i 1){ + for(j= ll;j thresOrig && (sfmSbr[i] > mhThresh.sfmThresSbr && sfmOrig[i] < mhThresh.sfmThresOrig)){ + pHarmVec[i] = 1; + newGuideVectors.guideVectorOrig[i] = quotaBuffer[j]; + } + } + } + else{ + if(i < nSfb -1){ + ll = pFreqBandTable[i]; + + if(i>0){ + if(quotaBuffer[ll] > mhThresh.thresHoldTone && (pDiffVecScfb[i+1] < mhThresh.invThresHoldTone || pDiffVecScfb[i-1] < mhThresh.invThresHoldTone)){ + pHarmVec[i] = 1; + newGuideVectors.guideVectorOrig[i] = quotaBuffer[ll]; + } + } + else{ + if(quotaBuffer[ll] > mhThresh.thresHoldTone && pDiffVecScfb[i+1] < mhThresh.invThresHoldTone){ + pHarmVec[i] = 1; + newGuideVectors.guideVectorOrig[i] = quotaBuffer[ll]; + } + } + } + } + } + } +} + + +/**************************************************************************/ +/*! + \brief Do detection for every tonality estimate, using forward prediction. + + + \return none. + +*/ +/**************************************************************************/ +static void detectionWithPrediction(FIXP_DBL **quotaBuffer, + FIXP_DBL **pDiffVecScfb, + INT ** signBuffer, + INT nSfb, + const UCHAR* pFreqBandTable, + FIXP_DBL **sfmOrig, + FIXP_DBL **sfmSbr, + UCHAR **detectionVectors, + UCHAR *pPrevAddHarmSfb, + GUIDE_VECTORS *guideVectors, + INT noEstPerFrame, + INT detectionStart, + INT totNoEst, + INT newDetectionAllowed, + INT *pAddHarmFlag, + UCHAR *pAddHarmSfb, + FIXP_DBL *pNrgVector, + const DETECTOR_PARAMETERS_MH *mhParams) +{ + INT est = 0,i; + INT start; + + FDKmemclear(pAddHarmSfb,nSfb*sizeof(UCHAR)); + + if(newDetectionAllowed){ + + if(totNoEst > 1){ + start = detectionStart; + + if (start != 0) { + FDKmemcpy(guideVectors[start].guideVectorDiff,guideVectors[0].guideVectorDiff,nSfb*sizeof(FIXP_DBL)); + FDKmemcpy(guideVectors[start].guideVectorOrig,guideVectors[0].guideVectorOrig,nSfb*sizeof(FIXP_DBL)); + FDKmemclear(guideVectors[start-1].guideVectorDetected,nSfb*sizeof(UCHAR)); + } + } + else{ + start = 0; + } + } + else{ + start = 0; + } + + + for(est = start; est < totNoEst; est++){ + + /* + * Do detection on the current frame using + * guide-info from the previous. + *******************************************/ + if(est > 0){ + FDKmemcpy(guideVectors[est].guideVectorDetected,detectionVectors[est-1],nSfb*sizeof(UCHAR)); + } + + FDKmemclear(detectionVectors[est], nSfb*sizeof(UCHAR)); + + if(est < totNoEst-1){ + FDKmemclear(guideVectors[est+1].guideVectorDiff,nSfb*sizeof(FIXP_DBL)); + FDKmemclear(guideVectors[est+1].guideVectorOrig,nSfb*sizeof(FIXP_DBL)); + FDKmemclear(guideVectors[est+1].guideVectorDetected,nSfb*sizeof(UCHAR)); + + detection(quotaBuffer[est], + pDiffVecScfb[est], + nSfb, + detectionVectors[est], + pFreqBandTable, + sfmOrig[est], + sfmSbr[est], + guideVectors[est], + guideVectors[est+1], + mhParams->thresHolds); + } + else{ + FDKmemclear(guideVectors[est].guideVectorDiff,nSfb*sizeof(FIXP_DBL)); + FDKmemclear(guideVectors[est].guideVectorOrig,nSfb*sizeof(FIXP_DBL)); + FDKmemclear(guideVectors[est].guideVectorDetected,nSfb*sizeof(UCHAR)); + + detection(quotaBuffer[est], + pDiffVecScfb[est], + nSfb, + detectionVectors[est], + pFreqBandTable, + sfmOrig[est], + sfmSbr[est], + guideVectors[est], + guideVectors[est], + mhParams->thresHolds); + } + } + + + /* Clean up the detection.*/ + transientCleanUp(quotaBuffer, + nSfb, + detectionVectors, + pAddHarmSfb, + pPrevAddHarmSfb, + signBuffer, + pFreqBandTable, + start, + totNoEst, + newDetectionAllowed, + pNrgVector, + mhParams->thresHolds); + + + /* Set flag... */ + *pAddHarmFlag = 0; + for(i=0; i maxVal){ + maxVal = pTonalityMatrix[est][l]; + maxPosF = l; + maxPosT = est; + } + } + } + + /* + * If the maximum tonality is at the lower border of the + * scalefactor band, we check the sign of the adjacent channels + * to see if this sine is shared by the lower channel. If so, the + * energy of the single sine will be present in two scalefactor bands + * in the SBR data, which will cause problems in the decoder, when we + * add a sine to just one of the channels. + *********************************************************************/ + if(maxPosF == ll && scfBand){ + if(!pAddHarmSfb[scfBand - 1]) { /* No detection below*/ + if (pSignMatrix[maxPosT][maxPosF - 1] > 0 && pSignMatrix[maxPosT][maxPosF] < 0) { + /* The comp value is calulated as the tonallity value, i.e we want to + reduce the envelope data for this channel with as much as the tonality + that is spread from the channel above. (ld64(RELAXATION) = 0.31143075889) */ + tmp = fixp_abs((FIXP_DBL)CalcLdData(pTonalityMatrix[maxPosT][maxPosF - 1]) + RELAXATION_LD64); + tmp = (tmp >> (DFRACT_BITS-1-LD_DATA_SHIFT-1)) + (FIXP_DBL)1; /* shift one bit less for rounding */ + compValue = ((INT)(LONG)tmp) >> 1; + + /* limit the comp-value*/ + if (compValue > maxComp) + compValue = maxComp; + + pEnvComp[scfBand-1] = compValue; + } + } + } + + /* + * Same as above, but for the upper end of the scalefactor-band. + ***************************************************************/ + if(maxPosF == lu-1 && scfBand+1 < nSfb){ /* Upper border*/ + if(!pAddHarmSfb[scfBand + 1]) { + if (pSignMatrix[maxPosT][maxPosF] > 0 && pSignMatrix[maxPosT][maxPosF + 1] < 0) { + tmp = fixp_abs((FIXP_DBL)CalcLdData(pTonalityMatrix[maxPosT][maxPosF + 1]) + RELAXATION_LD64); + tmp = (tmp >> (DFRACT_BITS-1-LD_DATA_SHIFT-1)) + (FIXP_DBL)1; /* shift one bit less for rounding */ + compValue = ((INT)(LONG)tmp) >> 1; + + if (compValue > maxComp) + compValue = maxComp; + + pEnvComp[scfBand+1] = compValue; + } + } + } + } + } + + if(newDetectionAllowed == 0){ + for(scfBand=0;scfBanddetectionVectors; + INT move = h_sbrMHDet->move; + INT noEstPerFrame = h_sbrMHDet->noEstPerFrame; + INT totNoEst = h_sbrMHDet->totNoEst; + INT prevTransientFlag = h_sbrMHDet->previousTransientFlag; + INT prevTransientFrame = h_sbrMHDet->previousTransientFrame; + INT transientPosOffset = h_sbrMHDet->transientPosOffset; + INT prevTransientPos = h_sbrMHDet->previousTransientPos; + GUIDE_VECTORS* guideVectors = h_sbrMHDet->guideVectors; + INT deltaTime = h_sbrMHDet->mhParams->deltaTime; + INT maxComp = h_sbrMHDet->mhParams->maxComp; + + int est; + + /* + Buffer values. + */ + FDK_ASSERT(move<=(MAX_NO_OF_ESTIMATES>>1)); + FDK_ASSERT(noEstPerFrame<=(MAX_NO_OF_ESTIMATES>>1)); + + FIXP_DBL *sfmSbr[MAX_NO_OF_ESTIMATES]; + FIXP_DBL *sfmOrig[MAX_NO_OF_ESTIMATES]; + FIXP_DBL *tonalityDiff[MAX_NO_OF_ESTIMATES]; + + for (est=0; est < MAX_NO_OF_ESTIMATES/2; est++) { + sfmSbr[est] = h_sbrMHDet->sfmSbr[est]; + sfmOrig[est] = h_sbrMHDet->sfmOrig[est]; + tonalityDiff[est] = h_sbrMHDet->tonalityDiff[est]; + } + + C_ALLOC_SCRATCH_START(scratch_mem, FIXP_DBL, (3*MAX_NO_OF_ESTIMATES/2*MAX_FREQ_COEFFS)); + FIXP_DBL *scratch = scratch_mem; + for (; est < MAX_NO_OF_ESTIMATES; est++) { + sfmSbr[est] = scratch; scratch+=MAX_FREQ_COEFFS; + sfmOrig[est] = scratch; scratch+=MAX_FREQ_COEFFS; + tonalityDiff[est] = scratch; scratch+=MAX_FREQ_COEFFS; + } + + + + /* Determine if we're allowed to detect "missing harmonics" that wasn't detected before. + In order to be allowed to do new detection, there must be a transient in the current + frame, or a transient in the previous frame sufficiently close to the current frame. */ + newDetectionAllowed = isDetectionOfNewToneAllowed(pFrameInfo, + &transientDetStart, + noEstPerFrame, + prevTransientFrame, + prevTransientPos, + prevTransientFlag, + transientPosOffset, + transientFlag, + transientPos, + deltaTime, + h_sbrMHDet); + + /* Calulate the variables that will be used subsequently for the actual detection */ + calculateDetectorInput(pQuotaBuffer, + indexVector, + tonalityDiff, + sfmOrig, + sfmSbr, + freqBandTable, + nSfb, + noEstPerFrame, + move); + + /* Do the actual detection using information from previous detections */ + detectionWithPrediction(pQuotaBuffer, + tonalityDiff, + pSignBuffer, + nSfb, + freqBandTable, + sfmOrig, + sfmSbr, + detectionVectors, + h_sbrMHDet->guideScfb, + guideVectors, + noEstPerFrame, + transientDetStart, + totNoEst, + newDetectionAllowed, + pAddHarmonicsFlag, + pAddHarmonicsScaleFactorBands, + pNrgVector, + h_sbrMHDet->mhParams); + + /* Calculate the comp vector, so that the energy can be + compensated for a sine between two QMF-bands. */ + calculateCompVector(pAddHarmonicsScaleFactorBands, + pQuotaBuffer, + pSignBuffer, + envelopeCompensation, + nSfb, + freqBandTable, + totNoEst, + maxComp, + h_sbrMHDet->prevEnvelopeCompensation, + newDetectionAllowed); + + for (est=0; est < move; est++) { + FDKmemcpy(tonalityDiff[est], tonalityDiff[est + noEstPerFrame], sizeof(FIXP_DBL)*MAX_FREQ_COEFFS); + FDKmemcpy(sfmOrig[est], sfmOrig[est + noEstPerFrame], sizeof(FIXP_DBL)*MAX_FREQ_COEFFS); + FDKmemcpy(sfmSbr[est], sfmSbr[est + noEstPerFrame], sizeof(FIXP_DBL)*MAX_FREQ_COEFFS); + } + C_ALLOC_SCRATCH_END(scratch, FIXP_DBL, (3*MAX_NO_OF_ESTIMATES/2*MAX_FREQ_COEFFS)); + + +} + +/**************************************************************************/ +/*! + \brief Initialize an instance of the missing harmonics detector. + + + \return errorCode, noError if OK. + +*/ +/**************************************************************************/ +INT +FDKsbrEnc_CreateSbrMissingHarmonicsDetector ( + HANDLE_SBR_MISSING_HARMONICS_DETECTOR hSbrMHDet, + INT chan) +{ + HANDLE_SBR_MISSING_HARMONICS_DETECTOR hs = hSbrMHDet; + INT i; + + UCHAR* detectionVectors = GetRam_Sbr_detectionVectors(chan); + UCHAR* guideVectorDetected = GetRam_Sbr_guideVectorDetected(chan); + FIXP_DBL* guideVectorDiff = GetRam_Sbr_guideVectorDiff(chan); + FIXP_DBL* guideVectorOrig = GetRam_Sbr_guideVectorOrig(chan); + + FDKmemclear (hs,sizeof(SBR_MISSING_HARMONICS_DETECTOR)); + + hs->prevEnvelopeCompensation = GetRam_Sbr_prevEnvelopeCompensation(chan); + hs->guideScfb = GetRam_Sbr_guideScfb(chan); + + for(i=0; iguideVectors[i].guideVectorDiff = guideVectorDiff + (i*MAX_FREQ_COEFFS); + hs->guideVectors[i].guideVectorOrig = guideVectorOrig + (i*MAX_FREQ_COEFFS); + hs->detectionVectors[i] = detectionVectors + (i*MAX_FREQ_COEFFS); + hs->guideVectors[i].guideVectorDetected = guideVectorDetected + (i*MAX_FREQ_COEFFS); + } + + return 0; +} + + +/**************************************************************************/ +/*! + \brief Initialize an instance of the missing harmonics detector. + + + \return errorCode, noError if OK. + +*/ +/**************************************************************************/ +INT +FDKsbrEnc_InitSbrMissingHarmonicsDetector ( + HANDLE_SBR_MISSING_HARMONICS_DETECTOR hSbrMHDet, + INT sampleFreq, + INT frameSize, + INT nSfb, + INT qmfNoChannels, + INT totNoEst, + INT move, + INT noEstPerFrame, + UINT sbrSyntaxFlags + ) +{ + HANDLE_SBR_MISSING_HARMONICS_DETECTOR hs = hSbrMHDet; + int i; + + FDK_ASSERT(totNoEst <= MAX_NO_OF_ESTIMATES); + + switch(frameSize){ + case 2048: + hs->transientPosOffset = FRAME_MIDDLE_SLOT_2048; + hs->timeSlots = NUMBER_TIME_SLOTS_2048; + break; + case 1920: + hs->transientPosOffset = FRAME_MIDDLE_SLOT_1920; + hs->timeSlots = NUMBER_TIME_SLOTS_1920; + break; + case 1024: + hs->transientPosOffset = FRAME_MIDDLE_SLOT_512LD; + hs->timeSlots = 16; + break; + case 960: + hs->transientPosOffset = FRAME_MIDDLE_SLOT_512LD; + hs->timeSlots = 15; + break; + default: + return -1; + } + + if (sbrSyntaxFlags & SBR_SYNTAX_LOW_DELAY) { + hs->mhParams = ¶msAacLd; + } else + hs->mhParams = ¶msAac; + + hs->qmfNoChannels = qmfNoChannels; + hs->sampleFreq = sampleFreq; + hs->nSfb = nSfb; + + hs->totNoEst = totNoEst; + hs->move = move; + hs->noEstPerFrame = noEstPerFrame; + + for(i=0; iguideVectors[i].guideVectorDiff,sizeof(FIXP_DBL)*MAX_FREQ_COEFFS); + FDKmemclear (hs->guideVectors[i].guideVectorOrig,sizeof(FIXP_DBL)*MAX_FREQ_COEFFS); + FDKmemclear (hs->detectionVectors[i],sizeof(UCHAR)*MAX_FREQ_COEFFS); + FDKmemclear (hs->guideVectors[i].guideVectorDetected,sizeof(UCHAR)*MAX_FREQ_COEFFS); + } + + //for(i=0; itonalityDiff[i],sizeof(FIXP_DBL)*MAX_FREQ_COEFFS); + FDKmemclear (hs->sfmOrig[i],sizeof(FIXP_DBL)*MAX_FREQ_COEFFS); + FDKmemclear (hs->sfmSbr[i],sizeof(FIXP_DBL)*MAX_FREQ_COEFFS); + } + + FDKmemclear ( hs->prevEnvelopeCompensation, sizeof(UCHAR)*MAX_FREQ_COEFFS); + FDKmemclear ( hs->guideScfb, sizeof(UCHAR)*MAX_FREQ_COEFFS); + + hs->previousTransientFlag = 0; + hs->previousTransientFrame = 0; + hs->previousTransientPos = 0; + + return (0); +} + +/**************************************************************************/ +/*! + \brief Deletes an instance of the missing harmonics detector. + + + \return none. + +*/ +/**************************************************************************/ +void +FDKsbrEnc_DeleteSbrMissingHarmonicsDetector(HANDLE_SBR_MISSING_HARMONICS_DETECTOR hSbrMHDet) +{ + if (hSbrMHDet) { + HANDLE_SBR_MISSING_HARMONICS_DETECTOR hs = hSbrMHDet; + + FreeRam_Sbr_detectionVectors(&hs->detectionVectors[0]); + FreeRam_Sbr_guideVectorDetected(&hs->guideVectors[0].guideVectorDetected); + FreeRam_Sbr_guideVectorDiff(&hs->guideVectors[0].guideVectorDiff); + FreeRam_Sbr_guideVectorOrig(&hs->guideVectors[0].guideVectorOrig); + FreeRam_Sbr_prevEnvelopeCompensation(&hs->prevEnvelopeCompensation); + FreeRam_Sbr_guideScfb(&hs->guideScfb); + + } +} + +/**************************************************************************/ +/*! + \brief Resets an instance of the missing harmonics detector. + + + \return error code, noError if OK. + +*/ +/**************************************************************************/ +INT +FDKsbrEnc_ResetSbrMissingHarmonicsDetector (HANDLE_SBR_MISSING_HARMONICS_DETECTOR hSbrMissingHarmonicsDetector, + INT nSfb) +{ + int i; + FIXP_DBL tempGuide[MAX_FREQ_COEFFS]; + UCHAR tempGuideInt[MAX_FREQ_COEFFS]; + INT nSfbPrev; + + nSfbPrev = hSbrMissingHarmonicsDetector->nSfb; + hSbrMissingHarmonicsDetector->nSfb = nSfb; + + FDKmemcpy( tempGuideInt, hSbrMissingHarmonicsDetector->guideScfb, nSfbPrev * sizeof(UCHAR) ); + + if ( nSfb > nSfbPrev ) { + for ( i = 0; i < (nSfb - nSfbPrev); i++ ) { + hSbrMissingHarmonicsDetector->guideScfb[i] = 0; + } + + for ( i = 0; i < nSfbPrev; i++ ) { + hSbrMissingHarmonicsDetector->guideScfb[i + (nSfb - nSfbPrev)] = tempGuideInt[i]; + } + } + else { + for ( i = 0; i < nSfb; i++ ) { + hSbrMissingHarmonicsDetector->guideScfb[i] = tempGuideInt[i + (nSfbPrev-nSfb)]; + } + } + + FDKmemcpy ( tempGuide, hSbrMissingHarmonicsDetector->guideVectors[0].guideVectorDiff, nSfbPrev * sizeof(FIXP_DBL) ); + + if (nSfb > nSfbPrev ) { + for ( i = 0; i < (nSfb - nSfbPrev); i++ ) { + hSbrMissingHarmonicsDetector->guideVectors[0].guideVectorDiff[i] = FL2FXCONST_DBL(0.0f); + } + + for ( i = 0; i < nSfbPrev; i++ ) { + hSbrMissingHarmonicsDetector->guideVectors[0].guideVectorDiff[i + (nSfb - nSfbPrev)] = tempGuide[i]; + } + } + else { + for ( i = 0; i < nSfb; i++ ) { + hSbrMissingHarmonicsDetector->guideVectors[0].guideVectorDiff[i] = tempGuide[i + (nSfbPrev-nSfb)]; + } + } + + FDKmemcpy ( tempGuide, hSbrMissingHarmonicsDetector->guideVectors[0].guideVectorOrig, nSfbPrev * sizeof(FIXP_DBL) ); + + if ( nSfb > nSfbPrev ) { + for ( i = 0; i< (nSfb - nSfbPrev); i++ ) { + hSbrMissingHarmonicsDetector->guideVectors[0].guideVectorOrig[i] = FL2FXCONST_DBL(0.0f); + } + + for ( i = 0; i < nSfbPrev; i++ ) { + hSbrMissingHarmonicsDetector->guideVectors[0].guideVectorOrig[i + (nSfb - nSfbPrev)] = tempGuide[i]; + } + } + else { + for ( i = 0; i < nSfb; i++ ) { + hSbrMissingHarmonicsDetector->guideVectors[0].guideVectorOrig[i] = tempGuide[i + (nSfbPrev-nSfb)]; + } + } + + FDKmemcpy ( tempGuideInt, hSbrMissingHarmonicsDetector->guideVectors[0].guideVectorDetected, nSfbPrev * sizeof(UCHAR) ); + + if ( nSfb > nSfbPrev ) { + for ( i = 0; i < (nSfb - nSfbPrev); i++ ) { + hSbrMissingHarmonicsDetector->guideVectors[0].guideVectorDetected[i] = 0; + } + + for ( i = 0; i < nSfbPrev; i++ ) { + hSbrMissingHarmonicsDetector->guideVectors[0].guideVectorDetected[i + (nSfb - nSfbPrev)] = tempGuideInt[i]; + } + } + else { + for ( i = 0; i < nSfb; i++ ) { + hSbrMissingHarmonicsDetector->guideVectors[0].guideVectorDetected[i] = tempGuideInt[i + (nSfbPrev-nSfb)]; + } + } + + FDKmemcpy ( tempGuideInt, hSbrMissingHarmonicsDetector->prevEnvelopeCompensation, nSfbPrev * sizeof(UCHAR) ); + + if ( nSfb > nSfbPrev ) { + for ( i = 0; i < (nSfb - nSfbPrev); i++ ) { + hSbrMissingHarmonicsDetector->prevEnvelopeCompensation[i] = 0; + } + + for ( i = 0; i < nSfbPrev; i++ ) { + hSbrMissingHarmonicsDetector->prevEnvelopeCompensation[i + (nSfb - nSfbPrev)] = tempGuideInt[i]; + } + } + else { + for ( i = 0; i < nSfb; i++ ) { + hSbrMissingHarmonicsDetector->prevEnvelopeCompensation[i] = tempGuideInt[i + (nSfbPrev-nSfb)]; + } + } + + return 0; +} + -- cgit v1.2.3