|
Packit |
c32a2d |
/*
|
|
Packit |
c32a2d |
layer1.c: the layer 1 decoder
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
copyright 1995-2009 by the mpg123 project - free software under the terms of the LGPL 2.1
|
|
Packit |
c32a2d |
see COPYING and AUTHORS files in distribution or http://mpg123.org
|
|
Packit |
c32a2d |
initially written by Michael Hipp
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
may have a few bugs after last optimization ...
|
|
Packit |
c32a2d |
*/
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
#include "mpg123lib_intern.h"
|
|
Packit |
c32a2d |
#include "getbits.h"
|
|
Packit |
c32a2d |
#include "debug.h"
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
/*
|
|
Packit |
c32a2d |
Allocation value is not allowed to be 15. Initially, libmad showed me the
|
|
Packit |
c32a2d |
error that mpg123 used to ignore. Then, I found a quote on that in
|
|
Packit |
c32a2d |
Shlien, S. (1994): Guide to MPEG-1 Audio Standard.
|
|
Packit |
c32a2d |
IEEE Transactions on Broadcasting 40, 4
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
"To avoid conflicts with the synchronization code, code '1111' is defined
|
|
Packit |
c32a2d |
to be illegal."
|
|
Packit |
c32a2d |
*/
|
|
Packit |
c32a2d |
static int check_balloc(mpg123_handle *fr, unsigned int *balloc, unsigned int *end)
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
unsigned int *ba;
|
|
Packit |
c32a2d |
for(ba=balloc; ba != end; ++ba)
|
|
Packit |
c32a2d |
if(*ba == 15)
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
if(NOQUIET) error("Illegal bit allocation value.");
|
|
Packit |
c32a2d |
return -1;
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
return 0;
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
static int I_step_one(unsigned int balloc[], unsigned int scale_index[2][SBLIMIT],mpg123_handle *fr)
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
unsigned int *ba=balloc;
|
|
Packit |
c32a2d |
unsigned int *sca = (unsigned int *) scale_index;
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
if(fr->stereo == 2)
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
int i;
|
|
Packit |
c32a2d |
int jsbound = fr->jsbound;
|
|
Packit |
c32a2d |
for(i=0;i
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
*ba++ = getbits(fr, 4);
|
|
Packit |
c32a2d |
*ba++ = getbits(fr, 4);
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
for(i=jsbound;i
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
if(check_balloc(fr, balloc, ba)) return -1;
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
ba = balloc;
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
for(i=0;i
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
if ((*ba++))
|
|
Packit |
c32a2d |
*sca++ = getbits(fr, 6);
|
|
Packit |
c32a2d |
if ((*ba++))
|
|
Packit |
c32a2d |
*sca++ = getbits(fr, 6);
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
for (i=jsbound;i
|
|
Packit |
c32a2d |
if((*ba++))
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
*sca++ = getbits(fr, 6);
|
|
Packit |
c32a2d |
*sca++ = getbits(fr, 6);
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
else
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
int i;
|
|
Packit |
c32a2d |
for(i=0;i
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
if(check_balloc(fr, balloc, ba)) return -1;
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
ba = balloc;
|
|
Packit |
c32a2d |
for (i=0;i
|
|
Packit |
c32a2d |
if ((*ba++))
|
|
Packit |
c32a2d |
*sca++ = getbits(fr, 6);
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
return 0;
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
/* Something sane in place of undefined (-1)<
|
|
Packit |
c32a2d |
#define MINUS_SHIFT(n) ( (int)(((unsigned int)-1)<<(n)) )
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
static void I_step_two(real fraction[2][SBLIMIT],unsigned int balloc[2*SBLIMIT], unsigned int scale_index[2][SBLIMIT],mpg123_handle *fr)
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
int i,n;
|
|
Packit |
c32a2d |
int smpb[2*SBLIMIT]; /* values: 0-65535 */
|
|
Packit |
c32a2d |
int *sample;
|
|
Packit |
c32a2d |
register unsigned int *ba;
|
|
Packit |
c32a2d |
register unsigned int *sca = (unsigned int *) scale_index;
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
if(fr->stereo == 2)
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
int jsbound = fr->jsbound;
|
|
Packit |
c32a2d |
register real *f0 = fraction[0];
|
|
Packit |
c32a2d |
register real *f1 = fraction[1];
|
|
Packit |
c32a2d |
ba = balloc;
|
|
Packit |
c32a2d |
for(sample=smpb,i=0;i
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
if((n = *ba++)) *sample++ = getbits(fr, n+1);
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
if((n = *ba++)) *sample++ = getbits(fr, n+1);
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
for(i=jsbound;i
|
|
Packit |
c32a2d |
if((n = *ba++))
|
|
Packit |
c32a2d |
*sample++ = getbits(fr, n+1);
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
ba = balloc;
|
|
Packit |
c32a2d |
for(sample=smpb,i=0;i
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
if((n=*ba++))
|
|
Packit |
c32a2d |
*f0++ = REAL_MUL_SCALE_LAYER12(DOUBLE_TO_REAL_15(MINUS_SHIFT(n) + (*sample++) + 1), fr->muls[n+1][*sca++]);
|
|
Packit |
c32a2d |
else *f0++ = DOUBLE_TO_REAL(0.0);
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
if((n=*ba++))
|
|
Packit |
c32a2d |
*f1++ = REAL_MUL_SCALE_LAYER12(DOUBLE_TO_REAL_15(MINUS_SHIFT(n) + (*sample++) + 1), fr->muls[n+1][*sca++]);
|
|
Packit |
c32a2d |
else *f1++ = DOUBLE_TO_REAL(0.0);
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
for(i=jsbound;i
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
if((n=*ba++))
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
real samp = DOUBLE_TO_REAL_15(MINUS_SHIFT(n) + (*sample++) + 1);
|
|
Packit |
c32a2d |
*f0++ = REAL_MUL_SCALE_LAYER12(samp, fr->muls[n+1][*sca++]);
|
|
Packit |
c32a2d |
*f1++ = REAL_MUL_SCALE_LAYER12(samp, fr->muls[n+1][*sca++]);
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
else *f0++ = *f1++ = DOUBLE_TO_REAL(0.0);
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
for(i=fr->down_sample_sblimit;i<32;i++)
|
|
Packit |
c32a2d |
fraction[0][i] = fraction[1][i] = 0.0;
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
else
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
register real *f0 = fraction[0];
|
|
Packit |
c32a2d |
ba = balloc;
|
|
Packit |
c32a2d |
for(sample=smpb,i=0;i
|
|
Packit |
c32a2d |
if ((n = *ba++))
|
|
Packit |
c32a2d |
*sample++ = getbits(fr, n+1);
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
ba = balloc;
|
|
Packit |
c32a2d |
for(sample=smpb,i=0;i
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
if((n=*ba++))
|
|
Packit |
c32a2d |
*f0++ = REAL_MUL_SCALE_LAYER12(DOUBLE_TO_REAL_15(MINUS_SHIFT(n) + (*sample++) + 1), fr->muls[n+1][*sca++]);
|
|
Packit |
c32a2d |
else *f0++ = DOUBLE_TO_REAL(0.0);
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
for(i=fr->down_sample_sblimit;i<32;i++)
|
|
Packit |
c32a2d |
fraction[0][i] = DOUBLE_TO_REAL(0.0);
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
int do_layer1(mpg123_handle *fr)
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
int clip=0;
|
|
Packit |
c32a2d |
int i,stereo = fr->stereo;
|
|
Packit |
c32a2d |
unsigned int balloc[2*SBLIMIT];
|
|
Packit |
c32a2d |
unsigned int scale_index[2][SBLIMIT];
|
|
Packit |
c32a2d |
real (*fraction)[SBLIMIT] = fr->layer1.fraction; /* fraction[2][SBLIMIT] */
|
|
Packit |
c32a2d |
int single = fr->single;
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
fr->jsbound = (fr->mode == MPG_MD_JOINT_STEREO) ? (fr->mode_ext<<2)+4 : 32;
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
if(stereo == 1 || single == SINGLE_MIX) /* I don't see mixing handled here */
|
|
Packit |
c32a2d |
single = SINGLE_LEFT;
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
if(I_step_one(balloc,scale_index,fr))
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
if(NOQUIET) error("Aborting layer I decoding after step one.\n");
|
|
Packit |
c32a2d |
return clip;
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
for(i=0;i
|
|
Packit |
c32a2d |
{
|
|
Packit |
c32a2d |
I_step_two(fraction,balloc,scale_index,fr);
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
if(single != SINGLE_STEREO)
|
|
Packit |
c32a2d |
clip += (fr->synth_mono)(fraction[single], fr);
|
|
Packit |
c32a2d |
else
|
|
Packit |
c32a2d |
clip += (fr->synth_stereo)(fraction[0], fraction[1], fr);
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
return clip;
|
|
Packit |
c32a2d |
}
|
|
Packit |
c32a2d |
|
|
Packit |
c32a2d |
|