added timer saving to savestates
[picodrive.git] / Pico / Memory.c
index 45d9fdf..fe87ab9 100644 (file)
@@ -706,6 +706,53 @@ static int get_scanline(int is_from_z80)
   return vcounts[SekCyclesDone()>>8];\r
 }\r
 \r
+/* probably not should be in this file, but it's near related code here */\r
+void ym2612_sync_timers(int z80_cycles, int mode_old, int mode_new)\r
+{\r
+  int xcycles = z80_cycles << 8;\r
+\r
+  /* check for overflows */\r
+  if ((mode_old & 4) && xcycles > timer_a_next_oflow)\r
+    ym2612.OPN.ST.status |= 1;\r
+\r
+  if ((mode_old & 8) && xcycles > timer_b_next_oflow)\r
+    ym2612.OPN.ST.status |= 2;\r
+\r
+  /* update timer a */\r
+  if (mode_old & 1)\r
+    while (xcycles > timer_a_next_oflow)\r
+      timer_a_next_oflow += timer_a_step;\r
+\r
+  if ((mode_old ^ mode_new) & 1) // turning on/off\r
+  {\r
+    if (mode_old & 1) {\r
+      timer_a_offset = timer_a_next_oflow - xcycles;\r
+      timer_a_next_oflow = TIMER_NO_OFLOW;\r
+    }\r
+    else\r
+      timer_a_next_oflow = xcycles + timer_a_offset;\r
+  }\r
+  if (mode_new & 1)\r
+    elprintf(EL_YMTIMER, "timer a upd to %i @ %i", timer_a_next_oflow>>8, z80_cycles);\r
+\r
+  /* update timer b */\r
+  if (mode_old & 2)\r
+    while (xcycles > timer_b_next_oflow)\r
+      timer_b_next_oflow += timer_b_step;\r
+\r
+  if ((mode_old ^ mode_new) & 2)\r
+  {\r
+    if (mode_old & 2) {\r
+      timer_b_offset = timer_b_next_oflow - xcycles;\r
+      timer_b_next_oflow = TIMER_NO_OFLOW;\r
+    }\r
+    else\r
+      timer_b_next_oflow = xcycles + timer_b_offset;\r
+  }\r
+  if (mode_new & 2)\r
+    elprintf(EL_YMTIMER, "timer b upd to %i @ %i", timer_b_next_oflow>>8, z80_cycles);\r
+}\r
+\r
 // ym2612 DAC and timer I/O handlers for z80\r
 int ym2612_write_local(u32 a, u32 d, int is_from_z80)\r
 {\r
@@ -751,13 +798,12 @@ int ym2612_write_local(u32 a, u32 d, int is_from_z80)
             ym2612.OPN.ST.TA = TAnew;\r
             //ym2612.OPN.ST.TAC = (1024-TAnew)*18;\r
             //ym2612.OPN.ST.TAT = 0;\r
-            //\r
-            timer_a_step = 16495 * (1024 - TAnew);\r
-            if ((ym2612.OPN.ST.mode & 5) == 5) {\r
+            timer_a_step = timer_a_offset = 16466 * (1024 - TAnew);\r
+            if (ym2612.OPN.ST.mode & 1) {\r
               int cycles = is_from_z80 ? z80_cyclesDone() : cycles_68k_to_z80(SekCyclesDone());\r
               timer_a_next_oflow = (cycles << 8) + timer_a_step;\r
-              //elprintf(EL_STATUS, "set to %i @ %i", timer_a_next_oflow>>8, cycles);\r
             }\r
+            elprintf(EL_YMTIMER, "timer a set to %i, %i", 1024 - TAnew, timer_a_next_oflow>>8);\r
           }\r
           return 0;\r
         }\r
