/*

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