ee75abcabc143b498760a4a3144612e261c1bf90
[picodrive.git] / Pico / MemoryCmn.c
1 // common code for Memory.c and cd/Memory.c
2 // (c) Copyright 2006-2007, Grazvydas "notaz" Ignotas
3
4 static int PadRead(int i)
5 {
6   int pad=0,value=0,TH;
7   pad=~PicoPad[i]; // Get inverse of pad MXYZ SACB RLDU
8   TH=Pico.ioports[i+1]&0x40;
9
10   if(PicoOpt & 0x20) { // 6 button gamepad enabled
11     int phase = Pico.m.padTHPhase[i];
12
13     if(phase == 2 && !TH) {
14       value=(pad&0xc0)>>2;              // ?0SA 0000
15       goto end;
16     } else if(phase == 3 && TH) {
17       value=(pad&0x30)|((pad>>8)&0xf);  // ?1CB MXYZ
18       goto end;
19     } else if(phase == 3 && !TH) {
20       value=((pad&0xc0)>>2)|0x0f;       // ?0SA 1111
21       goto end;
22     }
23   }
24
25   if(TH) value=(pad&0x3f);              // ?1CB RLDU
26   else   value=((pad&0xc0)>>2)|(pad&3); // ?0SA 00DU
27
28   end:
29
30   // orr the bits, which are set as output
31   value |= Pico.ioports[i+1]&Pico.ioports[i+4];
32
33   return value; // will mirror later
34 }
35
36
37 #ifndef _ASM_MEMORY_C
38 static
39 #endif
40 u8 z80Read8(u32 a)
41 {
42   if(Pico.m.z80Run&1) return 0;
43
44   a&=0x1fff;
45
46   if(!(PicoOpt&4)) {
47     // Z80 disabled, do some faking
48     static u8 zerosent = 0;
49     if(a == Pico.m.z80_lastaddr) { // probably polling something
50       u8 d = Pico.m.z80_fakeval;
51       if((d & 0xf) == 0xf && !zerosent) {
52         d = 0; zerosent = 1;
53       } else {
54         Pico.m.z80_fakeval++;
55         zerosent = 0;
56       }
57       return d;
58     } else {
59       Pico.m.z80_fakeval = 0;
60     }
61   }
62
63   Pico.m.z80_lastaddr = (u16) a;
64   return Pico.zram[a];
65 }
66
67
68 #ifndef _ASM_MEMORY_C
69 static
70 #endif
71 u32 OtherRead16(u32 a, int realsize)
72 {
73   u32 d=0;
74
75   if ((a&0xff0000)==0xa00000) {
76     if ((a&0x4000)==0x0000) { d=z80Read8(a); d|=d<<8; goto end; } // Z80 ram (not byteswaped)
77     if ((a&0x6000)==0x4000) { // 0x4000-0x5fff, Fudge if disabled
78       if(PicoOpt&1) d=YM2612Read();
79       else d=Pico.m.rotate++&3;
80       dprintf("read ym2612: %04x", d);
81       goto end;
82     }
83     d=0xffff;
84     goto end;
85   }
86
87   if ((a&0xffffe0)==0xa10000) { // I/O ports
88     a=(a>>1)&0xf;
89     switch(a) {
90       case 0:  d=Pico.m.hardware; break; // Hardware value (Version register)
91       case 1:  d=PadRead(0); d|=Pico.ioports[1]&0x80; break;
92       case 2:  d=PadRead(1); d|=Pico.ioports[2]&0x80; break;
93       default: d=Pico.ioports[a]; break; // IO ports can be used as RAM
94     }
95     d|=d<<8;
96     goto end;
97   }
98
99   // |=0x80 for Shadow of the Beast & Super Offroad; rotate fakes next fetched instruction for Time Killers
100   if (a==0xa11100) { // z80 busreq
101     d=Pico.m.z80Run&1;
102 #if 1
103     if (!d) {
104       // needed by buggy Terminator (Sega CD)
105       int stop_before = SekCyclesDone() - z80stopCycle;
106       dprintf("stop before: %i", stop_before);
107       if (stop_before > 0 && stop_before <= 32) // Gens uses 16 here
108         d = 1; // bus not yet available
109     }
110 #endif
111     d=(d<<8)|0x8000|Pico.m.rotate++;
112     dprintf("get_zrun: %04x [%i|%i] @%06x", d, Pico.m.scanline, SekCyclesDone(), SekPc);
113     goto end;
114   }
115
116 #ifndef _ASM_MEMORY_C
117   if ((a&0xe700e0)==0xc00000) { d=PicoVideoRead(a); goto end; }
118 #endif
119
120   d = OtherRead16End(a, realsize);
121
122 end:
123   return d;
124 }
125
126
127 //extern UINT32 mz80GetRegisterValue(void *, UINT32);
128
129 #ifndef _ASM_CD_MEMORY_C
130 static
131 #endif
132 void OtherWrite8(u32 a,u32 d,int realsize)
133 {
134   if ((a&0xe700f9)==0xc00011||(a&0xff7ff9)==0xa07f11) { if(PicoOpt&2) SN76496Write(d); return; } // PSG Sound
135   if ((a&0xff4000)==0xa00000)  { if(!(Pico.m.z80Run&1)) Pico.zram[a&0x1fff]=(u8)d; return; } // Z80 ram
136   if ((a&0xff6000)==0xa04000)  { if(PicoOpt&1) emustatus|=YM2612Write(a&3, d); return; } // FM Sound
137   if ((a&0xffffe0)==0xa10000)  { // I/O ports
138     a=(a>>1)&0xf;
139     // 6 button gamepad: if TH went from 0 to 1, gamepad changes state
140     if(PicoOpt&0x20) {
141       if(a==1) {
142         Pico.m.padDelay[0] = 0;
143         if(!(Pico.ioports[1]&0x40) && (d&0x40)) Pico.m.padTHPhase[0]++;
144       }
145       else if(a==2) {
146         Pico.m.padDelay[1] = 0;
147         if(!(Pico.ioports[2]&0x40) && (d&0x40)) Pico.m.padTHPhase[1]++;
148       }
149     }
150     Pico.ioports[a]=(u8)d; // IO ports can be used as RAM
151     return;
152   }
153   if (a==0xa11100) {
154     //int lineCycles=(488-SekCyclesLeft)&0x1ff;
155     d&=1; d^=1;
156     if(!d) {
157       // this is for a nasty situation where Z80 was enabled and disabled in the same 68k timeslice (Golden Axe III)
158       if (Pico.m.z80Run) {
159         int lineCycles;
160         z80stopCycle = SekCyclesDone();
161         if (Pico.m.z80Run&2)
162              lineCycles=(488-SekCyclesLeft)&0x1ff;
163         else lineCycles=z80stopCycle-z80startCycle; // z80 was started at current line
164         if (lineCycles > 0 && lineCycles <= 488) {
165           dprintf("zrun: %i/%i cycles", lineCycles, (lineCycles>>1)-(lineCycles>>5));
166           lineCycles=(lineCycles>>1)-(lineCycles>>5);
167           z80_run(lineCycles);
168         }
169       }
170     } else {
171       z80startCycle = SekCyclesDone();
172       //if(Pico.m.scanline != -1)
173     }
174     dprintf("set_zrun: %02x [%i|%i] @%06x", d, Pico.m.scanline, SekCyclesDone(), /*mz80GetRegisterValue(NULL, 0),*/ SekPc);
175     Pico.m.z80Run=(u8)d; return;
176   }
177   if (a==0xa11200) {
178     dprintf("write z80Reset: %02x", d);
179     if(!(d&1)) z80_reset();
180     return;
181   }
182
183   if ((a&0xff7f00)==0xa06000) // Z80 BANK register
184   {
185     Pico.m.z80_bank68k>>=1;
186     Pico.m.z80_bank68k|=(d&1)<<8;
187     Pico.m.z80_bank68k&=0x1ff; // 9 bits and filled in the new top one
188     return;
189   }
190
191   if ((a&0xe700e0)==0xc00000) {
192     PicoVideoWrite(a,(u16)(d|(d<<8))); // Byte access gets mirrored
193     return;
194   }
195
196   OtherWrite8End(a, d, realsize);
197 }
198
199
200 #ifndef _ASM_CD_MEMORY_C
201 static
202 #endif
203 void OtherWrite16(u32 a,u32 d)
204 {
205   if ((a&0xe700e0)==0xc00000) { PicoVideoWrite(a,(u16)d); return; }
206   if ((a&0xff4000)==0xa00000) { if(!(Pico.m.z80Run&1)) Pico.zram[a&0x1fff]=(u8)(d>>8); return; } // Z80 ram (MSB only)
207
208   if ((a&0xffffe0)==0xa10000) { // I/O ports
209     a=(a>>1)&0xf;
210     // 6 button gamepad: if TH went from 0 to 1, gamepad changes state
211     if(PicoOpt&0x20) {
212       if(a==1) {
213         Pico.m.padDelay[0] = 0;
214         if(!(Pico.ioports[1]&0x40) && (d&0x40)) Pico.m.padTHPhase[0]++;
215       }
216       else if(a==2) {
217         Pico.m.padDelay[1] = 0;
218         if(!(Pico.ioports[2]&0x40) && (d&0x40)) Pico.m.padTHPhase[1]++;
219       }
220     }
221     Pico.ioports[a]=(u8)d; // IO ports can be used as RAM
222     return;
223   }
224   if (a==0xa11100) { OtherWrite8(a, d>>8, 16); return; }
225   if (a==0xa11200) { dprintf("write z80reset: %04x", d); if(!(d&0x100)) z80_reset(); return; }
226
227   OtherWrite8(a,  d>>8, 16);
228   OtherWrite8(a+1,d&0xff, 16);
229 }
230
231