]> git.sesse.net Git - vlc/blob - src/audio_decoder/adec_math.c
dc66df9dd746bdce71db116bd2af924f229f63ed
[vlc] / src / audio_decoder / adec_math.c
1 /*****************************************************************************
2  * adec_math.c: Inverse Discrete Cosine Transform and Pulse Code Modulation
3  *****************************************************************************
4  * Copyright (C) 1999, 2000 VideoLAN
5  *
6  * Authors:
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License as published by
10  * the Free Software Foundation; either version 2 of the License, or
11  * (at your option) any later version.
12  * 
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  * GNU General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111, USA.
21  *****************************************************************************/
22
23 #include "int_types.h"
24 #include "adec_generic.h"
25
26 /*****************************************************************************
27  * DCT32: Fast 32 points Discrete Cosine Transform
28  *****************************************************************************
29  * 289 additions and multiplications
30  * F(u)=alpha(u)*SUM(x=0, x<N) f(x)*cos((2x+1)u*pi/2N)
31  * where alpha(u) = sqrt(2)/N if u=0, 2/N otherwise.
32  * See fastdct.ps, and fast.tar.gz for a (Fortran :) implementation.
33  *****************************************************************************/
34
35 void DCT32(float *x, adec_bank_t *b)
36 {
37     /* cosine coefficients */
38     static const float c2  =  .70710678118655;
39     static const float c3  =  .54119610014620;
40     static const float c4  = -1.3065629648764;
41     static const float c5  =  .50979557910416;
42     static const float c6  =  .89997622313642;
43     static const float c7  = -2.5629154477415;
44     static const float c8  = -.60134488693505;
45     static const float c9  =  .50241928618816;
46     static const float c10 =  .56694403481636;
47     static const float c11 =  .78815462345125;
48     static const float c12 =  1.7224470982383;
49     static const float c13 = -5.1011486186892;
50     static const float c14 = -1.0606776859903;
51     static const float c15 = -.64682178335999;
52     static const float c16 = -.52249861493969;
53     static const float c17 =  .50060299823520;
54     static const float c18 =  .51544730992262;
55     static const float c19 =  .55310389603444;
56     static const float c20 =  .62250412303566;
57     static const float c21 =  .74453627100230;
58     static const float c22 =  .97256823786196;
59     static const float c23 =  1.4841646163142;
60     static const float c24 =  3.4076084184687;
61     static const float c25 = -10.190008123548;
62     static const float c26 = -2.0577810099534;
63     static const float c27 = -1.1694399334329;
64     static const float c28 = -.83934964541553;
65     static const float c29 = -.67480834145501;
66     static const float c30 = -.58293496820613;
67     static const float c31 = -.53104259108978;
68     static const float c32 = -.50547095989754;
69
70     /* temporary variables */
71     float  t1  , t2  , t3  , t4  , t5  , t6  , t7  , t8  ,
72            t9  , t10 , t11 , t12 , t13 , t14 , t15 , t16 ,
73            t17 , t18 , t19 , t20 , t21 , t22 , t23 , t24 ,
74            t25 , t26 , t27 , t28 , t29 , t30 , t31 , t32 ,
75            tt1 , tt2 , tt3 , tt4 , tt5 , tt6 , tt7 , tt8 ,
76            tt9 , tt10, tt11, tt12, tt13, tt14, tt15, tt16,
77            tt17, tt18, tt19, tt20, tt21, tt22, tt23, tt24,
78            tt25, tt26, tt27, tt28, tt29, tt30, tt31, tt32, *y;
79
80     /* We unrolled the loops */
81     /* Odd-even ordering is integrated before the 1st stage */
82     t17 = c17 * (x[0] - x[31]);
83     t1  = x[0] + x[31];
84     t18 = c18 * (x[2] - x[29]);
85     t2  = x[2] + x[29];
86     t19 = c19 * (x[4] - x[27]);
87     t3  = x[4] + x[27];
88     t20 = c20 * (x[6] - x[25]);
89     t4  = x[6] + x[25];
90     t21 = c21 * (x[8] - x[23]);
91     t5  = x[8] + x[23];
92     t22 = c22 * (x[10] - x[21]);
93     t6  = x[10] + x[21];
94     t23 = c23 * (x[12] - x[19]);
95     t7  = x[12] + x[19];
96     t24 = c24 * (x[14] - x[17]);
97     t8  = x[14] + x[17];
98     t25 = c25 * (x[16] - x[15]);
99     t9  = x[16] + x[15];
100     t26 = c26 * (x[18] - x[13]);
101     t10 = x[18] + x[13];
102     t27 = c27 * (x[20] - x[11]);
103     t11 = x[20] + x[11];
104     t28 = c28 * (x[22] - x[9]);
105     t12 = x[22] + x[9];
106     t29 = c29 * (x[24] - x[7]);
107     t13 = x[24] + x[7];
108     t30 = c30 * (x[26] - x[5]);
109     t14 = x[26] + x[5];
110     t31 = c31 * (x[28] - x[3]);
111     t15 = x[28] + x[3];
112     t32 = c32 * (x[30] - x[1]);
113     t16 = x[30] + x[1];
114     /* 2nd stage */
115     tt9  = c9  * (t1  - t9);
116     tt1  = t1  + t9;
117     tt10 = c10 * (t2  - t10);
118     tt2  = t2  + t10;
119     tt11 = c11 * (t3  - t11);
120     tt3  = t3  + t11;
121     tt12 = c12 * (t4  - t12);
122     tt4  = t4  + t12;
123     tt13 = c13 * (t5  - t13);
124     tt5  = t5  + t13;
125     tt14 = c14 * (t6  - t14);
126     tt6  = t6  + t14;
127     tt15 = c15 * (t7  - t15);
128     tt7  = t7  + t15;
129     tt16 = c16 * (t8  - t16);
130     tt8  = t8  + t16;
131     tt25 = c9  * (t17 - t25);
132     tt17 = t17 + t25;
133     tt26 = c10 * (t18 - t26);
134     tt18 = t18 + t26;
135     tt27 = c11 * (t19 - t27);
136     tt19 = t19 + t27;
137     tt28 = c12 * (t20 - t28);
138     tt20 = t20 + t28;
139     tt29 = c13 * (t21 - t29);
140     tt21 = t21 + t29;
141     tt30 = c14 * (t22 - t30);
142     tt22 = t22 + t30;
143     tt31 = c15 * (t23 - t31);
144     tt23 = t23 + t31;
145     tt32 = c16 * (t24 - t32);
146     tt24 = t24 + t32;
147     /* 3rd stage */
148     t5  = c5 * (tt1  - tt5);
149     t1  = tt1  + tt5;
150     t6  = c6 * (tt2  - tt6);
151     t2  = tt2  + tt6;
152     t7  = c7 * (tt3  - tt7);
153     t3  = tt3  + tt7;
154     t8  = c8 * (tt4  - tt8);
155     t4  = tt4  + tt8;
156     t13 = c5 * (tt9  - tt13);
157     t9  = tt9  + tt13;
158     t14 = c6 * (tt10 - tt14);
159     t10 = tt10 + tt14;
160     t15 = c7 * (tt11 - tt15);
161     t11 = tt11 + tt15;
162     t16 = c8 * (tt12 - tt16);
163     t12 = tt12 + tt16;
164     t21 = c5 * (tt17 - tt21);
165     t17 = tt17 + tt21;
166     t22 = c6 * (tt18 - tt22);
167     t18 = tt18 + tt22;
168     t23 = c7 * (tt19 - tt23);
169     t19 = tt19 + tt23;
170     t24 = c8 * (tt20 - tt24);
171     t20 = tt20 + tt24;
172     t29 = c5 * (tt25 - tt29);
173     t25 = tt25 + tt29;
174     t30 = c6 * (tt26 - tt30);
175     t26 = tt26 + tt30;
176     t31 = c7 * (tt27 - tt31);
177     t27 = tt27 + tt31;
178     t32 = c8 * (tt28 - tt32);
179     t28 = tt28 + tt32;
180     /* 4th stage */
181     tt3  = c3 * (t1  - t3);
182     tt1  = t1  + t3;
183     tt4  = c4 * (t2  - t4);
184     tt2  = t2  + t4;
185     tt7  = c3 * (t5  - t7);
186     tt5  = t5  + t7;
187     tt8  = c4 * (t6  - t8);
188     tt6  = t6  + t8;
189     tt11 = c3 * (t9  - t11);
190     tt9  = t9  + t11;
191     tt12 = c4 * (t10 - t12);
192     tt10 = t10 + t12;
193     tt15 = c3 * (t13 - t15);
194     tt13 = t13 + t15;
195     tt16 = c4 * (t14 - t16);
196     tt14 = t14 + t16;
197     tt19 = c3 * (t17 - t19);
198     tt17 = t17 + t19;
199     tt20 = c4 * (t18 - t20);
200     tt18 = t18 + t20;
201     tt23 = c3 * (t21 - t23);
202     tt21 = t21 + t23;
203     tt24 = c4 * (t22 - t24);
204     tt22 = t22 + t24;
205     tt27 = c3 * (t25 - t27);
206     tt25 = t25 + t27;
207     tt28 = c4 * (t26 - t28);
208     tt26 = t26 + t28;
209     tt31 = c3 * (t29 - t31);
210     tt29 = t29 + t31;
211     tt32 = c4 * (t30 - t32);
212     tt30 = t30 + t32;
213     /* Bit-reverse ordering is integrated after the 5th stage */
214     /* Begin to split the result of the DCT (t1 to t32) in the filter bank */
215     x = b->actual + b->pos;
216     y = (b->actual == b->v1 ? b->v2 : b->v1) + b->pos;
217     x[0] = -(y[0] = c2 * (tt1  - tt2)); /* t17 */
218     x[256] = 0; y[256] = tt1  + tt2; /* t1  */
219     t25 = c2 * (tt3  - tt4);
220     t9  = tt3  + tt4;
221     t21 = c2 * (tt5  - tt6);
222     t5  = tt5  + tt6;
223     t29 = c2 * (tt7  - tt8);
224     t13 = tt7  + tt8;
225     t19 = c2 * (tt9  - tt10);
226     t3  = tt9  + tt10;
227     t27 = c2 * (tt11 - tt12);
228     t11 = tt11 + tt12;
229     t23 = c2 * (tt13 - tt14);
230     t7  = tt13 + tt14;
231     t31 = c2 * (tt15 - tt16);
232     t15 = tt15 + tt16;
233     t18 = c2 * (tt17 - tt18);
234     t2  = tt17 + tt18;
235     t26 = c2 * (tt19 - tt20);
236     t10 = tt19 + tt20;
237     t22 = c2 * (tt21 - tt22);
238     t6  = tt21 + tt22;
239     t30 = c2 * (tt23 - tt24);
240     t14 = tt23 + tt24;
241     t20 = c2 * (tt25 - tt26);
242     t4  = tt25 + tt26;
243     t28 = c2 * (tt27 - tt28);
244     t12 = tt27 + tt28;
245     t24 = c2 * (tt29 - tt30);
246     t8  = tt29 + tt30;
247     t32 = c2 * (tt31 - tt32);
248     t16 = tt31 + tt32;
249     /* Do the sums */
250     /* Keep on splitting the result */
251     y[384] = y[128] = t9 - (x[128] = -(x[384] = t25)); /* t25, t9  */
252     t10 += t26;
253     t11 += t27;
254     t12 += t28;
255     t13 += t29;
256     t14 += t30;
257     t15 += t31;
258     t16 += t32;
259     y[320] = y[192] = t5 + t13; /* t5  */
260     y[448] = y[64] = t13 + t21; /* t13 */
261     x[64] = -(x[448] = t21 - (x[192] = -(x[320] = t29))); /* t29, t21 */
262     t6  += t14;
263     t14 += t22;
264     t22 += t30;
265     t7  += t15;
266     t15 += t23;
267     t23 += t31;
268     t8  += t16;
269     t16 += t24;
270     t24 += t32;
271     y[288] = y[224] = t3 + t7; /* t3  */
272     y[352] = y[160] = t7 + t11; /* t7  */
273     y[416] = y[96] = t11 + t15; /* t11 */
274     y[480] = y[32] = t15 + t19; /* t15 */
275     x[32] = -(x[480] = t19 + t23); /* t19 */
276     x[96] = -(x[416] = t23 + t27); /* t23 */
277     x[160] = -(x[352] = t27 - (x[224] = -(x[288] = t31))); /* t31, t27 */
278     t4  += t8 ;
279     t8  += t12;
280     t12 += t16;
281     t16 += t20;
282     t20 += t24;
283     t24 += t28;
284     t28 += t32;
285     y[272] = y[240] = t2 + t4; /* t2  */
286     y[304] = y[208] = t4 + t6; /* t4  */
287     y[336] = y[176] = t6 + t8; /* t6  */
288     y[368] = y[144] = t8 + t10; /* t8  */
289     y[400] = y[112] = t10 + t12; /* t10 */
290     y[432] = y[80] = t12 + t14; /* t12 */
291     y[464] = y[48] = t14 + t16; /* t14 */
292     y[496] = y[16] = t16 + t18; /* t16 */
293     x[16] = -(x[496] = t18 + t20); /* t18 */
294     x[48] = -(x[464] = t20 + t22); /* t20 */
295     x[80] = -(x[432] = t22 + t24); /* t22 */
296     x[112] = -(x[400] = t24 + t26); /* t24 */
297     x[144] = -(x[368] = t26 + t28); /* t26 */
298     x[176] = -(x[336] = t28 + t30); /* t28 */
299     x[208] = -(x[304] = t30 - (x[240] = -(x[272] = t32))); /* t32, t30 */
300     /* Note that to be really complete, the DCT should multiply t1 by sqrt(2)/N
301        and t2 to t32 by 2/N, and would take 321 additions and multiplications.
302        But that's unuseful in this application. */
303 }
304
305
306 /*****************************************************************************
307  * PCM: Pulse Code Modulation
308  *****************************************************************************
309  * Compute 32 PCM samples with a convolution product
310  *****************************************************************************/
311
312 void PCM(adec_bank_t *b, s16 **pcm, int jump)
313 {
314     /* scale factor */
315 #define F -32768
316     /* These values are not in the same order as in Annex 3-B.3 of the ISO/IEC
317        DIS 11172-3 */
318     static const float c[512] =
319     {
320         0.000000000 * F, -0.000442505 * F,  0.003250122 * F, -0.007003784 * F,
321         0.031082153 * F, -0.078628540 * F,  0.100311279 * F, -0.572036743 * F,
322         1.144989014 * F,  0.572036743 * F,  0.100311279 * F,  0.078628540 * F,
323         0.031082153 * F,  0.007003784 * F,  0.003250122 * F,  0.000442505 * F,
324        -0.000015259 * F, -0.000473022 * F,  0.003326416 * F, -0.007919312 * F,
325         0.030517578 * F, -0.084182739 * F,  0.090927124 * F, -0.600219727 * F,
326         1.144287109 * F,  0.543823242 * F,  0.108856201 * F,  0.073059082 * F,
327         0.031478882 * F,  0.006118774 * F,  0.003173828 * F,  0.000396729 * F,
328        -0.000015259 * F, -0.000534058 * F,  0.003387451 * F, -0.008865356 * F,
329         0.029785156 * F, -0.089706421 * F,  0.080688477 * F, -0.628295898 * F,
330         1.142211914 * F,  0.515609741 * F,  0.116577148 * F,  0.067520142 * F,
331         0.031738281 * F,  0.005294800 * F,  0.003082275 * F,  0.000366211 * F,
332        -0.000015259 * F, -0.000579834 * F,  0.003433228 * F, -0.009841919 * F,
333         0.028884888 * F, -0.095169067 * F,  0.069595337 * F, -0.656219482 * F,
334         1.138763428 * F,  0.487472534 * F,  0.123474121 * F,  0.061996460 * F,
335         0.031845093 * F,  0.004486084 * F,  0.002990723 * F,  0.000320435 * F,
336        -0.000015259 * F, -0.000625610 * F,  0.003463745 * F, -0.010848999 * F,
337         0.027801514 * F, -0.100540161 * F,  0.057617188 * F, -0.683914185 * F,
338         1.133926392 * F,  0.459472656 * F,  0.129577637 * F,  0.056533813 * F,
339         0.031814575 * F,  0.003723145 * F,  0.002899170 * F,  0.000289917 * F,
340        -0.000015259 * F, -0.000686646 * F,  0.003479004 * F, -0.011886597 * F,
341         0.026535034 * F, -0.105819702 * F,  0.044784546 * F, -0.711318970 * F,
342         1.127746582 * F,  0.431655884 * F,  0.134887695 * F,  0.051132202 * F,
343         0.031661987 * F,  0.003005981 * F,  0.002792358 * F,  0.000259399 * F,
344        -0.000015259 * F, -0.000747681 * F,  0.003479004 * F, -0.012939453 * F,
345         0.025085449 * F, -0.110946655 * F,  0.031082153 * F, -0.738372803 * F,
346         1.120223999 * F,  0.404083252 * F,  0.139450073 * F,  0.045837402 * F,
347         0.031387329 * F,  0.002334595 * F,  0.002685547 * F,  0.000244141 * F,
348        -0.000030518 * F, -0.000808716 * F,  0.003463745 * F, -0.014022827 * F,
349         0.023422241 * F, -0.115921021 * F,  0.016510010 * F, -0.765029907 * F,
350         1.111373901 * F,  0.376800537 * F,  0.143264771 * F,  0.040634155 * F,
351         0.031005859 * F,  0.001693726 * F,  0.002578735 * F,  0.000213623 * F,
352        -0.000030518 * F, -0.000885010 * F,  0.003417969 * F, -0.015121460 * F,
353         0.021575928 * F, -0.120697021 * F,  0.001068115 * F, -0.791213989 * F,
354         1.101211548 * F,  0.349868774 * F,  0.146362305 * F,  0.035552979 * F,
355         0.030532837 * F,  0.001098633 * F,  0.002456665 * F,  0.000198364 * F,
356        -0.000030518 * F, -0.000961304 * F,  0.003372192 * F, -0.016235352 * F,
357         0.019531250 * F, -0.125259399 * F, -0.015228271 * F, -0.816864014 * F,
358         1.089782715 * F,  0.323318481 * F,  0.148773193 * F,  0.030609131 * F,
359         0.029937744 * F,  0.000549316 * F,  0.002349854 * F,  0.000167847 * F,
360        -0.000030518 * F, -0.001037598 * F,  0.003280640 * F, -0.017349243 * F,
361         0.017257690 * F, -0.129562378 * F, -0.032379150 * F, -0.841949463 * F,
362         1.077117920 * F,  0.297210693 * F,  0.150497437 * F,  0.025817871 * F,
363         0.029281616 * F,  0.000030518 * F,  0.002243042 * F,  0.000152588 * F,
364        -0.000045776 * F, -0.001113892 * F,  0.003173828 * F, -0.018463135 * F,
365         0.014801025 * F, -0.133590698 * F, -0.050354004 * F, -0.866363525 * F,
366         1.063217163 * F,  0.271591187 * F,  0.151596069 * F,  0.021179199 * F,
367         0.028533936 * F, -0.000442505 * F,  0.002120972 * F,  0.000137329 * F,
368        -0.000045776 * F, -0.001205444 * F,  0.003051758 * F, -0.019577026 * F,
369         0.012115479 * F, -0.137298584 * F, -0.069168091 * F, -0.890090942 * F,
370         1.048156738 * F,  0.246505737 * F,  0.152069092 * F,  0.016708374 * F,
371         0.027725220 * F, -0.000869751 * F,  0.002014160 * F,  0.000122070 * F,
372        -0.000061035 * F, -0.001296997 * F,  0.002883911 * F, -0.020690918 * F,
373         0.009231567 * F, -0.140670776 * F, -0.088775635 * F, -0.913055420 * F,
374         1.031936646 * F,  0.221984863 * F,  0.151962280 * F,  0.012420654 * F,
375         0.026840210 * F, -0.001266479 * F,  0.001907349 * F,  0.000106812 * F,
376        -0.000061035 * F, -0.001388550 * F,  0.002700806 * F, -0.021789551 * F,
377         0.006134033 * F, -0.143676758 * F, -0.109161377 * F, -0.935195923 * F,
378         1.014617920 * F,  0.198059082 * F,  0.151306152 * F,  0.008316040 * F,
379         0.025909424 * F, -0.001617432 * F,  0.001785278 * F,  0.000106812 * F,
380        -0.000076294 * F, -0.001480103 * F,  0.002487183 * F, -0.022857666 * F,
381         0.002822876 * F, -0.146255493 * F, -0.130310059 * F, -0.956481934 * F,
382         0.996246338 * F,  0.174789429 * F,  0.150115967 * F,  0.004394531 * F,
383         0.024932861 * F, -0.001937866 * F,  0.001693726 * F,  0.000091553 * F,
384        -0.000076294 * F, -0.001586914 * F,  0.002227783 * F, -0.023910522 * F,
385        -0.000686646 * F, -0.148422241 * F, -0.152206421 * F, -0.976852417 * F,
386         0.976852417 * F,  0.152206421 * F,  0.148422241 * F,  0.000686646 * F,
387         0.023910522 * F, -0.002227783 * F,  0.001586914 * F,  0.000076294 * F,
388        -0.000091553 * F, -0.001693726 * F,  0.001937866 * F, -0.024932861 * F,
389        -0.004394531 * F, -0.150115967 * F, -0.174789429 * F, -0.996246338 * F,
390         0.956481934 * F,  0.130310059 * F,  0.146255493 * F, -0.002822876 * F,
391         0.022857666 * F, -0.002487183 * F,  0.001480103 * F,  0.000076294 * F,
392        -0.000106812 * F, -0.001785278 * F,  0.001617432 * F, -0.025909424 * F,
393        -0.008316040 * F, -0.151306152 * F, -0.198059082 * F, -1.014617920 * F,
394         0.935195923 * F,  0.109161377 * F,  0.143676758 * F, -0.006134033 * F,
395         0.021789551 * F, -0.002700806 * F,  0.001388550 * F,  0.000061035 * F,
396        -0.000106812 * F, -0.001907349 * F,  0.001266479 * F, -0.026840210 * F,
397        -0.012420654 * F, -0.151962280 * F, -0.221984863 * F, -1.031936646 * F,
398         0.913055420 * F,  0.088775635 * F,  0.140670776 * F, -0.009231567 * F,
399         0.020690918 * F, -0.002883911 * F,  0.001296997 * F,  0.000061035 * F,
400        -0.000122070 * F, -0.002014160 * F,  0.000869751 * F, -0.027725220 * F,
401        -0.016708374 * F, -0.152069092 * F, -0.246505737 * F, -1.048156738 * F,
402         0.890090942 * F,  0.069168091 * F,  0.137298584 * F, -0.012115479 * F,
403         0.019577026 * F, -0.003051758 * F,  0.001205444 * F,  0.000045776 * F,
404        -0.000137329 * F, -0.002120972 * F,  0.000442505 * F, -0.028533936 * F,
405        -0.021179199 * F, -0.151596069 * F, -0.271591187 * F, -1.063217163 * F,
406         0.866363525 * F,  0.050354004 * F,  0.133590698 * F, -0.014801025 * F,
407         0.018463135 * F, -0.003173828 * F,  0.001113892 * F,  0.000045776 * F,
408        -0.000152588 * F, -0.002243042 * F, -0.000030518 * F, -0.029281616 * F,
409        -0.025817871 * F, -0.150497437 * F, -0.297210693 * F, -1.077117920 * F,
410         0.841949463 * F,  0.032379150 * F,  0.129562378 * F, -0.017257690 * F,
411         0.017349243 * F, -0.003280640 * F,  0.001037598 * F,  0.000030518 * F,
412        -0.000167847 * F, -0.002349854 * F, -0.000549316 * F, -0.029937744 * F,
413        -0.030609131 * F, -0.148773193 * F, -0.323318481 * F, -1.089782715 * F,
414         0.816864014 * F,  0.015228271 * F,  0.125259399 * F, -0.019531250 * F,
415         0.016235352 * F, -0.003372192 * F,  0.000961304 * F,  0.000030518 * F,
416        -0.000198364 * F, -0.002456665 * F, -0.001098633 * F, -0.030532837 * F,
417        -0.035552979 * F, -0.146362305 * F, -0.349868774 * F, -1.101211548 * F,
418         0.791213989 * F, -0.001068115 * F,  0.120697021 * F, -0.021575928 * F,
419         0.015121460 * F, -0.003417969 * F,  0.000885010 * F,  0.000030518 * F,
420        -0.000213623 * F, -0.002578735 * F, -0.001693726 * F, -0.031005859 * F,
421        -0.040634155 * F, -0.143264771 * F, -0.376800537 * F, -1.111373901 * F,
422         0.765029907 * F, -0.016510010 * F,  0.115921021 * F, -0.023422241 * F,
423         0.014022827 * F, -0.003463745 * F,  0.000808716 * F,  0.000030518 * F,
424        -0.000244141 * F, -0.002685547 * F, -0.002334595 * F, -0.031387329 * F,
425        -0.045837402 * F, -0.139450073 * F, -0.404083252 * F, -1.120223999 * F,
426         0.738372803 * F, -0.031082153 * F,  0.110946655 * F, -0.025085449 * F,
427         0.012939453 * F, -0.003479004 * F,  0.000747681 * F,  0.000015259 * F,
428        -0.000259399 * F, -0.002792358 * F, -0.003005981 * F, -0.031661987 * F,
429        -0.051132202 * F, -0.134887695 * F, -0.431655884 * F, -1.127746582 * F,
430         0.711318970 * F, -0.044784546 * F,  0.105819702 * F, -0.026535034 * F,
431         0.011886597 * F, -0.003479004 * F,  0.000686646 * F,  0.000015259 * F,
432        -0.000289917 * F, -0.002899170 * F, -0.003723145 * F, -0.031814575 * F,
433        -0.056533813 * F, -0.129577637 * F, -0.459472656 * F, -1.133926392 * F,
434         0.683914185 * F, -0.057617188 * F,  0.100540161 * F, -0.027801514 * F,
435         0.010848999 * F, -0.003463745 * F,  0.000625610 * F,  0.000015259 * F,
436        -0.000320435 * F, -0.002990723 * F, -0.004486084 * F, -0.031845093 * F,
437        -0.061996460 * F, -0.123474121 * F, -0.487472534 * F, -1.138763428 * F,
438         0.656219482 * F, -0.069595337 * F,  0.095169067 * F, -0.028884888 * F,
439         0.009841919 * F, -0.003433228 * F,  0.000579834 * F,  0.000015259 * F,
440        -0.000366211 * F, -0.003082275 * F, -0.005294800 * F, -0.031738281 * F,
441        -0.067520142 * F, -0.116577148 * F, -0.515609741 * F, -1.142211914 * F,
442         0.628295898 * F, -0.080688477 * F,  0.089706421 * F, -0.029785156 * F,
443         0.008865356 * F, -0.003387451 * F,  0.000534058 * F,  0.000015259 * F,
444        -0.000396729 * F, -0.003173828 * F, -0.006118774 * F, -0.031478882 * F,
445        -0.073059082 * F, -0.108856201 * F, -0.543823242 * F, -1.144287109 * F,
446         0.600219727 * F, -0.090927124 * F,  0.084182739 * F, -0.030517578 * F,
447         0.007919312 * F, -0.003326416 * F,  0.000473022 * F,  0.000015259 * F
448     };
449 #undef F
450     int i;
451     float tmp, *v;
452     const float *f;
453
454     f = c;
455
456     switch(b->pos)
457     {
458         case 0:
459             v = b->actual;
460             for (i=0; i<32; i++)
461             {
462                 tmp = *f++ * *v;
463                 v += 15;
464                 tmp += *f++ * *v--;
465                 tmp += *f++ * *v--;
466                 tmp += *f++ * *v--;
467                 tmp += *f++ * *v--;
468                 tmp += *f++ * *v--;
469                 tmp += *f++ * *v--;
470                 tmp += *f++ * *v--;
471                 tmp += *f++ * *v--;
472                 tmp += *f++ * *v--;
473                 tmp += *f++ * *v--;
474                 tmp += *f++ * *v--;
475                 tmp += *f++ * *v--;
476                 tmp += *f++ * *v--;
477                 tmp += *f++ * *v--;
478                 if ((tmp += *f++ * *v) > 32767)
479                 {
480                     /* ceiling saturation */
481                     **pcm = 0x7FFF;
482                 }
483                 else if (tmp < -32768)
484                 {
485                     /* floor saturation */
486                     **pcm = 0x8000;
487                 }
488                 else
489                 {
490                     **pcm = (s16)tmp;
491                 }
492                 *pcm += jump;
493                 v += 15;
494             }
495             break;
496         case 1:
497             v = b->actual + 1;
498             for (i=0; i<32; i++)
499             {
500                 tmp = *f++ * *v--;
501                 tmp += *f++ * *v;
502                 v += 15;
503                 tmp += *f++ * *v--;
504                 tmp += *f++ * *v--;
505                 tmp += *f++ * *v--;
506                 tmp += *f++ * *v--;
507                 tmp += *f++ * *v--;
508                 tmp += *f++ * *v--;
509                 tmp += *f++ * *v--;
510                 tmp += *f++ * *v--;
511                 tmp += *f++ * *v--;
512                 tmp += *f++ * *v--;
513                 tmp += *f++ * *v--;
514                 tmp += *f++ * *v--;
515                 tmp += *f++ * *v--;
516                 if ((tmp += *f++ * *v) > 32767)
517                 {
518                     **pcm = 0x7FFF;
519                 }
520                 else if (tmp < -32768)
521                 {
522                     **pcm = 0x8000;
523                 }
524                 else
525                 {
526                     **pcm = (s16)tmp;
527                 }
528                 *pcm += jump;
529                 v += 15;
530             }
531             break;
532         case 2:
533             v = b->actual + 2;
534             for (i=0; i<32; i++)
535             {
536                 tmp = *f++ * *v--;
537                 tmp += *f++ * *v--;
538                 tmp += *f++ * *v;
539                 v += 15;
540                 tmp += *f++ * *v--;
541                 tmp += *f++ * *v--;
542                 tmp += *f++ * *v--;
543                 tmp += *f++ * *v--;
544                 tmp += *f++ * *v--;
545                 tmp += *f++ * *v--;
546                 tmp += *f++ * *v--;
547                 tmp += *f++ * *v--;
548                 tmp += *f++ * *v--;
549                 tmp += *f++ * *v--;
550                 tmp += *f++ * *v--;
551                 tmp += *f++ * *v--;
552                 if ((tmp += *f++ * *v) > 32767)
553                 {
554                     **pcm = 0x7FFF;
555                 }
556                 else if (tmp < -32768)
557                 {
558                     **pcm = 0x8000;
559                 }
560                 else
561                 {
562                     **pcm = (s16)tmp;
563                 }
564                 *pcm += jump;
565                 v += 15;
566             }
567             break;
568         case 3:
569             v = b->actual + 3;
570             for (i=0; i<32; i++)
571             {
572                 tmp = *f++ * *v--;
573                 tmp += *f++ * *v--;
574                 tmp += *f++ * *v--;
575                 tmp += *f++ * *v;
576                 v += 15;
577                 tmp += *f++ * *v--;
578                 tmp += *f++ * *v--;
579                 tmp += *f++ * *v--;
580                 tmp += *f++ * *v--;
581                 tmp += *f++ * *v--;
582                 tmp += *f++ * *v--;
583                 tmp += *f++ * *v--;
584                 tmp += *f++ * *v--;
585                 tmp += *f++ * *v--;
586                 tmp += *f++ * *v--;
587                 tmp += *f++ * *v--;
588                 if ((tmp += *f++ * *v) > 32767)
589                 {
590                     **pcm = 0x7FFF;
591                 }
592                 else if (tmp < -32768)
593                 {
594                     **pcm = 0x8000;
595                 }
596                 else
597                 {
598                     **pcm = (s16)tmp;
599                 }
600                 *pcm += jump;
601                 v += 15;
602             }
603             break;
604         case 4:
605             v = b->actual + 4;
606             for (i=0; i<32; i++)
607             {
608                 tmp = *f++ * *v--;
609                 tmp += *f++ * *v--;
610                 tmp += *f++ * *v--;
611                 tmp += *f++ * *v--;
612                 tmp += *f++ * *v;
613                 v += 15;
614                 tmp += *f++ * *v--;
615                 tmp += *f++ * *v--;
616                 tmp += *f++ * *v--;
617                 tmp += *f++ * *v--;
618                 tmp += *f++ * *v--;
619                 tmp += *f++ * *v--;
620                 tmp += *f++ * *v--;
621                 tmp += *f++ * *v--;
622                 tmp += *f++ * *v--;
623                 tmp += *f++ * *v--;
624                 if ((tmp += *f++ * *v) > 32767)
625                 {
626                     **pcm = 0x7FFF;
627                 }
628                 else if (tmp < -32768)
629                 {
630                     **pcm = 0x8000;
631                 }
632                 else
633                 {
634                     **pcm = (s16)tmp;
635                 }
636                 *pcm += jump;
637                 v += 15;
638             }
639             break;
640         case 5:
641             v = b->actual + 5;
642             for (i=0; i<32; i++)
643             {
644                 tmp = *f++ * *v--;
645                 tmp += *f++ * *v--;
646                 tmp += *f++ * *v--;
647                 tmp += *f++ * *v--;
648                 tmp += *f++ * *v--;
649                 tmp += *f++ * *v;
650                 v += 15;
651                 tmp += *f++ * *v--;
652                 tmp += *f++ * *v--;
653                 tmp += *f++ * *v--;
654                 tmp += *f++ * *v--;
655                 tmp += *f++ * *v--;
656                 tmp += *f++ * *v--;
657                 tmp += *f++ * *v--;
658                 tmp += *f++ * *v--;
659                 tmp += *f++ * *v--;
660                 if ((tmp += *f++ * *v) > 32767)
661                 {
662                     **pcm = 0x7FFF;
663                 }
664                 else if (tmp < -32768)
665                 {
666                     **pcm = 0x8000;
667                 }
668                 else
669                 {
670                     **pcm = (s16)tmp;
671                 }
672                 *pcm += jump;
673                 v += 15;
674             }
675             break;
676         case 6:
677             v = b->actual + 6;
678             for (i=0; i<32; i++)
679             {
680                 tmp = *f++ * *v--;
681                 tmp += *f++ * *v--;
682                 tmp += *f++ * *v--;
683                 tmp += *f++ * *v--;
684                 tmp += *f++ * *v--;
685                 tmp += *f++ * *v--;
686                 tmp += *f++ * *v;
687                 v += 15;
688                 tmp += *f++ * *v--;
689                 tmp += *f++ * *v--;
690                 tmp += *f++ * *v--;
691                 tmp += *f++ * *v--;
692                 tmp += *f++ * *v--;
693                 tmp += *f++ * *v--;
694                 tmp += *f++ * *v--;
695                 tmp += *f++ * *v--;
696                 if ((tmp += *f++ * *v) > 32767)
697                 {
698                     **pcm = 0x7FFF;
699                 }
700                 else if (tmp < -32768)
701                 {
702                     **pcm = 0x8000;
703                 }
704                 else
705                 {
706                     **pcm = (s16)tmp;
707                 }
708                 *pcm += jump;
709                 v += 15;
710             }
711             break;
712         case 7:
713             v = b->actual + 7;
714             for (i=0; i<32; i++)
715             {
716                 tmp = *f++ * *v--;
717                 tmp += *f++ * *v--;
718                 tmp += *f++ * *v--;
719                 tmp += *f++ * *v--;
720                 tmp += *f++ * *v--;
721                 tmp += *f++ * *v--;
722                 tmp += *f++ * *v--;
723                 tmp += *f++ * *v;
724                 v += 15;
725                 tmp += *f++ * *v--;
726                 tmp += *f++ * *v--;
727                 tmp += *f++ * *v--;
728                 tmp += *f++ * *v--;
729                 tmp += *f++ * *v--;
730                 tmp += *f++ * *v--;
731                 tmp += *f++ * *v--;
732                 if ((tmp += *f++ * *v) > 32767)
733                 {
734                     **pcm = 0x7FFF;
735                 }
736                 else if (tmp < -32768)
737                 {
738                     **pcm = 0x8000;
739                 }
740                 else
741                 {
742                      **pcm = (s16)tmp;
743                 }
744                 *pcm += jump;
745                 v += 15;
746             }
747             break;
748         case 8:
749             v = b->actual + 8;
750             for (i=0; i<32; i++)
751             {
752                 tmp = *f++ * *v--;
753                 tmp += *f++ * *v--;
754                 tmp += *f++ * *v--;
755                 tmp += *f++ * *v--;
756                 tmp += *f++ * *v--;
757                 tmp += *f++ * *v--;
758                 tmp += *f++ * *v--;
759                 tmp += *f++ * *v--;
760                 tmp += *f++ * *v;
761                 v += 15;
762                 tmp += *f++ * *v--;
763                 tmp += *f++ * *v--;
764                 tmp += *f++ * *v--;
765                 tmp += *f++ * *v--;
766                 tmp += *f++ * *v--;
767                 tmp += *f++ * *v--;
768                 if ((tmp += *f++ * *v) > 32767)
769                 {
770                     **pcm = 0x7FFF;
771                 }
772                 else if (tmp < -32768)
773                 {
774                     **pcm = 0x8000;
775                 }
776                 else
777                 {
778                     **pcm = (s16)tmp;
779                 }
780                 *pcm += jump;
781                 v += 15;
782             }
783             break;
784         case 9:
785             v = b->actual + 9;
786             for (i=0; i<32; i++)
787             {
788                 tmp = *f++ * *v--;
789                 tmp += *f++ * *v--;
790                 tmp += *f++ * *v--;
791                 tmp += *f++ * *v--;
792                 tmp += *f++ * *v--;
793                 tmp += *f++ * *v--;
794                 tmp += *f++ * *v--;
795                 tmp += *f++ * *v--;
796                 tmp += *f++ * *v--;
797                 tmp += *f++ * *v;
798                 v += 15;
799                 tmp += *f++ * *v--;
800                 tmp += *f++ * *v--;
801                 tmp += *f++ * *v--;
802                 tmp += *f++ * *v--;
803                 tmp += *f++ * *v--;
804                 if ((tmp += *f++ * *v) > 32767)
805                 {
806                     **pcm = 0x7FFF;
807                 }
808                 else if (tmp < -32768)
809                 {
810                     **pcm = 0x8000;
811                 }
812                 else
813                 {
814                     **pcm = (s16)tmp;
815                 } 
816                 *pcm += jump;
817                 v += 15;
818             }
819             break;
820         case 10:
821             v = b->actual + 10;
822             for (i=0; i<32; i++)
823             {
824                 tmp = *f++ * *v--;
825                 tmp += *f++ * *v--;
826                 tmp += *f++ * *v--;
827                 tmp += *f++ * *v--;
828                 tmp += *f++ * *v--;
829                 tmp += *f++ * *v--;
830                 tmp += *f++ * *v--;
831                 tmp += *f++ * *v--;
832                 tmp += *f++ * *v--;
833                 tmp += *f++ * *v--;
834                 tmp += *f++ * *v;
835                 v += 15;
836                 tmp += *f++ * *v--;
837                 tmp += *f++ * *v--;
838                 tmp += *f++ * *v--;
839                 tmp += *f++ * *v--;
840                 if ((tmp += *f++ * *v) > 32767)
841                 {
842                     **pcm = 0x7FFF;
843                 }
844                 else if (tmp < -32768)
845                 {    
846                     **pcm = 0x8000;
847                 }
848                 else
849                 {
850                     **pcm = (s16)tmp;
851                 }
852                 *pcm += jump;
853                 v += 15;
854             }
855             break;
856         case 11:
857             v = b->actual + 11;
858             for (i=0; i<32; i++)
859             {
860                 tmp = *f++ * *v--;
861                 tmp += *f++ * *v--;
862                 tmp += *f++ * *v--;
863                 tmp += *f++ * *v--;
864                 tmp += *f++ * *v--;
865                 tmp += *f++ * *v--;
866                 tmp += *f++ * *v--;
867                 tmp += *f++ * *v--;
868                 tmp += *f++ * *v--;
869                 tmp += *f++ * *v--;
870                 tmp += *f++ * *v--;
871                 tmp += *f++ * *v;
872                 v += 15;
873                 tmp += *f++ * *v--;
874                 tmp += *f++ * *v--;
875                 tmp += *f++ * *v--;
876                 if ((tmp += *f++ * *v) > 32767)
877                 {
878                     **pcm = 0x7FFF;
879                 }
880                 else if (tmp < -32768)
881                 {
882                     **pcm = 0x8000;
883                 }
884                 else
885                 {
886                     **pcm = (s16)tmp;
887                 }
888                 *pcm += jump;
889                 v += 15;
890             }
891             break;
892         case 12:
893             v = b->actual + 12;
894             for (i=0; i<32; i++)
895             {
896                 tmp = *f++ * *v--;
897                 tmp += *f++ * *v--;
898                 tmp += *f++ * *v--;
899                 tmp += *f++ * *v--;
900                 tmp += *f++ * *v--;
901                 tmp += *f++ * *v--;
902                 tmp += *f++ * *v--;
903                 tmp += *f++ * *v--;
904                 tmp += *f++ * *v--;
905                 tmp += *f++ * *v--;
906                 tmp += *f++ * *v--;
907                 tmp += *f++ * *v--;
908                 tmp += *f++ * *v;
909                 v += 15;
910                 tmp += *f++ * *v--;
911                 tmp += *f++ * *v--;
912                 if ((tmp += *f++ * *v) > 32767)
913                 {
914                     **pcm = 0x7FFF;
915                 }
916                 else if (tmp < -32768)
917                 {
918                     **pcm = 0x8000;
919                 }
920                 else
921                 {
922                     **pcm = (s16)tmp;
923                 }
924                 *pcm += jump;
925                 v += 15;
926             }
927             break;
928         case 13:
929             v = b->actual + 13;
930             for (i=0; i<32; i++)
931             {
932                 tmp = *f++ * *v--;
933                 tmp += *f++ * *v--;
934                 tmp += *f++ * *v--;
935                 tmp += *f++ * *v--;
936                 tmp += *f++ * *v--;
937                 tmp += *f++ * *v--;
938                 tmp += *f++ * *v--;
939                 tmp += *f++ * *v--;
940                 tmp += *f++ * *v--;
941                 tmp += *f++ * *v--;
942                 tmp += *f++ * *v--;
943                 tmp += *f++ * *v--;
944                 tmp += *f++ * *v--;
945                 tmp += *f++ * *v;
946                 v += 15;
947                 tmp += *f++ * *v--;
948                 if ((tmp += *f++ * *v) > 32767)
949                 {
950                     **pcm = 0x7FFF;
951                 }
952                 else if (tmp < -32768)
953                 {
954                     **pcm = 0x8000;
955                 }
956                 else
957                 {
958                     **pcm = (s16)tmp;
959                 }
960                 *pcm += jump;
961                 v += 15;
962             }
963             break;
964         case 14:
965             v = b->actual + 14;
966             for (i=0; i<32; i++)
967             {
968                 tmp = *f++ * *v--;
969                 tmp += *f++ * *v--;
970                 tmp += *f++ * *v--;
971                 tmp += *f++ * *v--;
972                 tmp += *f++ * *v--;
973                 tmp += *f++ * *v--;
974                 tmp += *f++ * *v--;
975                 tmp += *f++ * *v--;
976                 tmp += *f++ * *v--;
977                 tmp += *f++ * *v--;
978                 tmp += *f++ * *v--;
979                 tmp += *f++ * *v--;
980                 tmp += *f++ * *v--;
981                 tmp += *f++ * *v--;
982                 tmp += *f++ * *v;
983                 v += 15;
984                 if ((tmp += *f++ * *v) > 32767)
985                 {
986                     **pcm = 0x7FFF;
987                 }
988                 else if (tmp < -32768)
989                 {
990                     **pcm = 0x8000;
991                 }
992                 else
993                 {
994                     **pcm = (s16)tmp;
995                 }
996                 *pcm += jump;
997                 v += 15;
998             }
999             break;
1000         case 15:
1001             v = b->actual + 15;
1002             for (i=0; i<32; i++)
1003             {
1004                 tmp = *f++ * *v--;
1005                 tmp += *f++ * *v--;
1006                 tmp += *f++ * *v--;
1007                 tmp += *f++ * *v--;
1008                 tmp += *f++ * *v--;
1009                 tmp += *f++ * *v--;
1010                 tmp += *f++ * *v--;
1011                 tmp += *f++ * *v--;
1012                 tmp += *f++ * *v--;
1013                 tmp += *f++ * *v--;
1014                 tmp += *f++ * *v--;
1015                 tmp += *f++ * *v--;
1016                 tmp += *f++ * *v--;
1017                 tmp += *f++ * *v--;
1018                 tmp += *f++ * *v--;
1019                 if ((tmp += *f++ * *v) > 32767)
1020                 {
1021                     **pcm = 0x7FFF;
1022                 }
1023                 else if (tmp < -32768)
1024                 {
1025                     **pcm = 0x8000;
1026                 }
1027                 else
1028                 {
1029                     **pcm = (s16)tmp;
1030                 }
1031                 *pcm += jump;
1032                 v += 31;
1033             }
1034             break;
1035     }
1036
1037     /* Set the next position in the filter bank */
1038     b->pos++;
1039     b->pos &= 15;
1040     b->actual = (b->actual == b->v1 ? b->v2 : b->v1);
1041 }