[pcsx_rearmed.git] / plugins / dfsound / xa.c

/***************************************************************************
                            xa.c  -  description
                             -------------------
    begin                : Wed May 15 2002
    copyright            : (C) 2002 by Pete Bernert
    email                : BlackDove@addcom.de
 ***************************************************************************/
/***************************************************************************
 *                                                                         *
 *   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. See also the license.txt file for *
 *   additional informations.                                              *
 *                                                                         *
 ***************************************************************************/

#include "stdafx.h"
#include "spu.h"
#define _IN_XA
#include <stdint.h>
#include "psemu_plugin_defs.h"

// will be included from spu.c
#ifdef _IN_SPU

////////////////////////////////////////////////////////////////////////
// XA GLOBALS
////////////////////////////////////////////////////////////////////////

static int gauss_ptr = 0;
static int gauss_window[8] = {0, 0, 0, 0, 0, 0, 0, 0};

#define gvall0 gauss_window[gauss_ptr]
#define gvall(x) gauss_window[(gauss_ptr+x)&3]
#define gvalr0 gauss_window[4+gauss_ptr]
#define gvalr(x) gauss_window[4+((gauss_ptr+x)&3)]

////////////////////////////////////////////////////////////////////////
// MIX XA & CDDA
////////////////////////////////////////////////////////////////////////

INLINE void SkipCD(int ns_to, int decode_pos)
{
 int cursor = decode_pos;
 int ns;

 if(spu.XAPlay != spu.XAFeed)
 {
  for(ns = 0; ns < ns_to*2; ns += 2)
   {
    if(spu.XAPlay != spu.XAFeed) spu.XAPlay++;
    if(spu.XAPlay == spu.XAEnd) spu.XAPlay=spu.XAStart;

    spu.spuMem[cursor] = 0;
    spu.spuMem[cursor + 0x400/2] = 0;
    cursor = (cursor + 1) & 0x1ff;
   }
 }
 else if(spu.CDDAPlay != spu.CDDAFeed)
 {
  for(ns = 0; ns < ns_to*2; ns += 2)
   {
    if(spu.CDDAPlay != spu.CDDAFeed) spu.CDDAPlay++;
    if(spu.CDDAPlay == spu.CDDAEnd) spu.CDDAPlay=spu.CDDAStart;

    spu.spuMem[cursor] = 0;
    spu.spuMem[cursor + 0x400/2] = 0;
    cursor = (cursor + 1) & 0x1ff;
   }
 }
 spu.XALastVal = 0;
}

INLINE void MixCD(int *SSumLR, int *RVB, int ns_to, int decode_pos)
{
 int vll = spu.iLeftXAVol * spu.cdv.ll >> 7;
 int vrl = spu.iLeftXAVol * spu.cdv.rl >> 7;
 int vlr = spu.iRightXAVol * spu.cdv.lr >> 7;
 int vrr = spu.iRightXAVol * spu.cdv.rr >> 7;
 int cursor = decode_pos;
 int l1, r1, l, r;
 int ns;
 uint32_t v = spu.XALastVal;

 // note: spu volume doesn't affect cd capture
 if ((spu.cdv.ll | spu.cdv.lr | spu.cdv.rl | spu.cdv.rr) == 0)
 {
  SkipCD(ns_to, decode_pos);
  return;
 }

 if(spu.XAPlay != spu.XAFeed || spu.XARepeat > 0)
 {
  if(spu.XAPlay == spu.XAFeed)
   spu.XARepeat--;

  for(ns = 0; ns < ns_to*2; ns += 2)
   {
    if(spu.XAPlay != spu.XAFeed) v=*spu.XAPlay++;
    if(spu.XAPlay == spu.XAEnd) spu.XAPlay=spu.XAStart;

    l1 = (short)v, r1 = (short)(v >> 16);
    l = (l1 * vll + r1 * vrl) >> 15;
    r = (r1 * vrr + l1 * vlr) >> 15;
    ssat32_to_16(l);
    ssat32_to_16(r);
    if (spu.spuCtrl & CTRL_CD)
    {
     SSumLR[ns+0] += l;
     SSumLR[ns+1] += r;
    }
    if (unlikely(spu.spuCtrl & CTRL_CDREVERB))
    {
     RVB[ns+0] += l;
     RVB[ns+1] += r;
    }

    spu.spuMem[cursor] = HTOLE16(v);
    spu.spuMem[cursor + 0x400/2] = HTOLE16(v >> 16);
    cursor = (cursor + 1) & 0x1ff;
   }
  spu.XALastVal = v;
 }
 // occasionally CDDAFeed underflows by a few samples due to poor timing,
 // hence this 'ns_to < 8'
 else if(spu.CDDAPlay != spu.CDDAFeed || ns_to < 8)
 {
  for(ns = 0; ns < ns_to*2; ns += 2)
   {
    if(spu.CDDAPlay != spu.CDDAFeed) v=*spu.CDDAPlay++;
    if(spu.CDDAPlay == spu.CDDAEnd) spu.CDDAPlay=spu.CDDAStart;

    l1 = (short)v, r1 = (short)(v >> 16);
    l = (l1 * vll + r1 * vrl) >> 15;
    r = (r1 * vrr + l1 * vlr) >> 15;
    ssat32_to_16(l);
    ssat32_to_16(r);
    if (spu.spuCtrl & CTRL_CD)
    {
     SSumLR[ns+0] += l;
     SSumLR[ns+1] += r;
    }
    if (unlikely(spu.spuCtrl & CTRL_CDREVERB))
    {
     RVB[ns+0] += l;
     RVB[ns+1] += r;
    }

    spu.spuMem[cursor] = HTOLE16(v);
    spu.spuMem[cursor + 0x400/2] = HTOLE16(v >> 16);
    cursor = (cursor + 1) & 0x1ff;
   }
  spu.XALastVal = v;
 }
 else if (spu.cdClearSamples > 0)
 {
  for(ns = 0; ns < ns_to; ns++)
   {
    spu.spuMem[cursor] = spu.spuMem[cursor + 0x400/2] = 0;
    cursor = (cursor + 1) & 0x1ff;
   }
  spu.cdClearSamples -= ns_to;
  spu.XALastVal = 0;
 }
}

