ShuriZma
/
flycast
mirror of https://github.com/flyinghead/flycast.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity
flycast/core/hw/aica/sgc_if.cpp

1517 lines
29 KiB
C++
Executable File
Raw Blame History

#include "sgc_if.h"
#include "dsp.h"
#include "aica_mem.h"
#include "hw/aica/aica_if.h"
#include <math.h>
#include <algorithm>
using namespace std;
#undef FAR
//#define CLIP_WARN
#define key_printf(...)
#define aeg_printf(...)
#define step_printf(...)
#ifdef CLIP_WARN
#define clip_verify(x) verify(x)
#else
#define clip_verify(x)
#endif
//Sound generation, mixin, and channel regs emulation
//x.15
s32 volume_lut[16];
//255 -> mute
//Converts Send levels to TL-compatible values (DISDL, etc)
u32 SendLevel[16]={255,14<<3,13<<3,12<<3,11<<3,10<<3,9<<3,8<<3,7<<3,6<<3,5<<3,4<<3,3<<3,2<<3,1<<3,0<<3};
s32 tl_lut[256 + 768]; //xx.15 format. >=255 is muted
//in ms :)
double AEG_Attack_Time[]=
{
-1,-1,8100.0,6900.0,6000.0,4800.0,4000.0,3400.0,3000.0,2400.0,2000.0,1700.0,1500.0,
1200.0,1000.0,860.0,760.0,600.0,500.0,430.0,380.0,300.0,250.0,220.0,190.0,150.0,130.0,110.0,95.0,
76.0,63.0,55.0,47.0,38.0,31.0,27.0,24.0,19.0,15.0,13.0,12.0,9.4,7.9,6.8,6.0,4.7,3.8,3.4,3.0,2.4,
2.0,1.8,1.6,1.3,1.1,0.93,0.85,0.65,0.53,0.44,0.40,0.35,0.0,0.0
};
double AEG_DSR_Time[]=
{ -1,-1,118200.0,101300.0,88600.0,70900.0,59100.0,50700.0,44300.0,35500.0,29600.0,25300.0,22200.0,17700.0,
14800.0,12700.0,11100.0,8900.0,7400.0,6300.0,5500.0,4400.0,3700.0,3200.0,2800.0,2200.0,1800.0,1600.0,1400.0,1100.0,
920.0,790.0,690.0,550.0,460.0,390.0,340.0,270.0,230.0,200.0,170.0,140.0,110.0,98.0,85.0,68.0,57.0,49.0,43.0,34.0,
28.0,25.0,22.0,18.0,14.0,12.0,11.0,8.5,7.1,6.1,5.4,4.3,3.6,3.1
};
#define AEG_STEP_BITS (16)
//Steps per sample
u32 AEG_ATT_SPS[64];
u32 AEG_DSR_SPS[64];
const char* stream_names[]=
{
"0: 16-bit PCM (two's complement format)",
"1: 8-bit PCM (two's complement format)",
"2: 4-bit ADPCM (Yamaha format)",
"3: 4-bit ADPCM long stream"
};
//x.8 format
const s32 adpcm_qs[8] =
{
0x0e6, 0x0e6, 0x0e6, 0x0e6, 0x133, 0x199, 0x200, 0x266,
};
//x.3 format
const s32 adpcm_scale[16] =
{
1,3,5,7,9,11,13,15,
-1,-3,-5,-7,-9,-11,-13,-15,
};
void AICA_Sample();
//Remove the fractional part , with rounding ;) -- does not need an extra bit
#define well(a,bits) (((a) + ((1<<(bits-1))))>>bits)
//Remove the fractional part by chopping..
#define FPChop(a,bits) ((a)>>bits)
#define FPs FPChop
//Fixed point mul w/ rounding :)
#define FPMul(a,b,bits) (FPs(a*b,bits))
#define VOLPAN(value,vol,pan,outl,outr) \
{\
s32 temp=FPMul((value),volume_lut[(vol)],15);\
u32 t_pan=(pan);\
SampleType Sc=FPMul(temp,volume_lut[0xF-(t_pan&0xF)],15);\
if (t_pan& 0x10)\
{\
outl+=temp;\
outr+=Sc ;\
}\
else\
{\
outl+=Sc;\
outr+=temp;\
}\
}
s16 pl=0,pr=0;
DSP_OUT_VOL_REG* dsp_out_vol;
#pragma pack (1)
//All regs are 16b , aligned to 32b (upper bits 0?)
struct ChannelCommonData
{
//+00 [0]
//SA is half at reg 0 and the rest at reg 1
u32 SA_hi:7;
u32 PCMS:2;
u32 LPCTL:1;
u32 SSCTL:1;
u32 res_1:3;
u32 KYONB:1;
u32 KYONEX:1;
u32 pad_2:16;
//+04 [1]
//SA (defined above)
u32 SA_low:16;
u32 pad_3:16;
//+08 [2]
u32 LSA:16;
u32 pad_4:16;
//+0C [3]
u32 LEA:16;
u32 pad_5:16;
//+10 [4]
u32 AR:5;
u32 res_2:1;
u32 D1R:5;
u32 D2R:5;
u32 pad_7:16;
//+14 [5]
u32 RR:5;
u32 DL:5;
u32 KRS:4;
u32 LPSLNK:1;
u32 res_3:1;
u32 pad_8:16;
//+18[6]
u32 FNS:10;
u32 rez_8_1:1;
u32 OCT:4;
u32 rez_8_2:1;
u32 pad_9:16;
//+1C RE LFOF[4:0] PLFOWS PLFOS[2:0] ALFOWS ALFOS[2:0]
u32 ALFOS:3;
u32 ALFOWS:2;
u32 PLFOS:3;
u32 PLFOWS:2;
u32 LFOF:5;
u32 LFORE:1;
u32 pad_10:16;
//+20 -- IMXL[3:0] ISEL[3:0]
u32 ISEL:4;
u32 IMXL:4;
u32 rez_20_0:8;
u32 pad_11:16;
//+24 -- DISDL[3:0] -- DIPAN[4:0]
u32 DIPAN:5;
u32 rez_24_0:3;
u32 DISDL:4;
u32 rez_24_1:4;
u32 pad_12:16;
//+28 TL[7:0] -- Q[4:0]
u32 Q:5;
u32 rez_28_0:3;
u32 TL:8;
u32 pad_13:16;
//+2C -- FLV0[12:0]
u32 FLV0:13;
u32 rez_2C_0:3;
u32 pad_14:16;
//+30 -- FLV1[12:0]
u32 FLV1:13;
u32 rez_30_0:3;
u32 pad_15:16;
//+34 -- FLV2[12:0]
u32 FLV2:13;
u32 rez_34_0:3;
u32 pad_16:16;
//+38 -- FLV3[12:0]
u32 FLV3:13;
u32 rez_38_0:3;
u32 pad_17:16;
//+3C -- FLV4[12:0]
u32 FLV4:13;
u32 rez_3C_0:3;
u32 pad_18:16;
//+40 -- FAR[4:0] -- FD1R[4:0]
u32 FD1R:5;
u32 rez_40_0:3;
u32 FAR:5;
u32 rez_40_1:3;
u32 pad_19:16;
//+44 -- FD2R[4:0] -- FRR[4:0]
u32 FRR:5;
u32 rez_44_0:3;
u32 FD2R:5;
u32 rez_44_1:3;
u32 pad_20:16;
};
enum _EG_state
{
EG_Attack = 0,
EG_Decay1 = 1,
EG_Decay2 = 2,
EG_Release = 3
};
/*
KEY_OFF->KEY_ON : Resets everything, and starts playback (EG: A)
KEY_ON->KEY_ON : nothing
KEY_ON->KEY_OFF : Switches to RELEASE state (does not disable channel)
*/
struct ChannelEx;
//make these DYNACALL ? they were fastcall before ..
void (* STREAM_STEP_LUT[5][2][2])(ChannelEx* ch);
void (* STREAM_INITAL_STEP_LUT[5])(ChannelEx* ch);
void (* AEG_STEP_LUT[4])(ChannelEx* ch);
void (* FEG_STEP_LUT[4])(ChannelEx* ch);
void (* ALFOWS_CALC[4])(ChannelEx* ch);
void (* PLFOWS_CALC[4])(ChannelEx* ch);
struct ChannelEx
{
static ChannelEx Chans[64];
ChannelCommonData* ccd;
u8* SA;
u32 CA;
fp_22_10 step;
u32 update_rate;
SampleType s0,s1;
struct
{
u32 LSA;
u32 LEA;
u8 looped;
} loop;
struct
{
//used in adpcm decoding
s32 last_quant;
//SampleType prev_sample;
void Reset(ChannelEx* ch)
{
last_quant=127;
//prev_sample=0;
ch->s0=0;
}
} adpcm;
u32 noise_state;//for Noise generator
struct
{
u32 DLAtt;
u32 DRAtt;
u32 DSPAtt;
SampleType* DSPOut;
} VolMix;
void (* StepAEG)(ChannelEx* ch);
void (* StepFEG)(ChannelEx* ch);
void (* StepStream)(ChannelEx* ch);
void (* StepStreamInitial)(ChannelEx* ch);
u8 step_stream_lut1=0 ;
u8 step_stream_lut2=0 ;
u8 step_stream_lut3=0 ;
struct
{
s32 val;
__forceinline s32 GetValue() { return val>>AEG_STEP_BITS;}
void SetValue(u32 aegb) { val=aegb<<AEG_STEP_BITS; }
_EG_state state=EG_Attack;
u32 AttackRate;
u32 Decay1Rate;
u32 Decay2Value;
u32 Decay2Rate;
u32 ReleaseRate;
} AEG;
struct
{
s32 value;
_EG_state state=EG_Attack;
} FEG;//i have to figure out how this works w/ AEG and channel state, and the iir values
struct
{
u32 counter;
u32 start_value;
u8 state;
u8 alfo;
u8 alfo_shft;
u8 plfo;
u8 plfo_shft;
u8 alfo_calc_lut=0 ;
u8 plfo_calc_lut=0 ;
void (* alfo_calc)(ChannelEx* ch);
void (* plfo_calc)(ChannelEx* ch);
__forceinline void Step(ChannelEx* ch) { counter--;if (counter==0) { state++; counter=start_value; alfo_calc(ch);plfo_calc(ch); } }
void Reset(ChannelEx* ch) { state=0; counter=start_value; alfo_calc(ch); plfo_calc(ch); }
void SetStartValue(u32 nv) { start_value=nv;counter=start_value; }
} lfo;
bool enabled; //set to false to 'freeze' the channel
int ChanelNumber;
void Init(int cn,u8* ccd_raw)
{
ccd=(ChannelCommonData*)&ccd_raw[cn*0x80];
ChanelNumber=cn;
for (u32 i=0;i<0x80;i++)
RegWrite(i);
disable();
}
void disable()
{
enabled=false;
SetAegState(EG_Release);
AEG.SetValue(0x3FF);
}
void enable()
{
enabled=true;
}
__forceinline SampleType InterpolateSample()
{
SampleType rv;
u32 fp=step.fp;
rv=FPMul(s0,(s32)(1024-fp),10);
rv+=FPMul(s1,(s32)(fp),10);
return rv;
}
__forceinline bool Step(SampleType& oLeft, SampleType& oRight, SampleType& oDsp)
{
if (!enabled)
{
oLeft=oRight=oDsp=0;
return false;
}
else
{
SampleType sample=InterpolateSample();
//Volume & Mixer processing
//All attenuations are added together then applied and mixed :)
//offset is up to 511
//*Att is up to 511
//logtable handles up to 1024, anything >=255 is mute
u32 ofsatt=lfo.alfo+(AEG.GetValue()>>2);
ofsatt = min(ofsatt, (u32)255); // make sure it never gets more 255 -- it can happen with some alfo/aeg combinations
u32 const max_att = ((16 << 4) - 1) - ofsatt;
s32* logtable = ofsatt + tl_lut;
u32 dl = min(VolMix.DLAtt, max_att);
u32 dr = min(VolMix.DRAtt, max_att);
u32 ds = min(VolMix.DSPAtt, max_att);
oLeft = FPMul(sample, logtable[dl], 15);
oRight = FPMul(sample, logtable[dr], 15);
oDsp = FPMul(sample, logtable[ds], 15);
clip_verify(((s16)oLeft)==oLeft);
clip_verify(((s16)oRight)==oRight);
clip_verify(((s16)oDsp)==oDsp);
clip_verify(sample*oLeft>=0);
clip_verify(sample*oRight>=0);
clip_verify(sample*oDsp>=0);
StepAEG(this);
StepFEG(this);
StepStream(this);
lfo.Step(this);
return true;
}
}
__forceinline void Step(SampleType& mixl, SampleType& mixr)
{
SampleType oLeft,oRight,oDsp;
Step(oLeft, oRight, oDsp);
*VolMix.DSPOut+=oDsp;
mixl+=oLeft;
mixr+=oRight;
}
__forceinline static void StepAll(SampleType& mixl, SampleType& mixr)
{
for (int i = 0; i < 64; i++)
{
Chans[i].Step(mixl, mixr);
}
}
void SetAegState(_EG_state newstate)
{
StepAEG=AEG_STEP_LUT[newstate];
AEG.state=newstate;
if (newstate==EG_Release)
ccd->KYONB=0;
}
void SetFegState(_EG_state newstate)
{
StepFEG=FEG_STEP_LUT[newstate];
FEG.state=newstate;
}
void KEY_ON()
{
if (AEG.state==EG_Release)
{
//if it was off then turn it on !
enable();
// reset AEG
SetAegState(EG_Attack);
AEG.SetValue(0x3FF);//start from 0x3FF ? .. it seems so !
//reset FEG
SetFegState(EG_Attack);
//set values and crap
//Reset sampling state
CA=0;
step.full=0;
loop.looped=false;
adpcm.Reset(this);
StepStreamInitial(this);
key_printf("[%d] KEY_ON %s @ %f Hz, loop : %d\n",Channel,stream_names[ChanData->PCMS],(44100.0*update_rate)/1024,ChanData->LPCTL);
}
else
{
//ignore ?
}
}
void KEY_OFF()
{
if (AEG.state!=EG_Release)
{
key_printf("[%d] KEY_OFF -> Release\n",Channel);
SetAegState(EG_Release);
//switch to release state
}
else
{
//ignore ?
}
}
//PCMS,SSCTL,LPCTL,LPSLNK
void UpdateStreamStep()
{
s32 fmt=ccd->PCMS;
if (ccd->SSCTL)
fmt=4;
StepStream=STREAM_STEP_LUT[fmt][ccd->LPCTL][ccd->LPSLNK];
StepStreamInitial=STREAM_INITAL_STEP_LUT[fmt];
step_stream_lut1 = fmt ;
step_stream_lut2 = ccd->LPCTL ;
step_stream_lut3 = ccd->LPSLNK ;
}
//SA,PCMS
void UpdateSA()
{
u32 addr = (ccd->SA_hi<<16) | ccd->SA_low;
if (ccd->PCMS==0)
addr&=~1; //0: 16 bit
SA=&aica_ram.data[addr];
}
//LSA,LEA
void UpdateLoop()
{
loop.LSA=ccd->LSA;
loop.LEA=ccd->LEA;
}
//
u32 AEG_EffRate(u32 re)
{
s32 rv=ccd->KRS+(ccd->FNS>>9) + re*2;
if (ccd->KRS==0xF)
rv-=0xF;
if (ccd->OCT&8)
rv-=(16-ccd->OCT)*2;
else
rv+=ccd->OCT*2;
if (rv<0)
rv=0;
if (rv>0x3f)
rv=0x3f;
return rv;
}
//D2R,D1R,AR,DL,RR,KRS, [OCT,FNS] for now
void UpdateAEG()
{
AEG.AttackRate = AEG_ATT_SPS[AEG_EffRate(ccd->AR)];
AEG.Decay1Rate = AEG_DSR_SPS[AEG_EffRate(ccd->D1R)];
AEG.Decay2Value = ccd->DL<<5;
AEG.Decay2Rate = AEG_DSR_SPS[AEG_EffRate(ccd->D2R)];
AEG.ReleaseRate = AEG_DSR_SPS[AEG_EffRate(ccd->RR)];
}
//OCT,FNS
void UpdatePitch()
{
u32 oct=ccd->OCT;
u32 update_rate = 1024 | ccd->FNS;
if (oct& 8)
update_rate>>=(16-oct);
else
update_rate<<=oct;
this->update_rate=update_rate;
}
//LFORE,LFOF,PLFOWS,PLFOS,LFOWS,ALFOS
void UpdateLFO()
{
{
int N=ccd->LFOF;
int S = N >> 2;
int M = (~N) & 3;
int G = 128>>S;
int L = (G-1)<<2;
int O = L + G * (M+1);
lfo.SetStartValue(O);
}
lfo.plfo_shft=8-ccd->PLFOS;
lfo.alfo_shft=8-ccd->ALFOS;
lfo.alfo_calc=ALFOWS_CALC[ccd->ALFOWS];
lfo.plfo_calc=PLFOWS_CALC[ccd->PLFOWS];
lfo.alfo_calc_lut=ccd->ALFOWS;
lfo.plfo_calc_lut=ccd->PLFOWS;
if (ccd->LFORE)
{
lfo.Reset(this);
}
else
{
lfo.alfo_calc(this);
lfo.plfo_calc(this);
}
ccd->LFORE=0;
}
//ISEL
void UpdateDSPMIX()
{
VolMix.DSPOut = &dsp.MIXS[ccd->ISEL];
}
//TL,DISDL,DIPAN,IMXL
void UpdateAtts()
{
u32 attFull=ccd->TL+SendLevel[ccd->DISDL];
u32 attPan=attFull+SendLevel[(~ccd->DIPAN)&0xF];
//0x1* -> R decreases
if (ccd->DIPAN&0x10)
{
VolMix.DLAtt=attFull;
VolMix.DRAtt=attPan;
}
else //0x0* -> L decreases
{
VolMix.DLAtt=attPan;
VolMix.DRAtt=attFull;
}
VolMix.DSPAtt = ccd->TL+SendLevel[ccd->IMXL];
}
//Q,FLV0,FLV1,FLV2,FLV3,FLV4,FAR,FD1R,FD2R,FRR
void UpdateFEG()
{
//this needs to be filled
}
//WHEE :D!
void RegWrite(u32 offset)
{
switch(offset)
{
case 0x00: //yay ?
UpdateStreamStep();
UpdateSA();
break;
case 0x01: //yay ?
UpdateStreamStep();
UpdateSA();
if (ccd->KYONEX)
{
ccd->KYONEX=0;
for (int i = 0; i < 64; i++)
{
if (Chans[i].ccd->KYONB)
Chans[i].KEY_ON();
else
Chans[i].KEY_OFF();
}
}
break;
case 0x04:
case 0x05:
UpdateSA();
break;
case 0x08://LSA
case 0x09://LSA
case 0x0C://LEA
case 0x0D://LEA
UpdateLoop();
break;
case 0x10://D1R,AR
case 0x11://D2R,D1R
UpdateAEG();
break;
case 0x14://RR,DL
case 0x15://DL,KRS,LPSLINK
UpdateStreamStep();
UpdateAEG();
break;
case 0x18://FNS
case 0x19://FNS,OCT
UpdatePitch();
UpdateAEG();
break;
case 0x1C://ALFOS,ALFOWS,PLFOS
case 0x1D://PLFOWS,LFOF,RE
UpdateLFO();
break;
case 0x20://ISEL,IMXL
//case 0x21://nothing here !
UpdateDSPMIX();
UpdateAtts();
break;
case 0x24://DIPAN
case 0x25://DISDL
UpdateAtts();
break;
case 0x28://Q
UpdateFEG();
break;
case 0x29://TL
UpdateAtts();
break;
case 0x2C: //FLV0
case 0x2D: //FLV0
case 0x30: //FLV1
case 0x31: //FLV1
case 0x34: //FLV2
case 0x35: //FLV2
case 0x38: //FLV3
case 0x39: //FLV3
case 0x3C: //FLV4
case 0x3D: //FLV4
case 0x40: //FD1R
case 0x41: //FAR
case 0x44: //FRR
case 0x45: //FD2R
UpdateFEG();
break;
}
}
};
__forceinline SampleType DecodeADPCM(u32 sample,s32 prev,s32& quant)
{
s32 sign=1-2*(sample/8);
u32 data=sample&7;
/*(1 - 2 * L4) * (L3 + L2/2 +L1/4 + 1/8) * quantized width (ƒΆn) + decode value (Xn - 1) */
SampleType rv = (quant * adpcm_scale[data]) >> 3;
if (rv > 0x7FFF)
rv = 0x7FFF;
rv = sign * rv + prev;
quant = (quant * adpcm_qs[data])>>8;
clip(quant,127,24576);
clip16(rv);
return rv;
}
template<s32 PCMS,bool last>
__forceinline void StepDecodeSample(ChannelEx* ch,u32 CA)
{
if (!last && PCMS<2)
return ;
s16* sptr16=(s16*)ch->SA;
s8* sptr8=(s8*)sptr16;
u8* uptr8=(u8*)sptr16;
SampleType s0,s1;
switch(PCMS)
{
case -1:
ch->noise_state = ch->noise_state*16807 + 0xbeef; //beef is good
s0=ch->noise_state;
s0>>=16;
s1=ch->noise_state*16807 + 0xbeef;
s1>>=16;
break;
case 0:
{
//s16* ptr=(s16*)&aica_ram[(addr&~1)+(CA<<1)];
sptr16+=CA;
s0=sptr16[0];
s1=sptr16[1];
}
break;
case 1:
{
//s8* ptr=(s8*)&aica_ram[addr+(CA)];
sptr8+=CA;
s0=sptr8[0]<<8;
s1=sptr8[1]<<8;
}
break;
case 2:
case 3:
{
//u32 offs=CA;
u8 ad1=uptr8[CA>>1];
u8 ad2=uptr8[(CA+1)>>1];
u8 sf=(CA&1)*4;
ad1>>=sf;
ad2>>=4-sf;
ad1&=0xF;
ad2&=0xF;
s32 q=ch->adpcm.last_quant;
s0=DecodeADPCM(ad1,ch->s0,q);
ch->adpcm.last_quant=q;
if (last)
s1=DecodeADPCM(ad2,s0,q);
else
s1=0;
}
break;
}
ch->s0=s0;
ch->s1=s1;
}
template<s32 PCMS>
void StepDecodeSampleInitial(ChannelEx* ch)
{
StepDecodeSample<PCMS,true>(ch,0);
}
template<s32 PCMS,u32 LPCTL,u32 LPSLNK>
void StreamStep(ChannelEx* ch)
{
ch->step.full+=ch->update_rate;
fp_22_10 sp=ch->step;
ch->step.ip=0;
while(sp.ip>0)
{
sp.ip--;
u32 CA=ch->CA + 1;
u32 ca_t=CA;
if (PCMS==3)
ca_t&=~3; //adpcm "stream" mode needs this ...
if (LPSLNK)
{
if ((ch->AEG.state==EG_Attack) && (CA>=ch->loop.LSA))
{
step_printf("[%d]LPSLNK : Switching to EG_Decay1 %X\n",Channel,AEG.GetValue());
ch->SetAegState(EG_Decay1);
}
}
if (ca_t>=ch->loop.LEA)
{
ch->loop.looped=1;
CA=ch->loop.LSA;
if (LPCTL)
{
if (PCMS==2) //if in adpcm non-stream mode, reset the decoder
{
ch->adpcm.Reset(ch);
}
}
else
{
ch->disable();
}
}
ch->CA=CA;
//keep adpcm up to date
if (sp.ip==0)
StepDecodeSample<PCMS,true>(ch,CA);
else
StepDecodeSample<PCMS,false>(ch,CA);
}
}
template<s32 ALFOWS>
void CalcAlfo(ChannelEx* ch)
{
u32 rv;
switch(ALFOWS)
{
case 0: // Sawtooth
rv=ch->lfo.state;
break;
case 1: // Square
rv=ch->lfo.state&0x80?255:0;
break;
case 2: // Triangle
rv=(ch->lfo.state&0x7f)^(ch->lfo.state&0x80 ? 0x7F:0);
rv<<=1;
break;
case 3:// Random ! .. not :p
rv=(ch->lfo.state>>3)^(ch->lfo.state<<3)^(ch->lfo.state&0xE3);
break;
}
ch->lfo.alfo=rv>>ch->lfo.alfo_shft;
}
template<s32 PLFOWS>
void CalcPlfo(ChannelEx* ch)
{
u32 rv;
switch(PLFOWS)
{
case 0: // sawtooth
rv=ch->lfo.state;
break;
case 1: // square
rv=ch->lfo.state&0x80?0x80:0x7F;
break;
case 2: // triangle
rv=(ch->lfo.state&0x7f)^(ch->lfo.state&0x80 ? 0x7F:0);
rv<<=1;
rv=(u8)(rv-0x80); //2's complement
break;
case 3:// random ! .. not :p
rv=(ch->lfo.state>>3)^(ch->lfo.state<<3)^(ch->lfo.state&0xE3);
break;
}
ch->lfo.plfo=rv>>ch->lfo.plfo_shft;
}
template<u32 state>
void AegStep(ChannelEx* ch)
{
switch(state)
{
case EG_Attack:
{
//wii
ch->AEG.val-=ch->AEG.AttackRate;
if (ch->AEG.GetValue()<=0)
{
ch->AEG.SetValue(0);
if (!ch->ccd->LPSLNK)
{
aeg_printf("[%d]AEG_step : Switching to EG_Decay1 %d\n",ch->AEG.GetValue());
ch->SetAegState(EG_Decay1);
}
}
}
break;
case EG_Decay1:
{
//x2
ch->AEG.val+=ch->AEG.Decay1Rate;
if (((u32)ch->AEG.GetValue())>=ch->AEG.Decay2Value)
{
aeg_printf("[%d]AEG_step : Switching to EG_Decay2 @ %x\n",ch->AEG.GetValue());
ch->SetAegState(EG_Decay2);
}
}
break;
case EG_Decay2:
{
//x3
ch->AEG.val+=ch->AEG.Decay2Rate;
if (ch->AEG.GetValue()>=0x3FF)
{
aeg_printf("[%d]AEG_step : Switching to EG_Release @ %x\n",ch->AEG.GetValue());
ch->AEG.SetValue(0x3FF);
ch->SetAegState(EG_Release);
}
}
break;
case EG_Release: //only on key_off ?
{
ch->AEG.val+=ch->AEG.ReleaseRate;
if (ch->AEG.GetValue()>=0x3FF)
{
aeg_printf("[%d]AEG_step : EG_Release End @ %x\n",ch->AEG.GetValue());
ch->AEG.SetValue(0x3FF); // TODO: mnn, should we do anything about it running wild ?
ch->disable(); // TODO: Is this ok here? It's a speed optimisation (since the channel is muted)
}
}
break;
}
}
template<u32 state>
void FegStep(ChannelEx* ch)
{
}
void staticinitialise()
{
STREAM_STEP_LUT[0][0][0]=&StreamStep<0,0,0>;
STREAM_STEP_LUT[1][0][0]=&StreamStep<1,0,0>;
STREAM_STEP_LUT[2][0][0]=&StreamStep<2,0,0>;
STREAM_STEP_LUT[3][0][0]=&StreamStep<3,0,0>;
STREAM_STEP_LUT[4][0][0]=&StreamStep<-1,0,0>;
STREAM_STEP_LUT[0][0][1]=&StreamStep<0,0,1>;
STREAM_STEP_LUT[1][0][1]=&StreamStep<1,0,1>;
STREAM_STEP_LUT[2][0][1]=&StreamStep<2,0,1>;
STREAM_STEP_LUT[3][0][1]=&StreamStep<3,0,1>;
STREAM_STEP_LUT[4][0][1]=&StreamStep<-1,0,1>;
STREAM_STEP_LUT[0][1][0]=&StreamStep<0,1,0>;
STREAM_STEP_LUT[1][1][0]=&StreamStep<1,1,0>;
STREAM_STEP_LUT[2][1][0]=&StreamStep<2,1,0>;
STREAM_STEP_LUT[3][1][0]=&StreamStep<3,1,0>;
STREAM_STEP_LUT[4][1][0]=&StreamStep<-1,1,0>;
STREAM_STEP_LUT[0][1][1]=&StreamStep<0,1,1>;
STREAM_STEP_LUT[1][1][1]=&StreamStep<1,1,1>;
STREAM_STEP_LUT[2][1][1]=&StreamStep<2,1,1>;
STREAM_STEP_LUT[3][1][1]=&StreamStep<3,1,1>;
STREAM_STEP_LUT[4][1][1]=&StreamStep<-1,1,1>;
STREAM_INITAL_STEP_LUT[0]=&StepDecodeSampleInitial<0>;
STREAM_INITAL_STEP_LUT[1]=&StepDecodeSampleInitial<1>;
STREAM_INITAL_STEP_LUT[2]=&StepDecodeSampleInitial<2>;
STREAM_INITAL_STEP_LUT[3]=&StepDecodeSampleInitial<3>;
STREAM_INITAL_STEP_LUT[4]=&StepDecodeSampleInitial<-1>;
AEG_STEP_LUT[0]=&AegStep<0>;
AEG_STEP_LUT[1]=&AegStep<1>;
AEG_STEP_LUT[2]=&AegStep<2>;
AEG_STEP_LUT[3]=&AegStep<3>;
FEG_STEP_LUT[0]=&FegStep<0>;
FEG_STEP_LUT[1]=&FegStep<1>;
FEG_STEP_LUT[2]=&FegStep<2>;
FEG_STEP_LUT[3]=&FegStep<3>;
ALFOWS_CALC[0]=&CalcAlfo<0>;
ALFOWS_CALC[1]=&CalcAlfo<1>;
ALFOWS_CALC[2]=&CalcAlfo<2>;
ALFOWS_CALC[3]=&CalcAlfo<3>;
PLFOWS_CALC[0]=&CalcPlfo<0>;
PLFOWS_CALC[1]=&CalcPlfo<1>;
PLFOWS_CALC[2]=&CalcPlfo<2>;
PLFOWS_CALC[3]=&CalcPlfo<3>;
}
#define AicaChannel ChannelEx
AicaChannel AicaChannel::Chans[64];
#define Chans AicaChannel::Chans
double dbToval(double db)
{
return pow(10,db/20.0);
}
u32 CalcAegSteps(float t)
{
const double aeg_allsteps=1024*(1<<AEG_STEP_BITS)-1;
if (t<0)
return 0;
if (t==0)
return (u32)aeg_allsteps;
//44.1*ms = samples
double scnt=44.1*t;
double steps=aeg_allsteps/scnt;
return (u32)(steps+0.5);
}
void sgc_Init()
{
staticinitialise();
for (int i=0;i<16;i++)
{
volume_lut[i]=(s32)((1<<15)/pow(2.0,(15-i)/2.0));
if (i==0)
volume_lut[i]=0;
}
for (int i=0;i<256;i++)
{
tl_lut[i]=(s32)((1<<15)/pow(2.0,i/16.0));
}
//tl entries 256 to 1023 are 0
for (int i=256;i<1024;i++)
tl_lut[i]=0;
for (int i=0;i<64;i++)
{
AEG_ATT_SPS[i]=CalcAegSteps(AEG_Attack_Time[i]);
AEG_DSR_SPS[i]=CalcAegSteps(AEG_DSR_Time[i]);
}
for (int i=0;i<64;i++)
Chans[i].Init(i,aica_reg);
dsp_out_vol=(DSP_OUT_VOL_REG*)&aica_reg[0x2000];
dsp_init();
}
void sgc_Term()
{
dsp_term();
}
void WriteChannelReg8(u32 channel,u32 reg)
{
Chans[channel].RegWrite(reg);
}
void ReadCommonReg(u32 reg,bool byte)
{
switch(reg)
{
case 0x2808:
case 0x2809:
CommonData->MIEMP=1;
CommonData->MOEMP=1;
break;
case 0x2810: //LP & misc
case 0x2811: //LP & misc
{
u32 chan=CommonData->MSLC;
CommonData->LP=Chans[chan].loop.looped;
verify(CommonData->AFSET==0);
CommonData->EG=Chans[chan].AEG.GetValue(); //AEG is only 10 bits, FEG is 13 bits
CommonData->SGC=Chans[chan].AEG.state;
if (! (byte && reg==0x2810))
Chans[chan].loop.looped=0;
}
break;
case 0x2814: //CA
case 0x2815: //CA
{
u32 chan=CommonData->MSLC;
CommonData->CA = Chans[chan].CA /*& (~1023)*/; //mmnn??
//printf("[%d] CA read %d\n",chan,Chans[chan].CA);
}
break;
}
}
void WriteCommonReg8(u32 reg,u32 data)
{
WriteMemArr(aica_reg,reg,data,1);
if (reg==0x2804 || reg==0x2805)
{
dsp.RBL=(8192<<CommonData->RBL)-1;
dsp.RBP=( CommonData->RBP*2048&AICA_RAM_MASK);
dsp.dyndirty=true;
}
}
#define CDDA_SIZE (2352/2)
s16 cdda_sector[CDDA_SIZE]={0};
u32 cdda_index=CDDA_SIZE<<1;
SampleType mxlr[64];
u32 samples_gen;
//no DSP for now in this version
void AICA_Sample32()
{
if (settings.aica.NoBatch)
{
return;
}
memset(mxlr,0,sizeof(mxlr));
//Generate 32 samples for each channel, before moving to next channel
//much more cache efficient !
u32 sg=0;
for (int ch = 0; ch < 64; ch++)
{
for (int i=0;i<32;i++)
{
SampleType oLeft,oRight,oDsp;
//stop working on this channel if its turned off ...
if (!Chans[ch].Step(oLeft, oRight, oDsp))
break;
sg++;
if (0==(oLeft+oRight))
{
oLeft=oRight=oDsp;
}
mxlr[i*2+0] += oLeft;
mxlr[i*2+1] += oRight;
}
}
#if HOST_OS==OS_WINDOWS
samples_gen += sg;
#endif
//OK , generated all Channels , now DSP/ect + final mix ;p
//CDDA EXTS input
for (int i=0;i<32;i++)
{
SampleType mixl,mixr;
mixl=mxlr[i*2+0];
mixr=mxlr[i*2+1];
if (cdda_index>=CDDA_SIZE)
{
cdda_index=0;
libCore_CDDA_Sector(cdda_sector);
}
s32 EXTS0L=cdda_sector[cdda_index];
s32 EXTS0R=cdda_sector[cdda_index+1];
cdda_index+=2;
//Final MIX ..
//Add CDDA / DSP effect(s)
//CDDA
if (settings.aica.CDDAMute==0)
{
VOLPAN(EXTS0L,dsp_out_vol[16].EFSDL,dsp_out_vol[16].EFPAN,mixl,mixr);
VOLPAN(EXTS0R,dsp_out_vol[17].EFSDL,dsp_out_vol[17].EFPAN,mixl,mixr);
}
/*
no dsp for now -- needs special handling of oDSP for ch paraller version ...
if (settings.aica.DSPEnabled)
{
dsp_step();
for (int i=0;i<16;i++)
{
VOLPAN( (*(s16*)&DSPData->EFREG[i]) ,dsp_out_vol[i].EFSDL,dsp_out_vol[i].EFPAN,mixl,mixr);
}
}
*/
//Mono !
if (CommonData->Mono)
{
//Yay for mono =P
mixl+=mixr;
mixr=mixl;
}
//MVOL !
//we want to make sure mix* is *At least* 23 bits wide here, so 64 bit mul !
u32 mvol=CommonData->MVOL;
s32 val=volume_lut[mvol];
mixl=(s32)FPMul((s64)mixl,val,15);
mixr=(s32)FPMul((s64)mixr,val,15);
if (CommonData->DAC18B)
{
//If 18 bit output , make it 16b :p
mixl=FPs(mixl,2);
mixr=FPs(mixr,2);
}
//Sample is ready ! clip/saturate and store :}
#ifdef CLIP_WARN
if (((s16)mixl) != mixl)
printf("Clipped mixl %d\n",mixl);
if (((s16)mixr) != mixr)
printf("Clipped mixr %d\n",mixr);
#endif
clip16(mixl);
clip16(mixr);
pl=mixl;
pr=mixr;
if (!settings.aica.NoSound) WriteSample(mixr,mixl);
}
}
void AICA_Sample()
{
SampleType mixl,mixr;
mixl = 0;
mixr = 0;
memset(dsp.MIXS,0,sizeof(dsp.MIXS));
ChannelEx::StepAll(mixl,mixr);
//OK , generated all Channels , now DSP/ect + final mix ;p
//CDDA EXTS input
if (cdda_index>=CDDA_SIZE)
{
cdda_index=0;
libCore_CDDA_Sector(cdda_sector);
}
s32 EXTS0L=cdda_sector[cdda_index];
s32 EXTS0R=cdda_sector[cdda_index+1];
cdda_index+=2;
//No dsp tho ;p
//Final MIX ..
//Add CDDA / DSP effect(s)
//CDDA
if (settings.aica.CDDAMute==0)
{
VOLPAN(EXTS0L,dsp_out_vol[16].EFSDL,dsp_out_vol[16].EFPAN,mixl,mixr);
VOLPAN(EXTS0R,dsp_out_vol[17].EFSDL,dsp_out_vol[17].EFPAN,mixl,mixr);
DSPData->EXTS[0] = EXTS0L;
DSPData->EXTS[1] = EXTS0R;
}
else
{
DSPData->EXTS[0] = 0;
DSPData->EXTS[1] = 0;
}
//if (settings.aica.DSPEnabled)
{
dsp_step();
for (int i=0;i<16;i++)
{
VOLPAN( (*(s16*)&DSPData->EFREG[i]) ,dsp_out_vol[i].EFSDL,dsp_out_vol[i].EFPAN,mixl,mixr);
}
}
if (settings.aica.NoSound)
{
return;
}
//Mono !
if (CommonData->Mono)
{
//Yay for mono =P
mixl+=mixr;
mixr=mixl;
}
//MVOL !
//we want to make sure mix* is *At least* 23 bits wide here, so 64 bit mul !
u32 mvol=CommonData->MVOL;
s32 val=volume_lut[mvol];
mixl=(s32)FPMul((s64)mixl,val,15);
mixr=(s32)FPMul((s64)mixr,val,15);
if (CommonData->DAC18B)
{
//If 18 bit output , make it 16b :p
mixl=FPs(mixl,2);
mixr=FPs(mixr,2);
}
//Sample is ready ! clip/saturate and store :}
#ifdef CLIP_WARN
if (((s16)mixl) != mixl)
printf("Clipped mixl %d\n",mixl);
if (((s16)mixr) != mixr)
printf("Clipped mixr %d\n",mixr);
#endif
clip16(mixl);
clip16(mixr);
pl=mixl;
pr=mixr;
WriteSample(mixr,mixl);
}
bool channel_serialize(void **data, unsigned int *total_size)
{
int i = 0 ;
int addr = 0 ;
for ( i = 0 ; i < 64 ; i++)
{
addr = Chans[i].SA - (&(aica_ram.data[0])) ;
REICAST_S(addr);
REICAST_S(Chans[i].CA) ;
REICAST_S(Chans[i].step) ;
REICAST_S(Chans[i].update_rate) ;
REICAST_S(Chans[i].s0) ;
REICAST_S(Chans[i].s1) ;
REICAST_S(Chans[i].loop) ;
REICAST_S(Chans[i].adpcm.last_quant) ;
REICAST_S(Chans[i].noise_state) ;
REICAST_S(Chans[i].VolMix.DLAtt) ;
REICAST_S(Chans[i].VolMix.DRAtt) ;
REICAST_S(Chans[i].VolMix.DSPAtt) ;
addr = Chans[i].VolMix.DSPOut - (&(dsp.MIXS[0])) ;
REICAST_S(addr);
REICAST_S(Chans[i].AEG.val) ;
REICAST_S(Chans[i].AEG.state) ;
REICAST_S(Chans[i].AEG.AttackRate) ;
REICAST_S(Chans[i].AEG.Decay1Rate) ;
REICAST_S(Chans[i].AEG.Decay2Rate) ;
REICAST_S(Chans[i].AEG.Decay2Value) ;
REICAST_S(Chans[i].AEG.ReleaseRate) ;
REICAST_S(Chans[i].FEG) ;
REICAST_S(Chans[i].step_stream_lut1) ;
REICAST_S(Chans[i].step_stream_lut2) ;
REICAST_S(Chans[i].step_stream_lut3) ;
REICAST_S(Chans[i].lfo.counter) ;
REICAST_S(Chans[i].lfo.start_value) ;
REICAST_S(Chans[i].lfo.state) ;
REICAST_S(Chans[i].lfo.alfo) ;
REICAST_S(Chans[i].lfo.alfo_shft) ;
REICAST_S(Chans[i].lfo.plfo) ;
REICAST_S(Chans[i].lfo.plfo_shft) ;
REICAST_S(Chans[i].lfo.alfo_calc_lut) ;
REICAST_S(Chans[i].lfo.plfo_calc_lut) ;
REICAST_S(Chans[i].enabled) ;
REICAST_S(Chans[i].ChanelNumber) ;
}
/* TODO/FIXME - no possibility for this to return false? */
return true;
}
bool channel_unserialize(void **data, unsigned int *total_size)
{
int i = 0 ;
int addr = 0 ;
for ( i = 0 ; i < 64 ; i++)
{
REICAST_US(addr);
Chans[i].SA = addr + (&(aica_ram.data[0])) ;
REICAST_US(Chans[i].CA) ;
REICAST_US(Chans[i].step) ;
REICAST_US(Chans[i].update_rate) ;
REICAST_US(Chans[i].s0) ;
REICAST_US(Chans[i].s1) ;
REICAST_US(Chans[i].loop) ;
REICAST_US(Chans[i].adpcm.last_quant) ;
REICAST_US(Chans[i].noise_state) ;
REICAST_US(Chans[i].VolMix.DLAtt) ;
REICAST_US(Chans[i].VolMix.DRAtt) ;
REICAST_US(Chans[i].VolMix.DSPAtt) ;
REICAST_US(addr);
Chans[i].VolMix.DSPOut = addr + (&(dsp.MIXS[0])) ;
REICAST_US(Chans[i].AEG.val) ;
REICAST_US(Chans[i].AEG.state) ;
Chans[i].StepAEG=AEG_STEP_LUT[Chans[i].AEG.state];
REICAST_US(Chans[i].AEG.AttackRate) ;
REICAST_US(Chans[i].AEG.Decay1Rate) ;
REICAST_US(Chans[i].AEG.Decay2Rate) ;
REICAST_US(Chans[i].AEG.Decay2Value) ;
REICAST_US(Chans[i].AEG.ReleaseRate) ;
REICAST_US(Chans[i].FEG) ;
Chans[i].StepFEG=FEG_STEP_LUT[Chans[i].FEG.state];
REICAST_US(Chans[i].step_stream_lut1) ;
REICAST_US(Chans[i].step_stream_lut2) ;
REICAST_US(Chans[i].step_stream_lut3) ;
Chans[i].StepStream=STREAM_STEP_LUT[Chans[i].step_stream_lut1][Chans[i].step_stream_lut2][Chans[i].step_stream_lut3] ;
Chans[i].StepStreamInitial=STREAM_INITAL_STEP_LUT[Chans[i].step_stream_lut1];
REICAST_US(Chans[i].lfo.counter) ;
REICAST_US(Chans[i].lfo.start_value) ;
REICAST_US(Chans[i].lfo.state) ;
REICAST_US(Chans[i].lfo.alfo) ;
REICAST_US(Chans[i].lfo.alfo_shft) ;
REICAST_US(Chans[i].lfo.plfo) ;
REICAST_US(Chans[i].lfo.plfo_shft) ;
REICAST_US(Chans[i].lfo.alfo_calc_lut) ;
REICAST_US(Chans[i].lfo.plfo_calc_lut) ;
Chans[i].lfo.alfo_calc = ALFOWS_CALC[Chans[i].lfo.alfo_calc_lut];
Chans[i].lfo.plfo_calc = PLFOWS_CALC[Chans[i].lfo.plfo_calc_lut];
REICAST_US(Chans[i].enabled) ;
REICAST_US(Chans[i].ChanelNumber) ;
}
/* TODO/FIXME - no possibility for this to return false? */
return true;
}
Reference in New Issue View Git Blame Copy Permalink