1 /***************************************************************************
4 begin : Wed May 15 2002
5 copyright : (C) 2002 by Pete Bernert
6 email : BlackDove@addcom.de
7 ***************************************************************************/
8 /***************************************************************************
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. *
16 ***************************************************************************/
22 // will be included from spu.c
25 ////////////////////////////////////////////////////////////////////////
27 ////////////////////////////////////////////////////////////////////////
29 static int gauss_ptr = 0;
30 static int gauss_window[8] = {0, 0, 0, 0, 0, 0, 0, 0};
32 #define gvall0 gauss_window[gauss_ptr]
33 #define gvall(x) gauss_window[(gauss_ptr+x)&3]
34 #define gvalr0 gauss_window[4+gauss_ptr]
35 #define gvalr(x) gauss_window[4+((gauss_ptr+x)&3)]
37 ////////////////////////////////////////////////////////////////////////
39 ////////////////////////////////////////////////////////////////////////
41 INLINE void MixXA(int *SSumLR, int ns_to, int decode_pos)
43 int cursor = decode_pos;
48 if(spu.XAPlay != spu.XAFeed || spu.XARepeat > 0)
50 if(spu.XAPlay == spu.XAFeed)
54 for(ns = 0; ns < ns_to*2; )
56 if(spu.XAPlay != spu.XAFeed) v=*spu.XAPlay++;
57 if(spu.XAPlay == spu.XAEnd) spu.XAPlay=spu.XAStart;
59 l = ((int)(short)v * spu.iLeftXAVol) >> 15;
60 r = ((int)(short)(v >> 16) * spu.iLeftXAVol) >> 15;
64 spu.spuMem[cursor] = v;
65 spu.spuMem[cursor + 0x400/2] = v >> 16;
66 cursor = (cursor + 1) & 0x1ff;
71 for(ns = 0; ns < ns_to * 2 && spu.CDDAPlay!=spu.CDDAFeed && (spu.CDDAPlay!=spu.CDDAEnd-1||spu.CDDAFeed!=spu.CDDAStart);)
74 if(spu.CDDAPlay==spu.CDDAEnd) spu.CDDAPlay=spu.CDDAStart;
76 l = ((int)(short)v * spu.iLeftXAVol) >> 15;
77 r = ((int)(short)(v >> 16) * spu.iLeftXAVol) >> 15;
81 spu.spuMem[cursor] = v;
82 spu.spuMem[cursor + 0x400/2] = v >> 16;
83 cursor = (cursor + 1) & 0x1ff;
87 ////////////////////////////////////////////////////////////////////////
88 // small linux time helper... only used for watchdog
89 ////////////////////////////////////////////////////////////////////////
91 static unsigned long timeGetTime_spu()
96 return GetTickCount();
99 gettimeofday(&tv, 0); // well, maybe there are better ways
100 return tv.tv_sec * 1000 + tv.tv_usec/1000; // to do that, but at least it works
104 ////////////////////////////////////////////////////////////////////////
106 ////////////////////////////////////////////////////////////////////////
108 INLINE void FeedXA(xa_decode_t *xap)
110 int sinc,spos,i,iSize,iPlace,vl,vr;
112 if(!spu.bSPUIsOpen) return;
114 spu.xapGlobal = xap; // store info for save states
115 spu.XARepeat = 100; // set up repeat
118 iSize=((45500*xap->nsamples)/xap->freq); // get size
120 iSize=((44100*xap->nsamples)/xap->freq); // get size
122 if(!iSize) return; // none? bye
124 if(spu.XAFeed<spu.XAPlay) iPlace=spu.XAPlay-spu.XAFeed; // how much space in my buf?
125 else iPlace=(spu.XAEnd-spu.XAFeed) + (spu.XAPlay-spu.XAStart);
127 if(iPlace==0) return; // no place at all
129 //----------------------------------------------------//
130 if(spu_config.iXAPitch) // pitch change option?
133 static DWORD dwFPS=0;
134 static int iFPSCnt=0;
135 static int iLastSize=0;
137 DWORD dw=timeGetTime_spu(),dw1,dw2;
141 dwFPS+=dw-dwLT;iFPSCnt++;
149 if(dw1>=(dwL1-100) && dw1<=(dwL1+100)) dw1=dwL1;
151 dw2=(xap->freq*100/xap->nsamples);
152 if((!dw1)||((dw2+100)>=dw1)) iLastSize=0;
155 iLastSize=iSize*dw2/dw1;
156 if(iLastSize>iPlace) iLastSize=iPlace;
163 if(iLastSize) iSize=iLastSize;
166 //----------------------------------------------------//
169 sinc = (xap->nsamples << 16) / iSize; // calc freq by num / size
173 uint32_t * pS=(uint32_t *)xap->pcm;
176 if(spu_config.iXAPitch)
178 int32_t l1,l2;short s;
181 if(spu_config.iUseInterpolation==2)
183 while(spos>=0x10000L)
186 gauss_window[gauss_ptr] = (short)LOWORD(l);
187 gauss_window[4+gauss_ptr] = (short)HIWORD(l);
188 gauss_ptr = (gauss_ptr+1) & 3;
191 vl = (spos >> 6) & ~3;
192 vr=(gauss[vl]*gvall0)&~2047;
193 vr+=(gauss[vl+1]*gvall(1))&~2047;
194 vr+=(gauss[vl+2]*gvall(2))&~2047;
195 vr+=(gauss[vl+3]*gvall(3))&~2047;
196 l= (vr >> 11) & 0xffff;
197 vr=(gauss[vl]*gvalr0)&~2047;
198 vr+=(gauss[vl+1]*gvalr(1))&~2047;
199 vr+=(gauss[vl+2]*gvalr(2))&~2047;
200 vr+=(gauss[vl+3]*gvalr(3))&~2047;
205 while(spos>=0x10000L)
214 l1=(l1*iPlace)/iSize;
218 l2=(l2*iPlace)/iSize;
220 l=(l1&0xffff)|(l2<<16);
224 if(spu.XAFeed==spu.XAEnd) spu.XAFeed=spu.XAStart;
225 if(spu.XAFeed==spu.XAPlay)
227 if(spu.XAPlay!=spu.XAStart) spu.XAFeed=spu.XAPlay-1;
238 if(spu_config.iUseInterpolation==2)
240 while(spos>=0x10000L)
243 gauss_window[gauss_ptr] = (short)LOWORD(l);
244 gauss_window[4+gauss_ptr] = (short)HIWORD(l);
245 gauss_ptr = (gauss_ptr+1) & 3;
248 vl = (spos >> 6) & ~3;
249 vr=(gauss[vl]*gvall0)&~2047;
250 vr+=(gauss[vl+1]*gvall(1))&~2047;
251 vr+=(gauss[vl+2]*gvall(2))&~2047;
252 vr+=(gauss[vl+3]*gvall(3))&~2047;
253 l= (vr >> 11) & 0xffff;
254 vr=(gauss[vl]*gvalr0)&~2047;
255 vr+=(gauss[vl+1]*gvalr(1))&~2047;
256 vr+=(gauss[vl+2]*gvalr(2))&~2047;
257 vr+=(gauss[vl+3]*gvalr(3))&~2047;
262 while(spos>=0x10000L)
271 if(spu.XAFeed==spu.XAEnd) spu.XAFeed=spu.XAStart;
272 if(spu.XAFeed==spu.XAPlay)
274 if(spu.XAPlay!=spu.XAStart) spu.XAFeed=spu.XAPlay-1;
284 unsigned short * pS=(unsigned short *)xap->pcm;
285 uint32_t l;short s=0;
287 if(spu_config.iXAPitch)
292 if(spu_config.iUseInterpolation==2)
294 while(spos>=0x10000L)
296 gauss_window[gauss_ptr] = (short)*pS++;
297 gauss_ptr = (gauss_ptr+1) & 3;
300 vl = (spos >> 6) & ~3;
301 vr=(gauss[vl]*gvall0)&~2047;
302 vr+=(gauss[vl+1]*gvall(1))&~2047;
303 vr+=(gauss[vl+2]*gvall(2))&~2047;
304 vr+=(gauss[vl+3]*gvall(3))&~2047;
310 while(spos>=0x10000L)
318 l1=(l1*iPlace)/iSize;
320 l=(l1&0xffff)|(l1<<16);
323 if(spu.XAFeed==spu.XAEnd) spu.XAFeed=spu.XAStart;
324 if(spu.XAFeed==spu.XAPlay)
326 if(spu.XAPlay!=spu.XAStart) spu.XAFeed=spu.XAPlay-1;
337 if(spu_config.iUseInterpolation==2)
339 while(spos>=0x10000L)
341 gauss_window[gauss_ptr] = (short)*pS++;
342 gauss_ptr = (gauss_ptr+1) & 3;
345 vl = (spos >> 6) & ~3;
346 vr=(gauss[vl]*gvall0)&~2047;
347 vr+=(gauss[vl+1]*gvall(1))&~2047;
348 vr+=(gauss[vl+2]*gvall(2))&~2047;
349 vr+=(gauss[vl+3]*gvall(3))&~2047;
354 while(spos>=0x10000L)
363 *spu.XAFeed++=(l|(l<<16));
365 if(spu.XAFeed==spu.XAEnd) spu.XAFeed=spu.XAStart;
366 if(spu.XAFeed==spu.XAPlay)
368 if(spu.XAPlay!=spu.XAStart) spu.XAFeed=spu.XAPlay-1;
378 ////////////////////////////////////////////////////////////////////////
380 ////////////////////////////////////////////////////////////////////////
382 INLINE int FeedCDDA(unsigned char *pcm, int nBytes)
385 space=(spu.CDDAPlay-spu.CDDAFeed-1)*4 & (CDDA_BUFFER_SIZE - 1);
387 return 0x7761; // rearmed_wait
391 if(spu.CDDAFeed==spu.CDDAEnd) spu.CDDAFeed=spu.CDDAStart;
392 space=(spu.CDDAPlay-spu.CDDAFeed-1)*4 & (CDDA_BUFFER_SIZE - 1);
393 if(spu.CDDAFeed+space/4>spu.CDDAEnd)
394 space=(spu.CDDAEnd-spu.CDDAFeed)*4;
398 memcpy(spu.CDDAFeed,pcm,space);
399 spu.CDDAFeed+=space/4;
404 return 0x676f; // rearmed_go