////////////////////////////////////////////////////////////////////////
// small linux time helper... only used for watchdog
////////////////////////////////////////////////////////////////////////

#if 0
static unsigned long timeGetTime_spu()
{
#if defined(NO_OS)
 return 0;
#elif defined(_WIN32)
 return GetTickCount();
#else
 struct timeval tv;
 gettimeofday(&tv, 0);                                 // well, maybe there are better ways
 return tv.tv_sec * 1000 + tv.tv_usec/1000;            // to do that, but at least it works
#endif
}
#endif

////////////////////////////////////////////////////////////////////////
// FEED XA 
////////////////////////////////////////////////////////////////////////

void FeedXA(const xa_decode_t *xap)
{
 int sinc,spos,i,iSize,iPlace,vl,vr;

 if(!spu.bSPUIsOpen) return;

 spu.XARepeat  = 3;                                    // set up repeat

#if 0//def XA_HACK
 iSize=((45500*xap->nsamples)/xap->freq);              // get size
#else
 iSize=((44100*xap->nsamples)/xap->freq);              // get size
#endif
 if(!iSize) return;                                    // none? bye

 if(spu.XAFeed<spu.XAPlay) iPlace=spu.XAPlay-spu.XAFeed; // how much space in my buf?
 else              iPlace=(spu.XAEnd-spu.XAFeed) + (spu.XAPlay-spu.XAStart);

 if(iPlace==0) return;                                 // no place at all

 //----------------------------------------------------//
#if 0
 if(spu_config.iXAPitch)                               // pitch change option?
  {
   static DWORD dwLT=0;
   static DWORD dwFPS=0;
   static int   iFPSCnt=0;
   static int   iLastSize=0;
   static DWORD dwL1=0;
   DWORD dw=timeGetTime_spu(),dw1,dw2;

   iPlace=iSize;

   dwFPS+=dw-dwLT;iFPSCnt++;

   dwLT=dw;
                                       
   if(iFPSCnt>=10)
    {
     if(!dwFPS) dwFPS=1;
     dw1=1000000/dwFPS; 
     if(dw1>=(dwL1-100) && dw1<=(dwL1+100)) dw1=dwL1;
     else dwL1=dw1;
     dw2=(xap->freq*100/xap->nsamples);
     if((!dw1)||((dw2+100)>=dw1)) iLastSize=0;
     else
      {
       iLastSize=iSize*dw2/dw1;
       if(iLastSize>iPlace) iLastSize=iPlace;
       iSize=iLastSize;
      }
     iFPSCnt=0;dwFPS=0;
    }
   else
    {
     if(iLastSize) iSize=iLastSize;
    }
  }
#endif
 //----------------------------------------------------//

 spos=0x10000L;
 sinc = (xap->nsamples << 16) / iSize;                 // calc freq by num / size

 if(xap->stereo)
{
   uint32_t * pS=(uint32_t *)xap->pcm;
   uint32_t l=0;

#if 0
   if(spu_config.iXAPitch)
    {
     int32_t l1,l2;short s;
     for(i=0;i<iSize;i++)
      {
       if(spu_config.iUseInterpolation==2)
        {
         while(spos>=0x10000L)
          {
           l = *pS++;
           gauss_window[gauss_ptr] = (short)LOWORD(l);
           gauss_window[4+gauss_ptr] = (short)HIWORD(l);
           gauss_ptr = (gauss_ptr+1) & 3;
           spos -= 0x10000L;
          }
         vl = (spos >> 6) & ~3;
         vr=(gauss[vl]*gvall0) >> 15;
         vr+=(gauss[vl+1]*gvall(1)) >> 15;
         vr+=(gauss[vl+2]*gvall(2)) >> 15;
         vr+=(gauss[vl+3]*gvall(3)) >> 15;
         l= vr & 0xffff;
         vr=(gauss[vl]*gvalr0) >> 15;
         vr+=(gauss[vl+1]*gvalr(1)) >> 15;
         vr+=(gauss[vl+2]*gvalr(2)) >> 15;
         vr+=(gauss[vl+3]*gvalr(3)) >> 15;
         l |= vr << 16;
        }
       else
        {
         while(spos>=0x10000L)
          {
           l = *pS++;
           spos -= 0x10000L;
          }
        }

       s=(short)LOWORD(l);
       l1=s;
       l1=(l1*iPlace)/iSize;
       ssat32_to_16(l1);
       s=(short)HIWORD(l);
       l2=s;
       l2=(l2*iPlace)/iSize;
       ssat32_to_16(l2);
       l=(l1&0xffff)|(l2<<16);

       *spu.XAFeed++=l;

       if(spu.XAFeed==spu.XAEnd) spu.XAFeed=spu.XAStart;
       if(spu.XAFeed==spu.XAPlay)
        {
         if(spu.XAPlay!=spu.XAStart) spu.XAFeed=spu.XAPlay-1;
         break;
        }

       spos += sinc;
      }
    }
   else
#endif
    {
     for(i=0;i<iSize;i++)
      {
       if(spu_config.iUseInterpolation==2)
        {
         while(spos>=0x10000L)
          {
           l = *pS++;
           gauss_window[gauss_ptr] = (short)LOWORD(l);
           gauss_window[4+gauss_ptr] = (short)HIWORD(l);
           gauss_ptr = (gauss_ptr+1) & 3;
           spos -= 0x10000L;
          }
         vl = (spos >> 6) & ~3;
         vr=(gauss[vl]*gvall0) >> 15;
         vr+=(gauss[vl+1]*gvall(1)) >> 15;
         vr+=(gauss[vl+2]*gvall(2)) >> 15;
         vr+=(gauss[vl+3]*gvall(3)) >> 15;
         l= vr & 0xffff;
         vr=(gauss[vl]*gvalr0) >> 15;
         vr+=(gauss[vl+1]*gvalr(1)) >> 15;
         vr+=(gauss[vl+2]*gvalr(2)) >> 15;
         vr+=(gauss[vl+3]*gvalr(3)) >> 15;
         l |= vr << 16;
        }
       else
        {
         while(spos>=0x10000L)
          {
           l = *pS++;
           spos -= 0x10000L;
          }
        }

       *spu.XAFeed++=l;

       if(spu.XAFeed==spu.XAEnd) spu.XAFeed=spu.XAStart;
       if(spu.XAFeed==spu.XAPlay)
        {
         if(spu.XAPlay!=spu.XAStart) spu.XAFeed=spu.XAPlay-1;
         break;
        }

       spos += sinc;
      }
    }
  }
 else
  {
   unsigned short * pS=(unsigned short *)xap->pcm;
   uint32_t l;short s=0;

#if 0
   if(spu_config.iXAPitch)
    {
     int32_t l1;
     for(i=0;i<iSize;i++)
      {
       if(spu_config.iUseInterpolation==2)
        {
         while(spos>=0x10000L)
          {
           gauss_window[gauss_ptr] = (short)*pS++;
           gauss_ptr = (gauss_ptr+1) & 3;
           spos -= 0x10000L;
          }
         vl = (spos >> 6) & ~3;
         vr=(gauss[vl]*gvall0) >> 15;
         vr+=(gauss[vl+1]*gvall(1)) >> 15;
         vr+=(gauss[vl+2]*gvall(2)) >> 15;
         vr+=(gauss[vl+3]*gvall(3)) >> 15;
         l1=s= vr;
         l1 &= 0xffff;
        }
       else
        {
         while(spos>=0x10000L)
          {
           s = *pS++;
           spos -= 0x10000L;
          }
         l1=s;
        }

       l1=(l1*iPlace)/iSize;
       ssat32_to_16(l1);
       l=(l1&0xffff)|(l1<<16);
       *spu.XAFeed++=l;

       if(spu.XAFeed==spu.XAEnd) spu.XAFeed=spu.XAStart;
       if(spu.XAFeed==spu.XAPlay)
        {
         if(spu.XAPlay!=spu.XAStart) spu.XAFeed=spu.XAPlay-1;
         break;
        }

       spos += sinc;
      }
    }
   else
#endif
    {
     for(i=0;i<iSize;i++)
      {
       if(spu_config.iUseInterpolation==2)
        {
         while(spos>=0x10000L)
          {
           gauss_window[gauss_ptr] = (short)*pS++;
           gauss_ptr = (gauss_ptr+1) & 3;
           spos -= 0x10000L;
          }
         vl = (spos >> 6) & ~3;
         vr=(gauss[vl]*gvall0) >> 15;
         vr+=(gauss[vl+1]*gvall(1)) >> 15;
         vr+=(gauss[vl+2]*gvall(2)) >> 15;
         vr+=(gauss[vl+3]*gvall(3)) >> 15;
         l=s= vr;
        }
       else
        {
         while(spos>=0x10000L)
          {
           s = *pS++;
           spos -= 0x10000L;
          }
         l=s;
        }

       l &= 0xffff;
       *spu.XAFeed++=(l|(l<<16));

       if(spu.XAFeed==spu.XAEnd) spu.XAFeed=spu.XAStart;
       if(spu.XAFeed==spu.XAPlay)
        {
         if(spu.XAPlay!=spu.XAStart) spu.XAFeed=spu.XAPlay-1;
         break;
        }

       spos += sinc;
      }
    }
  }
}

