Pico/cd/Memory.c

   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