| 1 | // This is part of Pico Library\r |
| 2 | \r |
| 3 | // (c) Copyright 2004 Dave, All rights reserved.\r |
| 4 | // (c) Copyright 2006 notaz, All rights reserved.\r |
| 5 | // Free for non-commercial use.\r |
| 6 | \r |
| 7 | // For commercial use, separate licencing terms must be obtained.\r |
| 8 | \r |
| 9 | // A68K no longer supported here\r |
| 10 | \r |
| 11 | //#define __debug_io\r |
| 12 | \r |
| 13 | #include "../PicoInt.h"\r |
| 14 | \r |
| 15 | #include "../sound/sound.h"\r |
| 16 | #include "../sound/ym2612.h"\r |
| 17 | #include "../sound/sn76496.h"\r |
| 18 | \r |
| 19 | typedef unsigned char u8;\r |
| 20 | typedef unsigned short u16;\r |
| 21 | typedef unsigned int u32;\r |
| 22 | \r |
| 23 | //#define __debug_io\r |
| 24 | //#define __debug_io2\r |
| 25 | \r |
| 26 | // -----------------------------------------------------------------\r |
| 27 | \r |
| 28 | // extern m68ki_cpu_core m68ki_cpu;\r |
| 29 | \r |
| 30 | extern int counter75hz;\r |
| 31 | \r |
| 32 | \r |
| 33 | static u32 m68k_reg_read16(u32 a, int realsize)\r |
| 34 | {\r |
| 35 | u32 d=0;\r |
| 36 | a &= 0x3e;\r |
| 37 | dprintf("m68k_regs r%2i: [%02x] @%06x", realsize&~1, a+(realsize&1), SekPc);\r |
| 38 | \r |
| 39 | switch (a) {\r |
| 40 | case 2:\r |
| 41 | d = (Pico_mcd->m68k_regs[a]<<8) | Pico_mcd->m68k_regs[a+1] | 1; // for now 2M to m68k\r |
| 42 | goto end;\r |
| 43 | case 8:\r |
| 44 | dprintf("m68k host data read");\r |
| 45 | d = Read_CDC_Host(0);\r |
| 46 | goto end;\r |
| 47 | case 0xC:\r |
| 48 | dprintf("m68k stopwatch read");\r |
| 49 | break;\r |
| 50 | }\r |
| 51 | \r |
| 52 | if (a < 0xE) {\r |
| 53 | d = (Pico_mcd->m68k_regs[a]<<8) | Pico_mcd->m68k_regs[a+1];\r |
| 54 | goto end;\r |
| 55 | }\r |
| 56 | \r |
| 57 | if (a < 0x30) {\r |
| 58 | // comm flag/cmd/status (0xE-0x2F)\r |
| 59 | d = (Pico_mcd->s68k_regs[a]<<8) | Pico_mcd->s68k_regs[a+1];\r |
| 60 | goto end;\r |
| 61 | }\r |
| 62 | \r |
| 63 | dprintf("m68k_regs invalid read @ %02x", a);\r |
| 64 | \r |
| 65 | end:\r |
| 66 | \r |
| 67 | dprintf("ret = %04x", d);\r |
| 68 | return d;\r |
| 69 | }\r |
| 70 | \r |
| 71 | static void m68k_reg_write8(u32 a, u32 d, int realsize)\r |
| 72 | {\r |
| 73 | a &= 0x3f;\r |
| 74 | dprintf("m68k_regs w%2i: [%02x] %02x @%06x", realsize, a, d, SekPc);\r |
| 75 | \r |
| 76 | switch (a) {\r |
| 77 | case 0:\r |
| 78 | if ((d&1) && (Pico_mcd->s68k_regs[0x33]&(1<<2))) { dprintf("m68k: s68k irq 2"); SekInterruptS68k(2); }\r |
| 79 | break;\r |
| 80 | case 1:\r |
| 81 | if (!(d&1)) PicoMCD |= 2; // reset pending, needed to be sure we fetch the right vectors on reset\r |
| 82 | if ( (Pico_mcd->m68k_regs[1]&1) != (d&1)) dprintf("m68k: s68k reset %i", !(d&1));\r |
| 83 | if ( (Pico_mcd->m68k_regs[1]&2) != (d&2)) dprintf("m68k: s68k brq %i", (d&2)>>1);\r |
| 84 | if (/*!(Pico_mcd->m68k_regs[1]&1) &&*/ (PicoMCD&2) && (d&3)==1) {\r |
| 85 | SekResetS68k(); // S68k comes out of RESET or BRQ state\r |
| 86 | PicoMCD&=~2;\r |
| 87 | dprintf("m68k: resetting s68k");\r |
| 88 | }\r |
| 89 | break;\r |
| 90 | case 3:\r |
| 91 | if ((Pico_mcd->m68k_regs[3]>>6) != ((d>>6)&3))\r |
| 92 | dprintf("m68k: prg bank: %i -> %i", (Pico_mcd->m68k_regs[a]>>6), ((d>>6)&3));\r |
| 93 | if ((Pico_mcd->m68k_regs[3]&4) != (d&4)) dprintf("m68k: ram mode %i mbit", (d&4) ? 1 : 2);\r |
| 94 | if ((Pico_mcd->m68k_regs[3]&2) != (d&2)) dprintf("m68k: %s", (d&4) ? ((d&2) ? "word swap req" : "noop?") :\r |
| 95 | ((d&2) ? "word ram to s68k" : "word ram to m68k"));\r |
| 96 | break;\r |
| 97 | case 0xe:\r |
| 98 | dprintf("m68k: comm flag: %02x", d);\r |
| 99 | \r |
| 100 | dprintf("s68k @ %06x", SekPcS68k);\r |
| 101 | \r |
| 102 | Pico_mcd->s68k_regs[0xe] = d;\r |
| 103 | break;\r |
| 104 | }\r |
| 105 | \r |
| 106 | if ((a&0xff) == 0x10) {\r |
| 107 | Pico_mcd->s68k_regs[a] = d;\r |
| 108 | }\r |
| 109 | \r |
| 110 | if (a >= 0x20 || (a >= 0xa && a <= 0xd) || a == 0x0f)\r |
| 111 | dprintf("m68k: invalid write?");\r |
| 112 | \r |
| 113 | if (a < 0x10)\r |
| 114 | Pico_mcd->m68k_regs[a] = (u8) d;\r |
| 115 | }\r |
| 116 | \r |
| 117 | \r |
| 118 | \r |
| 119 | static u32 s68k_reg_read16(u32 a, int realsize)\r |
| 120 | {\r |
| 121 | u32 d=0;\r |
| 122 | a &= 0x1fe;\r |
| 123 | \r |
| 124 | dprintf("s68k_regs r%2i: [%02x] @ %06x", realsize&~1, a+(realsize&1), SekPcS68k);\r |
| 125 | \r |
| 126 | switch (a) {\r |
| 127 | case 0:\r |
| 128 | d = 1; goto end; // ver = 0, not in reset state\r |
| 129 | case 6:\r |
| 130 | d = CDC_Read_Reg();\r |
| 131 | goto end;\r |
| 132 | case 8:\r |
| 133 | dprintf("s68k host data read");\r |
| 134 | d = Read_CDC_Host(1);\r |
| 135 | goto end;\r |
| 136 | case 0xC:\r |
| 137 | dprintf("s68k stopwatch read");\r |
| 138 | break;\r |
| 139 | case 0x34: // fader\r |
| 140 | d = 0; // no busy bit\r |
| 141 | goto end;\r |
| 142 | }\r |
| 143 | \r |
| 144 | d = (Pico_mcd->s68k_regs[a]<<8) | Pico_mcd->s68k_regs[a+1];\r |
| 145 | \r |
| 146 | end:\r |
| 147 | \r |
| 148 | dprintf("ret = %04x", d);\r |
| 149 | \r |
| 150 | return d;\r |
| 151 | }\r |
| 152 | \r |
| 153 | static void s68k_reg_write8(u32 a, u32 d, int realsize)\r |
| 154 | {\r |
| 155 | a &= 0x1ff;\r |
| 156 | dprintf("s68k_regs w%2i: [%02x] %02x @ %06x", realsize, a, d, SekPcS68k);\r |
| 157 | \r |
| 158 | // TODO: review against Gens\r |
| 159 | switch (a) {\r |
| 160 | case 4:\r |
| 161 | dprintf("s68k CDC dest: %x", d&7);\r |
| 162 | Pico_mcd->s68k_regs[4] = (Pico_mcd->s68k_regs[4]&0xC0) | (d&7); // CDC mode\r |
| 163 | return;\r |
| 164 | case 5:\r |
| 165 | dprintf("s68k CDC reg addr: %x", d&0xf);\r |
| 166 | break;\r |
| 167 | case 7:\r |
| 168 | CDC_Write_Reg(d);\r |
| 169 | return;\r |
| 170 | case 0xa:\r |
| 171 | dprintf("s68k set CDC dma addr");\r |
| 172 | break;\r |
| 173 | case 0x33: // IRQ mask\r |
| 174 | dprintf("s68k irq mask: %02x", d);\r |
| 175 | if ((d&(1<<4)) && (Pico_mcd->s68k_regs[0x37]&4) && !(Pico_mcd->s68k_regs[0x33]&(1<<4))) {\r |
| 176 | CDD_Export_Status();\r |
| 177 | // counter75hz = 0; // ???\r |
| 178 | }\r |
| 179 | break;\r |
| 180 | case 0x34: // fader\r |
| 181 | Pico_mcd->s68k_regs[a] = (u8) d & 0x7f;\r |
| 182 | return;\r |
| 183 | case 0x37:\r |
| 184 | if ((d&4) && !(Pico_mcd->s68k_regs[0x37]&4)) {\r |
| 185 | CDD_Export_Status();\r |
| 186 | // counter75hz = 0; // ???\r |
| 187 | }\r |
| 188 | break;\r |
| 189 | case 0x4b:\r |
| 190 | Pico_mcd->s68k_regs[a] = (u8) d;\r |
| 191 | CDD_Import_Command();\r |
| 192 | return;\r |
| 193 | }\r |
| 194 | \r |
| 195 | if ((a&0x1f0) == 0x10 || a == 0x0e || (a >= 0x38 && a < 0x42))\r |
| 196 | {\r |
| 197 | dprintf("m68k: invalid write @ %02x?", a);\r |
| 198 | return;\r |
| 199 | }\r |
| 200 | \r |
| 201 | Pico_mcd->s68k_regs[a] = (u8) d;\r |
| 202 | }\r |
| 203 | \r |
| 204 | \r |
| 205 | \r |
| 206 | \r |
| 207 | \r |
| 208 | static int PadRead(int i)\r |
| 209 | {\r |
| 210 | int pad=0,value=0,TH;\r |
| 211 | pad=~PicoPad[i]; // Get inverse of pad MXYZ SACB RLDU\r |
| 212 | TH=Pico.ioports[i+1]&0x40;\r |
| 213 | \r |
| 214 | if(PicoOpt & 0x20) { // 6 button gamepad enabled\r |
| 215 | int phase = Pico.m.padTHPhase[i];\r |
| 216 | \r |
| 217 | if(phase == 2 && !TH) {\r |
| 218 | value=(pad&0xc0)>>2; // ?0SA 0000\r |
| 219 | goto end;\r |
| 220 | } else if(phase == 3 && TH) {\r |
| 221 | value=(pad&0x30)|((pad>>8)&0xf); // ?1CB MXYZ\r |
| 222 | goto end;\r |
| 223 | } else if(phase == 3 && !TH) {\r |
| 224 | value=((pad&0xc0)>>2)|0x0f; // ?0SA 1111\r |
| 225 | goto end;\r |
| 226 | }\r |
| 227 | }\r |
| 228 | \r |
| 229 | if(TH) value=(pad&0x3f); // ?1CB RLDU\r |
| 230 | else value=((pad&0xc0)>>2)|(pad&3); // ?0SA 00DU\r |
| 231 | \r |
| 232 | end:\r |
| 233 | \r |
| 234 | // orr the bits, which are set as output\r |
| 235 | value |= Pico.ioports[i+1]&Pico.ioports[i+4];\r |
| 236 | \r |
| 237 | return value; // will mirror later\r |
| 238 | }\r |
| 239 | \r |
| 240 | static u8 z80Read8(u32 a)\r |
| 241 | {\r |
| 242 | if(Pico.m.z80Run&1) return 0;\r |
| 243 | \r |
| 244 | a&=0x1fff;\r |
| 245 | \r |
| 246 | if(!(PicoOpt&4)) {\r |
| 247 | // Z80 disabled, do some faking\r |
| 248 | static u8 zerosent = 0;\r |
| 249 | if(a == Pico.m.z80_lastaddr) { // probably polling something\r |
| 250 | u8 d = Pico.m.z80_fakeval;\r |
| 251 | if((d & 0xf) == 0xf && !zerosent) {\r |
| 252 | d = 0; zerosent = 1;\r |
| 253 | } else {\r |
| 254 | Pico.m.z80_fakeval++;\r |
| 255 | zerosent = 0;\r |
| 256 | }\r |
| 257 | return d;\r |
| 258 | } else {\r |
| 259 | Pico.m.z80_fakeval = 0;\r |
| 260 | }\r |
| 261 | }\r |
| 262 | \r |
| 263 | Pico.m.z80_lastaddr = (u16) a;\r |
| 264 | return Pico.zram[a];\r |
| 265 | }\r |
| 266 | \r |
| 267 | \r |
| 268 | // for nonstandard reads\r |
| 269 | static u32 UnusualRead16(u32 a, int realsize)\r |
| 270 | {\r |
| 271 | u32 d=0;\r |
| 272 | \r |
| 273 | dprintf("unusual r%i: %06x @%06x", realsize&~1, (a&0xfffffe)+(realsize&1), SekPc);\r |
| 274 | \r |
| 275 | \r |
| 276 | dprintf("ret = %04x", d);\r |
| 277 | return d;\r |
| 278 | }\r |
| 279 | \r |
| 280 | static u32 OtherRead16(u32 a, int realsize)\r |
| 281 | {\r |
| 282 | u32 d=0;\r |
| 283 | \r |
| 284 | if ((a&0xff0000)==0xa00000) {\r |
| 285 | if ((a&0x4000)==0x0000) { d=z80Read8(a); d|=d<<8; goto end; } // Z80 ram (not byteswaped)\r |
| 286 | if ((a&0x6000)==0x4000) { if(PicoOpt&1) d=YM2612Read(); else d=Pico.m.rotate++&3; goto end; } // 0x4000-0x5fff, Fudge if disabled\r |
| 287 | d=0xffff; goto end;\r |
| 288 | }\r |
| 289 | if ((a&0xffffe0)==0xa10000) { // I/O ports\r |
| 290 | a=(a>>1)&0xf;\r |
| 291 | switch(a) {\r |
| 292 | case 0: d=Pico.m.hardware; break; // Hardware value (Version register)\r |
| 293 | case 1: d=PadRead(0); d|=Pico.ioports[1]&0x80; break;\r |
| 294 | case 2: d=PadRead(1); d|=Pico.ioports[2]&0x80; break;\r |
| 295 | default: d=Pico.ioports[a]; break; // IO ports can be used as RAM\r |
| 296 | }\r |
| 297 | d|=d<<8;\r |
| 298 | goto end;\r |
| 299 | }\r |
| 300 | // |=0x80 for Shadow of the Beast & Super Offroad; rotate fakes next fetched instruction for Time Killers\r |
| 301 | if (a==0xa11100) { d=((Pico.m.z80Run&1)<<8)|0x8000|Pico.m.rotate++; goto end; }\r |
| 302 | \r |
| 303 | if ((a&0xe700e0)==0xc00000) { d=PicoVideoRead(a); goto end; }\r |
| 304 | \r |
| 305 | if ((a&0xffffc0)==0xa12000) { d=m68k_reg_read16(a, realsize); goto end; }\r |
| 306 | \r |
| 307 | d = UnusualRead16(a, realsize);\r |
| 308 | \r |
| 309 | end:\r |
| 310 | return d;\r |
| 311 | }\r |
| 312 | \r |
| 313 | //extern UINT32 mz80GetRegisterValue(void *, UINT32);\r |
| 314 | \r |
| 315 | static void OtherWrite8(u32 a,u32 d,int realsize)\r |
| 316 | {\r |
| 317 | if ((a&0xe700f9)==0xc00011||(a&0xff7ff9)==0xa07f11) { if(PicoOpt&2) SN76496Write(d); return; } // PSG Sound\r |
| 318 | if ((a&0xff4000)==0xa00000) { if(!(Pico.m.z80Run&1)) Pico.zram[a&0x1fff]=(u8)d; return; } // Z80 ram\r |
| 319 | if ((a&0xff6000)==0xa04000) { if(PicoOpt&1) emustatus|=YM2612Write(a&3, d); return; } // FM Sound\r |
| 320 | if ((a&0xffffe0)==0xa10000) { // I/O ports\r |
| 321 | a=(a>>1)&0xf;\r |
| 322 | // 6 button gamepad: if TH went from 0 to 1, gamepad changes state\r |
| 323 | if(PicoOpt&0x20) {\r |
| 324 | if(a==1) {\r |
| 325 | Pico.m.padDelay[0] = 0;\r |
| 326 | if(!(Pico.ioports[1]&0x40) && (d&0x40)) Pico.m.padTHPhase[0]++;\r |
| 327 | }\r |
| 328 | else if(a==2) {\r |
| 329 | Pico.m.padDelay[1] = 0;\r |
| 330 | if(!(Pico.ioports[2]&0x40) && (d&0x40)) Pico.m.padTHPhase[1]++;\r |
| 331 | }\r |
| 332 | }\r |
| 333 | Pico.ioports[a]=(u8)d; // IO ports can be used as RAM\r |
| 334 | return;\r |
| 335 | }\r |
| 336 | if (a==0xa11100) {\r |
| 337 | extern int z80startCycle, z80stopCycle;\r |
| 338 | //int lineCycles=(488-SekCyclesLeft)&0x1ff;\r |
| 339 | d&=1; d^=1;\r |
| 340 | if(!d) {\r |
| 341 | // hack: detect a nasty situation where Z80 was enabled and disabled in the same 68k timeslice (Golden Axe III)\r |
| 342 | if((PicoOpt&4) && Pico.m.z80Run==1) z80_run(20);\r |
| 343 | z80stopCycle = SekCyclesDone();\r |
| 344 | //z80ExtraCycles += (lineCycles>>1)-(lineCycles>>5); // only meaningful in PicoFrameHints()\r |
| 345 | } else {\r |
| 346 | z80startCycle = SekCyclesDone();\r |
| 347 | //if(Pico.m.scanline != -1)\r |
| 348 | //z80ExtraCycles -= (lineCycles>>1)-(lineCycles>>5)+16;\r |
| 349 | }\r |
| 350 | //dprintf("set_zrun: %i [%i|%i] zPC=%04x @%06x", d, Pico.m.scanline, SekCyclesDone(), mz80GetRegisterValue(NULL, 0), SekPc);\r |
| 351 | Pico.m.z80Run=(u8)d; return;\r |
| 352 | }\r |
| 353 | if (a==0xa11200) { if(!(d&1)) z80_reset(); return; }\r |
| 354 | \r |
| 355 | if ((a&0xff7f00)==0xa06000) // Z80 BANK register\r |
| 356 | {\r |
| 357 | Pico.m.z80_bank68k>>=1;\r |
| 358 | Pico.m.z80_bank68k|=(d&1)<<8;\r |
| 359 | Pico.m.z80_bank68k&=0x1ff; // 9 bits and filled in the new top one\r |
| 360 | return;\r |
| 361 | }\r |
| 362 | \r |
| 363 | if ((a&0xe700e0)==0xc00000) { PicoVideoWrite(a,(u16)(d|(d<<8))); return; } // Byte access gets mirrored\r |
| 364 | \r |
| 365 | if ((a&0xffffc0)==0xa12000) { m68k_reg_write8(a, d, realsize); return; }\r |
| 366 | \r |
| 367 | dprintf("strange w%i: %06x, %08x @%06x", realsize, a&0xffffff, d, SekPc);\r |
| 368 | }\r |
| 369 | \r |
| 370 | static void OtherWrite16(u32 a,u32 d)\r |
| 371 | {\r |
| 372 | if ((a&0xe700e0)==0xc00000) { PicoVideoWrite(a,(u16)d); return; }\r |
| 373 | if ((a&0xff4000)==0xa00000) { if(!(Pico.m.z80Run&1)) Pico.zram[a&0x1fff]=(u8)(d>>8); return; } // Z80 ram (MSB only)\r |
| 374 | \r |
| 375 | if ((a&0xffffe0)==0xa10000) { // I/O ports\r |
| 376 | a=(a>>1)&0xf;\r |
| 377 | // 6 button gamepad: if TH went from 0 to 1, gamepad changes state\r |
| 378 | if(PicoOpt&0x20) {\r |
| 379 | if(a==1) {\r |
| 380 | Pico.m.padDelay[0] = 0;\r |
| 381 | if(!(Pico.ioports[1]&0x40) && (d&0x40)) Pico.m.padTHPhase[0]++;\r |
| 382 | }\r |
| 383 | else if(a==2) {\r |
| 384 | Pico.m.padDelay[1] = 0;\r |
| 385 | if(!(Pico.ioports[2]&0x40) && (d&0x40)) Pico.m.padTHPhase[1]++;\r |
| 386 | }\r |
| 387 | }\r |
| 388 | Pico.ioports[a]=(u8)d; // IO ports can be used as RAM\r |
| 389 | return;\r |
| 390 | }\r |
| 391 | if (a==0xa11100) { OtherWrite8(a, d>>8, 16); return; }\r |
| 392 | if (a==0xa11200) { if(!(d&0x100)) z80_reset(); return; }\r |
| 393 | \r |
| 394 | OtherWrite8(a, d>>8, 16);\r |
| 395 | OtherWrite8(a+1,d&0xff, 16);\r |
| 396 | }\r |
| 397 | \r |
| 398 | // -----------------------------------------------------------------\r |
| 399 | // Read Rom and read Ram\r |
| 400 | \r |
| 401 | u8 PicoReadM68k8(u32 a)\r |
| 402 | {\r |
| 403 | u32 d=0;\r |
| 404 | \r |
| 405 | if ((a&0xe00000)==0xe00000) { d = *(u8 *)(Pico.ram+((a^1)&0xffff)); goto end; } // Ram\r |
| 406 | \r |
| 407 | a&=0xffffff;\r |
| 408 | \r |
| 409 | if (a < 0x20000) { d = *(u8 *)(Pico_mcd->bios+(a^1)); goto end; } // bios\r |
| 410 | \r |
| 411 | // prg RAM\r |
| 412 | if ((a&0xfe0000)==0x020000) {\r |
| 413 | u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->m68k_regs[3]>>6];\r |
| 414 | d = *(prg_bank+((a^1)&0x1ffff));\r |
| 415 | goto end;\r |
| 416 | }\r |
| 417 | \r |
| 418 | if ((a&0xff4000)==0xa00000) { d=z80Read8(a); goto end; } // Z80 Ram\r |
| 419 | \r |
| 420 | d=OtherRead16(a&~1, 8|(a&1)); if ((a&1)==0) d>>=8;\r |
| 421 | \r |
| 422 | end:\r |
| 423 | \r |
| 424 | #ifdef __debug_io\r |
| 425 | dprintf("r8 : %06x, %02x @%06x", a&0xffffff, (u8)d, SekPc);\r |
| 426 | #endif\r |
| 427 | return (u8)d;\r |
| 428 | }\r |
| 429 | \r |
| 430 | u16 PicoReadM68k16(u32 a)\r |
| 431 | {\r |
| 432 | u16 d=0;\r |
| 433 | \r |
| 434 | if ((a&0xe00000)==0xe00000) { d=*(u16 *)(Pico.ram+(a&0xfffe)); goto end; } // Ram\r |
| 435 | \r |
| 436 | a&=0xfffffe;\r |
| 437 | \r |
| 438 | if (a < 0x20000) { d = *(u16 *)(Pico_mcd->bios+a); goto end; } // bios\r |
| 439 | \r |
| 440 | // prg RAM\r |
| 441 | if ((a&0xfe0000)==0x020000) {\r |
| 442 | u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->m68k_regs[3]>>6];\r |
| 443 | d = *(u16 *)(prg_bank+(a&0x1fffe));\r |
| 444 | goto end;\r |
| 445 | }\r |
| 446 | \r |
| 447 | d = (u16)OtherRead16(a, 16);\r |
| 448 | \r |
| 449 | end:\r |
| 450 | \r |
| 451 | #ifdef __debug_io\r |
| 452 | dprintf("r16: %06x, %04x @%06x", a&0xffffff, d, SekPc);\r |
| 453 | #endif\r |
| 454 | return d;\r |
| 455 | }\r |
| 456 | \r |
| 457 | u32 PicoReadM68k32(u32 a)\r |
| 458 | {\r |
| 459 | u32 d=0;\r |
| 460 | \r |
| 461 | if ((a&0xe00000)==0xe00000) { u16 *pm=(u16 *)(Pico.ram+(a&0xfffe)); d = (pm[0]<<16)|pm[1]; goto end; } // Ram\r |
| 462 | \r |
| 463 | a&=0xfffffe;\r |
| 464 | \r |
| 465 | if (a < 0x20000) { u16 *pm=(u16 *)(Pico_mcd->bios+a); d = (pm[0]<<16)|pm[1]; goto end; } // bios\r |
| 466 | \r |
| 467 | // prg RAM\r |
| 468 | if ((a&0xfe0000)==0x020000) {\r |
| 469 | u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->m68k_regs[3]>>6];\r |
| 470 | u16 *pm=(u16 *)(prg_bank+(a&0x1fffe));\r |
| 471 | d = (pm[0]<<16)|pm[1];\r |
| 472 | goto end;\r |
| 473 | }\r |
| 474 | \r |
| 475 | d = (OtherRead16(a, 32)<<16)|OtherRead16(a+2, 32);\r |
| 476 | \r |
| 477 | end:\r |
| 478 | #ifdef __debug_io\r |
| 479 | dprintf("r32: %06x, %08x @%06x", a&0xffffff, d, SekPc);\r |
| 480 | #endif\r |
| 481 | return d;\r |
| 482 | }\r |
| 483 | \r |
| 484 | // -----------------------------------------------------------------\r |
| 485 | // Write Ram\r |
| 486 | \r |
| 487 | void PicoWriteM68k8(u32 a,u8 d)\r |
| 488 | {\r |
| 489 | #ifdef __debug_io\r |
| 490 | dprintf("w8 : %06x, %02x @%06x", a&0xffffff, d, SekPc);\r |
| 491 | #endif\r |
| 492 | //if ((a&0xe0ffff)==0xe0a9ba+0x69c)\r |
| 493 | // dprintf("w8 : %06x, %02x @%06x", a&0xffffff, d, SekPc);\r |
| 494 | \r |
| 495 | \r |
| 496 | if ((a&0xe00000)==0xe00000) { u8 *pm=(u8 *)(Pico.ram+((a^1)&0xffff)); pm[0]=d; return; } // Ram\r |
| 497 | \r |
| 498 | a&=0xffffff;\r |
| 499 | \r |
| 500 | // prg RAM\r |
| 501 | if ((a&0xfe0000)==0x020000) {\r |
| 502 | u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->m68k_regs[3]>>6];\r |
| 503 | u8 *pm=(u8 *)(prg_bank+((a^1)&0x1ffff));\r |
| 504 | *pm=d;\r |
| 505 | return;\r |
| 506 | }\r |
| 507 | \r |
| 508 | OtherWrite8(a,d,8);\r |
| 509 | }\r |
| 510 | \r |
| 511 | void PicoWriteM68k16(u32 a,u16 d)\r |
| 512 | {\r |
| 513 | #ifdef __debug_io\r |
| 514 | dprintf("w16: %06x, %04x", a&0xffffff, d);\r |
| 515 | #endif\r |
| 516 | //if ((a&0xe0ffff)==0xe0AF0E+0x69c||(a&0xe0ffff)==0xe0A9A8+0x69c||(a&0xe0ffff)==0xe0A9AA+0x69c||(a&0xe0ffff)==0xe0A9AC+0x69c)\r |
| 517 | // dprintf("w16: %06x, %04x @%06x", a&0xffffff, d, SekPc);\r |
| 518 | \r |
| 519 | if ((a&0xe00000)==0xe00000) { *(u16 *)(Pico.ram+(a&0xfffe))=d; return; } // Ram\r |
| 520 | \r |
| 521 | a&=0xfffffe;\r |
| 522 | \r |
| 523 | // prg RAM\r |
| 524 | if ((a&0xfe0000)==0x020000) {\r |
| 525 | u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->m68k_regs[3]>>6];\r |
| 526 | *(u16 *)(prg_bank+(a&0x1fffe))=d;\r |
| 527 | return;\r |
| 528 | }\r |
| 529 | \r |
| 530 | \r |
| 531 | OtherWrite16(a,d);\r |
| 532 | }\r |
| 533 | \r |
| 534 | void PicoWriteM68k32(u32 a,u32 d)\r |
| 535 | {\r |
| 536 | #ifdef __debug_io\r |
| 537 | dprintf("w32: %06x, %08x", a&0xffffff, d);\r |
| 538 | #endif\r |
| 539 | \r |
| 540 | if ((a&0xe00000)==0xe00000)\r |
| 541 | {\r |
| 542 | // Ram:\r |
| 543 | u16 *pm=(u16 *)(Pico.ram+(a&0xfffe));\r |
| 544 | pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r |
| 545 | return;\r |
| 546 | }\r |
| 547 | \r |
| 548 | a&=0xfffffe;\r |
| 549 | \r |
| 550 | // prg RAM\r |
| 551 | if ((a&0xfe0000)==0x020000) {\r |
| 552 | u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->m68k_regs[3]>>6];\r |
| 553 | u16 *pm=(u16 *)(prg_bank+(a&0x1fffe));\r |
| 554 | pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r |
| 555 | return;\r |
| 556 | }\r |
| 557 | \r |
| 558 | \r |
| 559 | OtherWrite16(a, (u16)(d>>16));\r |
| 560 | OtherWrite16(a+2,(u16)d);\r |
| 561 | }\r |
| 562 | \r |
| 563 | \r |
| 564 | // -----------------------------------------------------------------\r |
| 565 | \r |
| 566 | \r |
| 567 | u8 PicoReadS68k8(u32 a)\r |
| 568 | {\r |
| 569 | u32 d=0;\r |
| 570 | \r |
| 571 | a&=0xffffff;\r |
| 572 | \r |
| 573 | // prg RAM\r |
| 574 | if (a < 0x80000) {\r |
| 575 | d = *(Pico_mcd->prg_ram+(a^1));\r |
| 576 | goto end;\r |
| 577 | }\r |
| 578 | \r |
| 579 | // regs\r |
| 580 | if ((a&0xfffe00) == 0xff8000) {\r |
| 581 | d = s68k_reg_read16(a&~1, 8|(a&1)); if ((a&1)==0) d>>=8;\r |
| 582 | goto end;\r |
| 583 | }\r |
| 584 | \r |
| 585 | dprintf("s68k r8 : %06x, %02x @%06x", a&0xffffff, (u8)d, SekPcS68k);\r |
| 586 | \r |
| 587 | end:\r |
| 588 | \r |
| 589 | #ifdef __debug_io2\r |
| 590 | dprintf("s68k r8 : %06x, %02x @%06x", a&0xffffff, (u8)d, SekPcS68k);\r |
| 591 | #endif\r |
| 592 | return (u8)d;\r |
| 593 | }\r |
| 594 | \r |
| 595 | u16 PicoReadS68k16(u32 a)\r |
| 596 | {\r |
| 597 | u16 d=0;\r |
| 598 | \r |
| 599 | a&=0xfffffe;\r |
| 600 | \r |
| 601 | // prg RAM\r |
| 602 | if (a < 0x80000) {\r |
| 603 | d = *(u16 *)(Pico_mcd->prg_ram+a);\r |
| 604 | goto end;\r |
| 605 | }\r |
| 606 | \r |
| 607 | // regs\r |
| 608 | if ((a&0xfffe00) == 0xff8000) {\r |
| 609 | d = s68k_reg_read16(a, 16);\r |
| 610 | goto end;\r |
| 611 | }\r |
| 612 | \r |
| 613 | dprintf("s68k r16: %06x, %04x @%06x", a&0xffffff, d, SekPcS68k);\r |
| 614 | \r |
| 615 | end:\r |
| 616 | \r |
| 617 | #ifdef __debug_io2\r |
| 618 | dprintf("s68k r16: %06x, %04x @%06x", a&0xffffff, d, SekPcS68k);\r |
| 619 | #endif\r |
| 620 | return d;\r |
| 621 | }\r |
| 622 | \r |
| 623 | u32 PicoReadS68k32(u32 a)\r |
| 624 | {\r |
| 625 | u32 d=0;\r |
| 626 | \r |
| 627 | a&=0xfffffe;\r |
| 628 | \r |
| 629 | // prg RAM\r |
| 630 | if (a < 0x80000) {\r |
| 631 | u16 *pm=(u16 *)(Pico_mcd->prg_ram+a);\r |
| 632 | d = (pm[0]<<16)|pm[1];\r |
| 633 | goto end;\r |
| 634 | }\r |
| 635 | \r |
| 636 | // regs\r |
| 637 | if ((a&0xfffe00) == 0xff8000) {\r |
| 638 | d = (s68k_reg_read16(a, 32)<<16)|s68k_reg_read16(a+2, 32);\r |
| 639 | goto end;\r |
| 640 | }\r |
| 641 | \r |
| 642 | dprintf("s68k r32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r |
| 643 | \r |
| 644 | end:\r |
| 645 | \r |
| 646 | #ifdef __debug_io2\r |
| 647 | dprintf("s68k r32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r |
| 648 | #endif\r |
| 649 | return d;\r |
| 650 | }\r |
| 651 | \r |
| 652 | // -----------------------------------------------------------------\r |
| 653 | \r |
| 654 | void PicoWriteS68k8(u32 a,u8 d)\r |
| 655 | {\r |
| 656 | #ifdef __debug_io2\r |
| 657 | dprintf("s68k w8 : %06x, %02x @%06x", a&0xffffff, d, SekPcS68k);\r |
| 658 | #endif\r |
| 659 | \r |
| 660 | a&=0xffffff;\r |
| 661 | \r |
| 662 | // prg RAM\r |
| 663 | if (a < 0x80000) {\r |
| 664 | u8 *pm=(u8 *)(Pico_mcd->prg_ram+(a^1));\r |
| 665 | *pm=d;\r |
| 666 | return;\r |
| 667 | }\r |
| 668 | \r |
| 669 | // regs\r |
| 670 | if ((a&0xfffe00) == 0xff8000) {\r |
| 671 | s68k_reg_write8(a,d,8);\r |
| 672 | return;\r |
| 673 | }\r |
| 674 | \r |
| 675 | dprintf("s68k w8 : %06x, %02x @%06x", a&0xffffff, d, SekPcS68k);\r |
| 676 | }\r |
| 677 | \r |
| 678 | void PicoWriteS68k16(u32 a,u16 d)\r |
| 679 | {\r |
| 680 | #ifdef __debug_io2\r |
| 681 | dprintf("s68k w16: %06x, %04x @%06x", a&0xffffff, d, SekPcS68k);\r |
| 682 | #endif\r |
| 683 | \r |
| 684 | a&=0xfffffe;\r |
| 685 | \r |
| 686 | // prg RAM\r |
| 687 | if (a < 0x80000) {\r |
| 688 | *(u16 *)(Pico_mcd->prg_ram+a)=d;\r |
| 689 | return;\r |
| 690 | }\r |
| 691 | \r |
| 692 | // regs\r |
| 693 | if ((a&0xfffe00) == 0xff8000) {\r |
| 694 | s68k_reg_write8(a, d>>8, 16);\r |
| 695 | s68k_reg_write8(a+1,d&0xff, 16);\r |
| 696 | return;\r |
| 697 | }\r |
| 698 | \r |
| 699 | dprintf("s68k w16: %06x, %04x @%06x", a&0xffffff, d, SekPcS68k);\r |
| 700 | }\r |
| 701 | \r |
| 702 | void PicoWriteS68k32(u32 a,u32 d)\r |
| 703 | {\r |
| 704 | #ifdef __debug_io2\r |
| 705 | dprintf("s68k w32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r |
| 706 | #endif\r |
| 707 | \r |
| 708 | a&=0xfffffe;\r |
| 709 | \r |
| 710 | // prg RAM\r |
| 711 | if (a < 0x80000) {\r |
| 712 | u16 *pm=(u16 *)(Pico_mcd->prg_ram+a);\r |
| 713 | pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r |
| 714 | return;\r |
| 715 | }\r |
| 716 | \r |
| 717 | // regs\r |
| 718 | if ((a&0xfffe00) == 0xff8000) {\r |
| 719 | s68k_reg_write8(a, d>>24, 32);\r |
| 720 | s68k_reg_write8(a+1,(d>>16)&0xff, 32);\r |
| 721 | s68k_reg_write8(a+2,(d>>8) &0xff, 32);\r |
| 722 | s68k_reg_write8(a+3, d &0xff, 32);\r |
| 723 | return;\r |
| 724 | }\r |
| 725 | \r |
| 726 | dprintf("s68k w32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r |
| 727 | }\r |
| 728 | \r |
| 729 | \r |
| 730 | \r |
| 731 | // -----------------------------------------------------------------\r |
| 732 | \r |
| 733 | #ifdef EMU_M68K\r |
| 734 | unsigned char PicoReadCD8w (unsigned int a) {\r |
| 735 | return m68ki_cpu_p == &PicoS68kCPU ? PicoReadS68k8(a) : PicoReadM68k8(a);\r |
| 736 | }\r |
| 737 | unsigned short PicoReadCD16w(unsigned int a) {\r |
| 738 | return m68ki_cpu_p == &PicoS68kCPU ? PicoReadS68k16(a) : PicoReadM68k16(a);\r |
| 739 | }\r |
| 740 | unsigned int PicoReadCD32w(unsigned int a) {\r |
| 741 | return m68ki_cpu_p == &PicoS68kCPU ? PicoReadS68k32(a) : PicoReadM68k32(a);\r |
| 742 | }\r |
| 743 | void PicoWriteCD8w (unsigned int a, unsigned char d) {\r |
| 744 | if (m68ki_cpu_p == &PicoS68kCPU) PicoWriteS68k8(a, d); else PicoWriteM68k8(a, d);\r |
| 745 | }\r |
| 746 | void PicoWriteCD16w(unsigned int a, unsigned short d) {\r |
| 747 | if (m68ki_cpu_p == &PicoS68kCPU) PicoWriteS68k16(a, d); else PicoWriteM68k16(a, d);\r |
| 748 | }\r |
| 749 | void PicoWriteCD32w(unsigned int a, unsigned int d) {\r |
| 750 | if (m68ki_cpu_p == &PicoS68kCPU) PicoWriteS68k32(a, d); else PicoWriteM68k32(a, d);\r |
| 751 | }\r |
| 752 | \r |
| 753 | // these are allowed to access RAM\r |
| 754 | unsigned int m68k_read_pcrelative_CD8 (unsigned int a) {\r |
| 755 | a&=0xffffff;\r |
| 756 | if(m68ki_cpu_p == &PicoS68kCPU) {\r |
| 757 | if (a < 0x80000) return *(u8 *)(Pico_mcd->prg_ram+(a^1)); // PRG Ram\r |
| 758 | else dprintf("s68k read_pcrel8 @ %06x", a);\r |
| 759 | } else {\r |
| 760 | if(a<Pico.romsize) return *(u8 *)(Pico.rom+(a^1)); // Rom\r |
| 761 | if((a&0xe00000)==0xe00000) return *(u8 *)(Pico.ram+((a^1)&0xffff)); // Ram\r |
| 762 | }\r |
| 763 | return 0;//(u8) lastread_d;\r |
| 764 | }\r |
| 765 | unsigned int m68k_read_pcrelative_CD16(unsigned int a) {\r |
| 766 | a&=0xffffff;\r |
| 767 | if(m68ki_cpu_p == &PicoS68kCPU) {\r |
| 768 | if (a < 0x80000) return *(u16 *)(Pico_mcd->prg_ram+(a&~1)); // PRG Ram\r |
| 769 | else dprintf("s68k read_pcrel16 @ %06x", a);\r |
| 770 | } else {\r |
| 771 | if(a<Pico.romsize) return *(u16 *)(Pico.rom+(a&~1)); // Rom\r |
| 772 | if((a&0xe00000)==0xe00000) return *(u16 *)(Pico.ram+(a&0xfffe)); // Ram\r |
| 773 | }\r |
| 774 | return 0;//(u16) lastread_d;\r |
| 775 | }\r |
| 776 | unsigned int m68k_read_pcrelative_CD32(unsigned int a) {\r |
| 777 | a&=0xffffff;\r |
| 778 | if(m68ki_cpu_p == &PicoS68kCPU) {\r |
| 779 | if (a < 0x80000) { u16 *pm=(u16 *)(Pico_mcd->prg_ram+(a&~1)); return (pm[0]<<16)|pm[1]; } // PRG Ram\r |
| 780 | else dprintf("s68k read_pcrel32 @ %06x", a);\r |
| 781 | } else {\r |
| 782 | if(a<Pico.romsize) { u16 *pm=(u16 *)(Pico.rom+(a&~1)); return (pm[0]<<16)|pm[1]; }\r |
| 783 | if((a&0xe00000)==0xe00000) { u16 *pm=(u16 *)(Pico.ram+(a&0xfffe)); return (pm[0]<<16)|pm[1]; } // Ram\r |
| 784 | }\r |
| 785 | return 0; //lastread_d;\r |
| 786 | }\r |
| 787 | #endif // EMU_M68K\r |
| 788 | \r |