git.sesse.net Git - vlc/blob - plugins/mpeg_adec/adec_layer1.c

   1 /*****************************************************************************
   2  * adec_layer1.c: MPEG Layer I audio decoder
   3  *****************************************************************************
   4  * Copyright (C) 1999, 2000 VideoLAN
   5  * $Id: adec_layer1.c,v 1.1 2001/11/13 12:09:18 henri Exp $
   6  *
   7  * Authors: Michel Kaempf <maxx@via.ecp.fr>
   8  *          Michel Lespinasse <walken@via.ecp.fr>
   9  *
  10  * This program is free software; you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License as published by
  12  * the Free Software Foundation; either version 2 of the License, or
  13  * (at your option) any later version.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111, USA.
  23  *****************************************************************************/
  24
  25 /*
  26  * TODO :
  27  *
  28  * - optimiser les NeedBits() et les GetBits() du code là où c'est possible ;
  29  *
  30  */
  31
  32 #include "defs.h"
  33
  34 #include <stdlib.h>                                                  /* NULL */
  35 #include <string.h>                                    /* memcpy(), memset() */
  36
  37 #include "config.h"
  38 #include "common.h"
  39 #include "threads.h"
  40 #include "mtime.h"
  41
  42 #include "modules_export.h"
  43 #include "stream_control.h"
  44 #include "input_ext-dec.h"
  45
  46 #include "mpeg_adec_generic.h"
  47 #include "mpeg_adec.h"
  48 #include "adec_math.h"                                     /* DCT32(), PCM() */
  49
  50 /**** wkn ****/
  51
  52 static float adec_scalefactor_table[64] =
  53 {   /* 2 ^ (1 - i/3) */
  54     2.0000000000000000, 1.5874010519681994, 1.2599210498948732,
  55     1.0000000000000000, 0.7937005259840998, 0.6299605249474366,
  56     0.5000000000000000, 0.3968502629920499, 0.3149802624737183,
  57     0.2500000000000000, 0.1984251314960249, 0.1574901312368591,
  58     0.1250000000000000, 0.0992125657480125, 0.0787450656184296,
  59     0.0625000000000000, 0.0496062828740062, 0.0393725328092148,
  60     0.0312500000000000, 0.0248031414370031, 0.0196862664046074,
  61     0.0156250000000000, 0.0124015707185016, 0.0098431332023037,
  62     0.0078125000000000, 0.0062007853592508, 0.0049215666011518,
  63     0.0039062500000000, 0.0031003926796254, 0.0024607833005759,
  64     0.0019531250000000, 0.0015501963398127, 0.0012303916502880,
  65     0.0009765625000000, 0.0007750981699063, 0.0006151958251440,
  66     0.0004882812500000, 0.0003875490849532, 0.0003075979125720,
  67     0.0002441406250000, 0.0001937745424766, 0.0001537989562860,
  68     0.0001220703125000, 0.0000968872712383, 0.0000768994781430,
  69     0.0000610351562500, 0.0000484436356191, 0.0000384497390715,
  70     0.0000305175781250, 0.0000242218178096, 0.0000192248695357,
  71     0.0000152587890625, 0.0000121109089048, 0.0000096124347679,
  72     0.0000076293945312, 0.0000060554544524, 0.0000048062173839,
  73     0.0000038146972656, 0.0000030277272262, 0.0000024031086920,
  74     0.0000019073486328, 0.0000015138636131, 0.0000012015543460,
  75     0.0000009536743164 /* last element is not in the standard... invalid ??? */
  76 };
  77
  78 static float adec_slope_table[15] =
  79 {
  80     0.6666666666666666, 0.2857142857142857, 0.1333333333333333,
  81     0.0645161290322581, 0.0317460317460317, 0.0157480314960630,
  82     0.0078431372549020, 0.0039138943248532, 0.0019550342130987,
  83     0.0009770395701026, 0.0004884004884005, 0.0002441704309608,
  84     0.0001220777635354, 0.0000610370189520, 0.0000305180437934
  85 };
  86
  87 static float adec_offset_table[15] =
  88 {
  89     -0.6666666666666666, -0.8571428571428571, -0.9333333333333333,
  90     -0.9677419354838710, -0.9841269841269841, -0.9921259842519685,
  91     -0.9960784313725490, -0.9980430528375733, -0.9990224828934506,
  92     -0.9995114802149487, -0.9997557997557998, -0.9998779147845196,
  93     -0.9999389611182323, -0.9999694814905240, -0.9999847409781033
  94 };
  95
  96 static u8 adec_layer1_allocation_table[15] =
  97 {
  98     0, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15
  99 };
 100
 101 static int adec_bound_table[4] = { 4, 8, 12, 16 };
 102
 103 int adec_layer1_mono( adec_thread_t * p_adec, s16 * buffer )
 104 {
 105     u8 allocation[32];
 106     float slope[32];
 107     float offset[32];
 108     float sample[32];
 109
 110     int i_sb;
 111     int s;
 112     int i_read_bits = 0;
 113
 114     /*
 115      * Parse the allocation tables
 116      */
 117
 118     for (i_sb = 0; i_sb < 32; i_sb += 2)
 119     {
 120         u8 tmp;
 121
 122         /* i_read_bits will be updated at the end of the loop */
 123         tmp = GetBits ( &p_adec->bit_stream, 8 );
 124
 125         if ( (tmp >> 4) > 14 )
 126         {
 127             return 1;
 128         }
 129
 130         allocation[i_sb] = adec_layer1_allocation_table [tmp >> 4];
 131
 132         if ((tmp & 15) > 14)
 133         {
 134             return 1;
 135         }
 136
 137         allocation[i_sb+1] = adec_layer1_allocation_table [tmp & 15];
 138     }
 139
 140     i_read_bits += 8 * 16; /* we did 16 iterations */
 141
 142     /*
 143      * Parse scalefactors
 144      */
 145
 146     for ( i_sb = 0; i_sb < 32; i_sb++ )
 147     {
 148         if ( allocation[i_sb] )
 149         {
 150             int index;
 151             float scalefactor;
 152
 153             index = GetBits( &p_adec->bit_stream, 6);
 154
 155             /* We also add the bits we'll take later in the sample parsing */
 156             i_read_bits += 6 + 12 * allocation[i_sb];
 157
 158             scalefactor = adec_scalefactor_table[index];
 159
 160             slope[i_sb] = adec_slope_table[allocation[i_sb]-2] * scalefactor;
 161             offset[i_sb] = adec_offset_table[allocation[i_sb]-2] * scalefactor;
 162         }
 163     }
 164
 165     /*
 166      * Parse samples
 167      */
 168
 169     for ( s = 0 ; s < 12; s++)
 170     {
 171         s16 * XXX_buf;
 172
 173         for (i_sb = 0; i_sb < 32; i_sb++)
 174         {
 175             if (!allocation[i_sb])
 176             {
 177                 sample[i_sb] = 0;
 178             }
 179             else
 180             {
 181                 int code;
 182
 183                 /* The bits were already counted in the scalefactors parsing */
 184                 code = GetBits( &p_adec->bit_stream, allocation[i_sb] );
 185
 186                 sample[i_sb] = slope[i_sb] * code + offset[i_sb];
 187             }
 188         }
 189
 190         DCT32 (sample, &p_adec->bank_0);
 191         XXX_buf = buffer;
 192         PCM (&p_adec->bank_0, &XXX_buf, 1);
 193         buffer += 32;
 194     }
 195
 196     p_adec->i_read_bits += i_read_bits;
 197
 198     return 0;
 199 }
 200
 201 int adec_layer1_stereo( adec_thread_t * p_adec, s16 * buffer )
 202 {
 203     u8 allocation_0[32], allocation_1[32];
 204     float slope_0[32], slope_1[32];
 205     float offset_0[32], offset_1[32];
 206     float sample_0[32], sample_1[32];
 207
 208     int bound;
 209     int i_sb;
 210     int s;
 211     int i_read_bits = 0;
 212
 213     /*
 214      * Calculate bound
 215      */
 216
 217     bound = 32;
 218     if ( (p_adec->header & 0xc0) == 0x40)
 219     {
 220         /* intensity stereo */
 221         int index;
 222         index = (p_adec->header >> 4) & 3;
 223         bound = adec_bound_table[index];
 224     }
 225
 226     /*
 227      * Parse allocation
 228      */
 229
 230     for (i_sb = 0; i_sb < bound; i_sb++)
 231     {
 232         u8 tmp;
 233         tmp = GetBits( &p_adec->bit_stream, 8 );
 234         if ((tmp >> 4) > 14)
 235         {
 236             return 1;
 237         }
 238         allocation_0[i_sb] = adec_layer1_allocation_table [tmp >> 4];
 239         if ((tmp & 15) > 14)
 240         {
 241             return 1;
 242         }
 243         allocation_1[i_sb] = adec_layer1_allocation_table [tmp & 15];
 244     }
 245
 246     for (; i_sb < 32; i_sb += 2)
 247     {
 248         u8 tmp;
 249         tmp = GetBits( &p_adec->bit_stream, 8 );
 250
 251         if ((tmp >> 4) > 14)
 252         {
 253             return 1;
 254         }
 255         allocation_0[i_sb] = allocation_1[i_sb]
 256             = adec_layer1_allocation_table [tmp >> 4];
 257
 258         if ((tmp & 15) > 14)
 259         {
 260             return 1;
 261         }
 262         allocation_0[i_sb+1] = allocation_1[i_sb+1]
 263             = adec_layer1_allocation_table [tmp & 15];
 264     }
 265
 266     i_read_bits += 4 * ( 32 + bound ); /* we read 8*bound and 4*(32-bound) */
 267
 268     /*
 269      * Parse scalefactors
 270      */
 271
 272     for ( i_sb = 0; i_sb < 32; i_sb++ )
 273     {
 274         if ( allocation_0[i_sb] )
 275         {
 276             int index;
 277             float scalefactor;
 278
 279             index = GetBits( &p_adec->bit_stream, 6 );
 280             i_read_bits += 6;
 281
 282             scalefactor = adec_scalefactor_table[index];
 283
 284             slope_0[i_sb] = adec_slope_table[allocation_0[i_sb]-2] * scalefactor;
 285             offset_0[i_sb] = adec_offset_table[allocation_0[i_sb]-2] * scalefactor;
 286         }
 287
 288         if (allocation_1[i_sb])
 289         {
 290             int index;
 291             float scalefactor;
 292
 293             index = GetBits( &p_adec->bit_stream, 6 );
 294             i_read_bits += 6;
 295
 296             scalefactor = adec_scalefactor_table[index];
 297
 298             slope_1[i_sb] = adec_slope_table[allocation_1[i_sb]-2] * scalefactor;
 299             offset_1[i_sb] = adec_offset_table[allocation_1[i_sb]-2] * scalefactor;
 300         }
 301     }
 302
 303     /* parse samples */
 304
 305     for (s = 0; s < 12; s++)
 306     {
 307         s16 * XXX_buf;
 308
 309         for (i_sb = 0; i_sb < bound; i_sb++)
 310         {
 311             if (!allocation_0[i_sb])
 312             {
 313                 sample_0[i_sb] = 0;
 314             }
 315             else
 316             {
 317                 int code;
 318
 319                 code = GetBits( &p_adec->bit_stream, allocation_0[i_sb] );
 320                 i_read_bits += allocation_0[i_sb];
 321
 322                 sample_0[i_sb] = slope_0[i_sb] * code + offset_0[i_sb];
 323             }
 324
 325             if ( !allocation_1[i_sb] )
 326             {
 327                 sample_1[i_sb] = 0;
 328             }
 329             else
 330             {
 331                 int code;
 332
 333                 code = GetBits( &p_adec->bit_stream, allocation_1[i_sb] );
 334                 i_read_bits += allocation_1[i_sb];
 335
 336                 sample_1[i_sb] = slope_1[i_sb] * code + offset_1[i_sb];
 337             }
 338         }
 339
 340         for (; i_sb < 32; i_sb++)
 341         {
 342             if (!allocation_0[i_sb])
 343             {
 344                 sample_0[i_sb] = 0;
 345                 sample_1[i_sb] = 0;
 346             }
 347             else
 348             {
 349                 int code;
 350
 351                 code = GetBits( &p_adec->bit_stream, allocation_0[i_sb] );
 352                 i_read_bits += allocation_0[i_sb];
 353
 354                 sample_0[i_sb] = slope_0[i_sb] * code + offset_0[i_sb];
 355                 sample_1[i_sb] = slope_1[i_sb] * code + offset_1[i_sb];
 356             }
 357         }
 358
 359         DCT32 (sample_0, &p_adec->bank_0);
 360         XXX_buf = buffer;
 361         PCM (&p_adec->bank_0, &XXX_buf, 2);
 362         DCT32 (sample_1, &p_adec->bank_1);
 363         XXX_buf = buffer+1;
 364         PCM (&p_adec->bank_1, &XXX_buf, 2);
 365         buffer += 64;
 366     }
 367
 368     p_adec->i_read_bits += i_read_bits;
 369
 370     return 0;
 371 }
 372