pico/memory.c

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