git.sesse.net Git - vlc/blob - src/audio_decoder/audio_math.c

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