dolphin/docs/DSP/wwdsp.c

423 lines
10 KiB
C
Raw Normal View History

/* important variables */
short mem[0x1000];
#define v_0341 mem[0x0341] /* op#2 saves a copy of 344 here */
#define v_0343 mem[0x0343] /* message type? */
#define v_0344 mem[0x0344] /* low byte of first word of message */
#define v_0345 mem[0x0345] /* copy of second word of message */
#define a_0346 mem[0x0346] /* buffer for message contents, size unknown */
#define v_034e mem[0x034e] /* init to 0, later set to most recent value written in a_04fc */
#define v_0350 mem[0x0350] /* init to 0x0280 (write location of messages) */
#define v_0351 mem[0x0351] /* init to 0x0280 (read location?) */
#define v_0352 mem[0x0352] /* init to 0 (number of messages pending?) */
#define v_0355 mem[0x0355] /* used by op#2, init to 0 */
#define a_0356 (mem+0x0356) /* message contents */
#define a_0388 (mem+0x388) /* where op 2 keeps its message */
#define a_038e (mem+0x38e) /* op#2 saves a copy of 345 here */
#define a_03a8 (mem+0x3a8) /* where op#2 dmas in its data, at least 0x80 */
#define v_03fa mem[0x03fa] /* temp for ax0.h during exception */
#define v_03fb mem[0x03fb] /* temp for ar0 during exception */
#define v_03fc mem[0x03fc] /* temp for r08 during exception */
#define v_03fd mem[0x03fd] /* temp for ac0.h during exception */
#define v_03fe mem[0x03fe] /* temp for ac0.m during exception */
#define v_03ff mem[0x03ff] /* temp for ac0.l during exception */
#define a_04e8 (mem+0x04e8) /* 4 element array */
#define a_04ec (mem+0x04ec) /* 4 element array (empty) */
#define a_04f0 (mem+0x04f0) /* 4 element array */
#define a_04f4 (mem+0x04f4) /* 4 element array (empty) */
#define a_04fc (mem+0x04fc) /* 16 element array, written by messages */
#define a_09a0 (mem+0x09a0) /* 0x50 element array, used by op#2, cleared */
#define a_0a00 (mem+0x0a00) /* 0x50 element array, used by op#2, cleared */
#define a_0b00 (mem+0x0b00) /* array from 0x0b00-0x0bff, involves accelerator? */
#define a_0ca0 (mem+0x0ca0) /* 0x50 element array, used by op#2, cleared */
#define a_0d00 (mem+0x0d00) /* 0x50 element array, used by op#2, cleared */
#define a_0d60 (mem+0x0d60) /* 0x50 element array, used by op#2, cleared */
#define a_0f40 (mem+0x0f40) /* 0x50 element array, used by op#2, cleared */
/* reset exception vector 0x0000 */
void main() {
/* JMP 0x0012 */
/* various inits */
SBCLR(5); /* disable interrupts? */
fcn_0057(); /* init hardware stuff */
for(ac1.m=0x1000,ac0.m=0;ac1.m>0;ac1.m--) mem[ac0.m++]=0; /* clear all vars */
fcn_0688(); /* init some vars */
fcn_04c0(); /* set something up related to the accelerator at a_0b00 */
fcn_0e14(); /* set up a table */
fcn_066a(0); /* send a message */
fcn_0674(0x1111); /* send a message */
v_034e=0;
SBSET(5); /* enable interrupts? */
/* jump to 0x06c5 */
mainloop:
while (v_0352) ; /* while no messages pending */
SBCLR(5); /* do not distrub */
v_0352--; /* important that this be atomic */
SBSET(5);
t=v_0351;
size=mem[t++];
if (!(size&0x8000)) { /* size > 0x7fff invalid */
if (size==0) { /* die on message of length 0? */
/* jump to 0x06f5 */
/* jump to 0x05f0 */
/* TODO: analysis of HALT */
HALT();
}
for (i=size,j=0;i>0;i--) {
a_0356[j++]=mem[t++];
a_0356[j++]=mem[t++];
}
v_0351=t;
/* jump to 0x002f */
/* actual command handling */
v_0345=a_0356[1];
v_0344=a_0356[0]&0x00ff;
v_0343=(a_0346[0]>>7)&0x7e;
/* jump table at 0x75 used here */
switch (v_0343>>1) {
// 0x43
case 0:
case 10:
case 11:
case 12:
case 14:
case 15:
/* invalid command? */
config=0x00ff;
fcn_066a(0x04); /* send off a message */
fcn_0674(a_0356[0]); /* send first word of command as a message */
goto mainloop;
break;
case 1:
/* jmp 0x0095 */
break;
case 2:
/* jmp 0x0243 */
sub_0243();
break;
case 3:
/* jmp 0x0073 */
break;
case 4:
/* jmp 0x580 */
break;
case 5:
/* jmp 0x592 */
break;
case 6:
/* jmp 0x469 */
break;
case 7:
/* jmp 0x41d */
break;
case 8: /* mix */
/* jmp 0x0485 */
fcn_0067(fcn_0067(0x0346)); /* read message twice? */
/* take in the two buffers to mix */
fcn_0525(mem[0x344],mem[0x346],mem[0x347],0x400); /* size, addrH, addrL, dsp addr */
fcn_0525(mem[0x344],mem[0x348],mem[0x349],0x800);
S16(); /* saturate all adds, multiplies to 16 bits? */
i=mem[0x0344];
src1=0x400;
src2=0x800;
scale=mem[0x345];
prod=scale*mem[src2++];
val2=mem[src2++];
do {
val1=mem[src1];
val1+=prod;
prod=scale*val2;
mem[src1]=val1;
val2=mem[src2];
src1++;
src2++;
} while (--i);
S40();
/* dma out mixed buf */
fcn_0523(mem[0x344],mem[0x346],mem[0x347],0x400);
break;
case 9:
/* jmp 0x44d */
break;
case 13:
/* jmp 0x00b2 */
break;
}
}
v_0351=t;
goto mainloop;
}
/* message in MBOX exception vector? 0x000e */
void exception() {
/* JMP 0x05b8 */
SBCLR(5);
S40();
/* save ax0.h,ac0.h,ac0.m, and ac0.l */
if ((tH=register_fffe)&0x8000) { /* CPU mailbox H */
if (!(tsize=register_ffff)) { /* CPU mailbox L */
/* empty message? */
while (!((tH=register_fffe)&0x8000)) ;
tH&=0xf;
v_034e=(tH+1)<<4;
a_04fc[tH]=register_ffff;
} else { /* nonempty message? */
/* jump to 0x0692 */
/* save ar0, r08 */
t=v_0350;
mem[t++]=tsize;
do {
while (!((tH=register_fffe)&0x8000)) ;
mem[t++]=tH;
mem[t++]=register_ffff;
} while (--tsize);
v_0350=t;
v_0352++;
/* restore ar0, r08 */
/* jump to 0x05e6 */
}
} else { /* interrupt without message? */
/* jump to 0x06b9 */
/* save ar0, r08 */
mem[v_0350]=0; /* empty message */
/* jump to 0x06ab */
v_0350++;
v_0352++;
/* restore ar0, r08 */
/* jump to 0x05e6 */
}
/* 0x05e6 */
/* restore ax0.h,ac0.h,ac0.m, and ac0.l */
SBSET(5);
/* RTI */
}
/* set up some registers */
void fcn_0057() {
SBCLR(2);
SBCLR(3);
SBCLR(4);
SBCLR(6);
S40(); /* 40-bit mode */
CLR15();
M0(); /* don't multiply result by 2 */
r08=-1;
r09=-1;
r0a=-1;
r0b=-1;
config=0xff;
}
void fcn_0688() {
v_0350=0x0280;
v_0351=0x0280;
v_0352=0;
}
void fcn_04c0() {
config=0xff;
for(i=0xff,ar0=0xb00;i>0;i--) mem[ar0++]=0;
mem[ar0++]=0; /* get the last one */
fcn_0573(0x0b00,0x0100,0);
}
/* a=an address in ac1.m, l=a length in ar0, v=a value? in ac0.m */
void fcn_0573(short a, short l, short v) {
fcn_0561(a,l,0x0001);
}
/* a=an address in ac1.m, l=a length in ar0, v=a value? in ac0.m, f is a flag? in ac0.h */
/* return is in ax0.h */
short fcn_0561(short a, short l, short v, short f) {
register_ffd1=0x0a; /* unknown reg, accel? */
register_ffd6=-1; /* accel end addr H */
register_ffd7=-1; /* accel end addr L */
register_ffd8=v>>1; /*
register_ffd9=?; /* has a value from way back? */
return f;
}
/* initializes some tables that look useful... */
void fcn_0e14() {
a_04e8[0]=0x8240;
a_04e8[1]=0x7fff;
a_04e8[2]=0x7dbf;
a_04e8[3]=0x843f;
a_04f0[0]=0xb23b;
a_04f0[1]=0x7fff;
a_04f0[2]=0x4dc4;
a_04f0[3]=0xd808;
a_04ec[0]=a_04ec[1]=a_04ec[2]=a_04ec[3]=0;
a_04f4[0]=a_04f4[1]=a_04f4[2]=a_04f4[3]=0;
}
/* send a message via DSP MBOX */
void fcn_066a(short m) {
fcn_0682(); /* wait for empty mbox */
register_fffc=0xdcd1;
register_fffd=m;
register_fffb=1; /* IRQ */
fcn_0682();
}
/* wait for dsp mbox empty */
void fcn_0682() {
while (register_fffc&0x8000);
}
void fcn_0674(short m) {
fcn_0682();
register_fffc=0xf355;
register_fffd=m;
fcn_0682();
}
/* a=address in ar0 */
/* fetch a message body (up to zero)? */
short fcn_0067(short a) {
i=0x0357;
j=a;
do {
mem[j++]=mem[i++];
mem[j++]=mem[i];
} while (mem[i++]);
return a;
}
/* dma in, I assume */
/* size=words to transfer in ar0, addrL=low word of RAM address in ac0.l, addrH=high word of RAM address in ac0.m, dspaddr=dsp address in ac1.m */
void fcn_0525(short size, short addrH, short addrL, short dspaddr) {
register_ffcd=dspaddr; /* dsp address */
register_ffc9=0; /* direction: ram->dsp */
register_ffce=addrH; /* memory address H */
register_ffcf=addrL; /* memory address L */
register_ffcb=size<<1; /* bytes to transfer (size must be in words) */
fcn_0536(); /* dma wait */
}
/* dma wait? */
void fcn_0536() {
while (!(register_ffc9&4));
}
/* dma out, I assume */
/* size=words to transfer in ar0, addrL=low word of RAM address is ac0.l, addrH=high word of RAM address in ac0.m, dspaddr=dsp address in ac1.m */
/* shares code with fcn_0525 */
void fcn_0523(short size, short addrH, short addrL, shot dspaddr) {
register_ffcd=dspaddr;
/* jump back into 0525 */
register_ffc9=1; /* direction dsp->ram */
register_ffce=addrH;
register_ffcf=addrL;
register_ffcb=size<<1;
fcn_0536();
}
/* huge subroutine, op #2 */
void sub_0243() {
fcn_0067(0x0388); /* called in an indirect manner... */
v_0341=v_0344; /* low byte first word of message */
v_038e=v_0345;
v_0355=0;
fcn_022a(); /* get stuffs */
fcn_05a4(); /* write to accel */
for (i=v_0341;i>0i--) {
fcn_0102();
}
}
void fcn_022a() {
/* something else must set 386, 387 */
fcn_0525(0x0040,v_0386,v_0387,0x03a8);
}
void fcn_05a4() {
register_ffd4=-1;
register_ffd5=-1;
register_ffd6=-1;
register_ffd7=-1;
}
void fcn_0102() {
for (i=0;i<0x50;i++) a_0d00[i]=0;
for (i=0;i<0x50;i++) a_0d60[i]=0;
fcn_0e3f();
for (i=0;i<0x50;i++) a_0ca0[i]=0;
for (i=0;i<0x50;i++) a_0f40[i]=0;
for (i=0;i<0x50;i++) a_0fa0[i]=0;
for (i=0;i<0x50;i++) a_0a00[i]=0;
for (i=0;i<0x50;i++) a_09a0[i]=0;
}
void fcn_0e3f() {
fcn_00fa(0x0f40,0x0b00,0x50,0x6784);
fcn_0ba4(0x04e8,0x0b00,0x04ec);
}
/* addr1=address in ar0, addr2=address in ar3, size=size of table at addr1 in ac1.m, val=in ax0.l */
void fcn_00fa(short addr1, short addr2, short size, short val) {
M2(); /* all multiplications 2x */
tmp=mem[addr1++];
prod=val*tmp*2;
tmp=mem[addr1++];
ac0.m=prod;
prod=val*tmp*2;
tmp=mem[addr1++];
do {
ac0.m=prod;
prod=val*tmp*2;
mem[addr2]=ac0.m;
tmp=mem[addr1];
addr1++;
addr2++;
} while (--size);
M0();
}
/* addr1=address in ar0 (source 4 element table?), addr2=address in ar1 (accelerator?), addr3=address in ar2 (destination 4 element table?) */
void fcn_00ba4(short addr1, short addr2, short addr3) {
}