Initial commit.
This commit is contained in:
Jim Gray
507
codemp/mp3code/uph.c
Normal file
507
codemp/mp3code/uph.c
Normal file
@@ -0,0 +1,507 @@
|
||||
/*____________________________________________________________________________
|
||||
|
||||
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: uph.c,v 1.3 1999/10/19 07:13:09 elrod Exp $
|
||||
____________________________________________________________________________*/
|
||||
|
||||
/**** uph.c ***************************************************
|
||||
|
||||
Layer 3 audio
|
||||
huffman decode
|
||||
|
||||
|
||||
******************************************************************/
|
||||
#include <stdlib.h>
|
||||
#include <stdio.h>
|
||||
#include <float.h>
|
||||
#include <math.h>
|
||||
|
||||
#include "L3.h"
|
||||
|
||||
#pragma warning ( disable : 4711 ) // function 'xxxx' selected for automatic inline expansion
|
||||
|
||||
|
||||
#ifdef _MSC_VER
|
||||
#pragma warning(disable: 4505)
|
||||
#endif
|
||||
|
||||
/*===============================================================*/
|
||||
|
||||
/* max bits required for any lookup - change if htable changes */
|
||||
/* quad required 10 bit w/signs must have (MAXBITS+2) >= 10 */
|
||||
#define MAXBITS 9
|
||||
|
||||
static const HUFF_ELEMENT huff_table_0[4] =
|
||||
{{0}, {0}, {0}, {64}}; /* dummy must not use */
|
||||
|
||||
#include "htable.h"
|
||||
|
||||
/*-- 6 bit lookup (purgebits, value) --*/
|
||||
static const unsigned char quad_table_a[][2] =
|
||||
{
|
||||
{6, 11}, {6, 15}, {6, 13}, {6, 14}, {6, 7}, {6, 5}, {5, 9},
|
||||
{5, 9}, {5, 6}, {5, 6}, {5, 3}, {5, 3}, {5, 10}, {5, 10},
|
||||
{5, 12}, {5, 12}, {4, 2}, {4, 2}, {4, 2}, {4, 2}, {4, 1},
|
||||
{4, 1}, {4, 1}, {4, 1}, {4, 4}, {4, 4}, {4, 4}, {4, 4},
|
||||
{4, 8}, {4, 8}, {4, 8}, {4, 8}, {1, 0}, {1, 0}, {1, 0},
|
||||
{1, 0}, {1, 0}, {1, 0}, {1, 0}, {1, 0}, {1, 0}, {1, 0},
|
||||
{1, 0}, {1, 0}, {1, 0}, {1, 0}, {1, 0}, {1, 0}, {1, 0},
|
||||
{1, 0}, {1, 0}, {1, 0}, {1, 0}, {1, 0}, {1, 0}, {1, 0},
|
||||
{1, 0}, {1, 0}, {1, 0}, {1, 0}, {1, 0}, {1, 0}, {1, 0},
|
||||
{1, 0},
|
||||
};
|
||||
|
||||
|
||||
typedef struct
|
||||
{
|
||||
const HUFF_ELEMENT *table;
|
||||
int linbits;
|
||||
int ncase;
|
||||
}
|
||||
HUFF_SETUP;
|
||||
|
||||
#define no_bits 0
|
||||
#define one_shot 1
|
||||
#define no_linbits 2
|
||||
#define have_linbits 3
|
||||
#define quad_a 4
|
||||
#define quad_b 5
|
||||
|
||||
|
||||
static const HUFF_SETUP table_look[] =
|
||||
{
|
||||
{huff_table_0, 0, no_bits},
|
||||
{huff_table_1, 0, one_shot},
|
||||
{huff_table_2, 0, one_shot},
|
||||
{huff_table_3, 0, one_shot},
|
||||
{huff_table_0, 0, no_bits},
|
||||
{huff_table_5, 0, one_shot},
|
||||
{huff_table_6, 0, one_shot},
|
||||
{huff_table_7, 0, no_linbits},
|
||||
{huff_table_8, 0, no_linbits},
|
||||
{huff_table_9, 0, no_linbits},
|
||||
{huff_table_10, 0, no_linbits},
|
||||
{huff_table_11, 0, no_linbits},
|
||||
{huff_table_12, 0, no_linbits},
|
||||
{huff_table_13, 0, no_linbits},
|
||||
{huff_table_0, 0, no_bits},
|
||||
{huff_table_15, 0, no_linbits},
|
||||
{huff_table_16, 1, have_linbits},
|
||||
{huff_table_16, 2, have_linbits},
|
||||
{huff_table_16, 3, have_linbits},
|
||||
{huff_table_16, 4, have_linbits},
|
||||
{huff_table_16, 6, have_linbits},
|
||||
{huff_table_16, 8, have_linbits},
|
||||
{huff_table_16, 10, have_linbits},
|
||||
{huff_table_16, 13, have_linbits},
|
||||
{huff_table_24, 4, have_linbits},
|
||||
{huff_table_24, 5, have_linbits},
|
||||
{huff_table_24, 6, have_linbits},
|
||||
{huff_table_24, 7, have_linbits},
|
||||
{huff_table_24, 8, have_linbits},
|
||||
{huff_table_24, 9, have_linbits},
|
||||
{huff_table_24, 11, have_linbits},
|
||||
{huff_table_24, 13, have_linbits},
|
||||
{huff_table_0, 0, quad_a},
|
||||
{huff_table_0, 0, quad_b},
|
||||
};
|
||||
|
||||
/*========================================================*/
|
||||
extern BITDAT bitdat;
|
||||
|
||||
/*------------- get n bits from bitstream -------------*/
|
||||
/* unused
|
||||
static 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 n bits - checks for n+2 avail bits (linbits+sign) -----*/
|
||||
static unsigned int bitget_lb(int n)
|
||||
{
|
||||
unsigned int x;
|
||||
|
||||
if (bitdat.bits < (n + 2))
|
||||
{ /* 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 n bits but DO NOT remove from bitstream --*/
|
||||
static unsigned int bitget2(int n)
|
||||
{
|
||||
unsigned int x;
|
||||
|
||||
if (bitdat.bits < (MAXBITS + 2))
|
||||
{ /* refill bit buf if necessary */
|
||||
while (bitdat.bits <= 24)
|
||||
{
|
||||
bitdat.bitbuf = (bitdat.bitbuf << 8) | *bitdat.bs_ptr++;
|
||||
bitdat.bits += 8;
|
||||
}
|
||||
}
|
||||
x = bitdat.bitbuf >> (bitdat.bits - n);
|
||||
return x;
|
||||
}
|
||||
/*------------- remove n bits from bitstream ---------*/
|
||||
/* unused
|
||||
static void bitget_purge(int n)
|
||||
{
|
||||
bitdat.bits -= n;
|
||||
bitdat.bitbuf -= (bitdat.bitbuf >> bitdat.bits) << bitdat.bits;
|
||||
}
|
||||
*/
|
||||
/*------------- get 1 bit from bitstream NO CHECK -------------*/
|
||||
/* unused
|
||||
static unsigned int bitget_1bit()
|
||||
{
|
||||
unsigned int x;
|
||||
|
||||
bitdat.bits--;
|
||||
x = bitdat.bitbuf >> bitdat.bits;
|
||||
bitdat.bitbuf -= x << bitdat.bits;
|
||||
return x;
|
||||
}
|
||||
*/
|
||||
/*========================================================*/
|
||||
/*========================================================*/
|
||||
#define mac_bitget_check(n) if( bitdat.bits < (n) ) { \
|
||||
while( bitdat.bits <= 24 ) { \
|
||||
bitdat.bitbuf = (bitdat.bitbuf << 8) | *bitdat.bs_ptr++; \
|
||||
bitdat.bits += 8; \
|
||||
} \
|
||||
}
|
||||
/*---------------------------------------------------------*/
|
||||
#define mac_bitget2(n) (bitdat.bitbuf >> (bitdat.bits-n));
|
||||
/*---------------------------------------------------------*/
|
||||
#define mac_bitget(n) ( bitdat.bits -= n, \
|
||||
code = bitdat.bitbuf >> bitdat.bits, \
|
||||
bitdat.bitbuf -= code << bitdat.bits, \
|
||||
code )
|
||||
/*---------------------------------------------------------*/
|
||||
#define mac_bitget_purge(n) bitdat.bits -= n, \
|
||||
bitdat.bitbuf -= (bitdat.bitbuf >> bitdat.bits) << bitdat.bits;
|
||||
/*---------------------------------------------------------*/
|
||||
#define mac_bitget_1bit() ( bitdat.bits--, \
|
||||
code = bitdat.bitbuf >> bitdat.bits, \
|
||||
bitdat.bitbuf -= code << bitdat.bits, \
|
||||
code )
|
||||
/*========================================================*/
|
||||
/*========================================================*/
|
||||
void unpack_huff(int xy[][2], int n, int ntable)
|
||||
{
|
||||
int i;
|
||||
const HUFF_ELEMENT *t;
|
||||
const HUFF_ELEMENT *t0;
|
||||
int linbits;
|
||||
int bits;
|
||||
int code;
|
||||
int x, y;
|
||||
|
||||
if (n <= 0)
|
||||
return;
|
||||
n = n >> 1; /* huff in pairs */
|
||||
/*-------------*/
|
||||
t0 = table_look[ntable].table;
|
||||
linbits = table_look[ntable].linbits;
|
||||
switch (table_look[ntable].ncase)
|
||||
{
|
||||
default:
|
||||
/*------------------------------------------*/
|
||||
case no_bits:
|
||||
/*- table 0, no data, x=y=0--*/
|
||||
for (i = 0; i < n; i++)
|
||||
{
|
||||
xy[i][0] = 0;
|
||||
xy[i][1] = 0;
|
||||
}
|
||||
return;
|
||||
/*------------------------------------------*/
|
||||
case one_shot:
|
||||
/*- single lookup, no escapes -*/
|
||||
for (i = 0; i < n; i++)
|
||||
{
|
||||
mac_bitget_check((MAXBITS + 2));
|
||||
bits = t0[0].b.signbits;
|
||||
code = mac_bitget2(bits);
|
||||
mac_bitget_purge(t0[1 + code].b.purgebits);
|
||||
x = t0[1 + code].b.x;
|
||||
y = t0[1 + code].b.y;
|
||||
if (x)
|
||||
if (mac_bitget_1bit())
|
||||
x = -x;
|
||||
if (y)
|
||||
if (mac_bitget_1bit())
|
||||
y = -y;
|
||||
xy[i][0] = x;
|
||||
xy[i][1] = y;
|
||||
if (bitdat.bs_ptr > bitdat.bs_ptr_end)
|
||||
break; // bad data protect
|
||||
|
||||
}
|
||||
return;
|
||||
/*------------------------------------------*/
|
||||
case no_linbits:
|
||||
for (i = 0; i < n; i++)
|
||||
{
|
||||
t = t0;
|
||||
for (;;)
|
||||
{
|
||||
mac_bitget_check((MAXBITS + 2));
|
||||
bits = t[0].b.signbits;
|
||||
code = mac_bitget2(bits);
|
||||
if (t[1 + code].b.purgebits)
|
||||
break;
|
||||
t += t[1 + code].ptr; /* ptr include 1+code */
|
||||
mac_bitget_purge(bits);
|
||||
}
|
||||
mac_bitget_purge(t[1 + code].b.purgebits);
|
||||
x = t[1 + code].b.x;
|
||||
y = t[1 + code].b.y;
|
||||
if (x)
|
||||
if (mac_bitget_1bit())
|
||||
x = -x;
|
||||
if (y)
|
||||
if (mac_bitget_1bit())
|
||||
y = -y;
|
||||
xy[i][0] = x;
|
||||
xy[i][1] = y;
|
||||
if (bitdat.bs_ptr > bitdat.bs_ptr_end)
|
||||
break; // bad data protect
|
||||
|
||||
}
|
||||
return;
|
||||
/*------------------------------------------*/
|
||||
case have_linbits:
|
||||
for (i = 0; i < n; i++)
|
||||
{
|
||||
t = t0;
|
||||
for (;;)
|
||||
{
|
||||
bits = t[0].b.signbits;
|
||||
code = bitget2(bits);
|
||||
if (t[1 + code].b.purgebits)
|
||||
break;
|
||||
t += t[1 + code].ptr; /* ptr includes 1+code */
|
||||
mac_bitget_purge(bits);
|
||||
}
|
||||
mac_bitget_purge(t[1 + code].b.purgebits);
|
||||
x = t[1 + code].b.x;
|
||||
y = t[1 + code].b.y;
|
||||
if (x == 15)
|
||||
x += bitget_lb(linbits);
|
||||
if (x)
|
||||
if (mac_bitget_1bit())
|
||||
x = -x;
|
||||
if (y == 15)
|
||||
y += bitget_lb(linbits);
|
||||
if (y)
|
||||
if (mac_bitget_1bit())
|
||||
y = -y;
|
||||
xy[i][0] = x;
|
||||
xy[i][1] = y;
|
||||
if (bitdat.bs_ptr > bitdat.bs_ptr_end)
|
||||
break; // bad data protect
|
||||
|
||||
}
|
||||
return;
|
||||
}
|
||||
/*--- end switch ---*/
|
||||
|
||||
}
|
||||
/*==========================================================*/
|
||||
int unpack_huff_quad(int vwxy[][4], int n, int nbits, int ntable)
|
||||
{
|
||||
int i;
|
||||
int code;
|
||||
int x, y, v, w;
|
||||
int tmp;
|
||||
int i_non_zero, tmp_nz;
|
||||
|
||||
tmp_nz = 15;
|
||||
i_non_zero = -1;
|
||||
|
||||
n = n >> 2; /* huff in quads */
|
||||
|
||||
if (ntable)
|
||||
goto case_quad_b;
|
||||
|
||||
/* case_quad_a: */
|
||||
for (i = 0; i < n; i++)
|
||||
{
|
||||
if (nbits <= 0)
|
||||
break;
|
||||
mac_bitget_check(10);
|
||||
code = mac_bitget2(6);
|
||||
nbits -= quad_table_a[code][0];
|
||||
mac_bitget_purge(quad_table_a[code][0]);
|
||||
tmp = quad_table_a[code][1];
|
||||
if (tmp)
|
||||
{
|
||||
i_non_zero = i;
|
||||
tmp_nz = tmp;
|
||||
}
|
||||
v = (tmp >> 3) & 1;
|
||||
w = (tmp >> 2) & 1;
|
||||
x = (tmp >> 1) & 1;
|
||||
y = tmp & 1;
|
||||
if (v)
|
||||
{
|
||||
if (mac_bitget_1bit())
|
||||
v = -v;
|
||||
nbits--;
|
||||
}
|
||||
if (w)
|
||||
{
|
||||
if (mac_bitget_1bit())
|
||||
w = -w;
|
||||
nbits--;
|
||||
}
|
||||
if (x)
|
||||
{
|
||||
if (mac_bitget_1bit())
|
||||
x = -x;
|
||||
nbits--;
|
||||
}
|
||||
if (y)
|
||||
{
|
||||
if (mac_bitget_1bit())
|
||||
y = -y;
|
||||
nbits--;
|
||||
}
|
||||
vwxy[i][0] = v;
|
||||
vwxy[i][1] = w;
|
||||
vwxy[i][2] = x;
|
||||
vwxy[i][3] = y;
|
||||
if (bitdat.bs_ptr > bitdat.bs_ptr_end)
|
||||
break; // bad data protect
|
||||
|
||||
}
|
||||
if (i && nbits < 0)
|
||||
{
|
||||
i--;
|
||||
vwxy[i][0] = 0;
|
||||
vwxy[i][1] = 0;
|
||||
vwxy[i][2] = 0;
|
||||
vwxy[i][3] = 0;
|
||||
}
|
||||
|
||||
i_non_zero = (i_non_zero + 1) << 2;
|
||||
|
||||
if ((tmp_nz & 3) == 0)
|
||||
i_non_zero -= 2;
|
||||
|
||||
return i_non_zero;
|
||||
|
||||
/*--------------------*/
|
||||
case_quad_b:
|
||||
for (i = 0; i < n; i++)
|
||||
{
|
||||
if (nbits < 4)
|
||||
break;
|
||||
nbits -= 4;
|
||||
mac_bitget_check(8);
|
||||
tmp = mac_bitget(4) ^ 15; /* one's complement of bitstream */
|
||||
if (tmp)
|
||||
{
|
||||
i_non_zero = i;
|
||||
tmp_nz = tmp;
|
||||
}
|
||||
v = (tmp >> 3) & 1;
|
||||
w = (tmp >> 2) & 1;
|
||||
x = (tmp >> 1) & 1;
|
||||
y = tmp & 1;
|
||||
if (v)
|
||||
{
|
||||
if (mac_bitget_1bit())
|
||||
v = -v;
|
||||
nbits--;
|
||||
}
|
||||
if (w)
|
||||
{
|
||||
if (mac_bitget_1bit())
|
||||
w = -w;
|
||||
nbits--;
|
||||
}
|
||||
if (x)
|
||||
{
|
||||
if (mac_bitget_1bit())
|
||||
x = -x;
|
||||
nbits--;
|
||||
}
|
||||
if (y)
|
||||
{
|
||||
if (mac_bitget_1bit())
|
||||
y = -y;
|
||||
nbits--;
|
||||
}
|
||||
vwxy[i][0] = v;
|
||||
vwxy[i][1] = w;
|
||||
vwxy[i][2] = x;
|
||||
vwxy[i][3] = y;
|
||||
if (bitdat.bs_ptr > bitdat.bs_ptr_end)
|
||||
break; // bad data protect
|
||||
|
||||
}
|
||||
if (nbits < 0)
|
||||
{
|
||||
i--;
|
||||
vwxy[i][0] = 0;
|
||||
vwxy[i][1] = 0;
|
||||
vwxy[i][2] = 0;
|
||||
vwxy[i][3] = 0;
|
||||
}
|
||||
|
||||
i_non_zero = (i_non_zero + 1) << 2;
|
||||
|
||||
if ((tmp_nz & 3) == 0)
|
||||
i_non_zero -= 2;
|
||||
|
||||
return i_non_zero; /* return non-zero sample (to nearest pair) */
|
||||
|
||||
}
|
||||
/*-----------------------------------------------------*/
|
||||
Reference in New Issue
Block a user