/*

  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 "../common/debug.h"

// The (normally precomputed) cos tables.

#include "costabs.h"

#ifdef RUNTIME_TABLES

#include "init_costabs.h"

#else

const

#endif

real *INT123_pnts[] = { cos64,cos32,cos16,cos8,cos4 };

static const 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 };

#ifdef OPT_MMXORSSE

#if !defined(OPT_X86_64) && !defined(OPT_NEON) && !defined(OPT_NEON64) && !defined(OPT_AVX)

void INT123_make_decode_tables_mmx_asm(long scaleval, float* decwin_mmx, float *decwins);

void INT123_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. */

  INT123_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 INT123_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 INT123_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 INT123_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