@@ -765,39 +811,38 @@ int ym2612_write_local(u32 a, u32 d, int is_from_z80)
           if (ym2612.OPN.ST.TB != d) {\r
             //elprintf(EL_STATUS, "timer b set %i", d);\r
             ym2612.OPN.ST.TB = d;\r
-            //ym2612.OPN.ST.TBC  = (256-d)<<4;\r
-            //ym2612.OPN.ST.TBC *= 18;\r
+            //ym2612.OPN.ST.TBC = (256-d) * 288;\r
             //ym2612.OPN.ST.TBT  = 0;\r
+            timer_b_step = timer_b_offset = 262800 * (256 - d); // 262881\r
+            if (ym2612.OPN.ST.mode & 2) {\r
+              int cycles = is_from_z80 ? z80_cyclesDone() : cycles_68k_to_z80(SekCyclesDone());\r
+              timer_b_next_oflow = (cycles << 8) + timer_b_step;\r
+            }\r
+            elprintf(EL_YMTIMER, "timer b set to %i, %i", 256 - d, timer_b_next_oflow>>8);\r
           }\r
           return 0;\r
         case 0x27: { /* mode, timer control */\r
           int old_mode = ym2612.OPN.ST.mode;\r
-          int xcycles = is_from_z80 ? z80_cyclesDone() : cycles_68k_to_z80(SekCyclesDone());\r
-          xcycles <<= 8;\r
+          int cycles = is_from_z80 ? z80_cyclesDone() : cycles_68k_to_z80(SekCyclesDone());\r
+          ym2612.OPN.ST.mode = d;\r
 \r
-          //elprintf(EL_STATUS, "st mode %02x", d);\r
+          elprintf(EL_YMTIMER, "st mode %02x", d);\r
+          ym2612_sync_timers(cycles, old_mode, d);\r
 \r
-          if ((ym2612.OPN.ST.mode & 5) != 5 && (d & 5) == 5) {\r
-            timer_a_next_oflow = xcycles + timer_a_step;\r
-            //elprintf(EL_STATUS, "set to %i @ %i st", timer_a_next_oflow>>8, xcycles >> 8);\r
-          }\r
+          /* reset Timer a flag */\r
+          if (d & 0x10)\r
+            ym2612.OPN.ST.status &= ~1;\r
 \r
           /* reset Timer b flag */\r
           if (d & 0x20)\r
             ym2612.OPN.ST.status &= ~2;\r
 \r
-          /* reset Timer a flag */\r
-          if (d & 0x10) {\r
-            if (ym2612.OPN.ST.status & 1)\r
-              while (xcycles > timer_a_next_oflow)\r
-                timer_a_next_oflow += timer_a_step;\r
-            ym2612.OPN.ST.status &= ~1;\r
-          }\r
-          if (!(d & 5)) timer_a_next_oflow = 0x80000000;\r
-          ym2612.OPN.ST.mode = d;\r
+          if ((d ^ old_mode) & 0xc0) {\r
 #ifdef __GP2X__\r
-          if (PicoOpt & POPT_EXT_FM) YM2612Write_940(a, d, get_scanline(is_from_z80));\r
+            if (PicoOpt & POPT_EXT_FM) YM2612Write_940(a, d, get_scanline(is_from_z80));\r
 #endif\r
+            return 1;\r
+          }\r
           return 0;\r
         }\r
         case 0x2b: { /* DAC Sel  (YM2612) */\r
@@ -836,19 +881,93 @@ int ym2612_write_local(u32 a, u32 d, int is_from_z80)
   return YM2612Write_(a, d);\r
 }\r
 \r
-// TODO: timer b, 68k side + asm, savestates\r
+\r
+#define ym2612_read_local() \\r
+  if (xcycles >= timer_a_next_oflow) \\r
+    ym2612.OPN.ST.status |= (ym2612.OPN.ST.mode >> 2) & 1; \\r
+  if (xcycles >= timer_b_next_oflow) \\r
+    ym2612.OPN.ST.status |= (ym2612.OPN.ST.mode >> 2) & 2\r
+\r
 u32 ym2612_read_local_z80(void)\r
 {\r
   int xcycles = z80_cyclesDone() << 8;\r
-  if (timer_a_next_oflow != 0x80000000 && xcycles >= timer_a_next_oflow) {\r
-    ym2612.OPN.ST.status |= 1;\r
-  }\r
 \r
-  //elprintf(EL_STATUS, "timer %i, sched %i, @ %i|%i", ym2612.OPN.ST.status, timer_a_next_oflow>>8,\r
-  //     xcycles >> 8, (xcycles >> 8) / 228);\r
+  ym2612_read_local();\r
+\r
+  elprintf(EL_YMTIMER, "timer z80 read %i, sched %i, %i @ %i|%i", ym2612.OPN.ST.status,\r
+      timer_a_next_oflow>>8, timer_b_next_oflow>>8, xcycles >> 8, (xcycles >> 8) / 228);\r
+  return ym2612.OPN.ST.status;\r
+}\r
+\r
+u32 ym2612_read_local_68k(void)\r
+{\r
+  int xcycles = cycles_68k_to_z80(SekCyclesDone()) << 8;\r
+\r
+  ym2612_read_local();\r
+\r
+  elprintf(EL_YMTIMER, "timer 68k read %i, sched %i, %i @ %i|%i", ym2612.OPN.ST.status,\r
+      timer_a_next_oflow>>8, timer_b_next_oflow>>8, xcycles >> 8, (xcycles >> 8) / 228);\r
   return ym2612.OPN.ST.status;\r
 }\r
 \r