////////////////////////////////////////////////////////////////////////
// FEED CDDA
////////////////////////////////////////////////////////////////////////

void FeedCDDA(unsigned char *pcm, int nBytes)
{
 int space;
 space=(spu.CDDAPlay-spu.CDDAFeed-1)*4 & (CDDA_BUFFER_SIZE - 1);
 if (space < nBytes) {
  log_unhandled("FeedCDDA: %d/%d\n", nBytes, space);
  return;
 }

 while(nBytes>0)
  {
   if(spu.CDDAFeed==spu.CDDAEnd) spu.CDDAFeed=spu.CDDAStart;
   space=(spu.CDDAPlay-spu.CDDAFeed-1)*4 & (CDDA_BUFFER_SIZE - 1);
   if(spu.CDDAFeed+space/4>spu.CDDAEnd)
    space=(spu.CDDAEnd-spu.CDDAFeed)*4;
   if(space>nBytes)
    space=nBytes;

   memcpy(spu.CDDAFeed,pcm,space);
   spu.CDDAFeed+=space/4;
   nBytes-=space;
   pcm+=space;
  }
}

#endif
// vim:shiftwidth=1:expandtab
Commit	Line	Data
ef79bbde P	1	/***************************************************************************
	2	xa.c - description
	3	-------------------
	4	begin : Wed May 15 2002
	5	copyright : (C) 2002 by Pete Bernert
	6	email : BlackDove@addcom.de
	7	***************************************************************************/
	8	/***************************************************************************
	9	* *
	10	* This program is free software; you can redistribute it and/or modify *
	11	* it under the terms of the GNU General Public License as published by *
	12	* the Free Software Foundation; either version 2 of the License, or *
	13	* (at your option) any later version. See also the license.txt file for *
	14	* additional informations. *
	15	* *
	16	***************************************************************************/
	17
	18	#include "stdafx.h"
