aboutsummaryrefslogtreecommitdiffstats
path: root/libSACdec/src/sac_process.cpp
diff options
context:
space:
mode:
authorFraunhofer IIS FDK <audio-fdk@iis.fraunhofer.de>2018-02-26 20:17:00 +0100
committerJean-Michel Trivi <jmtrivi@google.com>2018-04-19 11:21:15 -0700
commit6cfabd35363c3ef5e3b209b867169a500b3ccc3c (patch)
tree01c0a19f2735e8b5d2407555fe992d4230d089eb /libSACdec/src/sac_process.cpp
parent6288a1e34c4dede4c2806beb1736ece6580558c7 (diff)
downloadfdk-aac-6cfabd35363c3ef5e3b209b867169a500b3ccc3c.tar.gz
fdk-aac-6cfabd35363c3ef5e3b209b867169a500b3ccc3c.tar.bz2
fdk-aac-6cfabd35363c3ef5e3b209b867169a500b3ccc3c.zip
Upgrade to FDKv2
Bug: 71430241 Test: CTS DecoderTest and DecoderTestAacDrc original-Change-Id: Iaa20f749b8a04d553b20247cfe1a8930ebbabe30 Apply clang-format also on header files. original-Change-Id: I14de1ef16bbc79ec0283e745f98356a10efeb2e4 Fixes for MPEG-D DRC original-Change-Id: If1de2d74bbbac84b3f67de3b88b83f6a23b8a15c Catch unsupported tw_mdct at an early stage original-Change-Id: Ied9dd00d754162a0e3ca1ae3e6b854315d818afe Fixing PVC transition frames original-Change-Id: Ib75725abe39252806c32d71176308f2c03547a4e Move qmf bands sanity check original-Change-Id: Iab540c3013c174d9490d2ae100a4576f51d8dbc4 Initialize scaling variable original-Change-Id: I3c4087101b70e998c71c1689b122b0d7762e0f9e Add 16 qmf band configuration to getSlotNrgHQ() original-Change-Id: I49a5d30f703a1b126ff163df9656db2540df21f1 Always apply byte alignment at the end of the AudioMuxElement original-Change-Id: I42d560287506d65d4c3de8bfe3eb9a4ebeb4efc7 Setup SBR element only if no parse error exists original-Change-Id: I1915b73704bc80ab882b9173d6bec59cbd073676 Additional array index check in HCR original-Change-Id: I18cc6e501ea683b5009f1bbee26de8ddd04d8267 Fix fade-in index selection in concealment module original-Change-Id: Ibf802ed6ed8c05e9257e1f3b6d0ac1162e9b81c1 Enable explicit backward compatible parser for AAC_LD original-Change-Id: I27e9c678dcb5d40ed760a6d1e06609563d02482d Skip spatial specific config in explicit backward compatible ASC original-Change-Id: Iff7cc365561319e886090cedf30533f562ea4d6e Update flags description in decoder API original-Change-Id: I9a5b4f8da76bb652f5580cbd3ba9760425c43830 Add QMF domain reset function original-Change-Id: I4f89a8a2c0277d18103380134e4ed86996e9d8d6 DRC upgrade v2.1.0 original-Change-Id: I5731c0540139dab220094cd978ef42099fc45b74 Fix integer overflow in sqrtFixp_lookup() original-Change-Id: I429a6f0d19aa2cc957e0f181066f0ca73968c914 Fix integer overflow in invSqrtNorm2() original-Change-Id: I84de5cbf9fb3adeb611db203fe492fabf4eb6155 Fix integer overflow in GenerateRandomVector() original-Change-Id: I3118a641008bd9484d479e5b0b1ee2b5d7d44d74 Fix integer overflow in adjustTimeSlot_EldGrid() original-Change-Id: I29d503c247c5c8282349b79df940416a512fb9d5 Fix integer overflow in FDKsbrEnc_codeEnvelope() original-Change-Id: I6b34b61ebb9d525b0c651ed08de2befc1f801449 Follow-up on: Fix integer overflow in adjustTimeSlot_EldGrid() original-Change-Id: I6f8f578cc7089e5eb7c7b93e580b72ca35ad689a Fix integer overflow in get_pk_v2() original-Change-Id: I63375bed40d45867f6eeaa72b20b1f33e815938c Fix integer overflow in Syn_filt_zero() original-Change-Id: Ie0c02fdfbe03988f9d3b20d10cd9fe4c002d1279 Fix integer overflow in CFac_CalcFacSignal() original-Change-Id: Id2d767c40066c591b51768e978eb8af3b803f0c5 Fix integer overflow in FDKaacEnc_FDKaacEnc_calcPeNoAH() original-Change-Id: Idcbd0f4a51ae2550ed106aa6f3d678d1f9724841 Fix integer overflow in sbrDecoder_calculateGainVec() original-Change-Id: I7081bcbe29c5cede9821b38d93de07c7add2d507 Fix integer overflow in CLpc_SynthesisLattice() original-Change-Id: I4a95ddc18de150102352d4a1845f06094764c881 Fix integer overflow in Pred_Lt4() original-Change-Id: I4dbd012b2de7d07c3e70a47b92e3bfae8dbc750a Fix integer overflow in FDKsbrEnc_InitSbrFastTransientDetector() original-Change-Id: I788cbec1a4a00f44c2f3a72ad7a4afa219807d04 Fix unsigned integer overflow in FDKaacEnc_WriteBitstream() original-Change-Id: I68fc75166e7d2cd5cd45b18dbe3d8c2a92f1822a Fix unsigned integer overflow in FDK_MetadataEnc_Init() original-Change-Id: Ie8d025f9bcdb2442c704bd196e61065c03c10af4 Fix overflow in pseudo random number generators original-Change-Id: I3e2551ee01356297ca14e3788436ede80bd5513c Fix unsigned integer overflow in sbrDecoder_Parse() original-Change-Id: I3f231b2f437e9c37db4d5b964164686710eee971 Fix unsigned integer overflow in longsub() original-Change-Id: I73c2bc50415cac26f1f5a29e125bbe75f9180a6e Fix unsigned integer overflow in CAacDecoder_DecodeFrame() original-Change-Id: Ifce2db4b1454b46fa5f887e9d383f1cc43b291e4 Fix overflow at CLpdChannelStream_Read() original-Change-Id: Idb9d822ce3a4272e4794b643644f5434e2d4bf3f Fix unsigned integer overflow in Hcr_State_BODY_SIGN_ESC__ESC_WORD() original-Change-Id: I1ccf77c0015684b85534c5eb97162740a870b71c Fix unsigned integer overflow in UsacConfig_Parse() original-Change-Id: Ie6d27f84b6ae7eef092ecbff4447941c77864d9f Fix unsigned integer overflow in aacDecoder_drcParse() original-Change-Id: I713f28e883eea3d70b6fa56a7b8f8c22bcf66ca0 Fix unsigned integer overflow in aacDecoder_drcReadCompression() original-Change-Id: Ia34dfeb88c4705c558bce34314f584965cafcf7a Fix unsigned integer overflow in CDataStreamElement_Read() original-Change-Id: Iae896cc1d11f0a893d21be6aa90bd3e60a2c25f0 Fix unsigned integer overflow in transportDec_AdjustEndOfAccessUnit() original-Change-Id: I64cf29a153ee784bb4a16fdc088baabebc0007dc Fix unsigned integer overflow in transportDec_GetAuBitsRemaining() original-Change-Id: I975b3420faa9c16a041874ba0db82e92035962e4 Fix unsigned integer overflow in extractExtendedData() original-Change-Id: I2a59eb09e2053cfb58dfb75fcecfad6b85a80a8f Fix signed integer overflow in CAacDecoder_ExtPayloadParse() original-Change-Id: I4ad5ca4e3b83b5d964f1c2f8c5e7b17c477c7929 Fix unsigned integer overflow in CAacDecoder_DecodeFrame() original-Change-Id: I29a39df77d45c52a0c9c5c83c1ba81f8d0f25090 Follow-up on: Fix integer overflow in CLpc_SynthesisLattice() original-Change-Id: I8fb194ffc073a3432a380845be71036a272d388f Fix signed integer overflow in _interpolateDrcGain() original-Change-Id: I879ec9ab14005069a7c47faf80e8bc6e03d22e60 Fix unsigned integer overflow in FDKreadBits() original-Change-Id: I1f47a6a8037ff70375aa8844947d5681bb4287ad Fix unsigned integer overflow in FDKbyteAlign() original-Change-Id: Id5f3a11a0c9e50fc6f76ed6c572dbd4e9f2af766 Fix unsigned integer overflow in FDK_get32() original-Change-Id: I9d33b8e97e3d38cbb80629cb859266ca0acdce96 Fix unsigned integer overflow in FDK_pushBack() original-Change-Id: Ic87f899bc8c6acf7a377a8ca7f3ba74c3a1e1c19 Fix unsigned integer overflow in FDK_pushForward() original-Change-Id: I3b754382f6776a34be1602e66694ede8e0b8effc Fix unsigned integer overflow in ReadPsData() original-Change-Id: I25361664ba8139e32bbbef2ca8c106a606ce9c37 Fix signed integer overflow in E_UTIL_residu() original-Change-Id: I8c3abd1f437ee869caa8fb5903ce7d3d641b6aad REVERT: Follow-up on: Integer overflow in CLpc_SynthesisLattice(). original-Change-Id: I3d340099acb0414795c8dfbe6362bc0a8f045f9b Follow-up on: Fix integer overflow in CLpc_SynthesisLattice() original-Change-Id: I4aedb8b3a187064e9f4d985175aa55bb99cc7590 Follow-up on: Fix unsigned integer overflow in aacDecoder_drcParse() original-Change-Id: I2aa2e13916213bf52a67e8b0518e7bf7e57fb37d Fix integer overflow in acelp original-Change-Id: Ie6390c136d84055f8b728aefbe4ebef6e029dc77 Fix unsigned integer overflow in aacDecoder_UpdateBitStreamCounters() original-Change-Id: I391ffd97ddb0b2c184cba76139bfb356a3b4d2e2 Adjust concealment default settings original-Change-Id: I6a95db935a327c47df348030bcceafcb29f54b21 Saturate estimatedStartPos original-Change-Id: I27be2085e0ae83ec9501409f65e003f6bcba1ab6 Negative shift exponent in _interpolateDrcGain() original-Change-Id: I18edb26b26d002aafd5e633d4914960f7a359c29 Negative shift exponent in calculateICC() original-Change-Id: I3dcd2ae98d2eb70ee0d59750863cbb2a6f4f8aba Too large shift exponent in FDK_put() original-Change-Id: Ib7d9aaa434d2d8de4a13b720ca0464b31ca9b671 Too large shift exponent in CalcInvLdData() original-Change-Id: I43e6e78d4cd12daeb1dcd5d82d1798bdc2550262 Member access within null pointer of type SBR_CHANNEL original-Change-Id: Idc5e4ea8997810376d2f36bbdf628923b135b097 Member access within null pointer of type CpePersistentData original-Change-Id: Ib6c91cb0d37882768e5baf63324e429589de0d9d Member access within null pointer FDKaacEnc_psyMain() original-Change-Id: I7729b7f4479970531d9dc823abff63ca52e01997 Member access within null pointer FDKaacEnc_GetPnsParam() original-Change-Id: I9aa3b9f3456ae2e0f7483dbd5b3dde95fc62da39 Member access within null pointer FDKsbrEnc_EnvEncodeFrame() original-Change-Id: I67936f90ea714e90b3e81bc0dd1472cc713eb23a Add HCR sanity check original-Change-Id: I6c1d9732ebcf6af12f50b7641400752f74be39f7 Fix memory issue for HBE edge case with 8:3 SBR original-Change-Id: I11ea58a61e69fbe8bf75034b640baee3011e63e9 Additional SBR parametrization sanity check for ELD original-Change-Id: Ie26026fbfe174c2c7b3691f6218b5ce63e322140 Add MPEG-D DRC channel layout check original-Change-Id: Iea70a74f171b227cce636a9eac4ba662777a2f72 Additional out-of-bounds checks in MPEG-D DRC original-Change-Id: Ife4a8c3452c6fde8a0a09e941154a39a769777d4 Change-Id: Ic63cb2f628720f54fe9b572b0cb528e2599c624e
Diffstat (limited to 'libSACdec/src/sac_process.cpp')
-rw-r--r--libSACdec/src/sac_process.cpp1066
1 files changed, 1066 insertions, 0 deletions
diff --git a/libSACdec/src/sac_process.cpp b/libSACdec/src/sac_process.cpp
new file mode 100644
index 0000000..56c72ad
--- /dev/null
+++ b/libSACdec/src/sac_process.cpp
@@ -0,0 +1,1066 @@
+/* -----------------------------------------------------------------------------
+Software License for The Fraunhofer FDK AAC Codec Library for Android
+
+© Copyright 1995 - 2018 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
+----------------------------------------------------------------------------- */
+
+/*********************** MPEG surround decoder library *************************
+
+ Author(s):
+
+ Description: SAC Processing
+
+*******************************************************************************/
+
+/* data structures and interfaces for spatial audio reference software */
+#include "sac_process.h"
+
+#include "sac_bitdec.h"
+#include "sac_calcM1andM2.h"
+#include "sac_smoothing.h"
+#include "sac_rom.h"
+
+#include "sac_dec_errorcodes.h"
+
+#include "FDK_trigFcts.h"
+#include "FDK_decorrelate.h"
+
+/**
+ * \brief Linear interpolation between two parameter values.
+ * a*alpha + b*(1-alpha)
+ * = a*alpha + b - b*alpha
+ *
+ * \param alpha Weighting factor.
+ * \param a Parameter a.
+ * \param b Parameter b.
+ *
+ * \return Interpolated parameter value.
+ */
+FDK_INLINE FIXP_DBL interpolateParameter(const FIXP_SGL alpha, const FIXP_DBL a,
+ const FIXP_DBL b) {
+ return (b - fMult(alpha, b) + fMult(alpha, a));
+}
+
+/**
+ * \brief Map MPEG Surround channel indices to MPEG 4 PCE like channel indices.
+ * \param self Spatial decoder handle.
+ * \param ch MPEG Surround channel index.
+ * \return MPEG 4 PCE style channel index, corresponding to the given MPEG
+ * Surround channel index.
+ */
+static UINT mapChannel(spatialDec *self, UINT ch) {
+ static const UCHAR chanelIdx[][8] = {
+ {0, 1, 2, 3, 4, 5, 6, 7}, /* binaural, TREE_212, arbitrary tree */
+ };
+
+ int idx = 0;
+
+ return (chanelIdx[idx][ch]);
+}
+
+FIXP_DBL getChGain(spatialDec *self, UINT ch, INT *scale) {
+ /* init no gain modifier */
+ FIXP_DBL gain = 0x80000000;
+ *scale = 0;
+
+ if ((!isTwoChMode(self->upmixType)) &&
+ (self->upmixType != UPMIXTYPE_BYPASS)) {
+ if ((ch == 0) || (ch == 1) || (ch == 2)) {
+ /* no modifier */
+ }
+ }
+
+ return gain;
+}
+
+SACDEC_ERROR SpatialDecQMFAnalysis(spatialDec *self, const PCM_MPS *inData,
+ const INT ts, const INT bypassMode,
+ FIXP_DBL **qmfReal, FIXP_DBL **qmfImag,
+ const int numInputChannels) {
+ SACDEC_ERROR err = MPS_OK;
+ int ch, offset;
+
+ offset = self->pQmfDomain->globalConf.nBandsSynthesis *
+ self->pQmfDomain->globalConf.nQmfTimeSlots;
+
+ {
+ for (ch = 0; ch < numInputChannels; ch++) {
+ const PCM_MPS *inSamples =
+ &inData[ts * self->pQmfDomain->globalConf.nBandsAnalysis];
+ FIXP_DBL *pQmfRealAnalysis = qmfReal[ch]; /* no delay in blind mode */
+ FIXP_DBL *pQmfImagAnalysis = qmfImag[ch];
+
+ CalculateSpaceAnalysisQmf(&self->pQmfDomain->QmfDomainIn[ch].fb,
+ inSamples + (ch * offset), pQmfRealAnalysis,
+ pQmfImagAnalysis);
+
+ if (!isTwoChMode(self->upmixType) && !bypassMode) {
+ int i;
+ for (i = 0; i < self->qmfBands; i++) {
+ qmfReal[ch][i] = fMult(qmfReal[ch][i], self->clipProtectGain__FDK);
+ qmfImag[ch][i] = fMult(qmfImag[ch][i], self->clipProtectGain__FDK);
+ }
+ }
+ }
+ }
+
+ self->qmfInputDelayBufPos =
+ (self->qmfInputDelayBufPos + 1) % self->pc_filterdelay;
+
+ return err;
+}
+
+SACDEC_ERROR SpatialDecFeedQMF(spatialDec *self, FIXP_DBL **qmfInDataReal,
+ FIXP_DBL **qmfInDataImag, const INT ts,
+ const INT bypassMode, FIXP_DBL **qmfReal__FDK,
+ FIXP_DBL **qmfImag__FDK,
+ const INT numInputChannels) {
+ SACDEC_ERROR err = MPS_OK;
+ int ch;
+
+ {
+ for (ch = 0; ch < numInputChannels; ch++) {
+ FIXP_DBL *pQmfRealAnalysis =
+ qmfReal__FDK[ch]; /* no delay in blind mode */
+ FIXP_DBL *pQmfImagAnalysis = qmfImag__FDK[ch];
+
+ /* Write Input data to pQmfRealAnalysis. */
+ if (self->bShareDelayWithSBR) {
+ FDK_QmfDomain_GetSlot(
+ &self->pQmfDomain->QmfDomainIn[ch], ts + HYBRID_FILTER_DELAY, 0,
+ MAX_QMF_BANDS_TO_HYBRID, pQmfRealAnalysis, pQmfImagAnalysis, 15);
+ FDK_QmfDomain_GetSlot(&self->pQmfDomain->QmfDomainIn[ch], ts,
+ MAX_QMF_BANDS_TO_HYBRID, self->qmfBands,
+ pQmfRealAnalysis, pQmfImagAnalysis, 15);
+ } else {
+ FDK_QmfDomain_GetSlot(&self->pQmfDomain->QmfDomainIn[ch], ts, 0,
+ self->qmfBands, pQmfRealAnalysis,
+ pQmfImagAnalysis, 15);
+ }
+ if (ts == self->pQmfDomain->globalConf.nQmfTimeSlots - 1) {
+ /* Is currently also needed in case we dont have any overlap. We need to
+ * save lb_scale to ov_lb_scale */
+ FDK_QmfDomain_SaveOverlap(&self->pQmfDomain->QmfDomainIn[ch], 0);
+ }
+
+ /* Apply clip protection to output. */
+ if (!isTwoChMode(self->upmixType) && !bypassMode) {
+ int i;
+ for (i = 0; i < self->qmfBands; i++) {
+ qmfReal__FDK[ch][i] =
+ fMult(qmfReal__FDK[ch][i], self->clipProtectGain__FDK);
+ qmfImag__FDK[ch][i] =
+ fMult(qmfImag__FDK[ch][i], self->clipProtectGain__FDK);
+ }
+ }
+
+ } /* End of loop over numInputChannels */
+ }
+
+ self->qmfInputDelayBufPos =
+ (self->qmfInputDelayBufPos + 1) % self->pc_filterdelay;
+
+ return err;
+}
+
+/*******************************************************************************
+ Functionname: SpatialDecHybridAnalysis
+ *******************************************************************************
+
+ Description:
+
+ Arguments:
+
+ Input:
+ float** pointers[4] leftReal, leftIm, rightReal, rightIm
+
+ Output:
+ float self->qmfInputReal[MAX_INPUT_CHANNELS][MAX_TIME_SLOTS][MAX_QMF_BANDS];
+ float self->qmfInputImag[MAX_INPUT_CHANNELS][MAX_TIME_SLOTS][MAX_QMF_BANDS];
+
+ float
+self->hybInputReal[MAX_INPUT_CHANNELS][MAX_TIME_SLOTS][MAX_HYBRID_BANDS]; float
+self->hybInputImag[MAX_INPUT_CHANNELS][MAX_TIME_SLOTS][MAX_HYBRID_BANDS];
+
+
+*******************************************************************************/
+SACDEC_ERROR SpatialDecHybridAnalysis(spatialDec *self, FIXP_DBL **qmfInputReal,
+ FIXP_DBL **qmfInputImag,
+ FIXP_DBL **hybOutputReal,
+ FIXP_DBL **hybOutputImag, const INT ts,
+ const INT numInputChannels) {
+ SACDEC_ERROR err = MPS_OK;
+ int ch;
+
+ for (ch = 0; ch < numInputChannels;
+ ch++) /* hybrid filtering for down-mix signals */
+ {
+ if (self->pConfigCurrent->syntaxFlags & SACDEC_SYNTAX_LD) {
+ int k;
+ /* No hybrid filtering. Just copy the QMF data. */
+ for (k = 0; k < self->hybridBands; k += 1) {
+ hybOutputReal[ch][k] = qmfInputReal[ch][k];
+ hybOutputImag[ch][k] = qmfInputImag[ch][k];
+ }
+ } else {
+ self->hybridAnalysis[ch].hfMode = self->bShareDelayWithSBR;
+
+ if (self->stereoConfigIndex == 3)
+ FDK_ASSERT(self->hybridAnalysis[ch].hfMode == 0);
+ FDKhybridAnalysisApply(&self->hybridAnalysis[ch], qmfInputReal[ch],
+ qmfInputImag[ch], hybOutputReal[ch],
+ hybOutputImag[ch]);
+ }
+ }
+
+ if ((self->pConfigCurrent->syntaxFlags & SACDEC_SYNTAX_USAC) &&
+ self->residualCoding) {
+ self->hybridAnalysis[numInputChannels].hfMode = 0;
+ FDKhybridAnalysisApply(
+ &self->hybridAnalysis[numInputChannels],
+ self->qmfResidualReal__FDK[0][0], self->qmfResidualImag__FDK[0][0],
+ self->hybResidualReal__FDK[0], self->hybResidualImag__FDK[0]);
+ }
+
+ return err;
+}
+
+SACDEC_ERROR SpatialDecCreateX(spatialDec *self, FIXP_DBL **hybInputReal,
+ FIXP_DBL **hybInputImag, FIXP_DBL **pxReal,
+ FIXP_DBL **pxImag) {
+ SACDEC_ERROR err = MPS_OK;
+ int row;
+
+ /* Creating wDry */
+ for (row = 0; row < self->numInputChannels; row++) {
+ /* pointer to direct signals */
+ pxReal[row] = hybInputReal[row];
+ pxImag[row] = hybInputImag[row];
+ }
+
+ return err;
+}
+
+static void M2ParamToKernelMult(FIXP_SGL *RESTRICT pKernel,
+ FIXP_DBL *RESTRICT Mparam,
+ FIXP_DBL *RESTRICT MparamPrev,
+ int *RESTRICT pWidth, FIXP_SGL alpha__FDK,
+ int nBands) {
+ int pb;
+
+ for (pb = 0; pb < nBands; pb++) {
+ FIXP_SGL tmp = FX_DBL2FX_SGL(
+ interpolateParameter(alpha__FDK, Mparam[pb], MparamPrev[pb]));
+
+ int i = pWidth[pb];
+ if (i & 1) *pKernel++ = tmp;
+ if (i & 2) {
+ *pKernel++ = tmp;
+ *pKernel++ = tmp;
+ }
+ for (i >>= 2; i--;) {
+ *pKernel++ = tmp;
+ *pKernel++ = tmp;
+ *pKernel++ = tmp;
+ *pKernel++ = tmp;
+ }
+ }
+}
+
+SACDEC_ERROR SpatialDecApplyM1_CreateW_Mode212(
+ spatialDec *self, const SPATIAL_BS_FRAME *frame, FIXP_DBL **xReal,
+ FIXP_DBL **xImag, FIXP_DBL **vReal, FIXP_DBL **vImag) {
+ SACDEC_ERROR err = MPS_OK;
+ int res;
+ FIXP_DBL *decorrInReal = vReal[0];
+ FIXP_DBL *decorrInImag = vImag[0];
+
+ /* M1 does not do anything in 212 mode, so use simplified processing */
+ FDK_ASSERT(self->numVChannels == 2);
+ FDK_ASSERT(self->numDirektSignals == 1);
+ FDK_ASSERT(self->numDecorSignals == 1);
+ FDKmemcpy(vReal[0], xReal[0], self->hybridBands * sizeof(FIXP_DBL));
+ FDKmemcpy(vImag[0], xImag[0], self->hybridBands * sizeof(FIXP_DBL));
+
+ if (isTsdActive(frame->TsdData)) {
+ /* Generate v_{x,nonTr} as input for allpass based decorrelator */
+ TsdGenerateNonTr(self->hybridBands, frame->TsdData, self->TsdTs, vReal[0],
+ vImag[0], vReal[1], vImag[1], &decorrInReal,
+ &decorrInImag);
+ }
+ /* - Decorrelate */
+ res = SpatialDecGetResidualIndex(self, 1);
+ if (FDKdecorrelateApply(&self->apDecor[0], decorrInReal, decorrInImag,
+ vReal[1], vImag[1],
+ self->param2hyb[self->residualBands[res]])) {
+ return MPS_NOTOK;
+ }
+ if (isTsdActive(frame->TsdData)) {
+ /* Generate v_{x,Tr}, apply transient decorrelator and add to allpass based
+ * decorrelator output */
+ TsdApply(self->hybridBands, frame->TsdData, &self->TsdTs,
+ vReal[0], /* input: v_x */
+ vImag[0],
+ vReal[1], /* input: d_{x,nonTr}; output: d_{x,nonTr} + d_{x,Tr} */
+ vImag[1]);
+ }
+
+ /* Write residual signal in approriate parameter bands */
+ if (self->residualBands[res] > 0) {
+ int stopBand = self->param2hyb[self->residualBands[res]];
+ FDKmemcpy(vReal[1], self->hybResidualReal__FDK[res],
+ fixMin(stopBand, self->hybridBands) * sizeof(FIXP_DBL));
+ FDKmemcpy(vImag[1], self->hybResidualImag__FDK[res],
+ fixMin(stopBand, self->hybridBands) * sizeof(FIXP_DBL));
+ } /* (self->residualBands[res]>0) */
+
+ return err;
+}
+
+SACDEC_ERROR SpatialDecApplyM2_Mode212(spatialDec *self, INT ps,
+ const FIXP_SGL alpha, FIXP_DBL **wReal,
+ FIXP_DBL **wImag,
+ FIXP_DBL **hybOutputRealDry,
+ FIXP_DBL **hybOutputImagDry) {
+ SACDEC_ERROR err = MPS_OK;
+ INT row;
+
+ INT *pWidth = self->kernels_width;
+ /* for stereoConfigIndex == 3 case hybridBands is < 71 */
+ INT pb_max = self->kernels[self->hybridBands - 1] + 1;
+ INT max_row = self->numOutputChannels;
+
+ INT M2_exp = 0;
+ if (self->residualCoding) M2_exp = 3;
+
+ for (row = 0; row < max_row; row++) // 2 times
+ {
+ FIXP_DBL *Mparam0 = self->M2Real__FDK[row][0];
+ FIXP_DBL *Mparam1 = self->M2Real__FDK[row][1];
+ FIXP_DBL *MparamPrev0 = self->M2RealPrev__FDK[row][0];
+ FIXP_DBL *MparamPrev1 = self->M2RealPrev__FDK[row][1];
+
+ FIXP_DBL *RESTRICT pHybOutRealDry = hybOutputRealDry[row];
+ FIXP_DBL *RESTRICT pHybOutImagDry = hybOutputImagDry[row];
+
+ FIXP_DBL *RESTRICT pWReal0 = wReal[0];
+ FIXP_DBL *RESTRICT pWReal1 = wReal[1];
+ FIXP_DBL *RESTRICT pWImag0 = wImag[0];
+ FIXP_DBL *RESTRICT pWImag1 = wImag[1];
+ for (INT pb = 0; pb < pb_max; pb++) {
+ FIXP_DBL tmp0, tmp1;
+
+ tmp0 = interpolateParameter(alpha, Mparam0[pb], MparamPrev0[pb]);
+ tmp1 = interpolateParameter(alpha, Mparam1[pb], MparamPrev1[pb]);
+
+ INT i = pWidth[pb];
+
+ do // about 3-4 times
+ {
+ FIXP_DBL var0, var1, real, imag;
+
+ var0 = *pWReal0++;
+ var1 = *pWReal1++;
+ real = fMultDiv2(var0, tmp0);
+ var0 = *pWImag0++;
+ real = fMultAddDiv2(real, var1, tmp1);
+ var1 = *pWImag1++;
+ imag = fMultDiv2(var0, tmp0);
+ *pHybOutRealDry++ = real << (1 + M2_exp);
+ imag = fMultAddDiv2(imag, var1, tmp1);
+ *pHybOutImagDry++ = imag << (1 + M2_exp);
+ } while (--i != 0);
+ }
+ }
+ return err;
+}
+
+SACDEC_ERROR SpatialDecApplyM2_Mode212_ResidualsPlusPhaseCoding(
+ spatialDec *self, INT ps, const FIXP_SGL alpha, FIXP_DBL **wReal,
+ FIXP_DBL **wImag, FIXP_DBL **hybOutputRealDry,
+ FIXP_DBL **hybOutputImagDry) {
+ SACDEC_ERROR err = MPS_OK;
+ INT row;
+ INT scale_param_m2;
+ INT *pWidth = self->kernels_width;
+ INT pb_max = self->kernels[self->hybridBands - 1] + 1;
+
+ scale_param_m2 = SCALE_PARAM_M2_212_PRED + SCALE_DATA_APPLY_M2;
+
+ for (row = 0; row < self->numM2rows; row++) {
+ INT qs, pb;
+
+ FIXP_DBL *RESTRICT pWReal0 = wReal[0];
+ FIXP_DBL *RESTRICT pWImag0 = wImag[0];
+ FIXP_DBL *RESTRICT pWReal1 = wReal[1];
+ FIXP_DBL *RESTRICT pWImag1 = wImag[1];
+
+ FIXP_DBL *MReal0 = self->M2Real__FDK[row][0];
+ FIXP_DBL *MImag0 = self->M2Imag__FDK[row][0];
+ FIXP_DBL *MReal1 = self->M2Real__FDK[row][1];
+ FIXP_DBL *MRealPrev0 = self->M2RealPrev__FDK[row][0];
+ FIXP_DBL *MImagPrev0 = self->M2ImagPrev__FDK[row][0];
+ FIXP_DBL *MRealPrev1 = self->M2RealPrev__FDK[row][1];
+
+ FIXP_DBL *RESTRICT pHybOutRealDry = hybOutputRealDry[row];
+ FIXP_DBL *RESTRICT pHybOutImagDry = hybOutputImagDry[row];
+
+ FDK_ASSERT(!(self->pConfigCurrent->syntaxFlags & SACDEC_SYNTAX_LD));
+ FDK_ASSERT((pWidth[0] + pWidth[1]) >= 3);
+
+ for (pb = 0, qs = 3; pb < 2; pb++) {
+ INT s;
+ FIXP_DBL maxVal;
+ FIXP_SGL mReal1;
+ FIXP_SGL mReal0, mImag0;
+ FIXP_DBL iReal0, iImag0, iReal1;
+
+ iReal0 = interpolateParameter(alpha, MReal0[pb], MRealPrev0[pb]);
+ iImag0 = -interpolateParameter(alpha, MImag0[pb], MImagPrev0[pb]);
+ iReal1 = interpolateParameter(alpha, MReal1[pb], MRealPrev1[pb]);
+
+ maxVal = fAbs(iReal0) | fAbs(iImag0);
+ maxVal |= fAbs(iReal1);
+
+ s = fMax(CntLeadingZeros(maxVal) - 1, 0);
+ s = fMin(s, scale_param_m2);
+
+ mReal0 = FX_DBL2FX_SGL(iReal0 << s);
+ mImag0 = FX_DBL2FX_SGL(iImag0 << s);
+ mReal1 = FX_DBL2FX_SGL(iReal1 << s);
+
+ s = scale_param_m2 - s;
+
+ INT i = pWidth[pb];
+
+ do {
+ FIXP_DBL real, imag, wReal0, wImag0, wReal1, wImag1;
+
+ wReal0 = *pWReal0++;
+ wImag0 = *pWImag0++;
+ wReal1 = *pWReal1++;
+ wImag1 = *pWImag1++;
+
+ cplxMultDiv2(&real, &imag, wReal0, wImag0, mReal0, mImag0);
+
+ *pHybOutRealDry++ = fMultAddDiv2(real, wReal1, mReal1) << s;
+ *pHybOutImagDry++ = fMultAddDiv2(imag, wImag1, mReal1) << s;
+
+ if (qs > 0) {
+ mImag0 = -mImag0;
+ qs--;
+ }
+ } while (--i != 0);
+ }
+
+ for (; pb < pb_max; pb++) {
+ INT s;
+ FIXP_DBL maxVal;
+ FIXP_SGL mReal1;
+ FIXP_SGL mReal0, mImag0;
+ FIXP_DBL iReal0, iImag0, iReal1;
+
+ iReal0 = interpolateParameter(alpha, MReal0[pb], MRealPrev0[pb]);
+ iImag0 = interpolateParameter(alpha, MImag0[pb], MImagPrev0[pb]);
+ iReal1 = interpolateParameter(alpha, MReal1[pb], MRealPrev1[pb]);
+
+ maxVal = fAbs(iReal0) | fAbs(iImag0);
+ maxVal |= fAbs(iReal1);
+
+ s = fMax(CntLeadingZeros(maxVal) - 1, 0);
+ s = fMin(s, scale_param_m2);
+
+ mReal0 = FX_DBL2FX_SGL(iReal0 << s);
+ mImag0 = FX_DBL2FX_SGL(iImag0 << s);
+ mReal1 = FX_DBL2FX_SGL(iReal1 << s);
+
+ s = scale_param_m2 - s;
+
+ INT i = pWidth[pb];
+
+ do {
+ FIXP_DBL real, imag, wReal0, wImag0, wReal1, wImag1;
+
+ wReal0 = *pWReal0++;
+ wImag0 = *pWImag0++;
+ wReal1 = *pWReal1++;
+ wImag1 = *pWImag1++;
+
+ cplxMultDiv2(&real, &imag, wReal0, wImag0, mReal0, mImag0);
+
+ *pHybOutRealDry++ = fMultAddDiv2(real, wReal1, mReal1) << s;
+ *pHybOutImagDry++ = fMultAddDiv2(imag, wImag1, mReal1) << s;
+ } while (--i != 0);
+ }
+ }
+
+ return err;
+}
+
+SACDEC_ERROR SpatialDecApplyM2(spatialDec *self, INT ps, const FIXP_SGL alpha,
+ FIXP_DBL **wReal, FIXP_DBL **wImag,
+ FIXP_DBL **hybOutputRealDry,
+ FIXP_DBL **hybOutputImagDry,
+ FIXP_DBL **hybOutputRealWet,
+ FIXP_DBL **hybOutputImagWet) {
+ SACDEC_ERROR err = MPS_OK;
+
+ {
+ int qs, row, col;
+ int complexHybBands;
+ int complexParBands;
+ int scale_param_m2 = 0;
+ int toolsDisabled;
+
+ UCHAR activParamBands;
+ FIXP_DBL *RESTRICT pWReal, *RESTRICT pWImag, *RESTRICT pHybOutRealDry,
+ *RESTRICT pHybOutImagDry, *RESTRICT pHybOutRealWet,
+ *RESTRICT pHybOutImagWet;
+ C_ALLOC_SCRATCH_START(pKernel, FIXP_SGL, MAX_HYBRID_BANDS);
+
+ /* The wet signal is added to the dry signal directly in applyM2 if GES and
+ * STP are disabled */
+ toolsDisabled =
+ ((self->tempShapeConfig == 1) || (self->tempShapeConfig == 2)) ? 0 : 1;
+
+ {
+ complexHybBands = self->hybridBands;
+ complexParBands = self->numParameterBands;
+ }
+
+ FDKmemclear(hybOutputImagDry[0],
+ self->createParams.maxNumOutputChannels *
+ self->createParams.maxNumCmplxHybBands * sizeof(FIXP_DBL));
+ FDKmemclear(hybOutputRealDry[0], self->createParams.maxNumOutputChannels *
+ self->createParams.maxNumHybridBands *
+ sizeof(FIXP_DBL));
+
+ if (!toolsDisabled) {
+ FDKmemclear(hybOutputRealWet[0],
+ self->createParams.maxNumOutputChannels *
+ self->createParams.maxNumHybridBands * sizeof(FIXP_DBL));
+ FDKmemclear(hybOutputImagWet[0],
+ self->createParams.maxNumOutputChannels *
+ self->createParams.maxNumCmplxHybBands *
+ sizeof(FIXP_DBL));
+ }
+
+ if (self->phaseCoding == 3) {
+ /* + SCALE_DATA_APPLY_M2 to compensate for Div2 below ?! */
+ scale_param_m2 = SCALE_PARAM_M2_212_PRED + SCALE_DATA_APPLY_M2;
+ }
+
+ for (row = 0; row < self->numM2rows; row++) {
+ pHybOutRealDry = hybOutputRealDry[row];
+ pHybOutImagDry = hybOutputImagDry[row];
+
+ if (toolsDisabled) {
+ pHybOutRealWet = hybOutputRealDry[row];
+ pHybOutImagWet = hybOutputImagDry[row];
+ } else {
+ pHybOutRealWet = hybOutputRealWet[row];
+ pHybOutImagWet = hybOutputImagWet[row];
+ }
+
+ for (col = 0; col < self->numDirektSignals; col++) {
+ if (self->pActivM2ParamBands ==
+ 0) { /* default setting, calculate all rows and columns */
+ activParamBands = 1;
+ } else {
+ if (self->pActivM2ParamBands[MAX_M2_INPUT * row +
+ col]) /* table with activ and inactiv
+ bands exists for current
+ configuration */
+ activParamBands = 1;
+ else
+ activParamBands = 0;
+ }
+ if (activParamBands) {
+ pWReal = wReal[col];
+ pWImag = wImag[col];
+
+ M2ParamToKernelMult(pKernel, self->M2Real__FDK[row][col],
+ self->M2RealPrev__FDK[row][col],
+ self->kernels_width, alpha,
+ self->numParameterBands);
+
+ if (1 && (self->phaseCoding != 3)) {
+ /* direct signals */
+ {
+ /* only one sample will be assigned to each row, hence
+ * accumulation is not neccessary; that is valid for all
+ * configurations */
+ for (qs = 0; qs < complexHybBands; qs++) {
+ pHybOutRealDry[qs] = fMult(pWReal[qs], pKernel[qs]);
+ pHybOutImagDry[qs] = fMult(pWImag[qs], pKernel[qs]);
+ }
+ }
+ } else { /* isBinauralMode(self->upmixType) */
+
+ for (qs = 0; qs < complexHybBands; qs++) {
+ pHybOutRealDry[qs] += fMultDiv2(pWReal[qs], pKernel[qs])
+ << (scale_param_m2);
+ pHybOutImagDry[qs] += fMultDiv2(pWImag[qs], pKernel[qs])
+ << (scale_param_m2);
+ }
+
+ M2ParamToKernelMult(pKernel, self->M2Imag__FDK[row][col],
+ self->M2ImagPrev__FDK[row][col],
+ self->kernels_width, alpha, complexParBands);
+
+ /* direct signals sign is -1 for qs = 0,2 */
+ pHybOutRealDry[0] += fMultDiv2(pWImag[0], pKernel[0])
+ << (scale_param_m2);
+ pHybOutImagDry[0] -= fMultDiv2(pWReal[0], pKernel[0])
+ << (scale_param_m2);
+
+ pHybOutRealDry[2] += fMultDiv2(pWImag[2], pKernel[2])
+ << (scale_param_m2);
+ pHybOutImagDry[2] -= fMultDiv2(pWReal[2], pKernel[2])
+ << (scale_param_m2);
+
+ /* direct signals sign is +1 for qs = 1,3,4,5,...,complexHybBands */
+ pHybOutRealDry[1] -= fMultDiv2(pWImag[1], pKernel[1])
+ << (scale_param_m2);
+ pHybOutImagDry[1] += fMultDiv2(pWReal[1], pKernel[1])
+ << (scale_param_m2);
+
+ for (qs = 3; qs < complexHybBands; qs++) {
+ pHybOutRealDry[qs] -= fMultDiv2(pWImag[qs], pKernel[qs])
+ << (scale_param_m2);
+ pHybOutImagDry[qs] += fMultDiv2(pWReal[qs], pKernel[qs])
+ << (scale_param_m2);
+ }
+ } /* self->upmixType */
+ } /* if (activParamBands) */
+ } /* self->numDirektSignals */
+
+ for (; col < self->numVChannels; col++) {
+ if (self->pActivM2ParamBands ==
+ 0) { /* default setting, calculate all rows and columns */
+ activParamBands = 1;
+ } else {
+ if (self->pActivM2ParamBands[MAX_M2_INPUT * row +
+ col]) /* table with activ and inactiv
+ bands exists for current
+ configuration */
+ activParamBands = 1;
+ else
+ activParamBands = 0;
+ }
+
+ if (activParamBands) {
+ int resBandIndex;
+ int resHybIndex;
+
+ resBandIndex =
+ self->residualBands[SpatialDecGetResidualIndex(self, col)];
+ resHybIndex = self->param2hyb[resBandIndex];
+
+ pWReal = wReal[col];
+ pWImag = wImag[col];
+
+ M2ParamToKernelMult(pKernel, self->M2Real__FDK[row][col],
+ self->M2RealPrev__FDK[row][col],
+ self->kernels_width, alpha,
+ self->numParameterBands);
+
+ if (1 && (self->phaseCoding != 3)) {
+ /* residual signals */
+ for (qs = 0; qs < resHybIndex; qs++) {
+ pHybOutRealDry[qs] += fMult(pWReal[qs], pKernel[qs]);
+ pHybOutImagDry[qs] += fMult(pWImag[qs], pKernel[qs]);
+ }
+ /* decor signals */
+ for (; qs < complexHybBands; qs++) {
+ pHybOutRealWet[qs] += fMult(pWReal[qs], pKernel[qs]);
+ pHybOutImagWet[qs] += fMult(pWImag[qs], pKernel[qs]);
+ }
+ } else { /* self->upmixType */
+ /* residual signals */
+ FIXP_DBL *RESTRICT pHybOutReal;
+ FIXP_DBL *RESTRICT pHybOutImag;
+
+ for (qs = 0; qs < resHybIndex; qs++) {
+ pHybOutRealDry[qs] += fMultDiv2(pWReal[qs], pKernel[qs])
+ << (scale_param_m2);
+ pHybOutImagDry[qs] += fMultDiv2(pWImag[qs], pKernel[qs])
+ << (scale_param_m2);
+ }
+ /* decor signals */
+ for (; qs < complexHybBands; qs++) {
+ pHybOutRealWet[qs] += fMultDiv2(pWReal[qs], pKernel[qs])
+ << (scale_param_m2);
+ pHybOutImagWet[qs] += fMultDiv2(pWImag[qs], pKernel[qs])
+ << (scale_param_m2);
+ }
+
+ M2ParamToKernelMult(pKernel, self->M2Imag__FDK[row][col],
+ self->M2ImagPrev__FDK[row][col],
+ self->kernels_width, alpha, complexParBands);
+
+ /* direct signals sign is -1 for qs = 0,2 */
+ /* direct signals sign is +1 for qs = 1,3.. */
+ if (toolsDisabled) {
+ pHybOutRealDry[0] += fMultDiv2(pWImag[0], pKernel[0])
+ << (scale_param_m2);
+ pHybOutImagDry[0] -= fMultDiv2(pWReal[0], pKernel[0])
+ << (scale_param_m2);
+
+ pHybOutRealDry[1] -= fMultDiv2(pWImag[1], pKernel[1])
+ << (scale_param_m2);
+ pHybOutImagDry[1] += fMultDiv2(pWReal[1], pKernel[1])
+ << (scale_param_m2);
+
+ pHybOutRealDry[2] += fMultDiv2(pWImag[2], pKernel[2])
+ << (scale_param_m2);
+ pHybOutImagDry[2] -= fMultDiv2(pWReal[2], pKernel[2])
+ << (scale_param_m2);
+ } else {
+ pHybOutReal = &pHybOutRealDry[0];
+ pHybOutImag = &pHybOutImagDry[0];
+ if (0 == resHybIndex) {
+ pHybOutReal = &pHybOutRealWet[0];
+ pHybOutImag = &pHybOutImagWet[0];
+ }
+ pHybOutReal[0] += fMultDiv2(pWImag[0], pKernel[0])
+ << (scale_param_m2);
+ pHybOutImag[0] -= fMultDiv2(pWReal[0], pKernel[0])
+ << (scale_param_m2);
+
+ if (1 == resHybIndex) {
+ pHybOutReal = &pHybOutRealWet[0];
+ pHybOutImag = &pHybOutImagWet[0];
+ }
+ pHybOutReal[1] -= fMultDiv2(pWImag[1], pKernel[1])
+ << (scale_param_m2);
+ pHybOutImag[1] += fMultDiv2(pWReal[1], pKernel[1])
+ << (scale_param_m2);
+
+ if (2 == resHybIndex) {
+ pHybOutReal = &pHybOutRealWet[0];
+ pHybOutImag = &pHybOutImagWet[0];
+ }
+ pHybOutReal[2] += fMultDiv2(pWImag[2], pKernel[2])
+ << (scale_param_m2);
+ pHybOutImag[2] -= fMultDiv2(pWReal[2], pKernel[2])
+ << (scale_param_m2);
+ }
+
+ for (qs = 3; qs < resHybIndex; qs++) {
+ pHybOutRealDry[qs] -= fMultDiv2(pWImag[qs], pKernel[qs])
+ << (scale_param_m2);
+ pHybOutImagDry[qs] += fMultDiv2(pWReal[qs], pKernel[qs])
+ << (scale_param_m2);
+ }
+ /* decor signals */
+ for (; qs < complexHybBands; qs++) {
+ pHybOutRealWet[qs] -= fMultDiv2(pWImag[qs], pKernel[qs])
+ << (scale_param_m2);
+ pHybOutImagWet[qs] += fMultDiv2(pWReal[qs], pKernel[qs])
+ << (scale_param_m2);
+ }
+ } /* self->upmixType */
+ } /* if (activParamBands) { */
+ } /* self->numVChannels */
+ }
+
+ C_ALLOC_SCRATCH_END(pKernel, FIXP_SGL, MAX_HYBRID_BANDS);
+ }
+
+ return err;
+}
+
+SACDEC_ERROR SpatialDecSynthesis(spatialDec *self, const INT ts,
+ FIXP_DBL **hybOutputReal,
+ FIXP_DBL **hybOutputImag, PCM_MPS *timeOut,
+ const INT numInputChannels,
+ const FDK_channelMapDescr *const mapDescr) {
+ SACDEC_ERROR err = MPS_OK;
+
+ int ch;
+ int stride, offset;
+
+ stride = self->numOutputChannelsAT;
+ offset = 1;
+
+ PCM_MPS *pTimeOut__FDK =
+ &timeOut[stride * self->pQmfDomain->globalConf.nBandsSynthesis * ts];
+ C_ALLOC_SCRATCH_START(pQmfReal, FIXP_DBL, QMF_MAX_SYNTHESIS_BANDS);
+ C_ALLOC_SCRATCH_START(pQmfImag, FIXP_DBL, QMF_MAX_SYNTHESIS_BANDS);
+
+ for (ch = 0; ch < self->numOutputChannelsAT; ch++) {
+ if (self->pConfigCurrent->syntaxFlags & SACDEC_SYNTAX_LD) {
+ int k;
+ /* No hybrid filtering. Just copy the QMF data. */
+ for (k = 0; k < self->hybridBands; k += 1) {
+ pQmfReal[k] = hybOutputReal[ch][k];
+ pQmfImag[k] = hybOutputImag[ch][k];
+ }
+ } else {
+ FDKhybridSynthesisApply(&self->hybridSynthesis[ch], hybOutputReal[ch],
+ hybOutputImag[ch], pQmfReal, pQmfImag);
+ }
+
+ /* Map channel indices from MPEG Surround -> PCE style -> channelMapping[]
+ */
+ FDK_ASSERT(self->numOutputChannelsAT <= 6);
+ int outCh = FDK_chMapDescr_getMapValue(mapDescr, mapChannel(self, ch),
+ self->numOutputChannelsAT);
+
+ {
+ if (self->stereoConfigIndex == 3) {
+ /* MPS -> SBR */
+ int i;
+ FIXP_DBL *pWorkBufReal, *pWorkBufImag;
+ FDK_ASSERT((self->pQmfDomain->QmfDomainOut[outCh].fb.outGain_m ==
+ (FIXP_DBL)0x80000000) &&
+ (self->pQmfDomain->QmfDomainOut[outCh].fb.outGain_e == 0));
+ FDK_QmfDomain_GetWorkBuffer(&self->pQmfDomain->QmfDomainIn[outCh], ts,
+ &pWorkBufReal, &pWorkBufImag);
+ FDK_ASSERT(self->qmfBands <=
+ self->pQmfDomain->QmfDomainIn[outCh].workBuf_nBands);
+ for (i = 0; i < self->qmfBands; i++) {
+ pWorkBufReal[i] = pQmfReal[i];
+ pWorkBufImag[i] = pQmfImag[i];
+ }
+ self->pQmfDomain->QmfDomainIn[outCh].scaling.lb_scale =
+ -7; /*-ALGORITHMIC_SCALING_IN_ANALYSIS_FILTERBANK;*/
+ self->pQmfDomain->QmfDomainIn[outCh].scaling.lb_scale -=
+ self->pQmfDomain->QmfDomainIn[outCh].fb.filterScale;
+ self->pQmfDomain->QmfDomainIn[outCh].scaling.lb_scale -=
+ self->clipProtectGainSF__FDK;
+
+ } else {
+ /* Call the QMF synthesis for dry. */
+ err = CalculateSpaceSynthesisQmf(&self->pQmfDomain->QmfDomainOut[outCh],
+ pQmfReal, pQmfImag, stride,
+ pTimeOut__FDK + (offset * outCh));
+ }
+ if (err != MPS_OK) goto bail;
+ }
+ } /* ch loop */
+
+bail:
+ C_ALLOC_SCRATCH_END(pQmfImag, FIXP_DBL, QMF_MAX_SYNTHESIS_BANDS);
+ C_ALLOC_SCRATCH_END(pQmfReal, FIXP_DBL, QMF_MAX_SYNTHESIS_BANDS);
+
+ return err;
+}
+
+void SpatialDecBufferMatrices(spatialDec *self) {
+ int row, col;
+ int complexParBands;
+ complexParBands = self->numParameterBands;
+
+ /*
+ buffer matrices M2
+ */
+ for (row = 0; row < self->numM2rows; row++) {
+ for (col = 0; col < self->numVChannels; col++) {
+ FDKmemcpy(self->M2RealPrev__FDK[row][col], self->M2Real__FDK[row][col],
+ self->numParameterBands * sizeof(FIXP_DBL));
+ if (0 || (self->phaseCoding == 3)) {
+ FDKmemcpy(self->M2ImagPrev__FDK[row][col], self->M2Imag__FDK[row][col],
+ complexParBands * sizeof(FIXP_DBL));
+ }
+ }
+ }
+
+ /* buffer phase */
+ FDKmemcpy(self->PhasePrevLeft__FDK, self->PhaseLeft__FDK,
+ self->numParameterBands * sizeof(FIXP_DBL));
+ FDKmemcpy(self->PhasePrevRight__FDK, self->PhaseRight__FDK,
+ self->numParameterBands * sizeof(FIXP_DBL));
+}
+
+#define PHASE_SCALE 2
+
+#ifndef P_PI
+#define P_PI 3.1415926535897932
+#endif
+
+/* For better precision, PI (pi_x2) is already doubled */
+static FIXP_DBL interp_angle__FDK(FIXP_DBL angle1, FIXP_DBL angle2,
+ FIXP_SGL alpha, FIXP_DBL pi_x2) {
+ if (angle2 - angle1 > (pi_x2 >> 1)) angle2 -= pi_x2;
+
+ if (angle1 - angle2 > (pi_x2 >> 1)) angle1 -= pi_x2;
+
+ return interpolateParameter(alpha, angle2, angle1);
+}
+
+/*
+ *
+ */
+void SpatialDecApplyPhase(spatialDec *self, FIXP_SGL alpha__FDK,
+ int lastSlotOfParamSet) {
+ int pb, qs;
+ FIXP_DBL ppb[MAX_PARAMETER_BANDS *
+ 4]; /* left real, imag - right real, imag interleaved */
+
+ const FIXP_DBL pi_x2 = PIx2__IPD;
+ for (pb = 0; pb < self->numParameterBands; pb++) {
+ FIXP_DBL pl, pr;
+
+ pl = interp_angle__FDK(self->PhasePrevLeft__FDK[pb],
+ self->PhaseLeft__FDK[pb], alpha__FDK, pi_x2);
+ pr = interp_angle__FDK(self->PhasePrevRight__FDK[pb],
+ self->PhaseRight__FDK[pb], alpha__FDK, pi_x2);
+
+ inline_fixp_cos_sin(pl, pr, IPD_SCALE, &ppb[4 * pb]);
+ }
+
+ /* sign is -1 for qs = 0,2 and +1 for qs = 1 */
+
+ const SCHAR *kernels = &self->kernels[0];
+
+ FIXP_DBL *Dry_real0 = &self->hybOutputRealDry__FDK[0][0];
+ FIXP_DBL *Dry_imag0 = &self->hybOutputImagDry__FDK[0][0];
+ FIXP_DBL *Dry_real1 = &self->hybOutputRealDry__FDK[1][0];
+ FIXP_DBL *Dry_imag1 = &self->hybOutputImagDry__FDK[1][0];
+
+ for (qs = 2; qs >= 0; qs--) {
+ FIXP_DBL out_re, out_im;
+
+ pb = *kernels++;
+ if (qs == 1) /* sign[qs] >= 0 */
+ {
+ cplxMultDiv2(&out_re, &out_im, *Dry_real0, *Dry_imag0, ppb[4 * pb + 0],
+ ppb[4 * pb + 1]);
+ out_re <<= PHASE_SCALE - 1;
+ out_im <<= PHASE_SCALE - 1;
+ *Dry_real0++ = out_re;
+ *Dry_imag0++ = out_im;
+
+ cplxMultDiv2(&out_re, &out_im, *Dry_real1, *Dry_imag1, ppb[4 * pb + 2],
+ ppb[4 * pb + 3]);
+ out_re <<= PHASE_SCALE - 1;
+ out_im <<= PHASE_SCALE - 1;
+ *Dry_real1++ = out_re;
+ *Dry_imag1++ = out_im;
+ } else {
+ cplxMultDiv2(&out_re, &out_im, *Dry_real0, *Dry_imag0, ppb[4 * pb + 0],
+ -ppb[4 * pb + 1]);
+ out_re <<= PHASE_SCALE - 1;
+ out_im <<= PHASE_SCALE - 1;
+ *Dry_real0++ = out_re;
+ *Dry_imag0++ = out_im;
+
+ cplxMultDiv2(&out_re, &out_im, *Dry_real1, *Dry_imag1, ppb[4 * pb + 2],
+ -ppb[4 * pb + 3]);
+ out_re <<= PHASE_SCALE - 1;
+ out_im <<= PHASE_SCALE - 1;
+ *Dry_real1++ = out_re;
+ *Dry_imag1++ = out_im;
+ }
+ }
+
+ /* sign is +1 for qs >=3 */
+ for (qs = self->hybridBands - 3; qs--;) {
+ FIXP_DBL out_re, out_im;
+
+ pb = *kernels++;
+ cplxMultDiv2(&out_re, &out_im, *Dry_real0, *Dry_imag0, ppb[4 * pb + 0],
+ ppb[4 * pb + 1]);
+ out_re <<= PHASE_SCALE - 1;
+ out_im <<= PHASE_SCALE - 1;
+ *Dry_real0++ = out_re;
+ *Dry_imag0++ = out_im;
+
+ cplxMultDiv2(&out_re, &out_im, *Dry_real1, *Dry_imag1, ppb[4 * pb + 2],
+ ppb[4 * pb + 3]);
+ out_re <<= PHASE_SCALE - 1;
+ out_im <<= PHASE_SCALE - 1;
+ *Dry_real1++ = out_re;
+ *Dry_imag1++ = out_im;
+ }
+}