xref: /aosp_15_r20/external/aac/libFDK/include/qmf_pcm.h (revision e54365361535b070c2db7374cec45c159c7d0e7a)
1*e5436536SAndroid Build Coastguard Worker /* -----------------------------------------------------------------------------
2*e5436536SAndroid Build Coastguard Worker Software License for The Fraunhofer FDK AAC Codec Library for Android
3*e5436536SAndroid Build Coastguard Worker 
4*e5436536SAndroid Build Coastguard Worker © Copyright  1995 - 2019 Fraunhofer-Gesellschaft zur Förderung der angewandten
5*e5436536SAndroid Build Coastguard Worker Forschung e.V. All rights reserved.
6*e5436536SAndroid Build Coastguard Worker 
7*e5436536SAndroid Build Coastguard Worker  1.    INTRODUCTION
8*e5436536SAndroid Build Coastguard Worker The Fraunhofer FDK AAC Codec Library for Android ("FDK AAC Codec") is software
9*e5436536SAndroid Build Coastguard Worker that implements the MPEG Advanced Audio Coding ("AAC") encoding and decoding
10*e5436536SAndroid Build Coastguard Worker scheme for digital audio. This FDK AAC Codec software is intended to be used on
11*e5436536SAndroid Build Coastguard Worker a wide variety of Android devices.
12*e5436536SAndroid Build Coastguard Worker 
13*e5436536SAndroid Build Coastguard Worker AAC's HE-AAC and HE-AAC v2 versions are regarded as today's most efficient
14*e5436536SAndroid Build Coastguard Worker general perceptual audio codecs. AAC-ELD is considered the best-performing
15*e5436536SAndroid Build Coastguard Worker full-bandwidth communications codec by independent studies and is widely
16*e5436536SAndroid Build Coastguard Worker deployed. AAC has been standardized by ISO and IEC as part of the MPEG
17*e5436536SAndroid Build Coastguard Worker specifications.
18*e5436536SAndroid Build Coastguard Worker 
19*e5436536SAndroid Build Coastguard Worker Patent licenses for necessary patent claims for the FDK AAC Codec (including
20*e5436536SAndroid Build Coastguard Worker those of Fraunhofer) may be obtained through Via Licensing
21*e5436536SAndroid Build Coastguard Worker (www.vialicensing.com) or through the respective patent owners individually for
22*e5436536SAndroid Build Coastguard Worker the purpose of encoding or decoding bit streams in products that are compliant
23*e5436536SAndroid Build Coastguard Worker with the ISO/IEC MPEG audio standards. Please note that most manufacturers of
24*e5436536SAndroid Build Coastguard Worker Android devices already license these patent claims through Via Licensing or
25*e5436536SAndroid Build Coastguard Worker directly from the patent owners, and therefore FDK AAC Codec software may
26*e5436536SAndroid Build Coastguard Worker already be covered under those patent licenses when it is used for those
27*e5436536SAndroid Build Coastguard Worker licensed purposes only.
28*e5436536SAndroid Build Coastguard Worker 
29*e5436536SAndroid Build Coastguard Worker Commercially-licensed AAC software libraries, including floating-point versions
30*e5436536SAndroid Build Coastguard Worker with enhanced sound quality, are also available from Fraunhofer. Users are
31*e5436536SAndroid Build Coastguard Worker encouraged to check the Fraunhofer website for additional applications
32*e5436536SAndroid Build Coastguard Worker information and documentation.
33*e5436536SAndroid Build Coastguard Worker 
34*e5436536SAndroid Build Coastguard Worker 2.    COPYRIGHT LICENSE
35*e5436536SAndroid Build Coastguard Worker 
36*e5436536SAndroid Build Coastguard Worker Redistribution and use in source and binary forms, with or without modification,
37*e5436536SAndroid Build Coastguard Worker are permitted without payment of copyright license fees provided that you
38*e5436536SAndroid Build Coastguard Worker satisfy the following conditions:
39*e5436536SAndroid Build Coastguard Worker 
40*e5436536SAndroid Build Coastguard Worker You must retain the complete text of this software license in redistributions of
41*e5436536SAndroid Build Coastguard Worker the FDK AAC Codec or your modifications thereto in source code form.
42*e5436536SAndroid Build Coastguard Worker 
43*e5436536SAndroid Build Coastguard Worker You must retain the complete text of this software license in the documentation
44*e5436536SAndroid Build Coastguard Worker and/or other materials provided with redistributions of the FDK AAC Codec or
45*e5436536SAndroid Build Coastguard Worker your modifications thereto in binary form. You must make available free of
46*e5436536SAndroid Build Coastguard Worker charge copies of the complete source code of the FDK AAC Codec and your
47*e5436536SAndroid Build Coastguard Worker modifications thereto to recipients of copies in binary form.
48*e5436536SAndroid Build Coastguard Worker 
49*e5436536SAndroid Build Coastguard Worker The name of Fraunhofer may not be used to endorse or promote products derived
50*e5436536SAndroid Build Coastguard Worker from this library without prior written permission.
51*e5436536SAndroid Build Coastguard Worker 
52*e5436536SAndroid Build Coastguard Worker You may not charge copyright license fees for anyone to use, copy or distribute
53*e5436536SAndroid Build Coastguard Worker the FDK AAC Codec software or your modifications thereto.
54*e5436536SAndroid Build Coastguard Worker 
55*e5436536SAndroid Build Coastguard Worker Your modified versions of the FDK AAC Codec must carry prominent notices stating
56*e5436536SAndroid Build Coastguard Worker that you changed the software and the date of any change. For modified versions
57*e5436536SAndroid Build Coastguard Worker of the FDK AAC Codec, the term "Fraunhofer FDK AAC Codec Library for Android"
58*e5436536SAndroid Build Coastguard Worker must be replaced by the term "Third-Party Modified Version of the Fraunhofer FDK
59*e5436536SAndroid Build Coastguard Worker AAC Codec Library for Android."
60*e5436536SAndroid Build Coastguard Worker 
61*e5436536SAndroid Build Coastguard Worker 3.    NO PATENT LICENSE
62*e5436536SAndroid Build Coastguard Worker 
63*e5436536SAndroid Build Coastguard Worker NO EXPRESS OR IMPLIED LICENSES TO ANY PATENT CLAIMS, including without
64*e5436536SAndroid Build Coastguard Worker limitation the patents of Fraunhofer, ARE GRANTED BY THIS SOFTWARE LICENSE.
65*e5436536SAndroid Build Coastguard Worker Fraunhofer provides no warranty of patent non-infringement with respect to this
66*e5436536SAndroid Build Coastguard Worker software.
67*e5436536SAndroid Build Coastguard Worker 
68*e5436536SAndroid Build Coastguard Worker You may use this FDK AAC Codec software or modifications thereto only for
69*e5436536SAndroid Build Coastguard Worker purposes that are authorized by appropriate patent licenses.
70*e5436536SAndroid Build Coastguard Worker 
71*e5436536SAndroid Build Coastguard Worker 4.    DISCLAIMER
72*e5436536SAndroid Build Coastguard Worker 
73*e5436536SAndroid Build Coastguard Worker This FDK AAC Codec software is provided by Fraunhofer on behalf of the copyright
74*e5436536SAndroid Build Coastguard Worker holders and contributors "AS IS" and WITHOUT ANY EXPRESS OR IMPLIED WARRANTIES,
75*e5436536SAndroid Build Coastguard Worker including but not limited to the implied warranties of merchantability and
76*e5436536SAndroid Build Coastguard Worker fitness for a particular purpose. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
77*e5436536SAndroid Build Coastguard Worker CONTRIBUTORS BE LIABLE for any direct, indirect, incidental, special, exemplary,
78*e5436536SAndroid Build Coastguard Worker or consequential damages, including but not limited to procurement of substitute
79*e5436536SAndroid Build Coastguard Worker goods or services; loss of use, data, or profits, or business interruption,
80*e5436536SAndroid Build Coastguard Worker however caused and on any theory of liability, whether in contract, strict
81*e5436536SAndroid Build Coastguard Worker liability, or tort (including negligence), arising in any way out of the use of
82*e5436536SAndroid Build Coastguard Worker this software, even if advised of the possibility of such damage.
83*e5436536SAndroid Build Coastguard Worker 
84*e5436536SAndroid Build Coastguard Worker 5.    CONTACT INFORMATION
85*e5436536SAndroid Build Coastguard Worker 
86*e5436536SAndroid Build Coastguard Worker Fraunhofer Institute for Integrated Circuits IIS
87*e5436536SAndroid Build Coastguard Worker Attention: Audio and Multimedia Departments - FDK AAC LL
88*e5436536SAndroid Build Coastguard Worker Am Wolfsmantel 33
89*e5436536SAndroid Build Coastguard Worker 91058 Erlangen, Germany
90*e5436536SAndroid Build Coastguard Worker 
91*e5436536SAndroid Build Coastguard Worker www.iis.fraunhofer.de/amm
92*e5436536SAndroid Build Coastguard Worker [email protected]
93*e5436536SAndroid Build Coastguard Worker ----------------------------------------------------------------------------- */
94*e5436536SAndroid Build Coastguard Worker 
95*e5436536SAndroid Build Coastguard Worker /******************* Library for basic calculation routines ********************
96*e5436536SAndroid Build Coastguard Worker 
97*e5436536SAndroid Build Coastguard Worker    Author(s):   Markus Lohwasser, Josef Hoepfl, Manuel Jander
98*e5436536SAndroid Build Coastguard Worker 
99*e5436536SAndroid Build Coastguard Worker    Description: QMF filterbank
100*e5436536SAndroid Build Coastguard Worker 
101*e5436536SAndroid Build Coastguard Worker *******************************************************************************/
102*e5436536SAndroid Build Coastguard Worker 
103*e5436536SAndroid Build Coastguard Worker #ifndef QMF_PCM_H
104*e5436536SAndroid Build Coastguard Worker #define QMF_PCM_H
105*e5436536SAndroid Build Coastguard Worker 
106*e5436536SAndroid Build Coastguard Worker /*
107*e5436536SAndroid Build Coastguard Worker    All Synthesis functions dependent on datatype INT_PCM_QMFOUT
108*e5436536SAndroid Build Coastguard Worker    Should only be included by qmf.cpp, but not compiled separately, please
109*e5436536SAndroid Build Coastguard Worker    exclude compilation from project, if done otherwise. Is optional included
110*e5436536SAndroid Build Coastguard Worker    twice to duplicate all functions with two different pre-definitions, as:
111*e5436536SAndroid Build Coastguard Worker         #define INT_PCM_QMFOUT LONG
112*e5436536SAndroid Build Coastguard Worker     and ...
113*e5436536SAndroid Build Coastguard Worker         #define INT_PCM_QMFOUT SHORT
114*e5436536SAndroid Build Coastguard Worker     needed to run QMF synthesis in both 16bit and 32bit sample output format.
115*e5436536SAndroid Build Coastguard Worker */
116*e5436536SAndroid Build Coastguard Worker 
117*e5436536SAndroid Build Coastguard Worker #define QSSCALE (0)
118*e5436536SAndroid Build Coastguard Worker #define FX_DBL2FX_QSS(x) (x)
119*e5436536SAndroid Build Coastguard Worker #define FX_QSS2FX_DBL(x) (x)
120*e5436536SAndroid Build Coastguard Worker 
121*e5436536SAndroid Build Coastguard Worker /*!
122*e5436536SAndroid Build Coastguard Worker   \brief Perform Synthesis Prototype Filtering on a single slot of input data.
123*e5436536SAndroid Build Coastguard Worker 
124*e5436536SAndroid Build Coastguard Worker   The filter takes 2 * qmf->no_channels of input data and
125*e5436536SAndroid Build Coastguard Worker   generates qmf->no_channels time domain output samples.
126*e5436536SAndroid Build Coastguard Worker */
127*e5436536SAndroid Build Coastguard Worker /* static */
128*e5436536SAndroid Build Coastguard Worker #ifndef FUNCTION_qmfSynPrototypeFirSlot
qmfSynPrototypeFirSlot(HANDLE_QMF_FILTER_BANK qmf,FIXP_DBL * RESTRICT realSlot,FIXP_DBL * RESTRICT imagSlot,INT_PCM_QMFOUT * RESTRICT timeOut,int stride)129*e5436536SAndroid Build Coastguard Worker void qmfSynPrototypeFirSlot(
130*e5436536SAndroid Build Coastguard Worker #else
131*e5436536SAndroid Build Coastguard Worker void qmfSynPrototypeFirSlot_fallback(
132*e5436536SAndroid Build Coastguard Worker #endif
133*e5436536SAndroid Build Coastguard Worker     HANDLE_QMF_FILTER_BANK qmf,
134*e5436536SAndroid Build Coastguard Worker     FIXP_DBL *RESTRICT realSlot,      /*!< Input: Pointer to real Slot */
135*e5436536SAndroid Build Coastguard Worker     FIXP_DBL *RESTRICT imagSlot,      /*!< Input: Pointer to imag Slot */
136*e5436536SAndroid Build Coastguard Worker     INT_PCM_QMFOUT *RESTRICT timeOut, /*!< Time domain data */
137*e5436536SAndroid Build Coastguard Worker     int stride) {
138*e5436536SAndroid Build Coastguard Worker   FIXP_QSS *FilterStates = (FIXP_QSS *)qmf->FilterStates;
139*e5436536SAndroid Build Coastguard Worker   int no_channels = qmf->no_channels;
140*e5436536SAndroid Build Coastguard Worker   const FIXP_PFT *p_Filter = qmf->p_filter;
141*e5436536SAndroid Build Coastguard Worker   int p_stride = qmf->p_stride;
142*e5436536SAndroid Build Coastguard Worker   int j;
143*e5436536SAndroid Build Coastguard Worker   FIXP_QSS *RESTRICT sta = FilterStates;
144*e5436536SAndroid Build Coastguard Worker   const FIXP_PFT *RESTRICT p_flt, *RESTRICT p_fltm;
145*e5436536SAndroid Build Coastguard Worker   int scale = (DFRACT_BITS - SAMPLE_BITS_QMFOUT) - 1 - qmf->outScalefactor -
146*e5436536SAndroid Build Coastguard Worker               qmf->outGain_e;
147*e5436536SAndroid Build Coastguard Worker 
148*e5436536SAndroid Build Coastguard Worker   p_flt =
149*e5436536SAndroid Build Coastguard Worker       p_Filter + p_stride * QMF_NO_POLY; /*                     5th of 330 */
150*e5436536SAndroid Build Coastguard Worker   p_fltm = p_Filter + (qmf->FilterSize / 2) -
151*e5436536SAndroid Build Coastguard Worker            p_stride * QMF_NO_POLY; /* 5 + (320 - 2*5) = 315th of 330 */
152*e5436536SAndroid Build Coastguard Worker 
153*e5436536SAndroid Build Coastguard Worker   FIXP_SGL gain = FX_DBL2FX_SGL(qmf->outGain_m);
154*e5436536SAndroid Build Coastguard Worker 
155*e5436536SAndroid Build Coastguard Worker   FIXP_DBL rnd_val = 0;
156*e5436536SAndroid Build Coastguard Worker 
157*e5436536SAndroid Build Coastguard Worker   if (scale > 0) {
158*e5436536SAndroid Build Coastguard Worker     if (scale < (DFRACT_BITS - 1))
159*e5436536SAndroid Build Coastguard Worker       rnd_val = FIXP_DBL(1 << (scale - 1));
160*e5436536SAndroid Build Coastguard Worker     else
161*e5436536SAndroid Build Coastguard Worker       scale = (DFRACT_BITS - 1);
162*e5436536SAndroid Build Coastguard Worker   } else {
163*e5436536SAndroid Build Coastguard Worker     scale = fMax(scale, -(DFRACT_BITS - 1));
164*e5436536SAndroid Build Coastguard Worker   }
165*e5436536SAndroid Build Coastguard Worker 
166*e5436536SAndroid Build Coastguard Worker   for (j = no_channels - 1; j >= 0; j--) {
167*e5436536SAndroid Build Coastguard Worker     FIXP_DBL imag = imagSlot[j]; /* no_channels-1 .. 0 */
168*e5436536SAndroid Build Coastguard Worker     FIXP_DBL real = realSlot[j]; /* no_channels-1 .. 0 */
169*e5436536SAndroid Build Coastguard Worker     {
170*e5436536SAndroid Build Coastguard Worker       INT_PCM_QMFOUT tmp;
171*e5436536SAndroid Build Coastguard Worker       FIXP_DBL Are = fMultAddDiv2(FX_QSS2FX_DBL(sta[0]), p_fltm[0], real);
172*e5436536SAndroid Build Coastguard Worker 
173*e5436536SAndroid Build Coastguard Worker       /* This PCM formatting performs:
174*e5436536SAndroid Build Coastguard Worker          - multiplication with 16-bit gain, if not -1.0f
175*e5436536SAndroid Build Coastguard Worker          - rounding, if shift right is applied
176*e5436536SAndroid Build Coastguard Worker          - apply shift left (or right) with saturation to 32 (or 16) bits
177*e5436536SAndroid Build Coastguard Worker          - store output with --stride in 32 (or 16) bit format
178*e5436536SAndroid Build Coastguard Worker       */
179*e5436536SAndroid Build Coastguard Worker       if (gain != (FIXP_SGL)(-32768)) /* -1.0f */
180*e5436536SAndroid Build Coastguard Worker       {
181*e5436536SAndroid Build Coastguard Worker         Are = fMult(Are, gain);
182*e5436536SAndroid Build Coastguard Worker       }
183*e5436536SAndroid Build Coastguard Worker       if (scale >= 0) {
184*e5436536SAndroid Build Coastguard Worker         FDK_ASSERT(
185*e5436536SAndroid Build Coastguard Worker             Are <=
186*e5436536SAndroid Build Coastguard Worker             (Are + rnd_val)); /* Round-addition must not overflow, might be
187*e5436536SAndroid Build Coastguard Worker                                  equal for rnd_val=0 */
188*e5436536SAndroid Build Coastguard Worker         tmp = (INT_PCM_QMFOUT)(
189*e5436536SAndroid Build Coastguard Worker             SATURATE_RIGHT_SHIFT(Are + rnd_val, scale, SAMPLE_BITS_QMFOUT));
190*e5436536SAndroid Build Coastguard Worker       } else {
191*e5436536SAndroid Build Coastguard Worker         tmp = (INT_PCM_QMFOUT)(
192*e5436536SAndroid Build Coastguard Worker             SATURATE_LEFT_SHIFT(Are, -scale, SAMPLE_BITS_QMFOUT));
193*e5436536SAndroid Build Coastguard Worker       }
194*e5436536SAndroid Build Coastguard Worker 
195*e5436536SAndroid Build Coastguard Worker       { timeOut[(j)*stride] = tmp; }
196*e5436536SAndroid Build Coastguard Worker     }
197*e5436536SAndroid Build Coastguard Worker 
198*e5436536SAndroid Build Coastguard Worker     sta[0] = FX_DBL2FX_QSS(fMultAddDiv2(FX_QSS2FX_DBL(sta[1]), p_flt[4], imag));
199*e5436536SAndroid Build Coastguard Worker     sta[1] =
200*e5436536SAndroid Build Coastguard Worker         FX_DBL2FX_QSS(fMultAddDiv2(FX_QSS2FX_DBL(sta[2]), p_fltm[1], real));
201*e5436536SAndroid Build Coastguard Worker     sta[2] = FX_DBL2FX_QSS(fMultAddDiv2(FX_QSS2FX_DBL(sta[3]), p_flt[3], imag));
202*e5436536SAndroid Build Coastguard Worker     sta[3] =
203*e5436536SAndroid Build Coastguard Worker         FX_DBL2FX_QSS(fMultAddDiv2(FX_QSS2FX_DBL(sta[4]), p_fltm[2], real));
204*e5436536SAndroid Build Coastguard Worker     sta[4] = FX_DBL2FX_QSS(fMultAddDiv2(FX_QSS2FX_DBL(sta[5]), p_flt[2], imag));
205*e5436536SAndroid Build Coastguard Worker     sta[5] =
206*e5436536SAndroid Build Coastguard Worker         FX_DBL2FX_QSS(fMultAddDiv2(FX_QSS2FX_DBL(sta[6]), p_fltm[3], real));
207*e5436536SAndroid Build Coastguard Worker     sta[6] = FX_DBL2FX_QSS(fMultAddDiv2(FX_QSS2FX_DBL(sta[7]), p_flt[1], imag));
208*e5436536SAndroid Build Coastguard Worker     sta[7] =
209*e5436536SAndroid Build Coastguard Worker         FX_DBL2FX_QSS(fMultAddDiv2(FX_QSS2FX_DBL(sta[8]), p_fltm[4], real));
210*e5436536SAndroid Build Coastguard Worker     sta[8] = FX_DBL2FX_QSS(fMultDiv2(p_flt[0], imag));
211*e5436536SAndroid Build Coastguard Worker     p_flt += (p_stride * QMF_NO_POLY);
212*e5436536SAndroid Build Coastguard Worker     p_fltm -= (p_stride * QMF_NO_POLY);
213*e5436536SAndroid Build Coastguard Worker     sta += 9;  // = (2*QMF_NO_POLY-1);
214*e5436536SAndroid Build Coastguard Worker   }
215*e5436536SAndroid Build Coastguard Worker }
216*e5436536SAndroid Build Coastguard Worker 
217*e5436536SAndroid Build Coastguard Worker #ifndef FUNCTION_qmfSynPrototypeFirSlot_NonSymmetric
218*e5436536SAndroid Build Coastguard Worker /*!
219*e5436536SAndroid Build Coastguard Worker   \brief Perform Synthesis Prototype Filtering on a single slot of input data.
220*e5436536SAndroid Build Coastguard Worker 
221*e5436536SAndroid Build Coastguard Worker   The filter takes 2 * qmf->no_channels of input data and
222*e5436536SAndroid Build Coastguard Worker   generates qmf->no_channels time domain output samples.
223*e5436536SAndroid Build Coastguard Worker */
qmfSynPrototypeFirSlot_NonSymmetric(HANDLE_QMF_FILTER_BANK qmf,FIXP_DBL * RESTRICT realSlot,FIXP_DBL * RESTRICT imagSlot,INT_PCM_QMFOUT * RESTRICT timeOut,int stride)224*e5436536SAndroid Build Coastguard Worker static void qmfSynPrototypeFirSlot_NonSymmetric(
225*e5436536SAndroid Build Coastguard Worker     HANDLE_QMF_FILTER_BANK qmf,
226*e5436536SAndroid Build Coastguard Worker     FIXP_DBL *RESTRICT realSlot,      /*!< Input: Pointer to real Slot */
227*e5436536SAndroid Build Coastguard Worker     FIXP_DBL *RESTRICT imagSlot,      /*!< Input: Pointer to imag Slot */
228*e5436536SAndroid Build Coastguard Worker     INT_PCM_QMFOUT *RESTRICT timeOut, /*!< Time domain data */
229*e5436536SAndroid Build Coastguard Worker     int stride) {
230*e5436536SAndroid Build Coastguard Worker   FIXP_QSS *FilterStates = (FIXP_QSS *)qmf->FilterStates;
231*e5436536SAndroid Build Coastguard Worker   int no_channels = qmf->no_channels;
232*e5436536SAndroid Build Coastguard Worker   const FIXP_PFT *p_Filter = qmf->p_filter;
233*e5436536SAndroid Build Coastguard Worker   int p_stride = qmf->p_stride;
234*e5436536SAndroid Build Coastguard Worker   int j;
235*e5436536SAndroid Build Coastguard Worker   FIXP_QSS *RESTRICT sta = FilterStates;
236*e5436536SAndroid Build Coastguard Worker   const FIXP_PFT *RESTRICT p_flt, *RESTRICT p_fltm;
237*e5436536SAndroid Build Coastguard Worker   int scale = (DFRACT_BITS - SAMPLE_BITS_QMFOUT) - 1 - qmf->outScalefactor -
238*e5436536SAndroid Build Coastguard Worker               qmf->outGain_e;
239*e5436536SAndroid Build Coastguard Worker 
240*e5436536SAndroid Build Coastguard Worker   p_flt = p_Filter; /*!< Pointer to first half of filter coefficients */
241*e5436536SAndroid Build Coastguard Worker   p_fltm =
242*e5436536SAndroid Build Coastguard Worker       &p_flt[qmf->FilterSize / 2]; /* at index 320, overall 640 coefficients */
243*e5436536SAndroid Build Coastguard Worker 
244*e5436536SAndroid Build Coastguard Worker   FIXP_SGL gain = FX_DBL2FX_SGL(qmf->outGain_m);
245*e5436536SAndroid Build Coastguard Worker 
246*e5436536SAndroid Build Coastguard Worker   FIXP_DBL rnd_val = (FIXP_DBL)0;
247*e5436536SAndroid Build Coastguard Worker 
248*e5436536SAndroid Build Coastguard Worker   if (scale > 0) {
249*e5436536SAndroid Build Coastguard Worker     if (scale < (DFRACT_BITS - 1))
250*e5436536SAndroid Build Coastguard Worker       rnd_val = FIXP_DBL(1 << (scale - 1));
251*e5436536SAndroid Build Coastguard Worker     else
252*e5436536SAndroid Build Coastguard Worker       scale = (DFRACT_BITS - 1);
253*e5436536SAndroid Build Coastguard Worker   } else {
254*e5436536SAndroid Build Coastguard Worker     scale = fMax(scale, -(DFRACT_BITS - 1));
255*e5436536SAndroid Build Coastguard Worker   }
256*e5436536SAndroid Build Coastguard Worker 
257*e5436536SAndroid Build Coastguard Worker   for (j = no_channels - 1; j >= 0; j--) {
258*e5436536SAndroid Build Coastguard Worker     FIXP_DBL imag = imagSlot[j]; /* no_channels-1 .. 0 */
259*e5436536SAndroid Build Coastguard Worker     FIXP_DBL real = realSlot[j]; /* no_channels-1 .. 0 */
260*e5436536SAndroid Build Coastguard Worker     {
261*e5436536SAndroid Build Coastguard Worker       INT_PCM_QMFOUT tmp;
262*e5436536SAndroid Build Coastguard Worker       FIXP_DBL Are = sta[0] + FX_DBL2FX_QSS(fMultDiv2(p_fltm[4], real));
263*e5436536SAndroid Build Coastguard Worker 
264*e5436536SAndroid Build Coastguard Worker       /* This PCM formatting performs:
265*e5436536SAndroid Build Coastguard Worker          - multiplication with 16-bit gain, if not -1.0f
266*e5436536SAndroid Build Coastguard Worker          - rounding, if shift right is applied
267*e5436536SAndroid Build Coastguard Worker          - apply shift left (or right) with saturation to 32 (or 16) bits
268*e5436536SAndroid Build Coastguard Worker          - store output with --stride in 32 (or 16) bit format
269*e5436536SAndroid Build Coastguard Worker       */
270*e5436536SAndroid Build Coastguard Worker       if (gain != (FIXP_SGL)(-32768)) /* -1.0f */
271*e5436536SAndroid Build Coastguard Worker       {
272*e5436536SAndroid Build Coastguard Worker         Are = fMult(Are, gain);
273*e5436536SAndroid Build Coastguard Worker       }
274*e5436536SAndroid Build Coastguard Worker       if (scale > 0) {
275*e5436536SAndroid Build Coastguard Worker         FDK_ASSERT(Are <
276*e5436536SAndroid Build Coastguard Worker                    (Are + rnd_val)); /* Round-addition must not overflow */
277*e5436536SAndroid Build Coastguard Worker         tmp = (INT_PCM_QMFOUT)(
278*e5436536SAndroid Build Coastguard Worker             SATURATE_RIGHT_SHIFT(Are + rnd_val, scale, SAMPLE_BITS_QMFOUT));
279*e5436536SAndroid Build Coastguard Worker       } else {
280*e5436536SAndroid Build Coastguard Worker         tmp = (INT_PCM_QMFOUT)(
281*e5436536SAndroid Build Coastguard Worker             SATURATE_LEFT_SHIFT(Are, -scale, SAMPLE_BITS_QMFOUT));
282*e5436536SAndroid Build Coastguard Worker       }
283*e5436536SAndroid Build Coastguard Worker       timeOut[j * stride] = tmp;
284*e5436536SAndroid Build Coastguard Worker     }
285*e5436536SAndroid Build Coastguard Worker 
286*e5436536SAndroid Build Coastguard Worker     sta[0] = sta[1] + FX_DBL2FX_QSS(fMultDiv2(p_flt[4], imag));
287*e5436536SAndroid Build Coastguard Worker     sta[1] = sta[2] + FX_DBL2FX_QSS(fMultDiv2(p_fltm[3], real));
288*e5436536SAndroid Build Coastguard Worker     sta[2] = sta[3] + FX_DBL2FX_QSS(fMultDiv2(p_flt[3], imag));
289*e5436536SAndroid Build Coastguard Worker 
290*e5436536SAndroid Build Coastguard Worker     sta[3] = sta[4] + FX_DBL2FX_QSS(fMultDiv2(p_fltm[2], real));
291*e5436536SAndroid Build Coastguard Worker     sta[4] = sta[5] + FX_DBL2FX_QSS(fMultDiv2(p_flt[2], imag));
292*e5436536SAndroid Build Coastguard Worker     sta[5] = sta[6] + FX_DBL2FX_QSS(fMultDiv2(p_fltm[1], real));
293*e5436536SAndroid Build Coastguard Worker     sta[6] = sta[7] + FX_DBL2FX_QSS(fMultDiv2(p_flt[1], imag));
294*e5436536SAndroid Build Coastguard Worker 
295*e5436536SAndroid Build Coastguard Worker     sta[7] = sta[8] + FX_DBL2FX_QSS(fMultDiv2(p_fltm[0], real));
296*e5436536SAndroid Build Coastguard Worker     sta[8] = FX_DBL2FX_QSS(fMultDiv2(p_flt[0], imag));
297*e5436536SAndroid Build Coastguard Worker 
298*e5436536SAndroid Build Coastguard Worker     p_flt += (p_stride * QMF_NO_POLY);
299*e5436536SAndroid Build Coastguard Worker     p_fltm += (p_stride * QMF_NO_POLY);
300*e5436536SAndroid Build Coastguard Worker     sta += 9;  // = (2*QMF_NO_POLY-1);
301*e5436536SAndroid Build Coastguard Worker   }
302*e5436536SAndroid Build Coastguard Worker }
303*e5436536SAndroid Build Coastguard Worker #endif /* FUNCTION_qmfSynPrototypeFirSlot_NonSymmetric */
304*e5436536SAndroid Build Coastguard Worker 
qmfSynthesisFilteringSlot(HANDLE_QMF_FILTER_BANK synQmf,const FIXP_DBL * realSlot,const FIXP_DBL * imagSlot,const int scaleFactorLowBand,const int scaleFactorHighBand,INT_PCM_QMFOUT * timeOut,const int stride,FIXP_DBL * pWorkBuffer)305*e5436536SAndroid Build Coastguard Worker void qmfSynthesisFilteringSlot(HANDLE_QMF_FILTER_BANK synQmf,
306*e5436536SAndroid Build Coastguard Worker                                const FIXP_DBL *realSlot,
307*e5436536SAndroid Build Coastguard Worker                                const FIXP_DBL *imagSlot,
308*e5436536SAndroid Build Coastguard Worker                                const int scaleFactorLowBand,
309*e5436536SAndroid Build Coastguard Worker                                const int scaleFactorHighBand,
310*e5436536SAndroid Build Coastguard Worker                                INT_PCM_QMFOUT *timeOut, const int stride,
311*e5436536SAndroid Build Coastguard Worker                                FIXP_DBL *pWorkBuffer) {
312*e5436536SAndroid Build Coastguard Worker   if (!(synQmf->flags & QMF_FLAG_LP))
313*e5436536SAndroid Build Coastguard Worker     qmfInverseModulationHQ(synQmf, realSlot, imagSlot, scaleFactorLowBand,
314*e5436536SAndroid Build Coastguard Worker                            scaleFactorHighBand, pWorkBuffer);
315*e5436536SAndroid Build Coastguard Worker   else {
316*e5436536SAndroid Build Coastguard Worker     if (synQmf->flags & QMF_FLAG_CLDFB) {
317*e5436536SAndroid Build Coastguard Worker       qmfInverseModulationLP_odd(synQmf, realSlot, scaleFactorLowBand,
318*e5436536SAndroid Build Coastguard Worker                                  scaleFactorHighBand, pWorkBuffer);
319*e5436536SAndroid Build Coastguard Worker     } else {
320*e5436536SAndroid Build Coastguard Worker       qmfInverseModulationLP_even(synQmf, realSlot, scaleFactorLowBand,
321*e5436536SAndroid Build Coastguard Worker                                   scaleFactorHighBand, pWorkBuffer);
322*e5436536SAndroid Build Coastguard Worker     }
323*e5436536SAndroid Build Coastguard Worker   }
324*e5436536SAndroid Build Coastguard Worker 
325*e5436536SAndroid Build Coastguard Worker   if (synQmf->flags & QMF_FLAG_NONSYMMETRIC) {
326*e5436536SAndroid Build Coastguard Worker     qmfSynPrototypeFirSlot_NonSymmetric(synQmf, pWorkBuffer,
327*e5436536SAndroid Build Coastguard Worker                                         pWorkBuffer + synQmf->no_channels,
328*e5436536SAndroid Build Coastguard Worker                                         timeOut, stride);
329*e5436536SAndroid Build Coastguard Worker   } else {
330*e5436536SAndroid Build Coastguard Worker     qmfSynPrototypeFirSlot(synQmf, pWorkBuffer,
331*e5436536SAndroid Build Coastguard Worker                            pWorkBuffer + synQmf->no_channels, timeOut, stride);
332*e5436536SAndroid Build Coastguard Worker   }
333*e5436536SAndroid Build Coastguard Worker }
334*e5436536SAndroid Build Coastguard Worker 
335*e5436536SAndroid Build Coastguard Worker /*!
336*e5436536SAndroid Build Coastguard Worker  *
337*e5436536SAndroid Build Coastguard Worker  * \brief Perform complex-valued subband synthesis of the
338*e5436536SAndroid Build Coastguard Worker  *        low band and the high band and store the
339*e5436536SAndroid Build Coastguard Worker  *        time domain data in timeOut
340*e5436536SAndroid Build Coastguard Worker  *
341*e5436536SAndroid Build Coastguard Worker  * First step: Calculate the proper scaling factor of current
342*e5436536SAndroid Build Coastguard Worker  * spectral data in qmfReal/qmfImag, old spectral data in the overlap
343*e5436536SAndroid Build Coastguard Worker  * range and filter states.
344*e5436536SAndroid Build Coastguard Worker  *
345*e5436536SAndroid Build Coastguard Worker  * Second step: Perform Frequency-to-Time mapping with inverse
346*e5436536SAndroid Build Coastguard Worker  * Modulation slot-wise.
347*e5436536SAndroid Build Coastguard Worker  *
348*e5436536SAndroid Build Coastguard Worker  * Third step: Perform FIR-filter slot-wise. To save space for filter
349*e5436536SAndroid Build Coastguard Worker  * states, the MAC operations are executed directly on the filter states
350*e5436536SAndroid Build Coastguard Worker  * instead of accumulating several products in the accumulator. The
351*e5436536SAndroid Build Coastguard Worker  * buffer shift at the end of the function should be replaced by a
352*e5436536SAndroid Build Coastguard Worker  * modulo operation, which is available on some DSPs.
353*e5436536SAndroid Build Coastguard Worker  *
354*e5436536SAndroid Build Coastguard Worker  * Last step: Copy the upper part of the spectral data to the overlap buffer.
355*e5436536SAndroid Build Coastguard Worker  *
356*e5436536SAndroid Build Coastguard Worker  * The qmf coefficient table is symmetric. The symmetry is exploited by
357*e5436536SAndroid Build Coastguard Worker  * shrinking the coefficient table to half the size. The addressing mode
358*e5436536SAndroid Build Coastguard Worker  * takes care of the symmetries.  If the #define #QMFTABLE_FULL is set,
359*e5436536SAndroid Build Coastguard Worker  * coefficient addressing works on the full table size. The code will be
360*e5436536SAndroid Build Coastguard Worker  * slightly faster and slightly more compact.
361*e5436536SAndroid Build Coastguard Worker  *
362*e5436536SAndroid Build Coastguard Worker  * Workbuffer requirement: 2 x sizeof(**QmfBufferReal) * synQmf->no_channels
363*e5436536SAndroid Build Coastguard Worker  * The workbuffer must be aligned
364*e5436536SAndroid Build Coastguard Worker  */
qmfSynthesisFiltering(HANDLE_QMF_FILTER_BANK synQmf,FIXP_DBL ** QmfBufferReal,FIXP_DBL ** QmfBufferImag,const QMF_SCALE_FACTOR * scaleFactor,const INT ov_len,INT_PCM_QMFOUT * timeOut,const INT stride,FIXP_DBL * pWorkBuffer)365*e5436536SAndroid Build Coastguard Worker void qmfSynthesisFiltering(
366*e5436536SAndroid Build Coastguard Worker     HANDLE_QMF_FILTER_BANK synQmf, /*!< Handle of Qmf Synthesis Bank  */
367*e5436536SAndroid Build Coastguard Worker     FIXP_DBL **QmfBufferReal,      /*!< Low and High band, real */
368*e5436536SAndroid Build Coastguard Worker     FIXP_DBL **QmfBufferImag,      /*!< Low and High band, imag */
369*e5436536SAndroid Build Coastguard Worker     const QMF_SCALE_FACTOR *scaleFactor,
370*e5436536SAndroid Build Coastguard Worker     const INT ov_len,        /*!< split Slot of overlap and actual slots */
371*e5436536SAndroid Build Coastguard Worker     INT_PCM_QMFOUT *timeOut, /*!< Pointer to output */
372*e5436536SAndroid Build Coastguard Worker     const INT stride,        /*!< stride factor of output */
373*e5436536SAndroid Build Coastguard Worker     FIXP_DBL *pWorkBuffer    /*!< pointer to temporal working buffer */
374*e5436536SAndroid Build Coastguard Worker ) {
375*e5436536SAndroid Build Coastguard Worker   int i;
376*e5436536SAndroid Build Coastguard Worker   int L = synQmf->no_channels;
377*e5436536SAndroid Build Coastguard Worker   int scaleFactorHighBand;
378*e5436536SAndroid Build Coastguard Worker   int scaleFactorLowBand_ov, scaleFactorLowBand_no_ov;
379*e5436536SAndroid Build Coastguard Worker 
380*e5436536SAndroid Build Coastguard Worker   FDK_ASSERT(synQmf->no_channels >= synQmf->lsb);
381*e5436536SAndroid Build Coastguard Worker   FDK_ASSERT(synQmf->no_channels >= synQmf->usb);
382*e5436536SAndroid Build Coastguard Worker 
383*e5436536SAndroid Build Coastguard Worker   /* adapt scaling */
384*e5436536SAndroid Build Coastguard Worker   scaleFactorHighBand = -ALGORITHMIC_SCALING_IN_ANALYSIS_FILTERBANK -
385*e5436536SAndroid Build Coastguard Worker                         scaleFactor->hb_scale - synQmf->filterScale;
386*e5436536SAndroid Build Coastguard Worker   scaleFactorLowBand_ov = -ALGORITHMIC_SCALING_IN_ANALYSIS_FILTERBANK -
387*e5436536SAndroid Build Coastguard Worker                           scaleFactor->ov_lb_scale - synQmf->filterScale;
388*e5436536SAndroid Build Coastguard Worker   scaleFactorLowBand_no_ov = -ALGORITHMIC_SCALING_IN_ANALYSIS_FILTERBANK -
389*e5436536SAndroid Build Coastguard Worker                              scaleFactor->lb_scale - synQmf->filterScale;
390*e5436536SAndroid Build Coastguard Worker 
391*e5436536SAndroid Build Coastguard Worker   for (i = 0; i < synQmf->no_col; i++) /* ----- no_col loop ----- */
392*e5436536SAndroid Build Coastguard Worker   {
393*e5436536SAndroid Build Coastguard Worker     const FIXP_DBL *QmfBufferImagSlot = NULL;
394*e5436536SAndroid Build Coastguard Worker 
395*e5436536SAndroid Build Coastguard Worker     int scaleFactorLowBand =
396*e5436536SAndroid Build Coastguard Worker         (i < ov_len) ? scaleFactorLowBand_ov : scaleFactorLowBand_no_ov;
397*e5436536SAndroid Build Coastguard Worker 
398*e5436536SAndroid Build Coastguard Worker     if (!(synQmf->flags & QMF_FLAG_LP)) QmfBufferImagSlot = QmfBufferImag[i];
399*e5436536SAndroid Build Coastguard Worker 
400*e5436536SAndroid Build Coastguard Worker     qmfSynthesisFilteringSlot(synQmf, QmfBufferReal[i], QmfBufferImagSlot,
401*e5436536SAndroid Build Coastguard Worker                               scaleFactorLowBand, scaleFactorHighBand,
402*e5436536SAndroid Build Coastguard Worker                               timeOut + (i * L * stride), stride, pWorkBuffer);
403*e5436536SAndroid Build Coastguard Worker   } /* no_col loop  i  */
404*e5436536SAndroid Build Coastguard Worker }
405*e5436536SAndroid Build Coastguard Worker 
406*e5436536SAndroid Build Coastguard Worker /*!
407*e5436536SAndroid Build Coastguard Worker  *
408*e5436536SAndroid Build Coastguard Worker  * \brief Create QMF filter bank instance
409*e5436536SAndroid Build Coastguard Worker  *
410*e5436536SAndroid Build Coastguard Worker  *
411*e5436536SAndroid Build Coastguard Worker  * \return 0 if successful
412*e5436536SAndroid Build Coastguard Worker  *
413*e5436536SAndroid Build Coastguard Worker  */
qmfInitAnalysisFilterBank(HANDLE_QMF_FILTER_BANK h_Qmf,FIXP_QAS * pFilterStates,int noCols,int lsb,int usb,int no_channels,int flags)414*e5436536SAndroid Build Coastguard Worker int qmfInitAnalysisFilterBank(
415*e5436536SAndroid Build Coastguard Worker     HANDLE_QMF_FILTER_BANK h_Qmf, /*!< Returns handle */
416*e5436536SAndroid Build Coastguard Worker     FIXP_QAS *pFilterStates,      /*!< Handle to filter states */
417*e5436536SAndroid Build Coastguard Worker     int noCols,                   /*!< Number of timeslots per frame */
418*e5436536SAndroid Build Coastguard Worker     int lsb,                      /*!< lower end of QMF */
419*e5436536SAndroid Build Coastguard Worker     int usb,                      /*!< upper end of QMF */
420*e5436536SAndroid Build Coastguard Worker     int no_channels,              /*!< Number of channels (bands) */
421*e5436536SAndroid Build Coastguard Worker     int flags)                    /*!< Low Power flag */
422*e5436536SAndroid Build Coastguard Worker {
423*e5436536SAndroid Build Coastguard Worker   int err = qmfInitFilterBank(h_Qmf, pFilterStates, noCols, lsb, usb,
424*e5436536SAndroid Build Coastguard Worker                               no_channels, flags, 0);
425*e5436536SAndroid Build Coastguard Worker   if (!(flags & QMF_FLAG_KEEP_STATES) && (h_Qmf->FilterStates != NULL)) {
426*e5436536SAndroid Build Coastguard Worker     FDKmemclear(h_Qmf->FilterStates,
427*e5436536SAndroid Build Coastguard Worker                 (2 * QMF_NO_POLY - 1) * h_Qmf->no_channels * sizeof(FIXP_QAS));
428*e5436536SAndroid Build Coastguard Worker   }
429*e5436536SAndroid Build Coastguard Worker 
430*e5436536SAndroid Build Coastguard Worker   FDK_ASSERT(h_Qmf->no_channels >= h_Qmf->lsb);
431*e5436536SAndroid Build Coastguard Worker 
432*e5436536SAndroid Build Coastguard Worker   return err;
433*e5436536SAndroid Build Coastguard Worker }
434*e5436536SAndroid Build Coastguard Worker 
435*e5436536SAndroid Build Coastguard Worker #ifndef FUNCTION_qmfAnaPrototypeFirSlot
436*e5436536SAndroid Build Coastguard Worker /*!
437*e5436536SAndroid Build Coastguard Worker   \brief Perform Analysis Prototype Filtering on a single slot of input data.
438*e5436536SAndroid Build Coastguard Worker */
qmfAnaPrototypeFirSlot(FIXP_DBL * analysisBuffer,INT no_channels,const FIXP_PFT * p_filter,INT p_stride,FIXP_QAS * RESTRICT pFilterStates)439*e5436536SAndroid Build Coastguard Worker static void qmfAnaPrototypeFirSlot(
440*e5436536SAndroid Build Coastguard Worker     FIXP_DBL *analysisBuffer,
441*e5436536SAndroid Build Coastguard Worker     INT no_channels, /*!< Number channels of analysis filter */
442*e5436536SAndroid Build Coastguard Worker     const FIXP_PFT *p_filter, INT p_stride, /*!< Stride of analysis filter    */
443*e5436536SAndroid Build Coastguard Worker     FIXP_QAS *RESTRICT pFilterStates) {
444*e5436536SAndroid Build Coastguard Worker   INT k;
445*e5436536SAndroid Build Coastguard Worker 
446*e5436536SAndroid Build Coastguard Worker   FIXP_DBL accu;
447*e5436536SAndroid Build Coastguard Worker   const FIXP_PFT *RESTRICT p_flt = p_filter;
448*e5436536SAndroid Build Coastguard Worker   FIXP_DBL *RESTRICT pData_0 = analysisBuffer + 2 * no_channels - 1;
449*e5436536SAndroid Build Coastguard Worker   FIXP_DBL *RESTRICT pData_1 = analysisBuffer;
450*e5436536SAndroid Build Coastguard Worker 
451*e5436536SAndroid Build Coastguard Worker   FIXP_QAS *RESTRICT sta_0 = (FIXP_QAS *)pFilterStates;
452*e5436536SAndroid Build Coastguard Worker   FIXP_QAS *RESTRICT sta_1 =
453*e5436536SAndroid Build Coastguard Worker       (FIXP_QAS *)pFilterStates + (2 * QMF_NO_POLY * no_channels) - 1;
454*e5436536SAndroid Build Coastguard Worker   INT pfltStep = QMF_NO_POLY * (p_stride);
455*e5436536SAndroid Build Coastguard Worker   INT staStep1 = no_channels << 1;
456*e5436536SAndroid Build Coastguard Worker   INT staStep2 = (no_channels << 3) - 1; /* Rewind one less */
457*e5436536SAndroid Build Coastguard Worker 
458*e5436536SAndroid Build Coastguard Worker   /* FIR filters 127..64 0..63 */
459*e5436536SAndroid Build Coastguard Worker   for (k = 0; k < no_channels; k++) {
460*e5436536SAndroid Build Coastguard Worker     accu = fMultDiv2(p_flt[0], *sta_1);
461*e5436536SAndroid Build Coastguard Worker     sta_1 -= staStep1;
462*e5436536SAndroid Build Coastguard Worker     accu += fMultDiv2(p_flt[1], *sta_1);
463*e5436536SAndroid Build Coastguard Worker     sta_1 -= staStep1;
464*e5436536SAndroid Build Coastguard Worker     accu += fMultDiv2(p_flt[2], *sta_1);
465*e5436536SAndroid Build Coastguard Worker     sta_1 -= staStep1;
466*e5436536SAndroid Build Coastguard Worker     accu += fMultDiv2(p_flt[3], *sta_1);
467*e5436536SAndroid Build Coastguard Worker     sta_1 -= staStep1;
468*e5436536SAndroid Build Coastguard Worker     accu += fMultDiv2(p_flt[4], *sta_1);
469*e5436536SAndroid Build Coastguard Worker     *pData_1++ = (accu << 1);
470*e5436536SAndroid Build Coastguard Worker     sta_1 += staStep2;
471*e5436536SAndroid Build Coastguard Worker 
472*e5436536SAndroid Build Coastguard Worker     p_flt += pfltStep;
473*e5436536SAndroid Build Coastguard Worker     accu = fMultDiv2(p_flt[0], *sta_0);
474*e5436536SAndroid Build Coastguard Worker     sta_0 += staStep1;
475*e5436536SAndroid Build Coastguard Worker     accu += fMultDiv2(p_flt[1], *sta_0);
476*e5436536SAndroid Build Coastguard Worker     sta_0 += staStep1;
477*e5436536SAndroid Build Coastguard Worker     accu += fMultDiv2(p_flt[2], *sta_0);
478*e5436536SAndroid Build Coastguard Worker     sta_0 += staStep1;
479*e5436536SAndroid Build Coastguard Worker     accu += fMultDiv2(p_flt[3], *sta_0);
480*e5436536SAndroid Build Coastguard Worker     sta_0 += staStep1;
481*e5436536SAndroid Build Coastguard Worker     accu += fMultDiv2(p_flt[4], *sta_0);
482*e5436536SAndroid Build Coastguard Worker     *pData_0-- = (accu << 1);
483*e5436536SAndroid Build Coastguard Worker     sta_0 -= staStep2;
484*e5436536SAndroid Build Coastguard Worker   }
485*e5436536SAndroid Build Coastguard Worker }
486*e5436536SAndroid Build Coastguard Worker #endif /* !defined(FUNCTION_qmfAnaPrototypeFirSlot) */
487*e5436536SAndroid Build Coastguard Worker 
488*e5436536SAndroid Build Coastguard Worker #ifndef FUNCTION_qmfAnaPrototypeFirSlot_NonSymmetric
489*e5436536SAndroid Build Coastguard Worker /*!
490*e5436536SAndroid Build Coastguard Worker   \brief Perform Analysis Prototype Filtering on a single slot of input data.
491*e5436536SAndroid Build Coastguard Worker */
qmfAnaPrototypeFirSlot_NonSymmetric(FIXP_DBL * analysisBuffer,int no_channels,const FIXP_PFT * p_filter,int p_stride,FIXP_QAS * RESTRICT pFilterStates)492*e5436536SAndroid Build Coastguard Worker static void qmfAnaPrototypeFirSlot_NonSymmetric(
493*e5436536SAndroid Build Coastguard Worker     FIXP_DBL *analysisBuffer,
494*e5436536SAndroid Build Coastguard Worker     int no_channels, /*!< Number channels of analysis filter */
495*e5436536SAndroid Build Coastguard Worker     const FIXP_PFT *p_filter, int p_stride, /*!< Stride of analysis filter    */
496*e5436536SAndroid Build Coastguard Worker     FIXP_QAS *RESTRICT pFilterStates) {
497*e5436536SAndroid Build Coastguard Worker   const FIXP_PFT *RESTRICT p_flt = p_filter;
498*e5436536SAndroid Build Coastguard Worker   int p, k;
499*e5436536SAndroid Build Coastguard Worker 
500*e5436536SAndroid Build Coastguard Worker   for (k = 0; k < 2 * no_channels; k++) {
501*e5436536SAndroid Build Coastguard Worker     FIXP_DBL accu = (FIXP_DBL)0;
502*e5436536SAndroid Build Coastguard Worker 
503*e5436536SAndroid Build Coastguard Worker     p_flt += QMF_NO_POLY * (p_stride - 1);
504*e5436536SAndroid Build Coastguard Worker 
505*e5436536SAndroid Build Coastguard Worker     /*
506*e5436536SAndroid Build Coastguard Worker       Perform FIR-Filter
507*e5436536SAndroid Build Coastguard Worker     */
508*e5436536SAndroid Build Coastguard Worker     for (p = 0; p < QMF_NO_POLY; p++) {
509*e5436536SAndroid Build Coastguard Worker       accu += fMultDiv2(*p_flt++, pFilterStates[2 * no_channels * p]);
510*e5436536SAndroid Build Coastguard Worker     }
511*e5436536SAndroid Build Coastguard Worker     analysisBuffer[2 * no_channels - 1 - k] = (accu << 1);
512*e5436536SAndroid Build Coastguard Worker     pFilterStates++;
513*e5436536SAndroid Build Coastguard Worker   }
514*e5436536SAndroid Build Coastguard Worker }
515*e5436536SAndroid Build Coastguard Worker #endif /* FUNCTION_qmfAnaPrototypeFirSlot_NonSymmetric */
516*e5436536SAndroid Build Coastguard Worker 
517*e5436536SAndroid Build Coastguard Worker /*
518*e5436536SAndroid Build Coastguard Worker  * \brief Perform one QMF slot analysis of the time domain data of timeIn
519*e5436536SAndroid Build Coastguard Worker  *        with specified stride and stores the real part of the subband
520*e5436536SAndroid Build Coastguard Worker  *        samples in rSubband, and the imaginary part in iSubband
521*e5436536SAndroid Build Coastguard Worker  *
522*e5436536SAndroid Build Coastguard Worker  *        Note: anaQmf->lsb can be greater than anaQmf->no_channels in case
523*e5436536SAndroid Build Coastguard Worker  *        of implicit resampling (USAC with reduced 3/4 core frame length).
524*e5436536SAndroid Build Coastguard Worker  */
qmfAnalysisFilteringSlot(HANDLE_QMF_FILTER_BANK anaQmf,FIXP_DBL * qmfReal,FIXP_DBL * qmfImag,const INT_PCM_QMFIN * RESTRICT timeIn,const int stride,FIXP_DBL * pWorkBuffer)525*e5436536SAndroid Build Coastguard Worker void qmfAnalysisFilteringSlot(
526*e5436536SAndroid Build Coastguard Worker     HANDLE_QMF_FILTER_BANK anaQmf,        /*!< Handle of Qmf Synthesis Bank  */
527*e5436536SAndroid Build Coastguard Worker     FIXP_DBL *qmfReal,                    /*!< Low and High band, real */
528*e5436536SAndroid Build Coastguard Worker     FIXP_DBL *qmfImag,                    /*!< Low and High band, imag */
529*e5436536SAndroid Build Coastguard Worker     const INT_PCM_QMFIN *RESTRICT timeIn, /*!< Pointer to input */
530*e5436536SAndroid Build Coastguard Worker     const int stride,                     /*!< stride factor of input */
531*e5436536SAndroid Build Coastguard Worker     FIXP_DBL *pWorkBuffer /*!< pointer to temporal working buffer */
532*e5436536SAndroid Build Coastguard Worker ) {
533*e5436536SAndroid Build Coastguard Worker   int offset = anaQmf->no_channels * (QMF_NO_POLY * 2 - 1);
534*e5436536SAndroid Build Coastguard Worker   /*
535*e5436536SAndroid Build Coastguard Worker     Feed time signal into oldest anaQmf->no_channels states
536*e5436536SAndroid Build Coastguard Worker   */
537*e5436536SAndroid Build Coastguard Worker   {
538*e5436536SAndroid Build Coastguard Worker     FIXP_QAS *FilterStatesAnaTmp = ((FIXP_QAS *)anaQmf->FilterStates) + offset;
539*e5436536SAndroid Build Coastguard Worker 
540*e5436536SAndroid Build Coastguard Worker     /* Feed and scale actual time in slot */
541*e5436536SAndroid Build Coastguard Worker     for (int i = anaQmf->no_channels >> 1; i != 0; i--) {
542*e5436536SAndroid Build Coastguard Worker       /* Place INT_PCM value left aligned in scaledTimeIn */
543*e5436536SAndroid Build Coastguard Worker       *FilterStatesAnaTmp++ = (FIXP_QAS)*timeIn;
544*e5436536SAndroid Build Coastguard Worker       timeIn += stride;
545*e5436536SAndroid Build Coastguard Worker       *FilterStatesAnaTmp++ = (FIXP_QAS)*timeIn;
546*e5436536SAndroid Build Coastguard Worker       timeIn += stride;
547*e5436536SAndroid Build Coastguard Worker     }
548*e5436536SAndroid Build Coastguard Worker   }
549*e5436536SAndroid Build Coastguard Worker 
550*e5436536SAndroid Build Coastguard Worker   if (anaQmf->flags & QMF_FLAG_NONSYMMETRIC) {
551*e5436536SAndroid Build Coastguard Worker     qmfAnaPrototypeFirSlot_NonSymmetric(pWorkBuffer, anaQmf->no_channels,
552*e5436536SAndroid Build Coastguard Worker                                         anaQmf->p_filter, anaQmf->p_stride,
553*e5436536SAndroid Build Coastguard Worker                                         (FIXP_QAS *)anaQmf->FilterStates);
554*e5436536SAndroid Build Coastguard Worker   } else {
555*e5436536SAndroid Build Coastguard Worker     qmfAnaPrototypeFirSlot(pWorkBuffer, anaQmf->no_channels, anaQmf->p_filter,
556*e5436536SAndroid Build Coastguard Worker                            anaQmf->p_stride, (FIXP_QAS *)anaQmf->FilterStates);
557*e5436536SAndroid Build Coastguard Worker   }
558*e5436536SAndroid Build Coastguard Worker 
559*e5436536SAndroid Build Coastguard Worker   if (anaQmf->flags & QMF_FLAG_LP) {
560*e5436536SAndroid Build Coastguard Worker     if (anaQmf->flags & QMF_FLAG_CLDFB)
561*e5436536SAndroid Build Coastguard Worker       qmfForwardModulationLP_odd(anaQmf, pWorkBuffer, qmfReal);
562*e5436536SAndroid Build Coastguard Worker     else
563*e5436536SAndroid Build Coastguard Worker       qmfForwardModulationLP_even(anaQmf, pWorkBuffer, qmfReal);
564*e5436536SAndroid Build Coastguard Worker 
565*e5436536SAndroid Build Coastguard Worker   } else {
566*e5436536SAndroid Build Coastguard Worker     qmfForwardModulationHQ(anaQmf, pWorkBuffer, qmfReal, qmfImag);
567*e5436536SAndroid Build Coastguard Worker   }
568*e5436536SAndroid Build Coastguard Worker   /*
569*e5436536SAndroid Build Coastguard Worker     Shift filter states
570*e5436536SAndroid Build Coastguard Worker 
571*e5436536SAndroid Build Coastguard Worker     Should be realized with modulo addressing on a DSP instead of a true buffer
572*e5436536SAndroid Build Coastguard Worker     shift
573*e5436536SAndroid Build Coastguard Worker   */
574*e5436536SAndroid Build Coastguard Worker   FDKmemmove(anaQmf->FilterStates,
575*e5436536SAndroid Build Coastguard Worker              (FIXP_QAS *)anaQmf->FilterStates + anaQmf->no_channels,
576*e5436536SAndroid Build Coastguard Worker              offset * sizeof(FIXP_QAS));
577*e5436536SAndroid Build Coastguard Worker }
578*e5436536SAndroid Build Coastguard Worker 
579*e5436536SAndroid Build Coastguard Worker /*!
580*e5436536SAndroid Build Coastguard Worker  *
581*e5436536SAndroid Build Coastguard Worker  * \brief Perform complex-valued subband filtering of the time domain
582*e5436536SAndroid Build Coastguard Worker  *        data of timeIn and stores the real part of the subband
583*e5436536SAndroid Build Coastguard Worker  *        samples in rAnalysis, and the imaginary part in iAnalysis
584*e5436536SAndroid Build Coastguard Worker  * The qmf coefficient table is symmetric. The symmetry is expoited by
585*e5436536SAndroid Build Coastguard Worker  * shrinking the coefficient table to half the size. The addressing mode
586*e5436536SAndroid Build Coastguard Worker  * takes care of the symmetries.
587*e5436536SAndroid Build Coastguard Worker  *
588*e5436536SAndroid Build Coastguard Worker  *
589*e5436536SAndroid Build Coastguard Worker  * \sa PolyphaseFiltering
590*e5436536SAndroid Build Coastguard Worker  */
qmfAnalysisFiltering(HANDLE_QMF_FILTER_BANK anaQmf,FIXP_DBL ** qmfReal,FIXP_DBL ** qmfImag,QMF_SCALE_FACTOR * scaleFactor,const INT_PCM_QMFIN * timeIn,const int timeIn_e,const int stride,FIXP_DBL * pWorkBuffer)591*e5436536SAndroid Build Coastguard Worker void qmfAnalysisFiltering(
592*e5436536SAndroid Build Coastguard Worker     HANDLE_QMF_FILTER_BANK anaQmf, /*!< Handle of Qmf Analysis Bank */
593*e5436536SAndroid Build Coastguard Worker     FIXP_DBL **qmfReal,            /*!< Pointer to real subband slots */
594*e5436536SAndroid Build Coastguard Worker     FIXP_DBL **qmfImag,            /*!< Pointer to imag subband slots */
595*e5436536SAndroid Build Coastguard Worker     QMF_SCALE_FACTOR *scaleFactor,
596*e5436536SAndroid Build Coastguard Worker     const INT_PCM_QMFIN *timeIn, /*!< Time signal */
597*e5436536SAndroid Build Coastguard Worker     const int timeIn_e, const int stride,
598*e5436536SAndroid Build Coastguard Worker     FIXP_DBL *pWorkBuffer /*!< pointer to temporal working buffer */
599*e5436536SAndroid Build Coastguard Worker ) {
600*e5436536SAndroid Build Coastguard Worker   int i;
601*e5436536SAndroid Build Coastguard Worker   int no_channels = anaQmf->no_channels;
602*e5436536SAndroid Build Coastguard Worker 
603*e5436536SAndroid Build Coastguard Worker   scaleFactor->lb_scale =
604*e5436536SAndroid Build Coastguard Worker       -ALGORITHMIC_SCALING_IN_ANALYSIS_FILTERBANK - timeIn_e;
605*e5436536SAndroid Build Coastguard Worker   scaleFactor->lb_scale -= anaQmf->filterScale;
606*e5436536SAndroid Build Coastguard Worker 
607*e5436536SAndroid Build Coastguard Worker   for (i = 0; i < anaQmf->no_col; i++) {
608*e5436536SAndroid Build Coastguard Worker     FIXP_DBL *qmfImagSlot = NULL;
609*e5436536SAndroid Build Coastguard Worker 
610*e5436536SAndroid Build Coastguard Worker     if (!(anaQmf->flags & QMF_FLAG_LP)) {
611*e5436536SAndroid Build Coastguard Worker       qmfImagSlot = qmfImag[i];
612*e5436536SAndroid Build Coastguard Worker     }
613*e5436536SAndroid Build Coastguard Worker 
614*e5436536SAndroid Build Coastguard Worker     qmfAnalysisFilteringSlot(anaQmf, qmfReal[i], qmfImagSlot, timeIn, stride,
615*e5436536SAndroid Build Coastguard Worker                              pWorkBuffer);
616*e5436536SAndroid Build Coastguard Worker 
617*e5436536SAndroid Build Coastguard Worker     timeIn += no_channels * stride;
618*e5436536SAndroid Build Coastguard Worker 
619*e5436536SAndroid Build Coastguard Worker   } /* no_col loop  i  */
620*e5436536SAndroid Build Coastguard Worker }
621*e5436536SAndroid Build Coastguard Worker #endif /* QMF_PCM_H */
622