a4621d43	19	#include "spu.h"
ef79bbde P	20	#define _IN_XA
ef79bbde P	21	#include <stdint.h>
f06cf4a2	22	#include "psemu_plugin_defs.h"
ef79bbde P	23
	24	// will be included from spu.c
	25	#ifdef _IN_SPU
	26
	27	////////////////////////////////////////////////////////////////////////
	28	// XA GLOBALS
	29	////////////////////////////////////////////////////////////////////////
	30
ef79bbde P	31	static int gauss_ptr = 0;
	32	static int gauss_window[8] = {0, 0, 0, 0, 0, 0, 0, 0};
	33
	34	#define gvall0 gauss_window[gauss_ptr]
	35	#define gvall(x) gauss_window[(gauss_ptr+x)&3]
	36	#define gvalr0 gauss_window[4+gauss_ptr]
	37	#define gvalr(x) gauss_window[4+((gauss_ptr+x)&3)]
	38
	39	////////////////////////////////////////////////////////////////////////
	40	// MIX XA & CDDA
	41	////////////////////////////////////////////////////////////////////////
	42
38b8a211	43	INLINE void SkipCD(int ns_to, int decode_pos)
ef79bbde	44	{
215ff9e6	45	int cursor = decode_pos;
ef79bbde	46	int ns;
38b8a211	47
	48	if(spu.XAPlay != spu.XAFeed)
	49	{
	50	for(ns = 0; ns < ns_to*2; ns += 2)
	51	{
	52	if(spu.XAPlay != spu.XAFeed) spu.XAPlay++;
	53	if(spu.XAPlay == spu.XAEnd) spu.XAPlay=spu.XAStart;
	54
	55	spu.spuMem[cursor] = 0;
	56	spu.spuMem[cursor + 0x400/2] = 0;
	57	cursor = (cursor + 1) & 0x1ff;
	58	}
	59	}
	60	else if(spu.CDDAPlay != spu.CDDAFeed)
	61	{
	62	for(ns = 0; ns < ns_to*2; ns += 2)
	63	{
	64	if(spu.CDDAPlay != spu.CDDAFeed) spu.CDDAPlay++;
	65	if(spu.CDDAPlay == spu.CDDAEnd) spu.CDDAPlay=spu.CDDAStart;
	66
	67	spu.spuMem[cursor] = 0;
	68	spu.spuMem[cursor + 0x400/2] = 0;
	69	cursor = (cursor + 1) & 0x1ff;
	70	}
	71	}
	72	spu.XALastVal = 0;
	73	}
	74
	75	INLINE void MixCD(int SSumLR, int RVB, int ns_to, int decode_pos)
	76	{
	77	int vll = spu.iLeftXAVol * spu.cdv.ll >> 7;
	78	int vrl = spu.iLeftXAVol * spu.cdv.rl >> 7;
	79	int vlr = spu.iRightXAVol * spu.cdv.lr >> 7;
	80	int vrr = spu.iRightXAVol * spu.cdv.rr >> 7;
	81	int cursor = decode_pos;
	82	int l1, r1, l, r;
	83	int ns;
4197fb21	84	uint32_t v = spu.XALastVal;
ef79bbde	85
894cbc49	86	// note: spu volume doesn't affect cd capture
894cbc49	87	if ((spu.cdv.ll \| spu.cdv.lr \| spu.cdv.rl \| spu.cdv.rr) == 0)
38b8a211	88	{
	89	SkipCD(ns_to, decode_pos);
	90	return;
	91	}
	92
3154bfab	93	if(spu.XAPlay != spu.XAFeed \|\| spu.XARepeat > 0)
efce366c	94	{
3154bfab	95	if(spu.XAPlay == spu.XAFeed)
3154bfab	96	spu.XARepeat--;
efce366c	97
73d2a903	98	for(ns = 0; ns < ns_to*2; ns += 2)
efce366c	99	{
3154bfab	100	if(spu.XAPlay != spu.XAFeed) v=*spu.XAPlay++;
3154bfab	101	if(spu.XAPlay == spu.XAEnd) spu.XAPlay=spu.XAStart;
efce366c	102
38b8a211	103	l1 = (short)v, r1 = (short)(v >> 16);
	104	l = (l1 * vll + r1 * vrl) >> 15;
	105	r = (r1 * vrr + l1 * vlr) >> 15;
	106	ssat32_to_16(l);
	107	ssat32_to_16(r);
73d2a903	108	if (spu.spuCtrl & CTRL_CD)
	109	{
	110	SSumLR[ns+0] += l;
	111	SSumLR[ns+1] += r;
	112	}
	113	if (unlikely(spu.spuCtrl & CTRL_CDREVERB))
	114	{
	115	RVB[ns+0] += l;
	116	RVB[ns+1] += r;
	117	}
1d753163	118
a4621d43 PC	119	spu.spuMem[cursor] = HTOLE16(v);
a4621d43 PC	120	spu.spuMem[cursor + 0x400/2] = HTOLE16(v >> 16);
efce366c	121	cursor = (cursor + 1) & 0x1ff;
efce366c	122	}
3154bfab	123	spu.XALastVal = v;
efce366c	124	}
4197fb21	125	// occasionally CDDAFeed underflows by a few samples due to poor timing,
	126	// hence this 'ns_to < 8'
	127	else if(spu.CDDAPlay != spu.CDDAFeed \|\| ns_to < 8)
	128	{
73d2a903	129	for(ns = 0; ns < ns_to*2; ns += 2)
4197fb21	130	{
	131	if(spu.CDDAPlay != spu.CDDAFeed) v=*spu.CDDAPlay++;
	132	if(spu.CDDAPlay == spu.CDDAEnd) spu.CDDAPlay=spu.CDDAStart;
ef79bbde	133
38b8a211	134	l1 = (short)v, r1 = (short)(v >> 16);
	135	l = (l1 * vll + r1 * vrl) >> 15;
	136	r = (r1 * vrr + l1 * vlr) >> 15;
	137	ssat32_to_16(l);
	138	ssat32_to_16(r);
73d2a903	139	if (spu.spuCtrl & CTRL_CD)
	140	{
	141	SSumLR[ns+0] += l;
	142	SSumLR[ns+1] += r;
	143	}
	144	if (unlikely(spu.spuCtrl & CTRL_CDREVERB))
	145	{
	146	RVB[ns+0] += l;
	147	RVB[ns+1] += r;
	148	}
1d753163	149
a4621d43 PC	150	spu.spuMem[cursor] = HTOLE16(v);
a4621d43 PC	151	spu.spuMem[cursor + 0x400/2] = HTOLE16(v >> 16);
4197fb21	152	cursor = (cursor + 1) & 0x1ff;
	153	}
	154	spu.XALastVal = v;
	155	}
67c020ee	156	else if (spu.cdClearSamples > 0)
	157	{
	158	for(ns = 0; ns < ns_to; ns++)
	159	{
	160	spu.spuMem[cursor] = spu.spuMem[cursor + 0x400/2] = 0;
	161	cursor = (cursor + 1) & 0x1ff;
	162	}
	163	spu.cdClearSamples -= ns_to;
4197fb21	164	spu.XALastVal = 0;
67c020ee	165	}
ef79bbde P	166	}
	167
	168	////////////////////////////////////////////////////////////////////////
	169	// small linux time helper... only used for watchdog
	170	////////////////////////////////////////////////////////////////////////
	171
