#include "stdafx.h"
#define _IN_SPU
#include "../peops2/externals.h"
#include "../peops2/regs.h"
#include "../peops2/dma.h"
unsigned short regArea[32*1024];
unsigned short spuMem[1*1024*1024];
unsigned char * spuMemC;
unsigned char * pSpuIrq[2];
unsigned char * pSpuBuffer;
int iUseXA=0;
int iVolume=3;
int iXAPitch=1;
int iUseTimer=2;
int iSPUIRQWait=1;
int iDebugMode=0;
int iRecordMode=0;
int iUseReverb=1;
int iUseInterpolation=2;
SPUCHAN s_chan[MAXCHAN+1]; REVERBInfo rvb[2];
unsigned long dwNoiseVal=1;
unsigned short spuCtrl2[2]; unsigned short spuStat2[2];
unsigned long spuIrq2[2];
unsigned long spuAddr2[2]; unsigned long spuRvbAddr2[2];
unsigned long spuRvbAEnd2[2];
int bEndThread=0; int bThreadEnded=0;
int bSpuInit=0;
int bSPUIsOpen=0;
unsigned long dwNewChannel2[2]; unsigned long dwEndChannel2[2];
void (CALLBACK *irqCallback)(void)=0; void (CALLBACK *cddavCallback)(unsigned short,unsigned short)=0;
const int f[5][2] = { { 0, 0 },
{ 60, 0 },
{ 115, -52 },
{ 98, -55 },
{ 122, -60 } };
int SSumR[NSSIZE];
int SSumL[NSSIZE];
int iCycle=0;
short * pS;
static int lastch=-1; static int lastns=0; static int iSecureStart=0;
extern void ps2_update(unsigned char *samples, long lBytes);
#include "reverb.c"
#include "adsr.c"
INLINE void InterpolateUp(int ch)
{
if(s_chan[ch].SB[32]==1) {
const int id1=s_chan[ch].SB[30]-s_chan[ch].SB[29]; const int id2=s_chan[ch].SB[31]-s_chan[ch].SB[30];
s_chan[ch].SB[32]=0;
if(id1>0) {
if(id2<id1)
{s_chan[ch].SB[28]=id1;s_chan[ch].SB[32]=2;}
else
if(id2<(id1<<1))
s_chan[ch].SB[28]=(id1*s_chan[ch].sinc)/0x10000L;
else
s_chan[ch].SB[28]=(id1*s_chan[ch].sinc)/0x20000L;
}
else {
if(id2>id1)
{s_chan[ch].SB[28]=id1;s_chan[ch].SB[32]=2;}
else
if(id2>(id1<<1))
s_chan[ch].SB[28]=(id1*s_chan[ch].sinc)/0x10000L;
else
s_chan[ch].SB[28]=(id1*s_chan[ch].sinc)/0x20000L;
}
}
else
if(s_chan[ch].SB[32]==2) {
s_chan[ch].SB[32]=0;
s_chan[ch].SB[28]=(s_chan[ch].SB[28]*s_chan[ch].sinc)/0x20000L;
if(s_chan[ch].sinc<=0x8000)
s_chan[ch].SB[29]=s_chan[ch].SB[30]-(s_chan[ch].SB[28]*((0x10000/s_chan[ch].sinc)-1));
else s_chan[ch].SB[29]+=s_chan[ch].SB[28];
}
else s_chan[ch].SB[29]+=s_chan[ch].SB[28];
}
INLINE void InterpolateDown(int ch)
{
if(s_chan[ch].sinc>=0x20000L) {
s_chan[ch].SB[29]+=(s_chan[ch].SB[30]-s_chan[ch].SB[29])/2; if(s_chan[ch].sinc>=0x30000L) s_chan[ch].SB[29]+=(s_chan[ch].SB[31]-s_chan[ch].SB[30])/2; }
}
#define gval0 (((short*)(&s_chan[ch].SB[29]))[gpos])
#define gval(x) (((short*)(&s_chan[ch].SB[29]))[(gpos+x)&3])
#include "gauss_i.h"
INLINE void StartSound(int ch)
{
dwNewChannel2[ch/24]&=~(1<<(ch%24)); dwEndChannel2[ch/24]&=~(1<<(ch%24));
StartADSR(ch);
StartREVERB(ch);
s_chan[ch].pCurr=s_chan[ch].pStart;
s_chan[ch].s_1=0; s_chan[ch].s_2=0;
s_chan[ch].iSBPos=28;
s_chan[ch].bNew=0; s_chan[ch].bStop=0;
s_chan[ch].bOn=1;
s_chan[ch].SB[29]=0; s_chan[ch].SB[30]=0;
if(iUseInterpolation>=2) {s_chan[ch].spos=0x30000L;s_chan[ch].SB[28]=0;} else {s_chan[ch].spos=0x10000L;s_chan[ch].SB[31]=0;} }
static u32 sampcount;
static u32 decaybegin;
static u32 decayend;
void setlength2(s32 stop, s32 fade)
{
if(stop==~0)
{
decaybegin=~0;
}
else
{
stop=(stop*441)/10;
fade=(fade*441)/10;
decaybegin=stop;
decayend=stop+fade;
}
}
#define PAUSE_W 5
#define PAUSE_L 5000
int iSpuAsyncWait=0;
static void *MAINThread(int samp2run)
{
int s_1,s_2,fa,voldiv=iVolume;
unsigned char * start;unsigned int nSample;
int ch,predict_nr,shift_factor,flags,d,d2,s;
int gpos,bIRQReturn=0;
{
if(dwNewChannel2[0] || dwNewChannel2[1]) { iSecureStart++; if(iSecureStart>5) iSecureStart=0; }
else iSecureStart=0;
#if 0#endif
if(lastch>=0) {
ch=lastch; lastch=-1; goto GOON; }
{
for(ch=0;ch<MAXCHAN;ch++) {
if(s_chan[ch].bNew) StartSound(ch); if(!s_chan[ch].bOn) continue;
if(s_chan[ch].iActFreq!=s_chan[ch].iUsedFreq) {
s_chan[ch].iUsedFreq=s_chan[ch].iActFreq; s_chan[ch].sinc=s_chan[ch].iRawPitch<<4;
if(!s_chan[ch].sinc) s_chan[ch].sinc=1;
if(iUseInterpolation==1) s_chan[ch].SB[32]=1; }
{
while(s_chan[ch].spos>=0x10000L)
{
if(s_chan[ch].iSBPos==28) {
start=s_chan[ch].pCurr;
if (start == (unsigned char*)-1) {
s_chan[ch].bOn=0; s_chan[ch].ADSRX.lVolume=0;
s_chan[ch].ADSRX.EnvelopeVol=0;
goto ENDX; }
s_chan[ch].iSBPos=0;
s_1=s_chan[ch].s_1;
s_2=s_chan[ch].s_2;
predict_nr=(int)*start;start++;
shift_factor=predict_nr&0xf;
predict_nr >>= 4;
flags=(int)*start;start++;
for (nSample=0;nSample<28;start++)
{
d=(int)*start;
s=((d&0xf)<<12);
if(s&0x8000) s|=0xffff0000;
fa=(s >> shift_factor);
fa=fa + ((s_1 * f[predict_nr][0])>>6) + ((s_2 * f[predict_nr][1])>>6);
s_2=s_1;s_1=fa;
s=((d & 0xf0) << 8);
s_chan[ch].SB[nSample++]=fa;
if(s&0x8000) s|=0xffff0000;
fa=(s>>shift_factor);
fa=fa + ((s_1 * f[predict_nr][0])>>6) + ((s_2 * f[predict_nr][1])>>6);
s_2=s_1;s_1=fa;
s_chan[ch].SB[nSample++]=fa;
}
if(spuCtrl2[ch/24]&0x40) {
if((pSpuIrq[ch/24] > start-16 && pSpuIrq[ch/24] <= start) ||
((flags&1) && (pSpuIrq[ch/24] > s_chan[ch].pLoop-16 &&
pSpuIrq[ch/24] <= s_chan[ch].pLoop)))
{
s_chan[ch].iIrqDone=1;
if(irqCallback) irqCallback(); else
{
if(ch<24) InterruptDMA4(); else InterruptDMA7();
}
if(iSPUIRQWait) {
iSpuAsyncWait=1;
bIRQReturn=1;
}
}
}
if((flags&4) && (!s_chan[ch].bIgnoreLoop))
s_chan[ch].pLoop=start-16;
if(flags&1) {
dwEndChannel2[ch/24]|=(1<<(ch%24));
if(flags!=3 || s_chan[ch].pLoop==NULL) { start = (unsigned char*)-1;
}
else
{
start = s_chan[ch].pLoop;
}
}
s_chan[ch].pCurr=start; s_chan[ch].s_1=s_1;
s_chan[ch].s_2=s_2;
if(bIRQReturn) {
bIRQReturn=0;
{
lastch=ch;
return NULL;
}
}
GOON: ;
}
fa=s_chan[ch].SB[s_chan[ch].iSBPos++];
{
if(fa>32767L) fa=32767L;
if(fa<-32767L) fa=-32767L;
}
if(iUseInterpolation>=2) {
gpos = s_chan[ch].SB[28];
gval0 = fa;
gpos = (gpos+1) & 3;
s_chan[ch].SB[28] = gpos;
}
else
if(iUseInterpolation==1) {
s_chan[ch].SB[28] = 0;
s_chan[ch].SB[29] = s_chan[ch].SB[30]; s_chan[ch].SB[30] = s_chan[ch].SB[31];
s_chan[ch].SB[31] = fa;
s_chan[ch].SB[32] = 1; }
else s_chan[ch].SB[29]=fa;
s_chan[ch].spos -= 0x10000L;
}
if(s_chan[ch].bNoise)
{
if((dwNoiseVal<<=1)&0x80000000L)
{
dwNoiseVal^=0x0040001L;
fa=((dwNoiseVal>>2)&0x7fff);
fa=-fa;
}
else fa=(dwNoiseVal>>2)&0x7fff;
fa=s_chan[ch].iOldNoise+((fa-s_chan[ch].iOldNoise)/((0x001f-((spuCtrl2[ch/24]&0x3f00)>>9))+1));
if(fa>32767L) fa=32767L;
if(fa<-32767L) fa=-32767L;
s_chan[ch].iOldNoise=fa;
if(iUseInterpolation<2) s_chan[ch].SB[29] = fa; } else { if(iUseInterpolation==3) {
long xd;
xd = ((s_chan[ch].spos) >> 1)+1;
gpos = s_chan[ch].SB[28];
fa = gval(3) - 3*gval(2) + 3*gval(1) - gval0;
fa *= (xd - (2<<15)) / 6;
fa >>= 15;
fa += gval(2) - gval(1) - gval(1) + gval0;
fa *= (xd - (1<<15)) >> 1;
fa >>= 15;
fa += gval(1) - gval0;
fa *= xd;
fa >>= 15;
fa = fa + gval0;
}
else
if(iUseInterpolation==2) {
int vl, vr;
vl = (s_chan[ch].spos >> 6) & ~3;
gpos = s_chan[ch].SB[28];
vr=(gauss[vl]*gval0)&~2047;
vr+=(gauss[vl+1]*gval(1))&~2047;
vr+=(gauss[vl+2]*gval(2))&~2047;
vr+=(gauss[vl+3]*gval(3))&~2047;
fa = vr>>11;
}
else
if(iUseInterpolation==1) {
if(s_chan[ch].sinc<0x10000L) InterpolateUp(ch); else InterpolateDown(ch); fa=s_chan[ch].SB[29];
}
else fa=s_chan[ch].SB[29]; }
s_chan[ch].sval = (MixADSR(ch) * fa) / 1023;
if(s_chan[ch].bFMod==2) {
int NP=s_chan[ch+1].iRawPitch;
double intr;
NP=((32768L+s_chan[ch].sval)*NP)/32768L;
if(NP>0x3fff) NP=0x3fff;
if(NP<0x1) NP=0x1;
intr = (double)48000.0f / (double)44100.0f * (double)NP;
NP = (UINT32)intr;
NP=(44100L*NP)/(4096L);
s_chan[ch+1].iActFreq=NP;
s_chan[ch+1].iUsedFreq=NP;
s_chan[ch+1].sinc=(((NP/10)<<16)/4410);
if(!s_chan[ch+1].sinc) s_chan[ch+1].sinc=1;
if(iUseInterpolation==1) s_chan[ch+1].SB[32]=1;
}
else
{
if(s_chan[ch].iMute)
s_chan[ch].sval=0; else
{
if(s_chan[ch].bVolumeL)
SSumL[0]+=(s_chan[ch].sval*s_chan[ch].iLeftVolume)/0x4000L;
if(s_chan[ch].bVolumeR)
SSumR[0]+=(s_chan[ch].sval*s_chan[ch].iRightVolume)/0x4000L;
}
if(s_chan[ch].bRVBActive) StoreREVERB(ch,0);
}
s_chan[ch].spos += s_chan[ch].sinc;
}
ENDX: ;
}
}
SSumL[0]+=MixREVERBLeft(0,0);
SSumL[0]+=MixREVERBLeft(0,1);
SSumR[0]+=MixREVERBRight(0);
SSumR[0]+=MixREVERBRight(1);
d=SSumL[0]/voldiv;SSumL[0]=0;
d2=SSumR[0]/voldiv;SSumR[0]=0;
if(d<-32767) d=-32767;if(d>32767) d=32767;
if(d2<-32767) d2=-32767;if(d2>32767) d2=32767;
if(sampcount>=decaybegin)
{
s32 dmul;
if(decaybegin!=~0) {
if(sampcount>=decayend)
{
return(0);
}
dmul=256-(256*(sampcount-decaybegin)/(decayend-decaybegin));
d=(d*dmul)>>8;
d2=(d2*dmul)>>8;
}
}
sampcount++;
*pS++=d;
*pS++=d2;
InitREVERB();
if ((((unsigned char *)pS)-((unsigned char *)pSpuBuffer)) == (735*4))
{
ps2_update((u8*)pSpuBuffer,(u8*)pS-(u8*)pSpuBuffer);
pS=(short *)pSpuBuffer;
}
}
bThreadEnded=1;
return 0;
}
EXPORT_GCC void CALLBACK SPU2async(unsigned long cycle)
{
if(iSpuAsyncWait)
{
iSpuAsyncWait++;
if(iSpuAsyncWait<=64) return;
iSpuAsyncWait=0;
}
MAINThread(0); }
EXPORT_GCC long CALLBACK SPU2init(void)
{
spuMemC=(unsigned char *)spuMem; memset((void *)s_chan,0,MAXCHAN*sizeof(SPUCHAN));
memset(rvb,0,2*sizeof(REVERBInfo));
sampcount = 0;
InitADSR();
return 0;
}
static void SetupTimer(void)
{
memset(SSumR,0,NSSIZE*sizeof(int)); memset(SSumL,0,NSSIZE*sizeof(int));
pS=(short *)pSpuBuffer;
bEndThread=0; bThreadEnded=0;
bSpuInit=1; }
static void RemoveTimer(void)
{
bEndThread=1; bThreadEnded=0; bSpuInit=0;
}
static void SetupStreams(void)
{
int i;
pSpuBuffer=(unsigned char *)malloc(32768);
i=NSSIZE*2;
sRVBStart[0] = (int *)malloc(i*4); memset(sRVBStart[0],0,i*4);
sRVBEnd[0] = sRVBStart[0] + i;
sRVBPlay[0] = sRVBStart[0];
sRVBStart[1] = (int *)malloc(i*4); memset(sRVBStart[1],0,i*4);
sRVBEnd[1] = sRVBStart[1] + i;
sRVBPlay[1] = sRVBStart[1];
for(i=0;i<MAXCHAN;i++) {
s_chan[i].ADSRX.SustainLevel = 1024; s_chan[i].iMute=0;
s_chan[i].iIrqDone=0;
s_chan[i].pLoop=spuMemC;
s_chan[i].pStart=spuMemC;
s_chan[i].pCurr=spuMemC;
}
}
static void RemoveStreams(void)
{
free(pSpuBuffer); pSpuBuffer=NULL;
free(sRVBStart[0]); sRVBStart[0]=0;
free(sRVBStart[1]); sRVBStart[1]=0;
}
EXPORT_GCC long CALLBACK SPU2open(void *pDsp)
{
if(bSPUIsOpen) return 0;
iUseXA=0; iVolume=3;
bEndThread=0;
bThreadEnded=0;
spuMemC=(unsigned char *)spuMem;
memset((void *)s_chan,0,(MAXCHAN+1)*sizeof(SPUCHAN));
pSpuIrq[0]=0;
pSpuIrq[1]=0;
iSPUIRQWait=1;
dwNewChannel2[0]=0;
dwNewChannel2[1]=0;
dwEndChannel2[0]=0;
dwEndChannel2[1]=0;
spuCtrl2[0]=0;
spuCtrl2[1]=0;
spuStat2[0]=0;
spuStat2[1]=0;
spuIrq2[0]=0;
spuIrq2[1]=0;
spuAddr2[0]=0xffffffff;
spuAddr2[1]=0xffffffff;
spuRvbAddr2[0]=0;
spuRvbAddr2[1]=0;
spuRvbAEnd2[0]=0;
spuRvbAEnd2[1]=0;
SetupStreams();
SetupTimer();
bSPUIsOpen=1;
return 0;
}
EXPORT_GCC void CALLBACK SPU2close(void)
{
if(!bSPUIsOpen) return;
bSPUIsOpen=0;
RemoveTimer();
RemoveStreams(); }
EXPORT_GCC void CALLBACK SPU2shutdown(void)
{
return;
}
EXPORT_GCC long CALLBACK SPU2test(void)
{
return 0;
}
EXPORT_GCC void CALLBACK SPU2irqCallback(void (CALLBACK *callback)(void))
{
irqCallback = callback;
}
EXPORT_GCC void CALLBACK SPU2registerCallback(void (CALLBACK *callback)(void))
{
irqCallback = callback;
}
EXPORT_GCC void CALLBACK SPU2registerCDDAVolume(void (CALLBACK *CDDAVcallback)(unsigned short,unsigned short))
{
cddavCallback = CDDAVcallback;
}