pico/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-2009 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 \r
  10 #include "pico_int.h"\r
  11 #include "memory.h"\r
  12 \r
  13 #include "sound/ym2612.h"\r
  14 #include "sound/sn76496.h"\r
  15 \r
  16 extern unsigned int lastSSRamWrite; // used by serial eeprom code\r
  17 \r
  18 unsigned long m68k_read8_map  [0x1000000 >> M68K_MEM_SHIFT];\r
  19 unsigned long m68k_read16_map [0x1000000 >> M68K_MEM_SHIFT];\r
  20 unsigned long m68k_write8_map [0x1000000 >> M68K_MEM_SHIFT];\r
  21 unsigned long m68k_write16_map[0x1000000 >> M68K_MEM_SHIFT];\r
  22 \r
  23 static void xmap_set(unsigned long *map, int shift, int start_addr, int end_addr,\r
  24     void *func_or_mh, int is_func)\r
  25 {\r
  26   unsigned long addr = (unsigned long)func_or_mh;\r
  27   int mask = (1 << shift) - 1;\r
  28   int i;\r
  29 \r
  30   if ((start_addr & mask) != 0 || (end_addr & mask) != mask) {\r
  31     elprintf(EL_STATUS|EL_ANOMALY, "xmap_set: tried to map bad range: %06x-%06x",\r
  32       start_addr, end_addr);\r
  33     return;\r
  34   }\r
  35 \r
  36   if (addr & 1) {\r
  37     elprintf(EL_STATUS|EL_ANOMALY, "xmap_set: ptr is not aligned: %08lx", addr);\r
  38     return;\r
  39   }\r
  40 \r
  41   if (!is_func)\r
  42     addr -= start_addr;\r
  43 \r
  44   for (i = start_addr >> shift; i <= end_addr >> shift; i++) {\r
  45     map[i] = addr >> 1;\r
  46     if (is_func)\r
  47       map[i] |= 1 << (sizeof(addr) * 8 - 1);\r
  48   }\r
  49 }\r
  50 \r
  51 void z80_map_set(unsigned long *map, int start_addr, int end_addr,\r
  52     void *func_or_mh, int is_func)\r
  53 {\r
  54   xmap_set(map, Z80_MEM_SHIFT, start_addr, end_addr, func_or_mh, is_func);\r
  55 }\r
  56 \r
  57 void cpu68k_map_set(unsigned long *map, int start_addr, int end_addr,\r
  58     void *func_or_mh, int is_func)\r
  59 {\r
  60   xmap_set(map, M68K_MEM_SHIFT, start_addr, end_addr, func_or_mh, is_func);\r
  61 }\r
  62 \r
  63 // more specialized/optimized function (does same as above)\r
  64 void cpu68k_map_all_ram(int start_addr, int end_addr, void *ptr, int is_sub)\r
  65 {\r
  66   unsigned long *r8map, *r16map, *w8map, *w16map;\r
  67   unsigned long addr = (unsigned long)ptr;\r
  68   int shift = M68K_MEM_SHIFT;\r
  69   int i;\r
  70 \r
  71   if (!is_sub) {\r
  72     r8map = m68k_read8_map;\r
  73     r16map = m68k_read16_map;\r
  74     w8map = m68k_write8_map;\r
  75     w16map = m68k_write16_map;\r
  76   } else {\r
  77     r8map = s68k_read8_map;\r
  78     r16map = s68k_read16_map;\r
  79     w8map = s68k_write8_map;\r
  80     w16map = s68k_write16_map;\r
  81   }\r
  82 \r
  83   addr -= start_addr;\r
  84   addr >>= 1;\r
  85   for (i = start_addr >> shift; i <= end_addr >> shift; i++)\r
  86     r8map[i] = r16map[i] = w8map[i] = w16map[i] = addr;\r
  87 }\r
  88 \r
  89 static u32 m68k_unmapped_read8(u32 a)\r
  90 {\r
  91   elprintf(EL_UIO, "m68k unmapped r8  [%06x] @%06x", a, SekPc);\r
  92   return 0; // assume pulldown, as if MegaCD2 was attached\r
  93 }\r
  94 \r
  95 static u32 m68k_unmapped_read16(u32 a)\r
  96 {\r
  97   elprintf(EL_UIO, "m68k unmapped r16 [%06x] @%06x", a, SekPc);\r
  98   return 0;\r
  99 }\r
 100 \r
 101 static void m68k_unmapped_write8(u32 a, u32 d)\r
 102 {\r
 103   elprintf(EL_UIO, "m68k unmapped w8  [%06x]   %02x @%06x", a, d & 0xff, SekPc);\r
 104 }\r
 105 \r
 106 static void m68k_unmapped_write16(u32 a, u32 d)\r
 107 {\r
 108   elprintf(EL_UIO, "m68k unmapped w16 [%06x] %04x @%06x", a, d & 0xffff, SekPc);\r
 109 }\r
 110 \r
 111 void m68k_map_unmap(int start_addr, int end_addr)\r
 112 {\r
 113   unsigned long addr;\r
 114   int shift = M68K_MEM_SHIFT;\r
 115   int i;\r
 116 \r
 117   addr = (unsigned long)m68k_unmapped_read8;\r
 118   for (i = start_addr >> shift; i <= end_addr >> shift; i++)\r
 119     m68k_read8_map[i] = (addr >> 1) | (1 << 31);\r
 120 \r
 121   addr = (unsigned long)m68k_unmapped_read16;\r
 122   for (i = start_addr >> shift; i <= end_addr >> shift; i++)\r
 123     m68k_read16_map[i] = (addr >> 1) | (1 << 31);\r
 124 \r
 125   addr = (unsigned long)m68k_unmapped_write8;\r
 126   for (i = start_addr >> shift; i <= end_addr >> shift; i++)\r
 127     m68k_write8_map[i] = (addr >> 1) | (1 << 31);\r
 128 \r
 129   addr = (unsigned long)m68k_unmapped_write16;\r
 130   for (i = start_addr >> shift; i <= end_addr >> shift; i++)\r
 131     m68k_write16_map[i] = (addr >> 1) | (1 << 31);\r
 132 }\r
 133 \r
 134 MAKE_68K_READ8(m68k_read8, m68k_read8_map)\r
 135 MAKE_68K_READ16(m68k_read16, m68k_read16_map)\r
 136 MAKE_68K_READ32(m68k_read32, m68k_read16_map)\r
 137 MAKE_68K_WRITE8(m68k_write8, m68k_write8_map)\r
 138 MAKE_68K_WRITE16(m68k_write16, m68k_write16_map)\r
 139 MAKE_68K_WRITE32(m68k_write32, m68k_write16_map)\r
 140 \r
 141 // -----------------------------------------------------------------\r
 142 \r
 143 static u32 ym2612_read_local_68k(void);\r
 144 static int ym2612_write_local(u32 a, u32 d, int is_from_z80);\r
 145 static void z80_mem_setup(void);\r
 146 \r
 147 \r
 148 #ifdef EMU_CORE_DEBUG\r
 149 u32 lastread_a, lastread_d[16]={0,}, lastwrite_cyc_d[16]={0,}, lastwrite_mus_d[16]={0,};\r
 150 int lrp_cyc=0, lrp_mus=0, lwp_cyc=0, lwp_mus=0;\r
 151 extern unsigned int ppop;\r
 152 #endif\r
 153 \r
 154 #ifdef IO_STATS\r
 155 void log_io(unsigned int addr, int bits, int rw);\r
 156 #elif defined(_MSC_VER)\r
 157 #define log_io\r
 158 #else\r
 159 #define log_io(...)\r
 160 #endif\r
 161 \r
 162 #if defined(EMU_C68K)\r
 163 static __inline int PicoMemBase(u32 pc)\r
 164 {\r
 165   int membase=0;\r
 166 \r
 167   if (pc<Pico.romsize+4)\r
 168   {\r
 169     membase=(int)Pico.rom; // Program Counter in Rom\r
 170   }\r
 171   else if ((pc&0xe00000)==0xe00000)\r
 172   {\r
 173     membase=(int)Pico.ram-(pc&0xff0000); // Program Counter in Ram\r
 174   }\r
 175   else\r
 176   {\r
 177     // Error - Program Counter is invalid\r
 178     membase=(int)Pico.rom;\r
 179   }\r
 180 \r
 181   return membase;\r
 182 }\r
 183 #endif\r
 184 \r
 185 \r
 186 PICO_INTERNAL u32 PicoCheckPc(u32 pc)\r
 187 {\r
 188   u32 ret=0;\r
 189 #if defined(EMU_C68K)\r
 190   pc-=PicoCpuCM68k.membase; // Get real pc\r
 191 //  pc&=0xfffffe;\r
 192   pc&=~1;\r
 193   if ((pc<<8) == 0)\r
 194   {\r
 195     elprintf(EL_STATUS|EL_ANOMALY, "%i:%03i: game crash detected @ %06x\n",\r
 196       Pico.m.frame_count, Pico.m.scanline, SekPc);\r
 197     return (int)Pico.rom + Pico.romsize; // common crash condition, may happen with bad ROMs\r
 198   }\r
 199 \r
 200   PicoCpuCM68k.membase=PicoMemBase(pc&0x00ffffff);\r
 201   PicoCpuCM68k.membase-=pc&0xff000000;\r
 202 \r
 203   ret = PicoCpuCM68k.membase+pc;\r
 204 #endif\r
 205   return ret;\r
 206 }\r
 207 \r
 208 \r
 209 PICO_INTERNAL void PicoInitPc(u32 pc)\r
 210 {\r
 211   PicoCheckPc(pc);\r
 212 }\r
 213 \r
 214 // -----------------------------------------------------------------\r
 215 // memmap helpers\r
 216 \r
 217 static int PadRead(int i)\r
 218 {\r
 219   int pad,value,data_reg;\r
 220   pad=~PicoPadInt[i]; // Get inverse of pad MXYZ SACB RLDU\r
 221   data_reg=Pico.ioports[i+1];\r
 222 \r
 223   // orr the bits, which are set as output\r
 224   value = data_reg&(Pico.ioports[i+4]|0x80);\r
 225 \r
 226   if (PicoOpt & POPT_6BTN_PAD)\r
 227   {\r
 228     int phase = Pico.m.padTHPhase[i];\r
 229 \r
 230     if(phase == 2 && !(data_reg&0x40)) { // TH\r
 231       value|=(pad&0xc0)>>2;              // ?0SA 0000\r
 232       return value;\r
 233     } else if(phase == 3) {\r
 234       if(data_reg&0x40)\r
 235         value|=(pad&0x30)|((pad>>8)&0xf);  // ?1CB MXYZ\r
 236       else\r
 237         value|=((pad&0xc0)>>2)|0x0f;       // ?0SA 1111\r
 238       return value;\r
 239     }\r
 240   }\r
 241 \r
 242   if(data_reg&0x40) // TH\r
 243        value|=(pad&0x3f);              // ?1CB RLDU\r
 244   else value|=((pad&0xc0)>>2)|(pad&3); // ?0SA 00DU\r
 245 \r
 246   return value; // will mirror later\r
 247 }\r
 248 \r
 249 static u32 io_ports_read(u32 a)\r
 250 {\r
 251   u32 d;\r
 252   a = (a>>1) & 0xf;\r
 253   switch (a) {\r
 254     case 0:  d = Pico.m.hardware; break; // Hardware value (Version register)\r
 255     case 1:  d = PadRead(0); break;\r
 256     case 2:  d = PadRead(1); break;\r
 257     default: d = Pico.ioports[a]; break; // IO ports can be used as RAM\r
 258   }\r
 259   return d;\r
 260 }\r
 261 \r
 262 static void io_ports_write(u32 a, u32 d)\r
 263 {\r
 264   a = (a>>1) & 0xf;\r
 265 \r
 266   // 6 button gamepad: if TH went from 0 to 1, gamepad changes state\r
 267   if (1 <= a && a <= 2 && (PicoOpt & POPT_6BTN_PAD))\r
 268   {\r
 269     Pico.m.padDelay[a - 1] = 0;\r
 270     if (!(Pico.ioports[a] & 0x40) && (d & 0x40))\r
 271       Pico.m.padTHPhase[a - 1]++;\r
 272   }\r
 273 \r
 274   // cartain IO ports can be used as RAM\r
 275   Pico.ioports[a] = d;\r
 276 }\r
 277 \r
 278 static void ctl_write_z80busreq(u32 d)\r
 279 {\r
 280   d&=1; d^=1;\r
 281   elprintf(EL_BUSREQ, "set_zrun: %i->%i [%i] @%06x", Pico.m.z80Run, d, SekCyclesDone(), SekPc);\r
 282   if (d ^ Pico.m.z80Run)\r
 283   {\r
 284     if (d)\r
 285     {\r
 286       z80_cycle_cnt = cycles_68k_to_z80(SekCyclesDone());\r
 287     }\r
 288     else\r
 289     {\r
 290       z80stopCycle = SekCyclesDone();\r
 291       if ((PicoOpt&POPT_EN_Z80) && !Pico.m.z80_reset)\r
 292         PicoSyncZ80(z80stopCycle);\r
 293     }\r
 294     Pico.m.z80Run = d;\r
 295   }\r
 296 }\r
 297 \r
 298 static void ctl_write_z80reset(u32 d)\r
 299 {\r
 300   d&=1; d^=1;\r
 301   elprintf(EL_BUSREQ, "set_zreset: %i->%i [%i] @%06x", Pico.m.z80_reset, d, SekCyclesDone(), SekPc);\r
 302   if (d ^ Pico.m.z80_reset)\r
 303   {\r
 304     if (d)\r
 305     {\r
 306       if ((PicoOpt&POPT_EN_Z80) && Pico.m.z80Run)\r
 307         PicoSyncZ80(SekCyclesDone());\r
 308       YM2612ResetChip();\r
 309       timers_reset();\r
 310     }\r
 311     else\r
 312     {\r
 313       z80_cycle_cnt = cycles_68k_to_z80(SekCyclesDone());\r
 314       z80_reset();\r
 315     }\r
 316     Pico.m.z80_reset = d;\r
 317   }\r
 318 }\r
 319 \r
 320 \r
 321 // for nonstandard reads\r
 322 // TODO: mv to carthw\r
 323 u32 OtherRead16End(u32 a, int realsize)\r
 324 {\r
 325   u32 d=0;\r
 326 \r
 327   // 32x test\r
 328 /*\r
 329   if      (a == 0xa130ec) { d = 0x4d41; goto end; } // MA\r
 330   else if (a == 0xa130ee) { d = 0x5253; goto end; } // RS\r
 331   else if (a == 0xa15100) { d = 0x0080; goto end; }\r
 332   else\r
 333 */\r
 334 \r
 335   // for games with simple protection devices, discovered by Haze\r
 336   // some dumb detection is used, but that should be enough to make things work\r
 337   if ((a>>22) == 1 && Pico.romsize >= 512*1024) {\r
 338     if      (*(int *)(Pico.rom+0x123e4) == 0x00550c39 && *(int *)(Pico.rom+0x123e8) == 0x00000040) { // Super Bubble Bobble (Unl) [!]\r
 339       if      (a == 0x400000) { d=0x55<<8; goto end; }\r
 340       else if (a == 0x400002) { d=0x0f<<8; goto end; }\r
 341     }\r
 342     else if (*(int *)(Pico.rom+0x008c4) == 0x66240055 && *(int *)(Pico.rom+0x008c8) == 0x00404df9) { // Smart Mouse (Unl)\r
 343       if      (a == 0x400000) { d=0x55<<8; goto end; }\r
 344       else if (a == 0x400002) { d=0x0f<<8; goto end; }\r
 345       else if (a == 0x400004) { d=0xaa<<8; goto end; }\r
 346       else if (a == 0x400006) { d=0xf0<<8; goto end; }\r
 347     }\r
 348     else if (*(int *)(Pico.rom+0x00404) == 0x00a90600 && *(int *)(Pico.rom+0x00408) == 0x6708b013) { // King of Fighters '98, The (Unl) [!]\r
 349       if      (a == 0x480000 || a == 0x4800e0 || a == 0x4824a0 || a == 0x488880) { d=0xaa<<8; goto end; }\r
 350       else if (a == 0x4a8820) { d=0x0a<<8; goto end; }\r
 351       // there is also a read @ 0x4F8820 which needs 0, but that is returned in default case\r
 352     }\r
 353     else if (*(int *)(Pico.rom+0x01b24) == 0x004013f9 && *(int *)(Pico.rom+0x01b28) == 0x00ff0000) { // Mahjong Lover (Unl) [!]\r
 354       if      (a == 0x400000) { d=0x90<<8; goto end; }\r
 355       else if (a == 0x401000) { d=0xd3<<8; goto end; } // this one doesn't seem to be needed, the code does 2 comparisons and only then\r
 356                                                        // checks the result, which is of the above one. Left it just in case.\r
 357     }\r
 358     else if (*(int *)(Pico.rom+0x05254) == 0x0c3962d0 && *(int *)(Pico.rom+0x05258) == 0x00400055) { // Elf Wor (Unl)\r
 359       if      (a == 0x400000) { d=0x55<<8; goto end; }\r
 360       else if (a == 0x400004) { d=0xc9<<8; goto end; } // this check is done if the above one fails\r
 361       else if (a == 0x400002) { d=0x0f<<8; goto end; }\r
 362       else if (a == 0x400006) { d=0x18<<8; goto end; } // similar to above\r
 363     }\r
 364     // our default behaviour is to return whatever was last written a 0x400000-0x7fffff range (used by Squirrel King (R) [!])\r
 365     // Lion King II, The (Unl) [!]  writes @ 400000 and wants to get that val @ 400002 and wites another val\r
 366     // @ 400004 which is expected @ 400006, so we really remember 2 values here\r
 367 ///    d = Pico.m.prot_bytes[(a>>2)&1]<<8;\r
 368   }\r
 369   else if (a == 0xa13000 && Pico.romsize >= 1024*1024) {\r
 370     if      (*(int *)(Pico.rom+0xc8af0) == 0x30133013 && *(int *)(Pico.rom+0xc8af4) == 0x000f0240) { // Rockman X3 (Unl) [!]\r
 371       d=0x0c; goto end;\r
 372     }\r
 373     else if (*(int *)(Pico.rom+0x28888) == 0x07fc0000 && *(int *)(Pico.rom+0x2888c) == 0x4eb94e75) { // Bug's Life, A (Unl) [!]\r
 374       d=0x28; goto end; // does the check from RAM\r
 375     }\r
 376     else if (*(int *)(Pico.rom+0xc8778) == 0x30133013 && *(int *)(Pico.rom+0xc877c) == 0x000f0240) { // Super Mario Bros. (Unl) [!]\r
 377       d=0x0c; goto end; // seems to be the same code as in Rockman X3 (Unl) [!]\r
 378     }\r
 379     else if (*(int *)(Pico.rom+0xf20ec) == 0x30143013 && *(int *)(Pico.rom+0xf20f0) == 0x000f0200) { // Super Mario 2 1998 (Unl) [!]\r
 380       d=0x0a; goto end;\r
 381     }\r
 382   }\r
 383   else if (a == 0xa13002) { // Pocket Monsters (Unl)\r
 384     d=0x01; goto end;\r
 385   }\r
 386   else if (a == 0xa1303E) { // Pocket Monsters (Unl)\r
 387     d=0x1f; goto end;\r
 388   }\r
 389   else if (a == 0x30fe02) {\r
 390     // Virtua Racing - just for fun\r
 391     // this seems to be some flag that SVP is ready or something similar\r
 392     d=1; goto end;\r
 393   }\r
 394 \r
 395 end:\r
 396   elprintf(EL_UIO, "strange r%i: [%06x] %04x @%06x", realsize, a&0xffffff, d, SekPc);\r
 397   return d;\r
 398 }\r
 399 \r
 400 void OtherWrite8End(u32 a,u32 d,int realsize)\r
 401 {\r
 402   // for games with simple protection devices, discovered by Haze\r
 403   if ((a>>22) == 1)\r
 404 ;///    Pico.m.prot_bytes[(a>>2)&1] = (u8)d;\r
 405 }\r
 406 \r
 407 // -----------------------------------------------------------------\r
 408 \r
 409 // cart (save) RAM area (usually 0x200000 - ...)\r
 410 static u32 PicoRead8_sram(u32 a)\r
 411 {\r
 412   u32 d;\r
 413   if (SRam.start <= a && a <= SRam.end && (Pico.m.sram_reg & SRR_MAPPED))\r
 414   {\r
 415     if (SRam.flags & SRF_EEPROM) {\r
 416       d = EEPROM_read();\r
 417       if (!(a & 1))\r
 418         d >>= 8;\r
 419     } else\r
 420       d = *(u8 *)(SRam.data - SRam.start + a);\r
 421     elprintf(EL_SRAMIO, "sram r8  [%06x]   %02x @ %06x", a, d, SekPc);\r
 422     return d;\r
 423   }\r
 424 \r
 425   // XXX: this is banking unfriendly\r
 426   if (a < Pico.romsize)\r
 427     return Pico.rom[a ^ 1];\r
 428   \r
 429   return m68k_unmapped_read8(a);\r
 430 }\r
 431 \r
 432 static u32 PicoRead16_sram(u32 a)\r
 433 {\r
 434   u32 d;\r
 435   if (SRam.end >= a && a >= SRam.start && (Pico.m.sram_reg & SRR_MAPPED))\r
 436   {\r
 437     if (SRam.flags & SRF_EEPROM)\r
 438       d = EEPROM_read();\r
 439     else {\r
 440       u8 *pm = (u8 *)(SRam.data - SRam.start + a);\r
 441       d  = pm[0] << 8;\r
 442       d |= pm[1];\r
 443     }\r
 444     elprintf(EL_SRAMIO, "sram r16 [%06x] %04x @ %06x", a, d, SekPc);\r
 445     return d;\r
 446   }\r
 447 \r
 448   if (a < Pico.romsize)\r
 449     return *(u16 *)(Pico.rom + a);\r
 450 \r
 451   return m68k_unmapped_read16(a);\r
 452 }\r
 453 \r
 454 static void PicoWrite8_sram(u32 a, u32 d)\r
 455 {\r
 456   if (a > SRam.end || a < SRam.start || !(Pico.m.sram_reg & SRR_MAPPED)) {\r
 457     m68k_unmapped_write8(a, d);\r
 458     return;\r
 459   }\r
 460 \r
 461   elprintf(EL_SRAMIO, "sram w8  [%06x]   %02x @ %06x", a, d & 0xff, SekPc);\r
 462   if (SRam.flags & SRF_EEPROM)\r
 463   {\r
 464     EEPROM_write8(a, d);\r
 465   }\r
 466   else {\r
 467     u8 *pm = (u8 *)(SRam.data - SRam.start + a);\r
 468     if (*pm != (u8)d) {\r
 469       SRam.changed = 1;\r
 470       *pm = (u8)d;\r
 471     }\r
 472   }\r
 473 }\r
 474 \r
 475 static void PicoWrite16_sram(u32 a, u32 d)\r
 476 {\r
 477   if (a > SRam.end || a < SRam.start || !(Pico.m.sram_reg & SRR_MAPPED)) {\r
 478     m68k_unmapped_write16(a, d);\r
 479     return;\r
 480   }\r
 481 \r
 482   elprintf(EL_SRAMIO, "sram w16 [%06x] %04x @ %06x", a, d & 0xffff, SekPc);\r
 483   if (SRam.flags & SRF_EEPROM)\r
 484   {\r
 485     EEPROM_write16(d);\r
 486   }\r
 487   else {\r
 488     // XXX: hardware could easily use MSB too..\r
 489     u8 *pm = (u8 *)(SRam.data - SRam.start + a);\r
 490     if (*pm != (u8)d) {\r
 491       SRam.changed = 1;\r
 492       *pm = (u8)d;\r
 493     }\r
 494   }\r
 495 }\r
 496 \r
 497 // z80 area (0xa00000 - 0xa0ffff)\r
 498 // TODO: verify mirrors VDP and bank reg (bank area mirroring verified)\r
 499 static u32 PicoRead8_z80(u32 a)\r
 500 {\r
 501   u32 d = 0xff;\r
 502   if ((Pico.m.z80Run & 1) || Pico.m.z80_reset) {\r
 503     elprintf(EL_ANOMALY, "68k z80 read with no bus! [%06x] @ %06x", a, SekPc);\r
 504     // open bus. Pulled down if MegaCD2 is attached.\r
 505     return 0;\r
 506   }\r
 507 \r
 508   if ((a & 0x4000) == 0x0000)\r
 509     d = Pico.zram[a & 0x1fff];\r
 510   else if ((a & 0x6000) == 0x4000) // 0x4000-0x5fff\r
 511     d = ym2612_read_local_68k(); \r
 512   else\r
 513     elprintf(EL_UIO|EL_ANOMALY, "68k bad read [%06x] @%06x", a, SekPc);\r
 514   return d;\r
 515 }\r
 516 \r
 517 static u32 PicoRead16_z80(u32 a)\r
 518 {\r
 519   u32 d = PicoRead8_z80(a);\r
 520   return d | (d << 8);\r
 521 }\r
 522 \r
 523 static void PicoWrite8_z80(u32 a, u32 d)\r
 524 {\r
 525   if ((Pico.m.z80Run & 1) || Pico.m.z80_reset) {\r
 526     // verified on real hw\r
 527     elprintf(EL_ANOMALY, "68k z80 write with no bus or reset! [%06x] %02x @ %06x", a, d&0xff, SekPc);\r
 528     return;\r
 529   }\r
 530 \r
 531   if ((a & 0x4000) == 0x0000) { // z80 RAM\r
 532     SekCyclesBurn(2); // hack\r
 533     Pico.zram[a & 0x1fff] = (u8)d;\r
 534     return;\r
 535   }\r
 536   if ((a & 0x6000) == 0x4000) { // FM Sound\r
 537     if (PicoOpt & POPT_EN_FM)\r
 538       emustatus |= ym2612_write_local(a&3, d&0xff, 0)&1;\r
 539     return;\r
 540   }\r
 541   // TODO: probably other VDP access too? Maybe more mirrors?\r
 542   if ((a & 0x7ff9) == 0x7f11) { // PSG Sound\r
 543     if (PicoOpt & POPT_EN_PSG)\r
 544       SN76496Write(d);\r
 545     return;\r
 546   }\r
 547 #if !defined(_ASM_MEMORY_C) || defined(_ASM_MEMORY_C_AMIPS)\r
 548   if ((a & 0x7f00) == 0x6000) // Z80 BANK register\r
 549   {\r
 550     Pico.m.z80_bank68k >>= 1;\r
 551     Pico.m.z80_bank68k |= d << 8;\r
 552     Pico.m.z80_bank68k &= 0x1ff; // 9 bits and filled in the new top one\r
 553     elprintf(EL_Z80BNK, "z80 bank=%06x", Pico.m.z80_bank68k << 15);\r
 554     return;\r
 555   }\r
 556 #endif\r
 557   elprintf(EL_UIO|EL_ANOMALY, "68k bad write [%06x] %02x @ %06x", a, d&0xff, SekPc);\r
 558 }\r
 559 \r
 560 static void PicoWrite16_z80(u32 a, u32 d)\r
 561 {\r
 562   // for RAM, only most significant byte is sent\r
 563   // TODO: verify remaining accesses\r
 564   PicoWrite8_z80(a, d >> 8);\r
 565 }\r
 566 \r
 567 // IO/control area (0xa10000 - 0xa1ffff)\r
 568 u32 PicoRead8_io(u32 a)\r
 569 {\r
 570   u32 d;\r
 571 \r
 572   if ((a & 0xffe0) == 0x0000) { // I/O ports\r
 573     d = io_ports_read(a);\r
 574     goto end;\r
 575   }\r
 576 \r
 577   // faking open bus (MegaCD pulldowns don't work here curiously)\r
 578   d = Pico.m.rotate++;\r
 579   d ^= d << 6;\r
 580 \r
 581   // bit8 seems to be readable in this range\r
 582   if ((a & 0xfc01) == 0x1000)\r
 583     d &= ~0x01;\r
 584 \r
 585   if ((a & 0xff01) == 0x1100) { // z80 busreq (verified)\r
 586     d |= (Pico.m.z80Run | Pico.m.z80_reset) & 1;\r
 587     elprintf(EL_BUSREQ, "get_zrun: %02x [%i] @%06x", d, SekCyclesDone(), SekPc);\r
 588     goto end;\r
 589   }\r
 590 \r
 591   d = m68k_unmapped_read8(a);\r
 592 end:\r
 593   return d;\r
 594 }\r
 595 \r
 596 u32 PicoRead16_io(u32 a)\r
 597 {\r
 598   u32 d;\r
 599 \r
 600   if ((a & 0xffe0) == 0x0000) { // I/O ports\r
 601     d = io_ports_read(a);\r
 602     goto end;\r
 603   }\r
 604 \r
 605   // faking open bus\r
 606   d = (Pico.m.rotate += 0x41);\r
 607   d ^= (d << 5) ^ (d << 8);\r
 608 \r
 609   // bit8 seems to be readable in this range\r
 610   if ((a & 0xfc00) == 0x1000)\r
 611     d &= ~0x0100;\r
 612 \r
 613   if ((a & 0xff00) == 0x1100) { // z80 busreq\r
 614     d |= ((Pico.m.z80Run | Pico.m.z80_reset) & 1) << 8;\r
 615     elprintf(EL_BUSREQ, "get_zrun: %04x [%i] @%06x", d, SekCyclesDone(), SekPc);\r
 616     goto end;\r
 617   }\r
 618 \r
 619   d = m68k_unmapped_read16(a);\r
 620 end:\r
 621   return d;\r
 622 }\r
 623 \r
 624 void PicoWrite8_io(u32 a, u32 d)\r
 625 {\r
 626   if ((a & 0xffe1) == 0x0001) { // I/O ports (verified: only LSB!)\r
 627     io_ports_write(a, d);\r
 628     return;\r
 629   }\r
 630   if ((a & 0xff01) == 0x1100) { // z80 busreq\r
 631     ctl_write_z80busreq(d);\r
 632     return;\r
 633   }\r
 634   if ((a & 0xff01) == 0x1200) { // z80 reset\r
 635     ctl_write_z80reset(d);\r
 636     return;\r
 637   }\r
 638   if (a == 0xa130f1) { // sram access register\r
 639     elprintf(EL_SRAMIO, "sram reg=%02x", d);\r
 640     Pico.m.sram_reg &= ~(SRR_MAPPED|SRR_READONLY);\r
 641     Pico.m.sram_reg |= (u8)(d & 3);\r
 642     return;\r
 643   }\r
 644   m68k_unmapped_write8(a, d);\r
 645 }\r
 646 \r
 647 void PicoWrite16_io(u32 a, u32 d)\r
 648 {\r
 649   if ((a & 0xffe0) == 0x0000) { // I/O ports (verified: only LSB!)\r
 650     io_ports_write(a, d);\r
 651     return;\r
 652   }\r
 653   if ((a & 0xff00) == 0x1100) { // z80 busreq\r
 654     ctl_write_z80busreq(d >> 8);\r
 655     return;\r
 656   }\r
 657   if ((a & 0xff00) == 0x1200) { // z80 reset\r
 658     ctl_write_z80reset(d >> 8);\r
 659     return;\r
 660   }\r
 661   if (a == 0xa130f0) { // sram access register\r
 662     elprintf(EL_SRAMIO, "sram reg=%02x", d);\r
 663     Pico.m.sram_reg &= ~(SRR_MAPPED|SRR_READONLY);\r
 664     Pico.m.sram_reg |= (u8)(d & 3);\r
 665     return;\r
 666   }\r
 667   m68k_unmapped_write16(a, d);\r
 668 }\r
 669 \r
 670 // VDP area (0xc00000 - 0xdfffff)\r
 671 // TODO: verify if lower byte goes to PSG on word writes\r
 672 static u32 PicoRead8_vdp(u32 a)\r
 673 {\r
 674   if ((a & 0x00e0) == 0x0000)\r
 675     return PicoVideoRead8(a);\r
 676 \r
 677   elprintf(EL_UIO|EL_ANOMALY, "68k bad read [%06x] @%06x", a, SekPc);\r
 678   return 0;\r
 679 }\r
 680 \r
 681 static u32 PicoRead16_vdp(u32 a)\r
 682 {\r
 683   if ((a & 0x00e0) == 0x0000)\r
 684     return PicoVideoRead(a);\r
 685 \r
 686   elprintf(EL_UIO|EL_ANOMALY, "68k bad read [%06x] @%06x", a, SekPc);\r
 687   return 0;\r
 688 }\r
 689 \r
 690 static void PicoWrite8_vdp(u32 a, u32 d)\r
 691 {\r
 692   if ((a & 0x00f9) == 0x0011) { // PSG Sound\r
 693     if (PicoOpt & POPT_EN_PSG)\r
 694       SN76496Write(d);\r
 695     return;\r
 696   }\r
 697   if ((a & 0x00e0) == 0x0000) {\r
 698     d &= 0xff;\r
 699     PicoVideoWrite(a, d | (d << 8));\r
 700     return;\r
 701   }\r
 702 \r
 703   elprintf(EL_UIO|EL_ANOMALY, "68k bad write [%06x] %02x @%06x", a, d & 0xff, SekPc);\r
 704 }\r
 705 \r
 706 static void PicoWrite16_vdp(u32 a, u32 d)\r
 707 {\r
 708   if ((a & 0x00f9) == 0x0010) { // PSG Sound\r
 709     if (PicoOpt & POPT_EN_PSG)\r
 710       SN76496Write(d);\r
 711     return;\r
 712   }\r
 713   if ((a & 0x00e0) == 0x0000) {\r
 714     PicoVideoWrite(a, d);\r
 715     return;\r
 716   }\r
 717 \r
 718   elprintf(EL_UIO|EL_ANOMALY, "68k bad write [%06x] %04x @%06x", a, d & 0xffff, SekPc);\r
 719 }\r
 720 \r
 721 // -----------------------------------------------------------------\r
 722 \r
 723 #ifdef EMU_M68K\r
 724 static void m68k_mem_setup(void);\r
 725 #endif\r
 726 \r
 727 PICO_INTERNAL void PicoMemSetup(void)\r
 728 {\r
 729   int mask, rs, a;\r
 730 \r
 731   // setup the memory map\r
 732   cpu68k_map_set(m68k_read8_map,   0x000000, 0xffffff, m68k_unmapped_read8, 1);\r
 733   cpu68k_map_set(m68k_read16_map,  0x000000, 0xffffff, m68k_unmapped_read16, 1);\r
 734   cpu68k_map_set(m68k_write8_map,  0x000000, 0xffffff, m68k_unmapped_write8, 1);\r
 735   cpu68k_map_set(m68k_write16_map, 0x000000, 0xffffff, m68k_unmapped_write16, 1);\r
 736 \r
 737   // ROM\r
 738   // align to bank size. We know ROM loader allocated enough for this\r
 739   mask = (1 << M68K_MEM_SHIFT) - 1;\r
 740   rs = (Pico.romsize + mask) & ~mask;\r
 741   cpu68k_map_set(m68k_read8_map,  0x000000, rs - 1, Pico.rom, 0);\r
 742   cpu68k_map_set(m68k_read16_map, 0x000000, rs - 1, Pico.rom, 0);\r
 743 \r
 744   // Common case of on-cart (save) RAM, usually at 0x200000-...\r
 745   if ((SRam.flags & SRF_ENABLED) && SRam.data != NULL) {\r
 746     rs = SRam.end - SRam.start;\r
 747     rs = (rs + mask) & ~mask;\r
 748     if (SRam.start + rs >= 0x1000000)\r
 749       rs = 0x1000000 - SRam.start;\r
 750     cpu68k_map_set(m68k_read8_map,   SRam.start, SRam.start + rs - 1, PicoRead8_sram, 1);\r
 751     cpu68k_map_set(m68k_read16_map,  SRam.start, SRam.start + rs - 1, PicoRead16_sram, 1);\r
 752     cpu68k_map_set(m68k_write8_map,  SRam.start, SRam.start + rs - 1, PicoWrite8_sram, 1);\r
 753     cpu68k_map_set(m68k_write16_map, SRam.start, SRam.start + rs - 1, PicoWrite16_sram, 1);\r
 754   }\r
 755 \r
 756   // Z80 region\r
 757   cpu68k_map_set(m68k_read8_map,   0xa00000, 0xa0ffff, PicoRead8_z80, 1);\r
 758   cpu68k_map_set(m68k_read16_map,  0xa00000, 0xa0ffff, PicoRead16_z80, 1);\r
 759   cpu68k_map_set(m68k_write8_map,  0xa00000, 0xa0ffff, PicoWrite8_z80, 1);\r
 760   cpu68k_map_set(m68k_write16_map, 0xa00000, 0xa0ffff, PicoWrite16_z80, 1);\r
 761 \r
 762   // IO/control region\r
 763   cpu68k_map_set(m68k_read8_map,   0xa10000, 0xa1ffff, PicoRead8_io, 1);\r
 764   cpu68k_map_set(m68k_read16_map,  0xa10000, 0xa1ffff, PicoRead16_io, 1);\r
 765   cpu68k_map_set(m68k_write8_map,  0xa10000, 0xa1ffff, PicoWrite8_io, 1);\r
 766   cpu68k_map_set(m68k_write16_map, 0xa10000, 0xa1ffff, PicoWrite16_io, 1);\r
 767 \r
 768   // VDP region\r
 769   for (a = 0xc00000; a < 0xe00000; a += 0x010000) {\r
 770     if ((a & 0xe700e0) != 0xc00000)\r
 771       continue;\r
 772     cpu68k_map_set(m68k_read8_map,   a, a + 0xffff, PicoRead8_vdp, 1);\r
 773     cpu68k_map_set(m68k_read16_map,  a, a + 0xffff, PicoRead16_vdp, 1);\r
 774     cpu68k_map_set(m68k_write8_map,  a, a + 0xffff, PicoWrite8_vdp, 1);\r
 775     cpu68k_map_set(m68k_write16_map, a, a + 0xffff, PicoWrite16_vdp, 1);\r
 776   }\r
 777 \r
 778   // RAM and it's mirrors\r
 779   for (a = 0xe00000; a < 0x1000000; a += 0x010000) {\r
 780     cpu68k_map_set(m68k_read8_map,   a, a + 0xffff, Pico.ram, 0);\r
 781     cpu68k_map_set(m68k_read16_map,  a, a + 0xffff, Pico.ram, 0);\r
 782     cpu68k_map_set(m68k_write8_map,  a, a + 0xffff, Pico.ram, 0);\r
 783     cpu68k_map_set(m68k_write16_map, a, a + 0xffff, Pico.ram, 0);\r
 784   }\r
 785 \r
 786   // Setup memory callbacks:\r
 787 #ifdef EMU_C68K\r
 788   PicoCpuCM68k.checkpc = PicoCheckPc;\r
 789   PicoCpuCM68k.fetch8  = PicoCpuCM68k.read8  = m68k_read8;\r
 790   PicoCpuCM68k.fetch16 = PicoCpuCM68k.read16 = m68k_read16;\r
 791   PicoCpuCM68k.fetch32 = PicoCpuCM68k.read32 = m68k_read32;\r
 792   PicoCpuCM68k.write8  = m68k_write8;\r
 793   PicoCpuCM68k.write16 = m68k_write16;\r
 794   PicoCpuCM68k.write32 = m68k_write32;\r
 795 #endif\r
 796 #ifdef EMU_F68K\r
 797   PicoCpuFM68k.read_byte  = m68k_read8;\r
 798   PicoCpuFM68k.read_word  = m68k_read16;\r
 799   PicoCpuFM68k.read_long  = m68k_read32;\r
 800   PicoCpuFM68k.write_byte = m68k_write8;\r
 801   PicoCpuFM68k.write_word = m68k_write16;\r
 802   PicoCpuFM68k.write_long = m68k_write32;\r
 803 \r
 804   // setup FAME fetchmap\r
 805   {\r
 806     int i;\r
 807     // by default, point everything to first 64k of ROM\r
 808     for (i = 0; i < M68K_FETCHBANK1; i++)\r
 809       PicoCpuFM68k.Fetch[i] = (unsigned int)Pico.rom - (i<<(24-FAMEC_FETCHBITS));\r
 810     // now real ROM\r
 811     for (i = 0; i < M68K_FETCHBANK1 && (i<<(24-FAMEC_FETCHBITS)) < Pico.romsize; i++)\r
 812       PicoCpuFM68k.Fetch[i] = (unsigned int)Pico.rom;\r
 813     // .. and RAM\r
 814     for (i = M68K_FETCHBANK1*14/16; i < M68K_FETCHBANK1; i++)\r
 815       PicoCpuFM68k.Fetch[i] = (unsigned int)Pico.ram - (i<<(24-FAMEC_FETCHBITS));\r
 816   }\r
 817 #endif\r
 818 #ifdef EMU_M68K\r
 819   m68k_mem_setup();\r
 820 #endif\r
 821 \r
 822   z80_mem_setup();\r
 823 }\r
 824 \r
 825 #ifdef EMU_M68K\r
 826 unsigned int (*pm68k_read_memory_8) (unsigned int address) = NULL;\r
 827 unsigned int (*pm68k_read_memory_16)(unsigned int address) = NULL;\r
 828 unsigned int (*pm68k_read_memory_32)(unsigned int address) = NULL;\r
 829 void (*pm68k_write_memory_8) (unsigned int address, unsigned char  value) = NULL;\r
 830 void (*pm68k_write_memory_16)(unsigned int address, unsigned short value) = NULL;\r
 831 void (*pm68k_write_memory_32)(unsigned int address, unsigned int   value) = NULL;\r
 832 \r
 833 /* it appears that Musashi doesn't always mask the unused bits */\r
 834 unsigned int m68k_read_memory_8 (unsigned int address) { return pm68k_read_memory_8 (address) & 0xff; }\r
 835 unsigned int m68k_read_memory_16(unsigned int address) { return pm68k_read_memory_16(address) & 0xffff; }\r
 836 unsigned int m68k_read_memory_32(unsigned int address) { return pm68k_read_memory_32(address); }\r
 837 void m68k_write_memory_8 (unsigned int address, unsigned int value) { pm68k_write_memory_8 (address, (u8)value); }\r
 838 void m68k_write_memory_16(unsigned int address, unsigned int value) { pm68k_write_memory_16(address,(u16)value); }\r
 839 void m68k_write_memory_32(unsigned int address, unsigned int value) { pm68k_write_memory_32(address, value); }\r
 840 \r
 841 static void m68k_mem_setup(void)\r
 842 {\r
 843   pm68k_read_memory_8  = m68k_read8;\r
 844   pm68k_read_memory_16 = m68k_read16;\r
 845   pm68k_read_memory_32 = m68k_read32;\r
 846   pm68k_write_memory_8  = m68k_write8;\r
 847   pm68k_write_memory_16 = m68k_write16;\r
 848   pm68k_write_memory_32 = m68k_write32;\r
 849 }\r
 850 #endif // EMU_M68K\r
 851 \r
 852 \r
 853 // -----------------------------------------------------------------\r
 854 \r
 855 static int get_scanline(int is_from_z80)\r
 856 {\r
 857   if (is_from_z80) {\r
 858     int cycles = z80_cyclesDone();\r
 859     while (cycles - z80_scanline_cycles >= 228)\r
 860       z80_scanline++, z80_scanline_cycles += 228;\r
 861     return z80_scanline;\r
 862   }\r
 863 \r
 864   return Pico.m.scanline;\r
 865 }\r
 866 \r
 867 /* probably should not be in this file, but it's near related code here */\r
 868 void ym2612_sync_timers(int z80_cycles, int mode_old, int mode_new)\r
 869 {\r
 870   int xcycles = z80_cycles << 8;\r
 871 \r
 872   /* check for overflows */\r
 873   if ((mode_old & 4) && xcycles > timer_a_next_oflow)\r
 874     ym2612.OPN.ST.status |= 1;\r
 875 \r
 876   if ((mode_old & 8) && xcycles > timer_b_next_oflow)\r
 877     ym2612.OPN.ST.status |= 2;\r
 878 \r
 879   /* update timer a */\r
 880   if (mode_old & 1)\r
 881     while (xcycles > timer_a_next_oflow)\r
 882       timer_a_next_oflow += timer_a_step;\r
 883 \r
 884   if ((mode_old ^ mode_new) & 1) // turning on/off\r
 885   {\r
 886     if (mode_old & 1)\r
 887       timer_a_next_oflow = TIMER_NO_OFLOW;\r
 888     else\r
 889       timer_a_next_oflow = xcycles + timer_a_step;\r
 890   }\r
 891   if (mode_new & 1)\r
 892     elprintf(EL_YMTIMER, "timer a upd to %i @ %i", timer_a_next_oflow>>8, z80_cycles);\r
 893 \r
 894   /* update timer b */\r
 895   if (mode_old & 2)\r
 896     while (xcycles > timer_b_next_oflow)\r
 897       timer_b_next_oflow += timer_b_step;\r
 898 \r
 899   if ((mode_old ^ mode_new) & 2)\r
 900   {\r
 901     if (mode_old & 2)\r
 902       timer_b_next_oflow = TIMER_NO_OFLOW;\r
 903     else\r
 904       timer_b_next_oflow = xcycles + timer_b_step;\r
 905   }\r
 906   if (mode_new & 2)\r
 907     elprintf(EL_YMTIMER, "timer b upd to %i @ %i", timer_b_next_oflow>>8, z80_cycles);\r
 908 }\r
 909 \r
 910 // ym2612 DAC and timer I/O handlers for z80\r
 911 static int ym2612_write_local(u32 a, u32 d, int is_from_z80)\r
 912 {\r
 913   int addr;\r
 914 \r
 915   a &= 3;\r
 916   if (a == 1 && ym2612.OPN.ST.address == 0x2a) /* DAC data */\r
 917   {\r
 918     int scanline = get_scanline(is_from_z80);\r
 919     //elprintf(EL_STATUS, "%03i -> %03i dac w %08x z80 %i", PsndDacLine, scanline, d, is_from_z80);\r
 920     ym2612.dacout = ((int)d - 0x80) << 6;\r
 921     if (PsndOut && ym2612.dacen && scanline >= PsndDacLine)\r
 922       PsndDoDAC(scanline);\r
 923     return 0;\r
 924   }\r
 925 \r
 926   switch (a)\r
 927   {\r
 928     case 0: /* address port 0 */\r
 929       ym2612.OPN.ST.address = d;\r
 930       ym2612.addr_A1 = 0;\r
 931 #ifdef __GP2X__\r
 932       if (PicoOpt & POPT_EXT_FM) YM2612Write_940(a, d, -1);\r
 933 #endif\r
 934       return 0;\r
 935 \r
 936     case 1: /* data port 0    */\r
 937       if (ym2612.addr_A1 != 0)\r
 938         return 0;\r
 939 \r
 940       addr = ym2612.OPN.ST.address;\r
 941       ym2612.REGS[addr] = d;\r
 942 \r
 943       switch (addr)\r
 944       {\r
 945         case 0x24: // timer A High 8\r
 946         case 0x25: { // timer A Low 2\r
 947           int TAnew = (addr == 0x24) ? ((ym2612.OPN.ST.TA & 0x03)|(((int)d)<<2))\r
 948                                      : ((ym2612.OPN.ST.TA & 0x3fc)|(d&3));\r
 949           if (ym2612.OPN.ST.TA != TAnew)\r
 950           {\r
 951             //elprintf(EL_STATUS, "timer a set %i", TAnew);\r
 952             ym2612.OPN.ST.TA = TAnew;\r
 953             //ym2612.OPN.ST.TAC = (1024-TAnew)*18;\r
 954             //ym2612.OPN.ST.TAT = 0;\r
 955             timer_a_step = TIMER_A_TICK_ZCYCLES * (1024 - TAnew);\r
 956             if (ym2612.OPN.ST.mode & 1) {\r
 957               // this is not right, should really be done on overflow only\r
 958               int cycles = is_from_z80 ? z80_cyclesDone() : cycles_68k_to_z80(SekCyclesDone());\r
 959               timer_a_next_oflow = (cycles << 8) + timer_a_step;\r
 960             }\r
 961             elprintf(EL_YMTIMER, "timer a set to %i, %i", 1024 - TAnew, timer_a_next_oflow>>8);\r
 962           }\r
 963           return 0;\r
 964         }\r
 965         case 0x26: // timer B\r
 966           if (ym2612.OPN.ST.TB != d) {\r
 967             //elprintf(EL_STATUS, "timer b set %i", d);\r
 968             ym2612.OPN.ST.TB = d;\r
 969             //ym2612.OPN.ST.TBC = (256-d) * 288;\r
 970             //ym2612.OPN.ST.TBT  = 0;\r
 971             timer_b_step = TIMER_B_TICK_ZCYCLES * (256 - d); // 262800\r
 972             if (ym2612.OPN.ST.mode & 2) {\r
 973               int cycles = is_from_z80 ? z80_cyclesDone() : cycles_68k_to_z80(SekCyclesDone());\r
 974               timer_b_next_oflow = (cycles << 8) + timer_b_step;\r
 975             }\r
 976             elprintf(EL_YMTIMER, "timer b set to %i, %i", 256 - d, timer_b_next_oflow>>8);\r
 977           }\r
 978           return 0;\r
 979         case 0x27: { /* mode, timer control */\r
 980           int old_mode = ym2612.OPN.ST.mode;\r
 981           int cycles = is_from_z80 ? z80_cyclesDone() : cycles_68k_to_z80(SekCyclesDone());\r
 982           ym2612.OPN.ST.mode = d;\r
 983 \r
 984           elprintf(EL_YMTIMER, "st mode %02x", d);\r
 985           ym2612_sync_timers(cycles, old_mode, d);\r
 986 \r
 987           /* reset Timer a flag */\r
 988           if (d & 0x10)\r
 989             ym2612.OPN.ST.status &= ~1;\r
 990 \r
 991           /* reset Timer b flag */\r
 992           if (d & 0x20)\r
 993             ym2612.OPN.ST.status &= ~2;\r
 994 \r
 995           if ((d ^ old_mode) & 0xc0) {\r
 996 #ifdef __GP2X__\r
 997             if (PicoOpt & POPT_EXT_FM) return YM2612Write_940(a, d, get_scanline(is_from_z80));\r
 998 #endif\r
 999             return 1;\r
1000           }\r
1001           return 0;\r
1002         }\r
1003         case 0x2b: { /* DAC Sel  (YM2612) */\r
1004           int scanline = get_scanline(is_from_z80);\r
1005           ym2612.dacen = d & 0x80;\r
1006           if (d & 0x80) PsndDacLine = scanline;\r
1007 #ifdef __GP2X__\r
1008           if (PicoOpt & POPT_EXT_FM) YM2612Write_940(a, d, scanline);\r
1009 #endif\r
1010           return 0;\r
1011         }\r
1012       }\r
1013       break;\r
1014 \r
1015     case 2: /* address port 1 */\r
1016       ym2612.OPN.ST.address = d;\r
1017       ym2612.addr_A1 = 1;\r
1018 #ifdef __GP2X__\r
1019       if (PicoOpt & POPT_EXT_FM) YM2612Write_940(a, d, -1);\r
1020 #endif\r
1021       return 0;\r
1022 \r
1023     case 3: /* data port 1    */\r
1024       if (ym2612.addr_A1 != 1)\r
1025         return 0;\r
1026 \r
1027       addr = ym2612.OPN.ST.address | 0x100;\r
1028       ym2612.REGS[addr] = d;\r
1029       break;\r
1030   }\r
1031 \r
1032 #ifdef __GP2X__\r
1033   if (PicoOpt & POPT_EXT_FM)\r
1034     return YM2612Write_940(a, d, get_scanline(is_from_z80));\r
1035 #endif\r
1036   return YM2612Write_(a, d);\r
1037 }\r
1038 \r
1039 \r
1040 #define ym2612_read_local() \\r
1041   if (xcycles >= timer_a_next_oflow) \\r
1042     ym2612.OPN.ST.status |= (ym2612.OPN.ST.mode >> 2) & 1; \\r
1043   if (xcycles >= timer_b_next_oflow) \\r
1044     ym2612.OPN.ST.status |= (ym2612.OPN.ST.mode >> 2) & 2\r
1045 \r
1046 static u32 MEMH_FUNC ym2612_read_local_z80(void)\r
1047 {\r
1048   int xcycles = z80_cyclesDone() << 8;\r
1049 \r
1050   ym2612_read_local();\r
1051 \r
1052   elprintf(EL_YMTIMER, "timer z80 read %i, sched %i, %i @ %i|%i", ym2612.OPN.ST.status,\r
1053       timer_a_next_oflow>>8, timer_b_next_oflow>>8, xcycles >> 8, (xcycles >> 8) / 228);\r
1054   return ym2612.OPN.ST.status;\r
1055 }\r
1056 \r
1057 static u32 ym2612_read_local_68k(void)\r
1058 {\r
1059   int xcycles = cycles_68k_to_z80(SekCyclesDone()) << 8;\r
1060 \r
1061   ym2612_read_local();\r
1062 \r
1063   elprintf(EL_YMTIMER, "timer 68k read %i, sched %i, %i @ %i|%i", ym2612.OPN.ST.status,\r
1064       timer_a_next_oflow>>8, timer_b_next_oflow>>8, xcycles >> 8, (xcycles >> 8) / 228);\r
1065   return ym2612.OPN.ST.status;\r
1066 }\r
1067 \r
1068 void ym2612_pack_state(void)\r
1069 {\r
1070   // timers are saved as tick counts, in 16.16 int format\r
1071   int tac, tat = 0, tbc, tbt = 0;\r
1072   tac = 1024 - ym2612.OPN.ST.TA;\r
1073   tbc = 256  - ym2612.OPN.ST.TB;\r
1074   if (timer_a_next_oflow != TIMER_NO_OFLOW)\r
1075     tat = (int)((double)(timer_a_step - timer_a_next_oflow) / (double)timer_a_step * tac * 65536);\r
1076   if (timer_b_next_oflow != TIMER_NO_OFLOW)\r
1077     tbt = (int)((double)(timer_b_step - timer_b_next_oflow) / (double)timer_b_step * tbc * 65536);\r
1078   elprintf(EL_YMTIMER, "save: timer a %i/%i", tat >> 16, tac);\r
1079   elprintf(EL_YMTIMER, "save: timer b %i/%i", tbt >> 16, tbc);\r
1080 \r
1081 #ifdef __GP2X__\r
1082   if (PicoOpt & POPT_EXT_FM)\r
1083     YM2612PicoStateSave2_940(tat, tbt);\r
1084   else\r
1085 #endif\r
1086     YM2612PicoStateSave2(tat, tbt);\r
1087 }\r
1088 \r
1089 void ym2612_unpack_state(void)\r
1090 {\r
1091   int i, ret, tac, tat, tbc, tbt;\r
1092   YM2612PicoStateLoad();\r
1093 \r
1094   // feed all the registers and update internal state\r
1095   for (i = 0x20; i < 0xA0; i++) {\r
1096     ym2612_write_local(0, i, 0);\r
1097     ym2612_write_local(1, ym2612.REGS[i], 0);\r
1098   }\r
1099   for (i = 0x30; i < 0xA0; i++) {\r
1100     ym2612_write_local(2, i, 0);\r
1101     ym2612_write_local(3, ym2612.REGS[i|0x100], 0);\r
1102   }\r
1103   for (i = 0xAF; i >= 0xA0; i--) { // must apply backwards\r
1104     ym2612_write_local(2, i, 0);\r
1105     ym2612_write_local(3, ym2612.REGS[i|0x100], 0);\r
1106     ym2612_write_local(0, i, 0);\r
1107     ym2612_write_local(1, ym2612.REGS[i], 0);\r
1108   }\r
1109   for (i = 0xB0; i < 0xB8; i++) {\r
1110     ym2612_write_local(0, i, 0);\r
1111     ym2612_write_local(1, ym2612.REGS[i], 0);\r
1112     ym2612_write_local(2, i, 0);\r
1113     ym2612_write_local(3, ym2612.REGS[i|0x100], 0);\r
1114   }\r
1115 \r
1116 #ifdef __GP2X__\r
1117   if (PicoOpt & POPT_EXT_FM)\r
1118     ret = YM2612PicoStateLoad2_940(&tat, &tbt);\r
1119   else\r
1120 #endif\r
1121     ret = YM2612PicoStateLoad2(&tat, &tbt);\r
1122   if (ret != 0) {\r
1123     elprintf(EL_STATUS, "old ym2612 state");\r
1124     return; // no saved timers\r
1125   }\r
1126 \r
1127   tac = (1024 - ym2612.OPN.ST.TA) << 16;\r
1128   tbc = (256  - ym2612.OPN.ST.TB) << 16;\r
1129   if (ym2612.OPN.ST.mode & 1)\r
1130     timer_a_next_oflow = (int)((double)(tac - tat) / (double)tac * timer_a_step);\r
1131   else\r
1132     timer_a_next_oflow = TIMER_NO_OFLOW;\r
1133   if (ym2612.OPN.ST.mode & 2)\r
1134     timer_b_next_oflow = (int)((double)(tbc - tbt) / (double)tbc * timer_b_step);\r
1135   else\r
1136     timer_b_next_oflow = TIMER_NO_OFLOW;\r
1137   elprintf(EL_YMTIMER, "load: %i/%i, timer_a_next_oflow %i", tat>>16, tac>>16, timer_a_next_oflow >> 8);\r
1138   elprintf(EL_YMTIMER, "load: %i/%i, timer_b_next_oflow %i", tbt>>16, tbc>>16, timer_b_next_oflow >> 8);\r
1139 }\r
1140 \r
1141 // -----------------------------------------------------------------\r
1142 //                        z80 memhandlers\r
1143 \r
1144 static unsigned char MEMH_FUNC z80_md_vdp_read(unsigned short a)\r
1145 {\r
1146   // TODO?\r
1147   elprintf(EL_ANOMALY, "z80 invalid r8 [%06x] %02x", a, 0xff);\r
1148   return 0xff;\r
1149 }\r
1150 \r
1151 static unsigned char MEMH_FUNC z80_md_bank_read(unsigned short a)\r
1152 {\r
1153   extern unsigned int PicoReadM68k8(unsigned int a);\r
1154   unsigned int addr68k;\r
1155   unsigned char ret;\r
1156 \r
1157   addr68k = Pico.m.z80_bank68k<<15;\r
1158   addr68k += a & 0x7fff;\r
1159 \r
1160   ret = m68k_read8(addr68k);\r
1161 \r
1162   elprintf(EL_Z80BNK, "z80->68k r8 [%06x] %02x", addr68k, ret);\r
1163   return ret;\r
1164 }\r
1165 \r
1166 static void MEMH_FUNC z80_md_ym2612_write(unsigned int a, unsigned char data)\r
1167 {\r
1168   if (PicoOpt & POPT_EN_FM)\r
1169     emustatus |= ym2612_write_local(a, data, 1) & 1;\r
1170 }\r
1171 \r
1172 static void MEMH_FUNC z80_md_vdp_br_write(unsigned int a, unsigned char data)\r
1173 {\r
1174   // TODO: allow full VDP access\r
1175   if ((a&0xfff9) == 0x7f11) // 7f11 7f13 7f15 7f17\r
1176   {\r
1177     if (PicoOpt & POPT_EN_PSG)\r
1178       SN76496Write(data);\r
1179     return;\r
1180   }\r
1181 \r
1182   if ((a>>8) == 0x60)\r
1183   {\r
1184     Pico.m.z80_bank68k >>= 1;\r
1185     Pico.m.z80_bank68k |= data << 8;\r
1186     Pico.m.z80_bank68k &= 0x1ff; // 9 bits and filled in the new top one\r
1187     return;\r
1188   }\r
1189 \r
1190   elprintf(EL_ANOMALY, "z80 invalid w8 [%06x] %02x", a, data);\r
1191 }\r
1192 \r
1193 static void MEMH_FUNC z80_md_bank_write(unsigned int a, unsigned char data)\r
1194 {\r
1195   extern void PicoWriteM68k8(unsigned int a, unsigned char d);\r
1196   unsigned int addr68k;\r
1197 \r
1198   addr68k = Pico.m.z80_bank68k << 15;\r
1199   addr68k += a & 0x7fff;\r
1200 \r
1201   elprintf(EL_Z80BNK, "z80->68k w8 [%06x] %02x", addr68k, data);\r
1202   m68k_write8(addr68k, data);\r
1203 }\r
1204 \r
1205 // -----------------------------------------------------------------\r
1206 \r
1207 static unsigned char z80_md_in(unsigned short p)\r
1208 {\r
1209   elprintf(EL_ANOMALY, "Z80 port %04x read", p);\r
1210   return 0xff;\r
1211 }\r
1212 \r
1213 static void z80_md_out(unsigned short p, unsigned char d)\r
1214 {\r
1215   elprintf(EL_ANOMALY, "Z80 port %04x write %02x", p, d);\r
1216 }\r
1217 \r
1218 static void z80_mem_setup(void)\r
1219 {\r
1220   z80_map_set(z80_read_map, 0x0000, 0x1fff, Pico.zram, 0);\r
1221   z80_map_set(z80_read_map, 0x2000, 0x3fff, Pico.zram, 0);\r
1222   z80_map_set(z80_read_map, 0x4000, 0x5fff, ym2612_read_local_z80, 1);\r
1223   z80_map_set(z80_read_map, 0x6000, 0x7fff, z80_md_vdp_read, 1);\r
1224   z80_map_set(z80_read_map, 0x8000, 0xffff, z80_md_bank_read, 1);\r
1225 \r
1226   z80_map_set(z80_write_map, 0x0000, 0x1fff, Pico.zram, 0);\r
1227   z80_map_set(z80_write_map, 0x2000, 0x3fff, Pico.zram, 0);\r
1228   z80_map_set(z80_write_map, 0x4000, 0x5fff, z80_md_ym2612_write, 1);\r
1229   z80_map_set(z80_write_map, 0x6000, 0x7fff, z80_md_vdp_br_write, 1);\r
1230   z80_map_set(z80_write_map, 0x8000, 0xffff, z80_md_bank_write, 1);\r
1231 \r
1232 #ifdef _USE_DRZ80\r
1233   drZ80.z80_in = z80_md_in;\r
1234   drZ80.z80_out = z80_md_out;\r
1235 #endif\r
1236 #ifdef _USE_CZ80\r
1237   Cz80_Set_Fetch(&CZ80, 0x0000, 0x1fff, (UINT32)Pico.zram); // main RAM\r
1238   Cz80_Set_Fetch(&CZ80, 0x2000, 0x3fff, (UINT32)Pico.zram); // mirror\r
1239   Cz80_Set_INPort(&CZ80, z80_md_in);\r
1240   Cz80_Set_OUTPort(&CZ80, z80_md_out);\r
1241 #endif\r
1242 }\r
1243 \r