609d9ea5	172	#if 0
f05d6ca2	173	static unsigned long timeGetTime_spu()
ef79bbde	174	{
de4a0279	175	#if defined(NO_OS)
	176	return 0;
	177	#elif defined(_WIN32)
003cfc63	178	return GetTickCount();
003cfc63	179	#else
ef79bbde P	180	struct timeval tv;
	181	gettimeofday(&tv, 0); // well, maybe there are better ways
	182	return tv.tv_sec * 1000 + tv.tv_usec/1000; // to do that, but at least it works
003cfc63	183	#endif
ef79bbde	184	}
609d9ea5	185	#endif
ef79bbde P	186
	187	////////////////////////////////////////////////////////////////////////
	188	// FEED XA
	189	////////////////////////////////////////////////////////////////////////
	190
b34d6a80	191	void FeedXA(const xa_decode_t *xap)
ef79bbde P	192	{
	193	int sinc,spos,i,iSize,iPlace,vl,vr;
	194
3154bfab	195	if(!spu.bSPUIsOpen) return;
ef79bbde	196
9cf79034	197	spu.XARepeat = 3; // set up repeat
ef79bbde	198
97ea4077	199	#if 0//def XA_HACK
ef79bbde P	200	iSize=((45500*xap->nsamples)/xap->freq); // get size
	201	#else
	202	iSize=((44100*xap->nsamples)/xap->freq); // get size
	203	#endif
	204	if(!iSize) return; // none? bye
	205
3154bfab	206	if(spu.XAFeed<spu.XAPlay) iPlace=spu.XAPlay-spu.XAFeed; // how much space in my buf?
3154bfab	207	else iPlace=(spu.XAEnd-spu.XAFeed) + (spu.XAPlay-spu.XAStart);
ef79bbde P	208
	209	if(iPlace==0) return; // no place at all
	210
	211	//----------------------------------------------------//
609d9ea5	212	#if 0
3154bfab	213	if(spu_config.iXAPitch) // pitch change option?
ef79bbde P	214	{
	215	static DWORD dwLT=0;
	216	static DWORD dwFPS=0;
	217	static int iFPSCnt=0;
	218	static int iLastSize=0;
	219	static DWORD dwL1=0;
	220	DWORD dw=timeGetTime_spu(),dw1,dw2;
	221
	222	iPlace=iSize;
	223
	224	dwFPS+=dw-dwLT;iFPSCnt++;
	225
	226	dwLT=dw;
	227
	228	if(iFPSCnt>=10)
	229	{
	230	if(!dwFPS) dwFPS=1;
	231	dw1=1000000/dwFPS;
	232	if(dw1>=(dwL1-100) && dw1<=(dwL1+100)) dw1=dwL1;
	233	else dwL1=dw1;
	234	dw2=(xap->freq*100/xap->nsamples);
	235	if((!dw1)\|\|((dw2+100)>=dw1)) iLastSize=0;
	236	else
	237	{
	238	iLastSize=iSize*dw2/dw1;
	239	if(iLastSize>iPlace) iLastSize=iPlace;
	240	iSize=iLastSize;
	241	}
	242	iFPSCnt=0;dwFPS=0;
	243	}
	244	else
	245	{
	246	if(iLastSize) iSize=iLastSize;
	247	}
	248	}
609d9ea5	249	#endif
ef79bbde P	250	//----------------------------------------------------//
	251
	252	spos=0x10000L;
	253	sinc = (xap->nsamples << 16) / iSize; // calc freq by num / size
	254
	255	if(xap->stereo)
	256	{
	257	uint32_t * pS=(uint32_t *)xap->pcm;
	258	uint32_t l=0;
	259
609d9ea5	260	#if 0
3154bfab	261	if(spu_config.iXAPitch)
ef79bbde P	262	{
	263	int32_t l1,l2;short s;
	264	for(i=0;i<iSize;i++)
	265	{
3154bfab	266	if(spu_config.iUseInterpolation==2)
ef79bbde P	267	{
	268	while(spos>=0x10000L)
	269	{
	270	l = *pS++;
	271	gauss_window[gauss_ptr] = (short)LOWORD(l);
	272	gauss_window[4+gauss_ptr] = (short)HIWORD(l);
	273	gauss_ptr = (gauss_ptr+1) & 3;
	274	spos -= 0x10000L;
	275	}
	276	vl = (spos >> 6) & ~3;
acc415b3 S	277	vr=(gauss[vl]*gvall0) >> 15;
	278	vr+=(gauss[vl+1]*gvall(1)) >> 15;
	279	vr+=(gauss[vl+2]*gvall(2)) >> 15;
	280	vr+=(gauss[vl+3]*gvall(3)) >> 15;
	281	l= vr & 0xffff;
	282	vr=(gauss[vl]*gvalr0) >> 15;
	283	vr+=(gauss[vl+1]*gvalr(1)) >> 15;
	284	vr+=(gauss[vl+2]*gvalr(2)) >> 15;
	285	vr+=(gauss[vl+3]*gvalr(3)) >> 15;
	286	l \|= vr << 16;
ef79bbde P	287	}
	288	else
	289	{
	290	while(spos>=0x10000L)
	291	{
	292	l = *pS++;
	293	spos -= 0x10000L;
	294	}
	295	}
	296
	297	s=(short)LOWORD(l);
	298	l1=s;
	299	l1=(l1*iPlace)/iSize;
381ea103	300	ssat32_to_16(l1);
ef79bbde P	301	s=(short)HIWORD(l);
	302	l2=s;
	303	l2=(l2*iPlace)/iSize;
381ea103	304	ssat32_to_16(l2);
ef79bbde P	305	l=(l1&0xffff)\|(l2<<16);
ef79bbde P	306
3154bfab	307	*spu.XAFeed++=l;
ef79bbde	308
3154bfab	309	if(spu.XAFeed==spu.XAEnd) spu.XAFeed=spu.XAStart;
3154bfab	310	if(spu.XAFeed==spu.XAPlay)
ef79bbde	311	{
3154bfab	312	if(spu.XAPlay!=spu.XAStart) spu.XAFeed=spu.XAPlay-1;
ef79bbde P	313	break;
	314	}
	315
	316	spos += sinc;
	317	}
	318	}
	319	else
609d9ea5	320	#endif
ef79bbde P	321	{
	322	for(i=0;i<iSize;i++)
	323	{
3154bfab	324	if(spu_config.iUseInterpolation==2)
ef79bbde P	325	{
	326	while(spos>=0x10000L)
	327	{
	328	l = *pS++;
	329	gauss_window[gauss_ptr] = (short)LOWORD(l);
	330	gauss_window[4+gauss_ptr] = (short)HIWORD(l);
	331	gauss_ptr = (gauss_ptr+1) & 3;
	332	spos -= 0x10000L;
	333	}
	334	vl = (spos >> 6) & ~3;
acc415b3 S	335	vr=(gauss[vl]*gvall0) >> 15;
	336	vr+=(gauss[vl+1]*gvall(1)) >> 15;
	337	vr+=(gauss[vl+2]*gvall(2)) >> 15;
	338	vr+=(gauss[vl+3]*gvall(3)) >> 15;
	339	l= vr & 0xffff;
	340	vr=(gauss[vl]*gvalr0) >> 15;
	341	vr+=(gauss[vl+1]*gvalr(1)) >> 15;
	342	vr+=(gauss[vl+2]*gvalr(2)) >> 15;
	343	vr+=(gauss[vl+3]*gvalr(3)) >> 15;
	344	l \|= vr << 16;
ef79bbde P	345	}
	346	else
	347	{
	348	while(spos>=0x10000L)
	349	{
	350	l = *pS++;
	351	spos -= 0x10000L;
	352	}
	353	}
	354
3154bfab	355	*spu.XAFeed++=l;
ef79bbde	356
3154bfab	357	if(spu.XAFeed==spu.XAEnd) spu.XAFeed=spu.XAStart;
3154bfab	358	if(spu.XAFeed==spu.XAPlay)
ef79bbde	359	{
3154bfab	360	if(spu.XAPlay!=spu.XAStart) spu.XAFeed=spu.XAPlay-1;
ef79bbde P	361	break;
	362	}
	363
	364	spos += sinc;
	365	}
	366	}
	367	}
	368	else
	369	{
	370	unsigned short * pS=(unsigned short *)xap->pcm;
	371	uint32_t l;short s=0;
	372
609d9ea5	373	#if 0
3154bfab	374	if(spu_config.iXAPitch)
ef79bbde P	375	{
	376	int32_t l1;
	377	for(i=0;i<iSize;i++)
	378	{
3154bfab	379	if(spu_config.iUseInterpolation==2)
ef79bbde P	380	{
	381	while(spos>=0x10000L)
	382	{
	383	gauss_window[gauss_ptr] = (short)*pS++;
	384	gauss_ptr = (gauss_ptr+1) & 3;
	385	spos -= 0x10000L;
	386	}
	387	vl = (spos >> 6) & ~3;
acc415b3 S	388	vr=(gauss[vl]*gvall0) >> 15;
	389	vr+=(gauss[vl+1]*gvall(1)) >> 15;
	390	vr+=(gauss[vl+2]*gvall(2)) >> 15;
	391	vr+=(gauss[vl+3]*gvall(3)) >> 15;
	392	l1=s= vr;
ef79bbde P	393	l1 &= 0xffff;
	394	}
	395	else
	396	{
	397	while(spos>=0x10000L)
	398	{
	399	s = *pS++;
	400	spos -= 0x10000L;
	401	}
	402	l1=s;
	403	}
	404
	405	l1=(l1*iPlace)/iSize;
381ea103	406	ssat32_to_16(l1);
ef79bbde	407	l=(l1&0xffff)\|(l1<<16);
3154bfab	408	*spu.XAFeed++=l;
ef79bbde	409
3154bfab	410	if(spu.XAFeed==spu.XAEnd) spu.XAFeed=spu.XAStart;
3154bfab	411	if(spu.XAFeed==spu.XAPlay)
ef79bbde	412	{
3154bfab	413	if(spu.XAPlay!=spu.XAStart) spu.XAFeed=spu.XAPlay-1;
ef79bbde P	414	break;
	415	}
	416
	417	spos += sinc;
	418	}
	419	}
	420	else
609d9ea5	421	#endif
ef79bbde P	422	{
	423	for(i=0;i<iSize;i++)
	424	{
3154bfab	425	if(spu_config.iUseInterpolation==2)
ef79bbde P	426	{
	427	while(spos>=0x10000L)
	428	{
	429	gauss_window[gauss_ptr] = (short)*pS++;
	430	gauss_ptr = (gauss_ptr+1) & 3;
	431	spos -= 0x10000L;
	432	}
	433	vl = (spos >> 6) & ~3;
acc415b3 S	434	vr=(gauss[vl]*gvall0) >> 15;
	435	vr+=(gauss[vl+1]*gvall(1)) >> 15;
	436	vr+=(gauss[vl+2]*gvall(2)) >> 15;
	437	vr+=(gauss[vl+3]*gvall(3)) >> 15;
	438	l=s= vr;
ef79bbde P	439	}
	440	else
	441	{
	442	while(spos>=0x10000L)
	443	{
	444	s = *pS++;
	445	spos -= 0x10000L;
	446	}
	447	l=s;
	448	}
	449
9098b863	450	l &= 0xffff;
3154bfab	451	*spu.XAFeed++=(l\|(l<<16));
ef79bbde	452
3154bfab	453	if(spu.XAFeed==spu.XAEnd) spu.XAFeed=spu.XAStart;
3154bfab	454	if(spu.XAFeed==spu.XAPlay)
ef79bbde	455	{
3154bfab	456	if(spu.XAPlay!=spu.XAStart) spu.XAFeed=spu.XAPlay-1;
ef79bbde P	457	break;
	458	}
	459
	460	spos += sinc;
	461	}
	462	}
	463	}
	464	}
	465
	466	////////////////////////////////////////////////////////////////////////
	467	// FEED CDDA
	468	////////////////////////////////////////////////////////////////////////
	469
