225 lines
10 KiB
C
225 lines
10 KiB
C
|
/*
|
||
|
|
* decode_i396.c: Mpeg Layer-1,2,3 audio decoder
|
||
|
|
*
|
||
|
|
* Copyright (C) 1999-2010 The L.A.M.E. project
|
||
|
|
*
|
||
|
|
* Initially written by Michael Hipp, see also AUTHORS and README.
|
||
|
|
*
|
||
|
|
* This library is free software; you can redistribute it and/or
|
||
|
|
* modify it under the terms of the GNU Library General Public
|
||
|
|
* License as published by the Free Software Foundation; either
|
||
|
|
* version 2 of the License, or (at your option) any later version.
|
||
|
|
*
|
||
|
|
* This library 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
|
||
|
|
* Library General Public License for more details.
|
||
|
|
*
|
||
|
|
* You should have received a copy of the GNU Library General Public
|
||
|
|
* License along with this library; if not, write to the
|
||
|
|
* Free Software Foundation, Inc., 59 Temple Place - Suite 330,
|
||
|
|
* Boston, MA 02111-1307, USA.
|
||
|
|
*
|
||
|
|
*
|
||
|
|
* Slighlty optimized for machines without autoincrement/decrement.
|
||
|
|
* The performance is highly compiler dependend. Maybe
|
||
|
|
* the decode.c version for 'normal' processor may be faster
|
||
|
|
* even for Intel processors.
|
||
|
|
*/
|
||
|
|
|
||
|
|
/* $Id: decode_i386.c,v 1.22 2010/03/22 14:30:19 robert Exp $ */
|
||
|
|
|
||
|
|
#ifdef HAVE_CONFIG_H
|
||
|
|
#include <config.h>
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef STDC_HEADERS
|
||
|
|
# include <stdlib.h>
|
||
|
|
# include <string.h>
|
||
|
|
#else
|
||
|
|
# ifndef HAVE_STRCHR
|
||
|
|
# define strchr index
|
||
|
|
# define strrchr rindex
|
||
|
|
# endif
|
||
|
|
char *strchr(), *strrchr();
|
||
|
|
# ifndef HAVE_MEMCPY
|
||
|
|
# define memcpy(d, s, n) bcopy ((s), (d), (n))
|
||
|
|
# define memmove(d, s, n) bcopy ((s), (d), (n))
|
||
|
|
# endif
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#if defined(__riscos__) && defined(FPA10)
|
||
|
|
#include "ymath.h"
|
||
|
|
#else
|
||
|
|
#include <math.h>
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#include "decode_i386.h"
|
||
|
|
#include "dct64_i386.h"
|
||
|
|
#include "tabinit.h"
|
||
|
|
|
||
|
|
#ifdef WITH_DMALLOC
|
||
|
|
#include <dmalloc.h>
|
||
|
|
#endif
|
||
|
|
|
||
|
|
|
||
|
|
/* old WRITE_SAMPLE_CLIPPED */
|
||
|
|
#define WRITE_SAMPLE_CLIPPED(TYPE,samples,sum,clip) \
|
||
|
|
if( (sum) > 32767.0) { *(samples) = 0x7fff; (clip)++; } \
|
||
|
|
else if( (sum) < -32768.0) { *(samples) = -0x8000; (clip)++; } \
|
||
|
|
else { *(samples) = (TYPE)((sum)>0 ? (sum)+0.5 : (sum)-0.5) ; }
|
||
|
|
|
||
|
|
#define WRITE_SAMPLE_UNCLIPPED(TYPE,samples,sum,clip) \
|
||
|
|
*samples = (TYPE)sum;
|
||
|
|
|
||
|
|
/* *INDENT-OFF* */
|
||
|
|
|
||
|
|
/* versions: clipped (when TYPE == short) and unclipped (when TYPE == real) of synth_1to1_mono* functions */
|
||
|
|
#define SYNTH_1TO1_MONO_CLIPCHOICE(TYPE,SYNTH_1TO1) \
|
||
|
|
TYPE samples_tmp[64]; \
|
||
|
|
TYPE *tmp1 = samples_tmp; \
|
||
|
|
int i,ret; \
|
||
|
|
int pnt1 = 0; \
|
||
|
|
\
|
||
|
|
ret = SYNTH_1TO1 (mp,bandPtr,0,(unsigned char *) samples_tmp,&pnt1); \
|
||
|
|
out += *pnt; \
|
||
|
|
\
|
||
|
|
for(i=0;i<32;i++) { \
|
||
|
|
*( (TYPE *) out) = *tmp1; \
|
||
|
|
out += sizeof(TYPE); \
|
||
|
|
tmp1 += 2; \
|
||
|
|
} \
|
||
|
|
*pnt += 32*sizeof(TYPE); \
|
||
|
|
\
|
||
|
|
return ret;
|
||
|
|
|
||
|
|
/* *INDENT-ON* */
|
||
|
|
|
||
|
|
|
||
|
|
int
|
||
|
|
synth_1to1_mono(PMPSTR mp, real * bandPtr, unsigned char *out, int *pnt)
|
||
|
|
{
|
||
|
|
SYNTH_1TO1_MONO_CLIPCHOICE(short, synth_1to1)
|
||
|
|
} int
|
||
|
|
synth_1to1_mono_unclipped(PMPSTR mp, real * bandPtr, unsigned char *out, int *pnt)
|
||
|
|
{
|
||
|
|
SYNTH_1TO1_MONO_CLIPCHOICE(real, synth_1to1_unclipped)
|
||
|
|
}
|
||
|
|
|
||
|
|
/* *INDENT-OFF* */
|
||
|
|
/* versions: clipped (when TYPE == short) and unclipped (when TYPE == real) of synth_1to1* functions */
|
||
|
|
#define SYNTH_1TO1_CLIPCHOICE(TYPE,WRITE_SAMPLE) \
|
||
|
|
static const int step = 2; \
|
||
|
|
int bo; \
|
||
|
|
TYPE *samples = (TYPE *) (out + *pnt); \
|
||
|
|
\
|
||
|
|
real *b0,(*buf)[0x110]; \
|
||
|
|
int clip = 0; \
|
||
|
|
int bo1; \
|
||
|
|
\
|
||
|
|
bo = mp->synth_bo; \
|
||
|
|
\
|
||
|
|
if(!channel) { \
|
||
|
|
bo--; \
|
||
|
|
bo &= 0xf; \
|
||
|
|
buf = mp->synth_buffs[0]; \
|
||
|
|
} \
|
||
|
|
else { \
|
||
|
|
samples++; \
|
||
|
|
buf = mp->synth_buffs[1]; \
|
||
|
|
} \
|
||
|
|
\
|
||
|
|
if(bo & 0x1) { \
|
||
|
|
b0 = buf[0]; \
|
||
|
|
bo1 = bo; \
|
||
|
|
dct64(buf[1]+((bo+1)&0xf),buf[0]+bo,bandPtr); \
|
||
|
|
} \
|
||
|
|
else { \
|
||
|
|
b0 = buf[1]; \
|
||
|
|
bo1 = bo+1; \
|
||
|
|
dct64(buf[0]+bo,buf[1]+bo+1,bandPtr); \
|
||
|
|
} \
|
||
|
|
\
|
||
|
|
mp->synth_bo = bo; \
|
||
|
|
\
|
||
|
|
{ \
|
||
|
|
int j; \
|
||
|
|
real *window = decwin + 16 - bo1; \
|
||
|
|
\
|
||
|
|
for (j=16;j;j--,b0+=0x10,window+=0x20,samples+=step) \
|
||
|
|
{ \
|
||
|
|
real sum; \
|
||
|
|
sum = window[0x0] * b0[0x0]; \
|
||
|
|
sum -= window[0x1] * b0[0x1]; \
|
||
|
|
sum += window[0x2] * b0[0x2]; \
|
||
|
|
sum -= window[0x3] * b0[0x3]; \
|
||
|
|
sum += window[0x4] * b0[0x4]; \
|
||
|
|
sum -= window[0x5] * b0[0x5]; \
|
||
|
|
sum += window[0x6] * b0[0x6]; \
|
||
|
|
sum -= window[0x7] * b0[0x7]; \
|
||
|
|
sum += window[0x8] * b0[0x8]; \
|
||
|
|
sum -= window[0x9] * b0[0x9]; \
|
||
|
|
sum += window[0xA] * b0[0xA]; \
|
||
|
|
sum -= window[0xB] * b0[0xB]; \
|
||
|
|
sum += window[0xC] * b0[0xC]; \
|
||
|
|
sum -= window[0xD] * b0[0xD]; \
|
||
|
|
sum += window[0xE] * b0[0xE]; \
|
||
|
|
sum -= window[0xF] * b0[0xF]; \
|
||
|
|
\
|
||
|
|
WRITE_SAMPLE (TYPE,samples,sum,clip); \
|
||
|
|
} \
|
||
|
|
\
|
||
|
|
{ \
|
||
|
|
real sum; \
|
||
|
|
sum = window[0x0] * b0[0x0]; \
|
||
|
|
sum += window[0x2] * b0[0x2]; \
|
||
|
|
sum += window[0x4] * b0[0x4]; \
|
||
|
|
sum += window[0x6] * b0[0x6]; \
|
||
|
|
sum += window[0x8] * b0[0x8]; \
|
||
|
|
sum += window[0xA] * b0[0xA]; \
|
||
|
|
sum += window[0xC] * b0[0xC]; \
|
||
|
|
sum += window[0xE] * b0[0xE]; \
|
||
|
|
WRITE_SAMPLE (TYPE,samples,sum,clip); \
|
||
|
|
b0-=0x10,window-=0x20,samples+=step; \
|
||
|
|
} \
|
||
|
|
window += bo1<<1; \
|
||
|
|
\
|
||
|
|
for (j=15;j;j--,b0-=0x10,window-=0x20,samples+=step) \
|
||
|
|
{ \
|
||
|
|
real sum; \
|
||
|
|
sum = -window[-0x1] * b0[0x0]; \
|
||
|
|
sum -= window[-0x2] * b0[0x1]; \
|
||
|
|
sum -= window[-0x3] * b0[0x2]; \
|
||
|
|
sum -= window[-0x4] * b0[0x3]; \
|
||
|
|
sum -= window[-0x5] * b0[0x4]; \
|
||
|
|
sum -= window[-0x6] * b0[0x5]; \
|
||
|
|
sum -= window[-0x7] * b0[0x6]; \
|
||
|
|
sum -= window[-0x8] * b0[0x7]; \
|
||
|
|
sum -= window[-0x9] * b0[0x8]; \
|
||
|
|
sum -= window[-0xA] * b0[0x9]; \
|
||
|
|
sum -= window[-0xB] * b0[0xA]; \
|
||
|
|
sum -= window[-0xC] * b0[0xB]; \
|
||
|
|
sum -= window[-0xD] * b0[0xC]; \
|
||
|
|
sum -= window[-0xE] * b0[0xD]; \
|
||
|
|
sum -= window[-0xF] * b0[0xE]; \
|
||
|
|
sum -= window[-0x0] * b0[0xF]; \
|
||
|
|
\
|
||
|
|
WRITE_SAMPLE (TYPE,samples,sum,clip); \
|
||
|
|
} \
|
||
|
|
} \
|
||
|
|
*pnt += 64*sizeof(TYPE); \
|
||
|
|
\
|
||
|
|
return clip;
|
||
|
|
/* *INDENT-ON* */
|
||
|
|
|
||
|
|
|
||
|
|
int
|
||
|
|
synth_1to1(PMPSTR mp, real * bandPtr, int channel, unsigned char *out, int *pnt)
|
||
|
|
{
|
||
|
|
SYNTH_1TO1_CLIPCHOICE(short, WRITE_SAMPLE_CLIPPED)
|
||
|
|
} int
|
||
|
|
synth_1to1_unclipped(PMPSTR mp, real * bandPtr, int channel, unsigned char *out, int *pnt)
|
||
|
|
{
|
||
|
|
SYNTH_1TO1_CLIPCHOICE(real, WRITE_SAMPLE_UNCLIPPED)
|
||
|
|
}
|