mirror of
https://github.com/reactos/reactos.git
synced 2024-08-21 10:53:15 +00:00
389 lines
11 KiB
C
389 lines
11 KiB
C
/*
|
|
tabinit.c: initialize tables...
|
|
|
|
copyright ?-2008 by the mpg123 project - free software under the terms of the LGPL 2.1
|
|
see COPYING and AUTHORS files in distribution or http://mpg123.org
|
|
initially written by Michael Hipp
|
|
*/
|
|
|
|
#include "mpg123lib_intern.h"
|
|
#include "debug.h"
|
|
|
|
/* That altivec alignment part here should not hurt generic code, I hope */
|
|
#ifdef OPT_ALTIVEC
|
|
static ALIGNED(16) real cos64[16];
|
|
static ALIGNED(16) real cos32[8];
|
|
static ALIGNED(16) real cos16[4];
|
|
static ALIGNED(16) real cos8[2];
|
|
static ALIGNED(16) real cos4[1];
|
|
#elif defined(REAL_IS_FIXED) && defined(PRECALC_TABLES)
|
|
static real cos64[16] =
|
|
{
|
|
8398725,8480395,8647771,8909416,9279544,9780026,10443886,11321405,
|
|
12491246,14081950,16316987,19619946,24900150,34523836,57170182,170959967
|
|
};
|
|
static real cos32[8] =
|
|
{
|
|
8429197,8766072,9511743,10851869,13223040,17795219,28897867,85583072
|
|
};
|
|
static real cos16[4] =
|
|
{
|
|
8552951,10088893,15099095,42998586
|
|
};
|
|
static real cos8[2] =
|
|
{
|
|
9079764,21920489
|
|
};
|
|
static real cos4[1] =
|
|
{
|
|
11863283
|
|
};
|
|
#else
|
|
static real cos64[16],cos32[8],cos16[4],cos8[2],cos4[1];
|
|
#endif
|
|
|
|
real *pnts[] = { cos64,cos32,cos16,cos8,cos4 };
|
|
|
|
|
|
static long intwinbase[] = {
|
|
0, -1, -1, -1, -1, -1, -1, -2, -2, -2,
|
|
-2, -3, -3, -4, -4, -5, -5, -6, -7, -7,
|
|
-8, -9, -10, -11, -13, -14, -16, -17, -19, -21,
|
|
-24, -26, -29, -31, -35, -38, -41, -45, -49, -53,
|
|
-58, -63, -68, -73, -79, -85, -91, -97, -104, -111,
|
|
-117, -125, -132, -139, -147, -154, -161, -169, -176, -183,
|
|
-190, -196, -202, -208, -213, -218, -222, -225, -227, -228,
|
|
-228, -227, -224, -221, -215, -208, -200, -189, -177, -163,
|
|
-146, -127, -106, -83, -57, -29, 2, 36, 72, 111,
|
|
153, 197, 244, 294, 347, 401, 459, 519, 581, 645,
|
|
711, 779, 848, 919, 991, 1064, 1137, 1210, 1283, 1356,
|
|
1428, 1498, 1567, 1634, 1698, 1759, 1817, 1870, 1919, 1962,
|
|
2001, 2032, 2057, 2075, 2085, 2087, 2080, 2063, 2037, 2000,
|
|
1952, 1893, 1822, 1739, 1644, 1535, 1414, 1280, 1131, 970,
|
|
794, 605, 402, 185, -45, -288, -545, -814, -1095, -1388,
|
|
-1692, -2006, -2330, -2663, -3004, -3351, -3705, -4063, -4425, -4788,
|
|
-5153, -5517, -5879, -6237, -6589, -6935, -7271, -7597, -7910, -8209,
|
|
-8491, -8755, -8998, -9219, -9416, -9585, -9727, -9838, -9916, -9959,
|
|
-9966, -9935, -9863, -9750, -9592, -9389, -9139, -8840, -8492, -8092,
|
|
-7640, -7134, -6574, -5959, -5288, -4561, -3776, -2935, -2037, -1082,
|
|
-70, 998, 2122, 3300, 4533, 5818, 7154, 8540, 9975, 11455,
|
|
12980, 14548, 16155, 17799, 19478, 21189, 22929, 24694, 26482, 28289,
|
|
30112, 31947, 33791, 35640, 37489, 39336, 41176, 43006, 44821, 46617,
|
|
48390, 50137, 51853, 53534, 55178, 56778, 58333, 59838, 61289, 62684,
|
|
64019, 65290, 66494, 67629, 68692, 69679, 70590, 71420, 72169, 72835,
|
|
73415, 73908, 74313, 74630, 74856, 74992, 75038 };
|
|
|
|
void prepare_decode_tables()
|
|
{
|
|
#if !defined(REAL_IS_FIXED) || !defined(PRECALC_TABLES)
|
|
int i,k,kr,divv;
|
|
real *costab;
|
|
|
|
for(i=0;i<5;i++)
|
|
{
|
|
kr=0x10>>i; divv=0x40>>i;
|
|
costab = pnts[i];
|
|
for(k=0;k<kr;k++)
|
|
costab[k] = DOUBLE_TO_REAL(1.0 / (2.0 * cos(M_PI * ((double) k * 2.0 + 1.0) / (double) divv)));
|
|
}
|
|
#endif
|
|
}
|
|
|
|
#ifdef OPT_MMXORSSE
|
|
#if !defined(OPT_X86_64) && !defined(OPT_NEON) && !defined(OPT_NEON64) && !defined(OPT_AVX)
|
|
void make_decode_tables_mmx_asm(long scaleval, float* decwin_mmx, float *decwins);
|
|
void make_decode_tables_mmx(mpg123_handle *fr)
|
|
{
|
|
debug("MMX decode tables");
|
|
/* Take care: The scale should be like before, when we didn't have float output all around. */
|
|
make_decode_tables_mmx_asm((long)((fr->lastscale < 0 ? fr->p.outscale : fr->lastscale)*SHORT_SCALE), fr->decwin_mmx, fr->decwins);
|
|
debug("MMX decode tables done");
|
|
}
|
|
#else
|
|
|
|
/* This mimics round() as defined in C99. We stay C89. */
|
|
static int rounded(double f)
|
|
{
|
|
return (int)(f>0 ? floor(f+0.5) : ceil(f-0.5));
|
|
}
|
|
|
|
/* x86-64 doesn't use asm version */
|
|
void make_decode_tables_mmx(mpg123_handle *fr)
|
|
{
|
|
int i,j,val;
|
|
int idx = 0;
|
|
short *ptr = (short *)fr->decwins;
|
|
/* Scale is always based on 1.0 . */
|
|
double scaleval = -0.5*(fr->lastscale < 0 ? fr->p.outscale : fr->lastscale);
|
|
debug1("MMX decode tables with scaleval %g", scaleval);
|
|
for(i=0,j=0;i<256;i++,j++,idx+=32)
|
|
{
|
|
if(idx < 512+16)
|
|
fr->decwin_mmx[idx+16] = fr->decwin_mmx[idx] = DOUBLE_TO_REAL((double) intwinbase[j] * scaleval);
|
|
|
|
if(i % 32 == 31)
|
|
idx -= 1023;
|
|
if(i % 64 == 63)
|
|
scaleval = - scaleval;
|
|
}
|
|
|
|
for( /* i=256 */ ;i<512;i++,j--,idx+=32)
|
|
{
|
|
if(idx < 512+16)
|
|
fr->decwin_mmx[idx+16] = fr->decwin_mmx[idx] = DOUBLE_TO_REAL((double) intwinbase[j] * scaleval);
|
|
|
|
if(i % 32 == 31)
|
|
idx -= 1023;
|
|
if(i % 64 == 63)
|
|
scaleval = - scaleval;
|
|
}
|
|
|
|
for(i=0; i<512; i++) {
|
|
if(i&1) val = rounded(fr->decwin_mmx[i]*0.5);
|
|
else val = rounded(fr->decwin_mmx[i]*-0.5);
|
|
if(val > 32767) val = 32767;
|
|
else if(val < -32768) val = -32768;
|
|
ptr[i] = val;
|
|
}
|
|
for(i=512; i<512+32; i++) {
|
|
if(i&1) val = rounded(fr->decwin_mmx[i]*0.5);
|
|
else val = 0;
|
|
if(val > 32767) val = 32767;
|
|
else if(val < -32768) val = -32768;
|
|
ptr[i] = val;
|
|
}
|
|
for(i=0; i<512; i++) {
|
|
val = rounded(fr->decwin_mmx[511-i]*-0.5);
|
|
if(val > 32767) val = 32767;
|
|
else if(val < -32768) val = -32768;
|
|
ptr[512+32+i] = val;
|
|
}
|
|
debug("decode tables done");
|
|
}
|
|
#endif
|
|
#endif
|
|
|
|
#ifdef REAL_IS_FIXED
|
|
/* Need saturating multiplication that keeps table values in 32 bit range,
|
|
with the option to swap sign at will (so -2**31 is out).
|
|
This code is far from the decoder core and so assembly optimization might
|
|
be overkill. */
|
|
static int32_t sat_mul32(int32_t a, int32_t b)
|
|
{
|
|
int64_t prod = (int64_t)a * (int64_t)b;
|
|
/* TODO: record the clipping? An extra flag? */
|
|
if(prod > 2147483647L) return 2147483647L;
|
|
if(prod < -2147483647L) return -2147483647L;
|
|
return (int32_t)prod;
|
|
}
|
|
#endif
|
|
|
|
void make_decode_tables(mpg123_handle *fr)
|
|
{
|
|
int i,j;
|
|
int idx = 0;
|
|
double scaleval;
|
|
#ifdef REAL_IS_FIXED
|
|
real scaleval_long;
|
|
#endif
|
|
/* Scale is always based on 1.0 . */
|
|
scaleval = -0.5*(fr->lastscale < 0 ? fr->p.outscale : fr->lastscale);
|
|
debug1("decode tables with scaleval %g", scaleval);
|
|
#ifdef REAL_IS_FIXED
|
|
scaleval_long = DOUBLE_TO_REAL_15(scaleval);
|
|
debug1("decode table with fixed scaleval %li", (long)scaleval_long);
|
|
if(scaleval_long > 28618 || scaleval_long < -28618)
|
|
{
|
|
/* TODO: Limit the scaleval itself or limit the multiplication afterwards?
|
|
The former basically disables significant amplification for fixed-point
|
|
decoders, but avoids (possibly subtle) distortion. */
|
|
/* This would limit the amplification instead:
|
|
scaleval_long = scaleval_long < 0 ? -28618 : 28618; */
|
|
if(NOQUIET) warning("Desired amplification may introduce distortion.");
|
|
}
|
|
#endif
|
|
for(i=0,j=0;i<256;i++,j++,idx+=32)
|
|
{
|
|
if(idx < 512+16)
|
|
#ifdef REAL_IS_FIXED
|
|
fr->decwin[idx+16] = fr->decwin[idx] =
|
|
REAL_SCALE_WINDOW(sat_mul32(intwinbase[j],scaleval_long));
|
|
#else
|
|
fr->decwin[idx+16] = fr->decwin[idx] = DOUBLE_TO_REAL((double) intwinbase[j] * scaleval);
|
|
#endif
|
|
|
|
if(i % 32 == 31)
|
|
idx -= 1023;
|
|
if(i % 64 == 63)
|
|
#ifdef REAL_IS_FIXED
|
|
scaleval_long = - scaleval_long;
|
|
#else
|
|
scaleval = - scaleval;
|
|
#endif
|
|
}
|
|
|
|
for( /* i=256 */ ;i<512;i++,j--,idx+=32)
|
|
{
|
|
if(idx < 512+16)
|
|
#ifdef REAL_IS_FIXED
|
|
fr->decwin[idx+16] = fr->decwin[idx] =
|
|
REAL_SCALE_WINDOW(sat_mul32(intwinbase[j],scaleval_long));
|
|
#else
|
|
fr->decwin[idx+16] = fr->decwin[idx] = DOUBLE_TO_REAL((double) intwinbase[j] * scaleval);
|
|
#endif
|
|
|
|
if(i % 32 == 31)
|
|
idx -= 1023;
|
|
if(i % 64 == 63)
|
|
#ifdef REAL_IS_FIXED
|
|
scaleval_long = - scaleval_long;
|
|
#else
|
|
scaleval = - scaleval;
|
|
#endif
|
|
}
|
|
#if defined(OPT_X86_64) || defined(OPT_ALTIVEC) || defined(OPT_SSE) || defined(OPT_SSE_VINTAGE) || defined(OPT_ARM) || defined(OPT_NEON) || defined(OPT_NEON64) || defined(OPT_AVX)
|
|
if( fr->cpu_opts.type == x86_64
|
|
|| fr->cpu_opts.type == altivec
|
|
|| fr->cpu_opts.type == sse
|
|
|| fr->cpu_opts.type == sse_vintage
|
|
|| fr->cpu_opts.type == arm
|
|
|| fr->cpu_opts.type == neon
|
|
|| fr->cpu_opts.type == neon64
|
|
|| fr->cpu_opts.type == avx )
|
|
{ /* for float SSE / AltiVec / ARM decoder */
|
|
for(i=512; i<512+32; i++)
|
|
{
|
|
fr->decwin[i] = (i&1) ? fr->decwin[i] : 0;
|
|
}
|
|
for(i=0; i<512; i++)
|
|
{
|
|
fr->decwin[512+32+i] = -fr->decwin[511-i];
|
|
}
|
|
#if defined(OPT_NEON) || defined(OPT_NEON64)
|
|
if(fr->cpu_opts.type == neon || fr->cpu_opts.type == neon64)
|
|
{
|
|
for(i=0; i<512; i+=2)
|
|
{
|
|
fr->decwin[i] = -fr->decwin[i];
|
|
}
|
|
}
|
|
#endif
|
|
}
|
|
#endif
|
|
debug("decode tables done");
|
|
}
|
|
|
|
#ifndef NO_8BIT
|
|
int make_conv16to8_table(mpg123_handle *fr)
|
|
{
|
|
int i;
|
|
int mode = fr->af.dec_enc;
|
|
|
|
/*
|
|
* ????: 8.0 is right but on SB cards '2.0' is a better value ???
|
|
*/
|
|
const double mul = 8.0;
|
|
|
|
if(!fr->conv16to8_buf){
|
|
fr->conv16to8_buf = (unsigned char *) malloc(8192);
|
|
if(!fr->conv16to8_buf) {
|
|
fr->err = MPG123_ERR_16TO8TABLE;
|
|
if(NOQUIET) error("Can't allocate 16 to 8 converter table!");
|
|
return -1;
|
|
}
|
|
fr->conv16to8 = fr->conv16to8_buf + 4096;
|
|
}
|
|
|
|
switch(mode)
|
|
{
|
|
case MPG123_ENC_ULAW_8:
|
|
{
|
|
double m=127.0 / log(256.0);
|
|
int c1;
|
|
|
|
for(i=-4096;i<4096;i++)
|
|
{
|
|
/* dunno whether this is a valid transformation rule ?!?!? */
|
|
if(i < 0)
|
|
c1 = 127 - (int) (log( 1.0 - 255.0 * (double) i*mul / 32768.0 ) * m);
|
|
else
|
|
c1 = 255 - (int) (log( 1.0 + 255.0 * (double) i*mul / 32768.0 ) * m);
|
|
if(c1 < 0 || c1 > 255)
|
|
{
|
|
if(NOQUIET) error2("Converror %d %d",i,c1);
|
|
return -1;
|
|
}
|
|
if(c1 == 0)
|
|
c1 = 2;
|
|
fr->conv16to8[i] = (unsigned char) c1;
|
|
}
|
|
}
|
|
break;
|
|
case MPG123_ENC_SIGNED_8:
|
|
for(i=-4096;i<4096;i++)
|
|
fr->conv16to8[i] = i>>5;
|
|
break;
|
|
case MPG123_ENC_UNSIGNED_8:
|
|
for(i=-4096;i<4096;i++)
|
|
fr->conv16to8[i] = (i>>5)+128;
|
|
break;
|
|
case MPG123_ENC_ALAW_8:
|
|
{
|
|
/*
|
|
Let's believe Wikipedia (http://en.wikipedia.org/wiki/G.711) that this
|
|
is the correct table:
|
|
|
|
s0000000wxyza... n000wxyz [0-31] -> [0-15]
|
|
s0000001wxyza... n001wxyz [32-63] -> [16-31]
|
|
s000001wxyzab... n010wxyz [64-127] -> [32-47]
|
|
s00001wxyzabc... n011wxyz [128-255] -> [48-63]
|
|
s0001wxyzabcd... n100wxyz [256-511] -> [64-79]
|
|
s001wxyzabcde... n101wxyz [512-1023] -> [80-95]
|
|
s01wxyzabcdef... n110wxyz [1024-2047] -> [96-111]
|
|
s1wxyzabcdefg... n111wxyz [2048-4095] -> [112-127]
|
|
|
|
Let's extend to -4096, too.
|
|
Also, bytes are xored with 0x55 for transmission.
|
|
|
|
Since it sounds OK, I assume it is fine;-)
|
|
*/
|
|
for(i=0; i<64; ++i)
|
|
fr->conv16to8[i] = ((unsigned int)i)>>1;
|
|
for(i=64; i<128; ++i)
|
|
fr->conv16to8[i] = ((((unsigned int)i)>>2) & 0xf) | (2<<4);
|
|
for(i=128; i<256; ++i)
|
|
fr->conv16to8[i] = ((((unsigned int)i)>>3) & 0xf) | (3<<4);
|
|
for(i=256; i<512; ++i)
|
|
fr->conv16to8[i] = ((((unsigned int)i)>>4) & 0xf) | (4<<4);
|
|
for(i=512; i<1024; ++i)
|
|
fr->conv16to8[i] = ((((unsigned int)i)>>5) & 0xf) | (5<<4);
|
|
for(i=1024; i<2048; ++i)
|
|
fr->conv16to8[i] = ((((unsigned int)i)>>6) & 0xf) | (6<<4);
|
|
for(i=2048; i<4096; ++i)
|
|
fr->conv16to8[i] = ((((unsigned int)i)>>7) & 0xf) | (7<<4);
|
|
|
|
for(i=-4095; i<0; ++i)
|
|
fr->conv16to8[i] = fr->conv16to8[-i] | 0x80;
|
|
|
|
fr->conv16to8[-4096] = fr->conv16to8[-4095];
|
|
|
|
for(i=-4096;i<4096;i++)
|
|
{
|
|
/* fr->conv16to8[i] = - i>>5; */
|
|
/* fprintf(stderr, "table %i %i\n", i<<AUSHIFT, fr->conv16to8[i]); */
|
|
fr->conv16to8[i] ^= 0x55;
|
|
}
|
|
}
|
|
break;
|
|
default:
|
|
fr->err = MPG123_ERR_16TO8TABLE;
|
|
if(NOQUIET) error("Unknown 8 bit encoding choice.");
|
|
return -1;
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
#endif
|
|
|