raven/jedioutcast
0
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity
jedioutcast/CODEmp/mp3code/cupl3.c

1288 lines
40 KiB
C
Raw Normal View History

Jedi Outcast v054
2013-04-04 14:52:42 +00:00
/*____________________________________________________________________________
FreeAmp - The Free MP3 Player
MP3 Decoder originally Copyright (C) 1995-1997 Xing Technology
Corp. http://www.xingtech.com
Portions Copyright (C) 1998-1999 EMusic.com
This program is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 2 of the License, or
(at your option) any later version.
This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with this program; if not, write to the Free Software
Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
$Id: cupl3.c,v 1.8 1999/10/19 07:13:08 elrod Exp $
____________________________________________________________________________*/
/**** cupL3.c ***************************************************
unpack Layer III
mod 8/18/97 bugfix crc problem
mod 10/9/97 add pMP3Stream->band_limit12 for short blocks
mod 10/22/97 zero buf_ptrs in init
mod 5/15/98 mpeg 2.5
mod 8/19/98 decode 22 sf bands
******************************************************************/
/*---------------------------------------
TO DO: Test mixed blocks (mixed long/short)
No mixed blocks in mpeg-1 test stream being used for development
-----------------------------------------*/
#include <stdlib.h>
#include <stdio.h>
#include <float.h>
#include <math.h>
#include <memory.h>
#include <string.h>
#include <assert.h>
#include "mhead.h" /* mpeg header structure */
#include "L3.h"
#include "jdw.h"
#include "mp3struct.h"
/*====================================================================*/
static const int mp_sr20_table[2][4] =
{{441, 480, 320, -999}, {882, 960, 640, -999}};
static const int mp_br_tableL3[2][16] =
{{0, 8, 16, 24, 32, 40, 48, 56, 64, 80, 96, 112, 128, 144, 160, 0}, /* mpeg 2 */
{0, 32, 40, 48, 56, 64, 80, 96, 112, 128, 160, 192, 224, 256, 320, 0}};
/*====================================================================*/
/*-- global band tables */
/*-- short portion is 3*x !! --*/
////@@@@int nBand[2][22]; /* [long/short][cb] */
////@@@@int sfBandIndex[2][22]; /* [long/short][cb] */
/*====================================================================*/
/*----------------*/
extern DEC_INFO decinfo; ////@@@@ this is ok, only written to during init, then chucked.
/*----------------*/
////@@@@static int pMP3Stream->mpeg25_flag; // L3 only
//int iframe;
/*-------*/
////@@@@static int pMP3Stream->band_limit = (576); // L3 only
////@@@@static int pMP3Stream->band_limit21 = (576); // limit for sf band 21 // L3 only
////@@@@static int pMP3Stream->band_limit12 = (576); // limit for sf band 12 short //L3 only
////@@@@int band_limit_nsb = 32; /* global for hybrid */
////@@@@static int pMP3Stream->nsb_limit = 32;
////@@@@static int pMP3Stream->gain_adjust = 0; /* adjust gain e.g. cvt to mono */ // L3 only
////@@@@static int id; // L3 only
////@@@@static int pMP3Stream->ncbl_mixed; /* number of long cb's in mixed block 8 or 6 */ // L3 only
////@@@@static int pMP3Stream->sr_index; // L3 only (99%)
//@@@@
////@@@@static int pMP3Stream->outvalues; //
////@@@@static int pMP3Stream->outbytes; //
////@@@@static int pMP3Stream->half_outbytes; // L3 only
////@@@@static int pMP3Stream->framebytes; //
//static int padframebytes;
////@@@@static int pMP3Stream->crcbytes; // L3 only
////@@@@static int pMP3Stream->pad; //
//static int stereo_flag; // only written to
////@@@@static int pMP3Stream->nchan; // L3 only
////@@@@static int pMP3Stream->ms_mode; // L3 only (99%)
////@@@@static int pMP3Stream->is_mode; // L3 only
////@@@@static unsigned int pMP3Stream->zero_level_pcm = 0; // L3 only
/* cb_info[igr][ch], compute by dequant, used by joint */
static CB_INFO cb_info[2][2]; // L3 only ############ I think this is ok, only a scratchpad?
static IS_SF_INFO is_sf_info; /* MPEG-2 intensity stereo */ // L3 only ############## scratchpad?
/*---------------------------------*/
//!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
/* main data bit buffer */
/*@@@@
#define NBUF (8*1024)
#define BUF_TRIGGER (NBUF-1500)
static unsigned char buf[NBUF];
static int buf_ptr0 = 0; // !!!!!!!!!!!
static int buf_ptr1 = 0; // !!!!!!!!!!!
static int main_pos_bit;
*/
/*---------------------------------*/
static SIDE_INFO side_info; // ####### scratchpad?
static SCALEFACT sf[2][2]; /* [gr][ch] */ // ########## scratchpad?
static int nsamp[2][2]; /* must start = 0, for nsamp[igr_prev] */ // ########## scratchpad?
/*- sample union of int/float sample[ch][gr][576] */
/* static SAMPLE sample[2][2][576]; */
// @@@@FINDME
////@@@@extern SAMPLE sample[2][2][576]; ////////////????? suspicious, mainly used in decode loop, but zeroed init code
static float yout[576]; /* hybrid out, sbt in */ //////////// scratchpad
////@@@@typedef void (*SBT_FUNCTION) (float *sample, short *pcm, int ch);
void sbt_dual_L3(float *sample, short *pcm, int n);
////@@@@static SBT_FUNCTION sbt_L3 = sbt_dual_L3; // !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
////@@@@typedef void (*XFORM_FUNCTION) (void *pcm, int igr);
static void Xform_dual(void *pcm, int igr);
////@@@@static XFORM_FUNCTION Xform = Xform_dual; // !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
IN_OUT L3audio_decode_MPEG1(unsigned char *bs, unsigned char *pcm);
IN_OUT L3audio_decode_MPEG2(unsigned char *bs, unsigned char *pcm);
////@@@@typedef IN_OUT(*DECODE_FUNCTION) (unsigned char *bs, unsigned char *pcm);
////@@@@static DECODE_FUNCTION decode_function = L3audio_decode_MPEG1; <------------------ needs streaming, ditto above!!!
/*====================================================================*/
int hybrid(void *xin, void *xprev, float *y,
int btype, int nlong, int ntot, int nprev);
int hybrid_sum(void *xin, void *xin_left, float *y,
int btype, int nlong, int ntot);
void sum_f_bands(void *a, void *b, int n);
void FreqInvert(float *y, int n);
void antialias(void *x, int n);
void ms_process(void *x, int n); /* sum-difference stereo */
void is_process_MPEG1(void *x, /* intensity stereo */
SCALEFACT * sf,
CB_INFO cb_info[2], /* [ch] */
int nsamp, int ms_mode);
void is_process_MPEG2(void *x, /* intensity stereo */
SCALEFACT * sf,
CB_INFO cb_info[2], /* [ch] */
IS_SF_INFO * is_sf_info,
int nsamp, int ms_mode);
void unpack_huff(void *xy, int n, int ntable);
int unpack_huff_quad(void *vwxy, int n, int nbits, int ntable);
void dequant(SAMPLE sample[], int *nsamp,
SCALEFACT * sf,
GR * gr,
CB_INFO * cb_info, int ncbl_mixed);
void unpack_sf_sub_MPEG1(SCALEFACT * scalefac, GR * gr,
int scfsi, /* bit flag */
int igr);
void unpack_sf_sub_MPEG2(SCALEFACT sf[], /* return intensity scale */
GR * grdat,
int is_and_ch, IS_SF_INFO * is_sf_info);
/*====================================================================*/
/* get bits from bitstream in endian independent way */
BITDAT bitdat; /* global for inline use by Huff */ // !!!!!!!!!!!!!!!!!!!
/*------------- initialize bit getter -------------*/
static void bitget_init(unsigned char *buf)
{
bitdat.bs_ptr0 = bitdat.bs_ptr = buf;
bitdat.bits = 0;
bitdat.bitbuf = 0;
}
/*------------- initialize bit getter -------------*/
static void bitget_init_end(unsigned char *buf_end)
{
bitdat.bs_ptr_end = buf_end;
}
/*------------- get n bits from bitstream -------------*/
int bitget_bits_used()
{
int n; /* compute bits used from last init call */
n = ((bitdat.bs_ptr - bitdat.bs_ptr0) << 3) - bitdat.bits;
return n;
}
/*------------- check for n bits in bitbuf -------------*/
void bitget_check(int n)
{
if (bitdat.bits < n)
{
while (bitdat.bits <= 24)
{
bitdat.bitbuf = (bitdat.bitbuf << 8) | *bitdat.bs_ptr++;
bitdat.bits += 8;
}
}
}
/*------------- get n bits from bitstream -------------*/
unsigned int bitget(int n)
{
unsigned int x;
if (bitdat.bits < n)
{ /* refill bit buf if necessary */
while (bitdat.bits <= 24)
{
bitdat.bitbuf = (bitdat.bitbuf << 8) | *bitdat.bs_ptr++;
bitdat.bits += 8;
}
}
bitdat.bits -= n;
x = bitdat.bitbuf >> bitdat.bits;
bitdat.bitbuf -= x << bitdat.bits;
return x;
}
/*------------- get 1 bit from bitstream -------------*/
unsigned int bitget_1bit()
{
unsigned int x;
if (bitdat.bits <= 0)
{ /* refill bit buf if necessary */
while (bitdat.bits <= 24)
{
bitdat.bitbuf = (bitdat.bitbuf << 8) | *bitdat.bs_ptr++;
bitdat.bits += 8;
}
}
bitdat.bits--;
x = bitdat.bitbuf >> bitdat.bits;
bitdat.bitbuf -= x << bitdat.bits;
return x;
}
/*====================================================================*/
static void Xform_mono(void *pcm, int igr)
{
int igr_prev, n1, n2;
/*--- hybrid + sbt ---*/
n1 = n2 = nsamp[igr][0]; /* total number bands */
if (side_info.gr[igr][0].block_type == 2)
{ /* long bands */
n1 = 0;
if (side_info.gr[igr][0].mixed_block_flag)
n1 = pMP3Stream->sfBandIndex[0][pMP3Stream->ncbl_mixed - 1];
}
if (n1 > pMP3Stream->band_limit)
n1 = pMP3Stream->band_limit;
if (n2 > pMP3Stream->band_limit)
n2 = pMP3Stream->band_limit;
igr_prev = igr ^ 1;
nsamp[igr][0] = hybrid(pMP3Stream->sample[0][igr], pMP3Stream->sample[0][igr_prev],
yout, side_info.gr[igr][0].block_type, n1, n2, nsamp[igr_prev][0]);
FreqInvert(yout, nsamp[igr][0]);
pMP3Stream->sbt_L3(yout, pcm, 0);
}
/*--------------------------------------------------------------------*/
static void Xform_dual_right(void *pcm, int igr)
{
int igr_prev, n1, n2;
/*--- hybrid + sbt ---*/
n1 = n2 = nsamp[igr][1]; /* total number bands */
if (side_info.gr[igr][1].block_type == 2)
{ /* long bands */
n1 = 0;
if (side_info.gr[igr][1].mixed_block_flag)
n1 = pMP3Stream->sfBandIndex[0][pMP3Stream->ncbl_mixed - 1];
}
if (n1 > pMP3Stream->band_limit)
n1 = pMP3Stream->band_limit;
if (n2 > pMP3Stream->band_limit)
n2 = pMP3Stream->band_limit;
igr_prev = igr ^ 1;
nsamp[igr][1] = hybrid(pMP3Stream->sample[1][igr], pMP3Stream->sample[1][igr_prev],
yout, side_info.gr[igr][1].block_type, n1, n2, nsamp[igr_prev][1]);
FreqInvert(yout, nsamp[igr][1]);
pMP3Stream->sbt_L3(yout, pcm, 0);
}
/*--------------------------------------------------------------------*/
static void Xform_dual(void *pcm, int igr)
{
int ch;
int igr_prev, n1, n2;
/*--- hybrid + sbt ---*/
igr_prev = igr ^ 1;
for (ch = 0; ch < pMP3Stream->nchan; ch++)
{
n1 = n2 = nsamp[igr][ch]; /* total number bands */
if (side_info.gr[igr][ch].block_type == 2)
{ /* long bands */
n1 = 0;
if (side_info.gr[igr][ch].mixed_block_flag)
n1 = pMP3Stream->sfBandIndex[0][pMP3Stream->ncbl_mixed - 1];
}
if (n1 > pMP3Stream->band_limit)
n1 = pMP3Stream->band_limit;
if (n2 > pMP3Stream->band_limit)
n2 = pMP3Stream->band_limit;
nsamp[igr][ch] = hybrid(pMP3Stream->sample[ch][igr], pMP3Stream->sample[ch][igr_prev],
yout, side_info.gr[igr][ch].block_type, n1, n2, nsamp[igr_prev][ch]);
FreqInvert(yout, nsamp[igr][ch]);
pMP3Stream->sbt_L3(yout, pcm, ch);
}
}
/*--------------------------------------------------------------------*/
static void Xform_dual_mono(void *pcm, int igr)
{
int igr_prev, n1, n2, n3;
/*--- hybrid + sbt ---*/
igr_prev = igr ^ 1;
if ((side_info.gr[igr][0].block_type == side_info.gr[igr][1].block_type)
&& (side_info.gr[igr][0].mixed_block_flag == 0)
&& (side_info.gr[igr][1].mixed_block_flag == 0))
{
n2 = nsamp[igr][0]; /* total number bands max of L R */
if (n2 < nsamp[igr][1])
n2 = nsamp[igr][1];
if (n2 > pMP3Stream->band_limit)
n2 = pMP3Stream->band_limit;
n1 = n2; /* n1 = number long bands */
if (side_info.gr[igr][0].block_type == 2)
n1 = 0;
sum_f_bands(pMP3Stream->sample[0][igr], pMP3Stream->sample[1][igr], n2);
n3 = nsamp[igr][0] = hybrid(pMP3Stream->sample[0][igr], pMP3Stream->sample[0][igr_prev],
yout, side_info.gr[igr][0].block_type, n1, n2, nsamp[igr_prev][0]);
}
else
{ /* transform and then sum (not tested - never happens in test) */
/*-- left chan --*/
n1 = n2 = nsamp[igr][0]; /* total number bands */
if (side_info.gr[igr][0].block_type == 2)
{
n1 = 0; /* long bands */
if (side_info.gr[igr][0].mixed_block_flag)
n1 = pMP3Stream->sfBandIndex[0][pMP3Stream->ncbl_mixed - 1];
}
n3 = nsamp[igr][0] = hybrid(pMP3Stream->sample[0][igr], pMP3Stream->sample[0][igr_prev],
yout, side_info.gr[igr][0].block_type, n1, n2, nsamp[igr_prev][0]);
/*-- right chan --*/
n1 = n2 = nsamp[igr][1]; /* total number bands */
if (side_info.gr[igr][1].block_type == 2)
{
n1 = 0; /* long bands */
if (side_info.gr[igr][1].mixed_block_flag)
n1 = pMP3Stream->sfBandIndex[0][pMP3Stream->ncbl_mixed - 1];
}
nsamp[igr][1] = hybrid_sum(pMP3Stream->sample[1][igr], pMP3Stream->sample[0][igr],
yout, side_info.gr[igr][1].block_type, n1, n2);
if (n3 < nsamp[igr][1])
n1 = nsamp[igr][1];
}
/*--------*/
FreqInvert(yout, n3);
pMP3Stream->sbt_L3(yout, pcm, 0);
}
/*--------------------------------------------------------------------*/
/*====================================================================*/
static int unpack_side_MPEG1()
{
int prot;
int br_index;
int igr, ch;
int side_bytes;
/* decode partial header plus initial side info */
/* at entry bit getter points at id, sync skipped by caller */
pMP3Stream->id = bitget(1); /* id */
bitget(2); /* skip layer */
prot = bitget(1); /* bitget prot bit */
br_index = bitget(4);
pMP3Stream->sr_index = bitget(2);
pMP3Stream->pad = bitget(1);
bitget(1); /* skip to mode */
side_info.mode = bitget(2); /* mode */
side_info.mode_ext = bitget(2); /* mode ext */
if (side_info.mode != 1)
side_info.mode_ext = 0;
/* adjust global gain in ms mode to avoid having to mult by 1/sqrt(2) */
pMP3Stream->ms_mode = side_info.mode_ext >> 1;
pMP3Stream->is_mode = side_info.mode_ext & 1;
pMP3Stream->crcbytes = 0;
if (prot)
bitget(4); /* skip to data */
else
{
bitget(20); /* skip crc */
pMP3Stream->crcbytes = 2;
}
if (br_index > 0) /* pMP3Stream->framebytes fixed for free format */
{
pMP3Stream->framebytes =
2880 * mp_br_tableL3[pMP3Stream->id][br_index] / mp_sr20_table[pMP3Stream->id][pMP3Stream->sr_index];
}
side_info.main_data_begin = bitget(9);
if (side_info.mode == 3)
{
side_info.private_bits = bitget(5);
pMP3Stream->nchan = 1;
// stereo_flag = 0;
side_bytes = (4 + 17);
/*-- with header --*/
}
else
{
side_info.private_bits = bitget(3);
pMP3Stream->nchan = 2;
// stereo_flag = 1;
side_bytes = (4 + 32);
/*-- with header --*/
}
for (ch = 0; ch < pMP3Stream->nchan; ch++)
side_info.scfsi[ch] = bitget(4);
/* this always 0 (both igr) for short blocks */
for (igr = 0; igr < 2; igr++)
{
for (ch = 0; ch < pMP3Stream->nchan; ch++)
{
side_info.gr[igr][ch].part2_3_length = bitget(12);
side_info.gr[igr][ch].big_values = bitget(9);
side_info.gr[igr][ch].global_gain = bitget(8) + pMP3Stream->gain_adjust;
if (pMP3Stream->ms_mode)
side_info.gr[igr][ch].global_gain -= 2;
side_info.gr[igr][ch].scalefac_compress = bitget(4);
side_info.gr[igr][ch].window_switching_flag = bitget(1);
if (side_info.gr[igr][ch].window_switching_flag)
{
side_info.gr[igr][ch].block_type = bitget(2);
side_info.gr[igr][ch].mixed_block_flag = bitget(1);
side_info.gr[igr][ch].table_select[0] = bitget(5);
side_info.gr[igr][ch].table_select[1] = bitget(5);
side_info.gr[igr][ch].subblock_gain[0] = bitget(3);
side_info.gr[igr][ch].subblock_gain[1] = bitget(3);
side_info.gr[igr][ch].subblock_gain[2] = bitget(3);
/* region count set in terms of long block cb's/bands */
/* r1 set so r0+r1+1 = 21 (lookup produces 576 bands ) */
/* if(window_switching_flag) always 36 samples in region0 */
side_info.gr[igr][ch].region0_count = (8 - 1); /* 36 samples */
side_info.gr[igr][ch].region1_count = 20 - (8 - 1);
}
else
{
side_info.gr[igr][ch].mixed_block_flag = 0;
side_info.gr[igr][ch].block_type = 0;
side_info.gr[igr][ch].table_select[0] = bitget(5);
side_info.gr[igr][ch].table_select[1] = bitget(5);
side_info.gr[igr][ch].table_select[2] = bitget(5);
side_info.gr[igr][ch].region0_count = bitget(4);
side_info.gr[igr][ch].region1_count = bitget(3);
}
side_info.gr[igr][ch].preflag = bitget(1);
side_info.gr[igr][ch].scalefac_scale = bitget(1);
side_info.gr[igr][ch].count1table_select = bitget(1);
}
}
/* return bytes in header + side info */
return side_bytes;
}
/*====================================================================*/
static int unpack_side_MPEG2(int igr)
{
int prot;
int br_index;
int ch;
int side_bytes;
/* decode partial header plus initial side info */
/* at entry bit getter points at id, sync skipped by caller */
pMP3Stream->id = bitget(1); /* id */
bitget(2); /* skip layer */
prot = bitget(1); /* bitget prot bit */
br_index = bitget(4);
pMP3Stream->sr_index = bitget(2);
pMP3Stream->pad = bitget(1);
bitget(1); /* skip to mode */
side_info.mode = bitget(2); /* mode */
side_info.mode_ext = bitget(2); /* mode ext */
if (side_info.mode != 1)
side_info.mode_ext = 0;
/* adjust global gain in ms mode to avoid having to mult by 1/sqrt(2) */
pMP3Stream->ms_mode = side_info.mode_ext >> 1;
pMP3Stream->is_mode = side_info.mode_ext & 1;
pMP3Stream->crcbytes = 0;
if (prot)
bitget(4); /* skip to data */
else
{
bitget(20); /* skip crc */
pMP3Stream->crcbytes = 2;
}
if (br_index > 0)
{ /* pMP3Stream->framebytes fixed for free format */
if (pMP3Stream->mpeg25_flag == 0)
{
pMP3Stream->framebytes =
1440 * mp_br_tableL3[pMP3Stream->id][br_index] / mp_sr20_table[pMP3Stream->id][pMP3Stream->sr_index];
}
else
{
pMP3Stream->framebytes =
2880 * mp_br_tableL3[pMP3Stream->id][br_index] / mp_sr20_table[pMP3Stream->id][pMP3Stream->sr_index];
//if( pMP3Stream->sr_index == 2 ) return 0; // fail mpeg25 8khz
}
}
side_info.main_data_begin = bitget(8);
if (side_info.mode == 3)
{
side_info.private_bits = bitget(1);
pMP3Stream->nchan = 1;
// stereo_flag = 0;
side_bytes = (4 + 9);
/*-- with header --*/
}
else
{
side_info.private_bits = bitget(2);
pMP3Stream->nchan = 2;
// stereo_flag = 1;
side_bytes = (4 + 17);
/*-- with header --*/
}
side_info.scfsi[1] = side_info.scfsi[0] = 0;
for (ch = 0; ch < pMP3Stream->nchan; ch++)
{
side_info.gr[igr][ch].part2_3_length = bitget(12);
side_info.gr[igr][ch].big_values = bitget(9);
side_info.gr[igr][ch].global_gain = bitget(8) + pMP3Stream->gain_adjust;
if (pMP3Stream->ms_mode)
side_info.gr[igr][ch].global_gain -= 2;
side_info.gr[igr][ch].scalefac_compress = bitget(9);
side_info.gr[igr][ch].window_switching_flag = bitget(1);
if (side_info.gr[igr][ch].window_switching_flag)
{
side_info.gr[igr][ch].block_type = bitget(2);
side_info.gr[igr][ch].mixed_block_flag = bitget(1);
side_info.gr[igr][ch].table_select[0] = bitget(5);
side_info.gr[igr][ch].table_select[1] = bitget(5);
side_info.gr[igr][ch].subblock_gain[0] = bitget(3);
side_info.gr[igr][ch].subblock_gain[1] = bitget(3);
side_info.gr[igr][ch].subblock_gain[2] = bitget(3);
/* region count set in terms of long block cb's/bands */
/* r1 set so r0+r1+1 = 21 (lookup produces 576 bands ) */
/* bt=1 or 3 54 samples */
/* bt=2 mixed=0 36 samples */
/* bt=2 mixed=1 54 (8 long sf) samples? or maybe 36 */
/* region0 discussion says 54 but this would mix long */
/* and short in region0 if scale factors switch */
/* at band 36 (6 long scale factors) */
if ((side_info.gr[igr][ch].block_type == 2))
{
side_info.gr[igr][ch].region0_count = (6 - 1); /* 36 samples */
side_info.gr[igr][ch].region1_count = 20 - (6 - 1);
}
else
{ /* long block type 1 or 3 */
side_info.gr[igr][ch].region0_count = (8 - 1); /* 54 samples */
side_info.gr[igr][ch].region1_count = 20 - (8 - 1);
}
}
else
{
side_info.gr[igr][ch].mixed_block_flag = 0;
side_info.gr[igr][ch].block_type = 0;
side_info.gr[igr][ch].table_select[0] = bitget(5);
side_info.gr[igr][ch].table_select[1] = bitget(5);
side_info.gr[igr][ch].table_select[2] = bitget(5);
side_info.gr[igr][ch].region0_count = bitget(4);
side_info.gr[igr][ch].region1_count = bitget(3);
}
side_info.gr[igr][ch].preflag = 0;
side_info.gr[igr][ch].scalefac_scale = bitget(1);
side_info.gr[igr][ch].count1table_select = bitget(1);
}
/* return bytes in header + side info */
return side_bytes;
}
/*-----------------------------------------------------------------*/
static void unpack_main(unsigned char *pcm, int igr)
{
int ch;
int bit0;
int n1, n2, n3, n4, nn2, nn3;
int nn4;
int qbits;
int m0;
for (ch = 0; ch < pMP3Stream->nchan; ch++)
{
bitget_init(pMP3Stream->buf + (pMP3Stream->main_pos_bit >> 3));
bit0 = (pMP3Stream->main_pos_bit & 7);
if (bit0)
bitget(bit0);
pMP3Stream->main_pos_bit += side_info.gr[igr][ch].part2_3_length;
bitget_init_end(pMP3Stream->buf + ((pMP3Stream->main_pos_bit + 39) >> 3));
/*-- scale factors --*/
if (pMP3Stream->id)
unpack_sf_sub_MPEG1(&sf[igr][ch],
&side_info.gr[igr][ch], side_info.scfsi[ch], igr);
else
unpack_sf_sub_MPEG2(&sf[igr][ch],
&side_info.gr[igr][ch], pMP3Stream->is_mode & ch, &is_sf_info);
/*--- huff data ---*/
n1 = pMP3Stream->sfBandIndex[0][side_info.gr[igr][ch].region0_count];
n2 = pMP3Stream->sfBandIndex[0][side_info.gr[igr][ch].region0_count
+ side_info.gr[igr][ch].region1_count + 1];
n3 = side_info.gr[igr][ch].big_values;
n3 = n3 + n3;
if (n3 > pMP3Stream->band_limit)
n3 = pMP3Stream->band_limit;
if (n2 > n3)
n2 = n3;
if (n1 > n3)
n1 = n3;
nn3 = n3 - n2;
nn2 = n2 - n1;
unpack_huff(pMP3Stream->sample[ch][igr], n1, side_info.gr[igr][ch].table_select[0]);
unpack_huff(pMP3Stream->sample[ch][igr] + n1, nn2, side_info.gr[igr][ch].table_select[1]);
unpack_huff(pMP3Stream->sample[ch][igr] + n2, nn3, side_info.gr[igr][ch].table_select[2]);
qbits = side_info.gr[igr][ch].part2_3_length - (bitget_bits_used() - bit0);
nn4 = unpack_huff_quad(pMP3Stream->sample[ch][igr] + n3, pMP3Stream->band_limit - n3, qbits,
side_info.gr[igr][ch].count1table_select);
n4 = n3 + nn4;
nsamp[igr][ch] = n4;
//limit n4 or allow deqaunt to sf band 22
if (side_info.gr[igr][ch].block_type == 2)
n4 = min(n4, pMP3Stream->band_limit12);
else
n4 = min(n4, pMP3Stream->band_limit21);
if (n4 < 576)
memset(pMP3Stream->sample[ch][igr] + n4, 0, sizeof(SAMPLE) * (576 - n4));
if (bitdat.bs_ptr > bitdat.bs_ptr_end)
{ // bad data overrun
memset(pMP3Stream->sample[ch][igr], 0, sizeof(SAMPLE) * (576));
}
}
/*--- dequant ---*/
for (ch = 0; ch < pMP3Stream->nchan; ch++)
{
dequant(pMP3Stream->sample[ch][igr],
&nsamp[igr][ch], /* nsamp updated for shorts */
&sf[igr][ch], &side_info.gr[igr][ch],
&cb_info[igr][ch], pMP3Stream->ncbl_mixed);
}
/*--- ms stereo processing ---*/
if (pMP3Stream->ms_mode)
{
if (pMP3Stream->is_mode == 0)
{
m0 = nsamp[igr][0]; /* process to longer of left/right */
if (m0 < nsamp[igr][1])
m0 = nsamp[igr][1];
}
else
{ /* process to last cb in right */
m0 = pMP3Stream->sfBandIndex[cb_info[igr][1].cbtype][cb_info[igr][1].cbmax];
}
ms_process(pMP3Stream->sample[0][igr], m0);
}
/*--- is stereo processing ---*/
if (pMP3Stream->is_mode)
{
if (pMP3Stream->id)
is_process_MPEG1(pMP3Stream->sample[0][igr], &sf[igr][1],
cb_info[igr], nsamp[igr][0], pMP3Stream->ms_mode);
else
is_process_MPEG2(pMP3Stream->sample[0][igr], &sf[igr][1],
cb_info[igr], &is_sf_info,
nsamp[igr][0], pMP3Stream->ms_mode);
}
/*-- adjust ms and is modes to max of left/right */
if (side_info.mode_ext)
{
if (nsamp[igr][0] < nsamp[igr][1])
nsamp[igr][0] = nsamp[igr][1];
else
nsamp[igr][1] = nsamp[igr][0];
}
/*--- antialias ---*/
for (ch = 0; ch < pMP3Stream->nchan; ch++)
{
if (cb_info[igr][ch].ncbl == 0)
continue; /* have no long blocks */
if (side_info.gr[igr][ch].mixed_block_flag)
n1 = 1; /* 1 -> 36 samples */
else
n1 = (nsamp[igr][ch] + 7) / 18;
if (n1 > 31)
n1 = 31;
antialias(pMP3Stream->sample[ch][igr], n1);
n1 = 18 * n1 + 8; /* update number of samples */
if (n1 > nsamp[igr][ch])
nsamp[igr][ch] = n1;
}
/*--- hybrid + sbt ---*/
pMP3Stream->Xform(pcm, igr);
/*-- done --*/
}
/*--------------------------------------------------------------------*/
/*-----------------------------------------------------------------*/
IN_OUT L3audio_decode(unsigned char *bs, unsigned char *pcm)
{
return pMP3Stream->decode_function(bs, pcm);
}
/*--------------------------------------------------------------------*/
extern unsigned char *gpNextByteAfterData;
IN_OUT L3audio_decode_MPEG1(unsigned char *bs, unsigned char *pcm)
{
int sync;
IN_OUT in_out;
int side_bytes;
int nbytes;
int padframebytes; ////@@@@
// iframe++;
bitget_init(bs); /* initialize bit getter */
/* test sync */
in_out.in_bytes = 0; /* assume fail */
in_out.out_bytes = 0;
sync = bitget(12);
if (sync != 0xFFF)
return in_out; /* sync fail */
/*-----------*/
/*-- unpack side info --*/
side_bytes = unpack_side_MPEG1();
padframebytes = pMP3Stream->framebytes + pMP3Stream->pad;
if (bs + padframebytes > gpNextByteAfterData)
return in_out; // error check if we're about to read off the end of the legal memory (caused by certain MP3 writers' goofy comment formats) -ste.
in_out.in_bytes = padframebytes;
/*-- load main data and update buf pointer --*/
/*-------------------------------------------
if start point < 0, must just cycle decoder
if jumping into middle of stream,
w---------------------------------------------*/
pMP3Stream->buf_ptr0 = pMP3Stream->buf_ptr1 - side_info.main_data_begin; /* decode start point */
if (pMP3Stream->buf_ptr1 > BUF_TRIGGER)
{ /* shift buffer */
memmove(pMP3Stream->buf, pMP3Stream->buf + pMP3Stream->buf_ptr0, side_info.main_data_begin);
pMP3Stream->buf_ptr0 = 0;
pMP3Stream->buf_ptr1 = side_info.main_data_begin;
}
nbytes = padframebytes - side_bytes - pMP3Stream->crcbytes;
// RAK: This is no bueno. :-(
if (nbytes < 0 || nbytes > NBUF)
{
in_out.in_bytes = 0;
return in_out;
}
if (bFastEstimateOnly)
{
in_out.out_bytes = pMP3Stream->outbytes;
return in_out;
}
memmove(pMP3Stream->buf + pMP3Stream->buf_ptr1, bs + side_bytes + pMP3Stream->crcbytes, nbytes);
pMP3Stream->buf_ptr1 += nbytes;
/*-----------------------*/
if (pMP3Stream->buf_ptr0 >= 0)
{
// dump_frame(buf+buf_ptr0, 64);
pMP3Stream->main_pos_bit = pMP3Stream->buf_ptr0 << 3;
unpack_main(pcm, 0);
unpack_main(pcm + pMP3Stream->half_outbytes, 1);
in_out.out_bytes = pMP3Stream->outbytes;
}
else
{
memset(pcm, pMP3Stream->zero_level_pcm, pMP3Stream->outbytes); /* fill out skipped frames */
in_out.out_bytes = pMP3Stream->outbytes;
/* iframe--; in_out.out_bytes = 0; // test test */
}
return in_out;
}
/*--------------------------------------------------------------------*/
/*--------------------------------------------------------------------*/
IN_OUT L3audio_decode_MPEG2(unsigned char *bs, unsigned char *pcm)
{
int sync;
IN_OUT in_out;
int side_bytes;
int nbytes;
static int igr = 0;
int padframebytes; ////@@@@
// iframe++;
bitget_init(bs); /* initialize bit getter */
/* test sync */
in_out.in_bytes = 0; /* assume fail */
in_out.out_bytes = 0;
sync = bitget(12);
// if( sync != 0xFFF ) return in_out; /* sync fail */
pMP3Stream->mpeg25_flag = 0;
if (sync != 0xFFF)
{
pMP3Stream->mpeg25_flag = 1; /* mpeg 2.5 sync */
if (sync != 0xFFE)
return in_out; /* sync fail */
}
/*-----------*/
/*-- unpack side info --*/
side_bytes = unpack_side_MPEG2(igr);
padframebytes = pMP3Stream->framebytes + pMP3Stream->pad;
in_out.in_bytes = padframebytes;
pMP3Stream->buf_ptr0 = pMP3Stream->buf_ptr1 - side_info.main_data_begin; /* decode start point */
if (pMP3Stream->buf_ptr1 > BUF_TRIGGER)
{ /* shift buffer */
memmove(pMP3Stream->buf, pMP3Stream->buf + pMP3Stream->buf_ptr0, side_info.main_data_begin);
pMP3Stream->buf_ptr0 = 0;
pMP3Stream->buf_ptr1 = side_info.main_data_begin;
}
nbytes = padframebytes - side_bytes - pMP3Stream->crcbytes;
// RAK: This is no bueno. :-(
if (nbytes < 0 || nbytes > NBUF)
{
in_out.in_bytes = 0;
return in_out;
}
if (bFastEstimateOnly)
{
in_out.out_bytes = pMP3Stream->outbytes;
return in_out;
}
memmove(pMP3Stream->buf + pMP3Stream->buf_ptr1, bs + side_bytes + pMP3Stream->crcbytes, nbytes);
pMP3Stream->buf_ptr1 += nbytes;
/*-----------------------*/
if (pMP3Stream->buf_ptr0 >= 0)
{
pMP3Stream->main_pos_bit = pMP3Stream->buf_ptr0 << 3;
unpack_main(pcm, igr);
in_out.out_bytes = pMP3Stream->outbytes;
}
else
{
memset(pcm, pMP3Stream->zero_level_pcm, pMP3Stream->outbytes); /* fill out skipped frames */
in_out.out_bytes = pMP3Stream->outbytes;
// iframe--; in_out.out_bytes = 0; return in_out;// test test */
}
igr = igr ^ 1;
return in_out;
}
/*--------------------------------------------------------------------*/
/*--------------------------------------------------------------------*/
/*--------------------------------------------------------------------*/
static const int sr_table[8] =
{22050, 24000, 16000, 1,
44100, 48000, 32000, 1};
static const struct
{
int l[23];
int s[14];
}
sfBandIndexTable[3][3] =
{
/* mpeg-2 */
{
{
{
0, 6, 12, 18, 24, 30, 36, 44, 54, 66, 80, 96, 116, 140, 168, 200, 238, 284, 336, 396, 464, 522, 576
}
,
{
0, 4, 8, 12, 18, 24, 32, 42, 56, 74, 100, 132, 174, 192
}
}
,
{
{
0, 6, 12, 18, 24, 30, 36, 44, 54, 66, 80, 96, 114, 136, 162, 194, 232, 278, 332, 394, 464, 540, 576
}
,
{
0, 4, 8, 12, 18, 26, 36, 48, 62, 80, 104, 136, 180, 192
}
}
,
{
{
0, 6, 12, 18, 24, 30, 36, 44, 54, 66, 80, 96, 116, 140, 168, 200, 238, 284, 336, 396, 464, 522, 576
}
,
{
0, 4, 8, 12, 18, 26, 36, 48, 62, 80, 104, 134, 174, 192
}
}
,
}
,
/* mpeg-1 */
{
{
{
0, 4, 8, 12, 16, 20, 24, 30, 36, 44, 52, 62, 74, 90, 110, 134, 162, 196, 238, 288, 342, 418, 576
}
,
{
0, 4, 8, 12, 16, 22, 30, 40, 52, 66, 84, 106, 136, 192
}
}
,
{
{
0, 4, 8, 12, 16, 20, 24, 30, 36, 42, 50, 60, 72, 88, 106, 128, 156, 190, 230, 276, 330, 384, 576
}
,
{
0, 4, 8, 12, 16, 22, 28, 38, 50, 64, 80, 100, 126, 192
}
}
,
{
{
0, 4, 8, 12, 16, 20, 24, 30, 36, 44, 54, 66, 82, 102, 126, 156, 194, 240, 296, 364, 448, 550, 576
}
,
{
0, 4, 8, 12, 16, 22, 30, 42, 58, 78, 104, 138, 180, 192
}
}
}
,
/* mpeg-2.5, 11 & 12 KHz seem ok, 8 ok */
{
{
{
0, 6, 12, 18, 24, 30, 36, 44, 54, 66, 80, 96, 116, 140, 168, 200, 238, 284, 336, 396, 464, 522, 576
}
,
{
0, 4, 8, 12, 18, 26, 36, 48, 62, 80, 104, 134, 174, 192
}
}
,
{
{
0, 6, 12, 18, 24, 30, 36, 44, 54, 66, 80, 96, 116, 140, 168, 200, 238, 284, 336, 396, 464, 522, 576
}
,
{
0, 4, 8, 12, 18, 26, 36, 48, 62, 80, 104, 134, 174, 192
}
}
,
// this 8khz table, and only 8khz, from mpeg123)
{
{
0, 12, 24, 36, 48, 60, 72, 88, 108, 132, 160, 192, 232, 280, 336, 400, 476, 566, 568, 570, 572, 574, 576
}
,
{
0, 8, 16, 24, 36, 52, 72, 96, 124, 160, 162, 164, 166, 192
}
}
,
}
,
};
void sbt_mono_L3(float *sample, signed short *pcm, int ch);
void sbt_dual_L3(float *sample, signed short *pcm, int ch);
void sbt16_mono_L3(float *sample, signed short *pcm, int ch);
void sbt16_dual_L3(float *sample, signed short *pcm, int ch);
void sbt8_mono_L3(float *sample, signed short *pcm, int ch);
void sbt8_dual_L3(float *sample, signed short *pcm, int ch);
void sbtB_mono_L3(float *sample, unsigned char *pcm, int ch);
void sbtB_dual_L3(float *sample, unsigned char *pcm, int ch);
void sbtB16_mono_L3(float *sample, unsigned char *pcm, int ch);
void sbtB16_dual_L3(float *sample, unsigned char *pcm, int ch);
void sbtB8_mono_L3(float *sample, unsigned char *pcm, int ch);
void sbtB8_dual_L3(float *sample, unsigned char *pcm, int ch);
static const SBT_FUNCTION sbt_table[2][3][2] =
{
{{ (SBT_FUNCTION) sbt_mono_L3,
(SBT_FUNCTION) sbt_dual_L3 } ,
{ (SBT_FUNCTION) sbt16_mono_L3,
(SBT_FUNCTION) sbt16_dual_L3 } ,
{ (SBT_FUNCTION) sbt8_mono_L3,
(SBT_FUNCTION) sbt8_dual_L3 }} ,
/*-- 8 bit output -*/
{{ (SBT_FUNCTION) sbtB_mono_L3,
(SBT_FUNCTION) sbtB_dual_L3 },
{ (SBT_FUNCTION) sbtB16_mono_L3,
(SBT_FUNCTION) sbtB16_dual_L3 },
{ (SBT_FUNCTION) sbtB8_mono_L3,
(SBT_FUNCTION) sbtB8_dual_L3 }}
};
void Xform_mono(void *pcm, int igr);
void Xform_dual(void *pcm, int igr);
void Xform_dual_mono(void *pcm, int igr);
void Xform_dual_right(void *pcm, int igr);
static XFORM_FUNCTION xform_table[5] =
{
Xform_mono,
Xform_dual,
Xform_dual_mono,
Xform_mono, /* left */
Xform_dual_right,
};
int L3table_init();
void msis_init();
void sbt_init();
typedef int iARRAY22[22];
iARRAY22 *quant_init_band_addr();
iARRAY22 *msis_init_band_addr();
/*---------------------------------------------------------*/
/* mpeg_head defined in mhead.h frame bytes is without pMP3Stream->pad */
////@@@@INIT
int L3audio_decode_init(MPEG_HEAD * h, int framebytes_arg,
int reduction_code, int transform_code, int convert_code,
int freq_limit)
{
int i, j, k;
// static int first_pass = 1;
int samprate;
int limit;
int bit_code;
int out_chans;
pMP3Stream->buf_ptr0 = 0;
pMP3Stream->buf_ptr1 = 0;
/* check if code handles */
if (h->option != 1)
return 0; /* layer III only */
if (h->id)
pMP3Stream->ncbl_mixed = 8; /* mpeg-1 */
else
pMP3Stream->ncbl_mixed = 6; /* mpeg-2 */
pMP3Stream->framebytes = framebytes_arg;
transform_code = transform_code; /* not used, asm compatability */
bit_code = 0;
if (convert_code & 8)
bit_code = 1;
convert_code = convert_code & 3; /* higher bits used by dec8 freq cvt */
if (reduction_code < 0)
reduction_code = 0;
if (reduction_code > 2)
reduction_code = 2;
if (freq_limit < 1000)
freq_limit = 1000;
samprate = sr_table[4 * h->id + h->sr_index];
if ((h->sync & 1) == 0)
samprate = samprate / 2; // mpeg 2.5
/*----- compute pMP3Stream->nsb_limit --------*/
pMP3Stream->nsb_limit = (freq_limit * 64L + samprate / 2) / samprate;
/*- caller limit -*/
limit = (32 >> reduction_code);
if (limit > 8)
limit--;
if (pMP3Stream->nsb_limit > limit)
pMP3Stream->nsb_limit = limit;
limit = 18 * pMP3Stream->nsb_limit;
k = h->id;
if ((h->sync & 1) == 0)
k = 2; // mpeg 2.5
if (k == 1)
{
pMP3Stream->band_limit12 = 3 * sfBandIndexTable[k][h->sr_index].s[13];
pMP3Stream->band_limit = pMP3Stream->band_limit21 = sfBandIndexTable[k][h->sr_index].l[22];
}
else
{
pMP3Stream->band_limit12 = 3 * sfBandIndexTable[k][h->sr_index].s[12];
pMP3Stream->band_limit = pMP3Stream->band_limit21 = sfBandIndexTable[k][h->sr_index].l[21];
}
pMP3Stream->band_limit += 8; /* allow for antialias */
if (pMP3Stream->band_limit > limit)
pMP3Stream->band_limit = limit;
if (pMP3Stream->band_limit21 > pMP3Stream->band_limit)
pMP3Stream->band_limit21 = pMP3Stream->band_limit;
if (pMP3Stream->band_limit12 > pMP3Stream->band_limit)
pMP3Stream->band_limit12 = pMP3Stream->band_limit;
pMP3Stream->band_limit_nsb = (pMP3Stream->band_limit + 17) / 18; /* limit nsb's rounded up */
/*----------------------------------------------*/
pMP3Stream->gain_adjust = 0; /* adjust gain e.g. cvt to mono sum channel */
if ((h->mode != 3) && (convert_code == 1))
pMP3Stream->gain_adjust = -4;
pMP3Stream->outvalues = 1152 >> reduction_code;
if (h->id == 0)
pMP3Stream->outvalues /= 2;
out_chans = 2;
if (h->mode == 3)
out_chans = 1;
if (convert_code)
out_chans = 1;
pMP3Stream->sbt_L3 = sbt_table[bit_code][reduction_code][out_chans - 1];
k = 1 + convert_code;
if (h->mode == 3)
k = 0;
pMP3Stream->Xform = xform_table[k];
pMP3Stream->outvalues *= out_chans;
if (bit_code)
pMP3Stream->outbytes = pMP3Stream->outvalues;
else
pMP3Stream->outbytes = sizeof(short) * pMP3Stream->outvalues;
if (bit_code)
pMP3Stream->zero_level_pcm = 128; /* 8 bit output */
else
pMP3Stream->zero_level_pcm = 0;
decinfo.channels = out_chans;
decinfo.outvalues = pMP3Stream->outvalues;
decinfo.samprate = samprate >> reduction_code;
if (bit_code)
decinfo.bits = 8;
else
decinfo.bits = sizeof(short) * 8;
decinfo.framebytes = pMP3Stream->framebytes;
decinfo.type = 0;
pMP3Stream->half_outbytes = pMP3Stream->outbytes / 2;
/*------------------------------------------*/
/*- init band tables --*/
k = h->id;
if ((h->sync & 1) == 0)
k = 2; // mpeg 2.5
for (i = 0; i < 22; i++)
pMP3Stream->sfBandIndex[0][i] = sfBandIndexTable[k][h->sr_index].l[i + 1];
for (i = 0; i < 13; i++)
pMP3Stream->sfBandIndex[1][i] = 3 * sfBandIndexTable[k][h->sr_index].s[i + 1];
for (i = 0; i < 22; i++)
pMP3Stream->nBand[0][i] = sfBandIndexTable[k][h->sr_index].l[i + 1] - sfBandIndexTable[k][h->sr_index].l[i];
for (i = 0; i < 13; i++)
pMP3Stream->nBand[1][i] = sfBandIndexTable[k][h->sr_index].s[i + 1] - sfBandIndexTable[k][h->sr_index].s[i];
/* init tables */
L3table_init();
/* init ms and is stereo modes */
msis_init();
/*----- init sbt ---*/
sbt_init();
/*--- clear buffers --*/
for (i = 0; i < 576; i++)
yout[i] = 0.0f;
for (j = 0; j < 2; j++)
{
for (k = 0; k < 2; k++)
{
for (i = 0; i < 576; i++)
{
pMP3Stream->sample[j][k][i].x = 0.0f;
pMP3Stream->sample[j][k][i].s = 0;
}
}
}
if (h->id == 1)
pMP3Stream->decode_function = L3audio_decode_MPEG1;
else
pMP3Stream->decode_function = L3audio_decode_MPEG2;
return 1;
}
/*---------------------------------------------------------*/
/*==========================================================*/
Reference in a new issue Copy permalink