b34d6a80	470	void FeedCDDA(unsigned char *pcm, int nBytes)
ef79bbde	471	{
983a7cfd	472	int space;
3154bfab	473	space=(spu.CDDAPlay-spu.CDDAFeed-1)*4 & (CDDA_BUFFER_SIZE - 1);
20ed712f	474	if (space < nBytes) {
20ed712f	475	log_unhandled("FeedCDDA: %d/%d\n", nBytes, space);
b34d6a80	476	return;
20ed712f	477	}
983a7cfd	478
ef79bbde P	479	while(nBytes>0)
ef79bbde P	480	{
3154bfab	481	if(spu.CDDAFeed==spu.CDDAEnd) spu.CDDAFeed=spu.CDDAStart;
	482	space=(spu.CDDAPlay-spu.CDDAFeed-1)*4 & (CDDA_BUFFER_SIZE - 1);
	483	if(spu.CDDAFeed+space/4>spu.CDDAEnd)
	484	space=(spu.CDDAEnd-spu.CDDAFeed)*4;
983a7cfd	485	if(space>nBytes)
	486	space=nBytes;
	487
3154bfab	488	memcpy(spu.CDDAFeed,pcm,space);
3154bfab	489	spu.CDDAFeed+=space/4;
983a7cfd	490	nBytes-=space;
983a7cfd	491	pcm+=space;
ef79bbde P	492	}
	493	}
	494
	495	#endif
73d2a903	496	// vim:shiftwidth=1:expandtab