+void ym2612_pack_state(void)\r
+{\r
+  // timers are saved as tick counts, in 16.16 int format\r
+  int tac, tat = 0, tbc, tbt = 0;\r
+  tac = 1024 - ym2612.OPN.ST.TA;\r
+  tbc = 256  - ym2612.OPN.ST.TB;\r
+  if (timer_a_next_oflow != TIMER_NO_OFLOW)\r
+    tat = (int)((double)(timer_a_step - timer_a_next_oflow) / (double)timer_a_step * tac * 65536);\r
+  if (timer_b_next_oflow != TIMER_NO_OFLOW)\r
+    tbt = (int)((double)(timer_b_step - timer_b_next_oflow) / (double)timer_b_step * tbc * 65536);\r
+  elprintf(EL_YMTIMER, "save: timer a %i/%i", tat >> 16, tac);\r
+  elprintf(EL_YMTIMER, "save: timer b %i/%i", tbt >> 16, tbc);\r
+\r
+#ifdef __GP2X__\r
+  if (PicoOpt & POPT_EXT_FM)\r
+    /*YM2612PicoStateSave2_940(tat, tbt)*/;\r
+  else\r
+#endif\r
+    YM2612PicoStateSave2(tat, tbt);\r
+}\r
+\r
+void ym2612_unpack_state(void)\r
+{\r
+  int i, ret, tac, tat, tbc, tbt;\r
+  YM2612PicoStateLoad();\r
+\r
+  // feed all the registers and update internal state\r
+  for (i = 0x20; i < 0xB8; i++) {\r
+    ym2612_write_local(0, i, 0);\r
+    ym2612_write_local(1, ym2612.REGS[i], 0);\r
+  }\r
+  for (i = 0x30; i < 0xB8; i++) {\r
+    ym2612_write_local(2, i, 0);\r
+    ym2612_write_local(3, ym2612.REGS[i|0x100], 0);\r
+  }\r
+\r
+#ifdef __GP2X__\r
+  if (PicoOpt & POPT_EXT_FM)\r
+    /*ret = YM2612PicoStateLoad2_940(&tat, &tbt)*/;\r
+  else\r
+#endif\r
+    ret = YM2612PicoStateLoad2(&tat, &tbt);\r
+  if (ret != 0) return; // no saved timers\r
+\r
+  tac = (1024 - ym2612.OPN.ST.TA) << 16;\r
+  tbc = (256  - ym2612.OPN.ST.TB) << 16;\r
+  if (ym2612.OPN.ST.mode & 1)\r
+    timer_a_next_oflow = (double)(tac - tat) / (double)tac * timer_a_step;\r
+  else\r
+    timer_a_next_oflow = TIMER_NO_OFLOW;\r
+  if (ym2612.OPN.ST.mode & 2)\r
+    timer_b_next_oflow = (double)(tbc - tbt) / (double)tbc * timer_b_step;\r
+  else\r
+    timer_b_next_oflow = TIMER_NO_OFLOW;\r
+  elprintf(EL_YMTIMER, "load: %i/%i, timer_a_next_oflow %i", tat>>16, tac>>16, timer_a_next_oflow >> 8);\r
+  elprintf(EL_YMTIMER, "load: %i/%i, timer_b_next_oflow %i", tbt>>16, tbc>>16, timer_b_next_oflow >> 8);\r
+}\r
+\r
 // -----------------------------------------------------------------\r
 //                        z80 memhandlers\r
 \r
@@ -869,13 +988,13 @@ PICO_INTERNAL unsigned char z80_read(unsigned short a)
     addr68k=Pico.m.z80_bank68k<<15;\r
     addr68k+=a&0x7fff;\r
 \r
+    if (addr68k < Pico.romsize) { ret = Pico.rom[addr68k^1]; goto bnkend; }\r
+    elprintf(EL_ANOMALY, "z80->68k upper read [%06x] %02x", addr68k, ret);\r
     if (PicoAHW & PAHW_MCD)\r
          ret = PicoReadM68k8(addr68k);\r
     else ret = PicoRead8(addr68k);\r
-    if (addr68k >= 0x400000) // not many games do this\r
-      { elprintf(EL_ANOMALY, "z80->68k upper read [%06x] %02x", addr68k, ret); }\r
-    else\r
-      { elprintf(EL_Z80BNK, "z80->68k r8 [%06x] %02x", addr68k, ret); }\r
+bnkend:\r
+    elprintf(EL_Z80BNK, "z80->68k r8 [%06x] %02x", addr68k, ret);\r
     return ret;\r
   }\r
 \r