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