FAME integration finished, some adjustments of CPU core stuff

[picodrive.git] / Pico / cd / Sek.c

diff --git a/Pico/cd/Sek.c b/Pico/cd/Sek.c
index 6295af5..6005f59 100644 (file)
--- a/Pico/cd/Sek.c
+++ b/Pico/cd/Sek.c
@@ -7,16 +7,22 @@
 int SekCycleCntS68k=0; // cycles done in this frame
 int SekCycleAimS68k=0; // cycle aim
 
+
+/* context */
+// Cyclone 68000
 #ifdef EMU_C68K
-// ---------------------- Cyclone 68000 ----------------------
-struct Cyclone PicoCpuS68k;
+struct Cyclone PicoCpuCS68k;
 #endif
-
+// MUSASHI 68000
 #ifdef EMU_M68K
-// ---------------------- MUSASHI 68000 ----------------------
-m68ki_cpu_core PicoS68kCPU; // Mega CD's CPU
+m68ki_cpu_core PicoCpuMS68k;
+#endif
+// FAME 68000
+#ifdef EMU_F68K
+M68K_CONTEXT PicoCpuFS68k;
 #endif
 
+
 static int new_irq_level(int level)
 {
   int level_new = 0, irqs;
@@ -28,16 +34,6 @@ static int new_irq_level(int level)
   return level_new;
 }
 
-#ifdef EMU_M68K
-static int SekIntAckS68kM(int level)
-{
-  int level_new = new_irq_level(level);
-  dprintf("s68kACK %i -> %i", level, level_new);
-  CPU_INT_LEVEL = level_new << 8;
-  return M68K_INT_ACK_AUTOVECTOR;
-}
-#endif
-
 #ifdef EMU_C68K
 // interrupt acknowledgement
 static int SekIntAckS68k(int level)
@@ -45,7 +41,7 @@ static int SekIntAckS68k(int level)
   int level_new = new_irq_level(level);
 
   dprintf("s68kACK %i -> %i", level, level_new);
-  PicoCpuS68k.irq = level_new;
+  PicoCpuCS68k.irq = level_new;
   return CYCLONE_INT_ACK_AUTOVECTOR;
 }
 
@@ -58,36 +54,64 @@ static int SekUnrecognizedOpcodeS68k(void)
 {
   unsigned int pc, op;
   pc = SekPcS68k;
-  op = PicoCpuS68k.read16(pc);
+  op = PicoCpuCS68k.read16(pc);
   dprintf("Unrecognized Opcode %04x @ %06x", op, pc);
   //exit(1);
   return 0;
 }
 #endif
 
+#ifdef EMU_M68K
+static int SekIntAckMS68k(int level)
+{
+  int level_new = new_irq_level(level);
+  dprintf("s68kACK %i -> %i", level, level_new);
+  CPU_INT_LEVEL = level_new << 8;
+  return M68K_INT_ACK_AUTOVECTOR;
+}
+#endif
+
+#ifdef EMU_F68K
+static void SekIntAckFS68k(unsigned level)
+{
+  int level_new = new_irq_level(level);
+  dprintf("s68kACK %i -> %i", level, level_new);
+  PicoCpuFS68k.interrupts[0] = level_new;
+}
+#endif
 
 
 PICO_INTERNAL int SekInitS68k()
 {
 #ifdef EMU_C68K
 //  CycloneInit();
-  memset(&PicoCpuS68k,0,sizeof(PicoCpuS68k));
-  PicoCpuS68k.IrqCallback=SekIntAckS68k;
-  PicoCpuS68k.ResetCallback=SekResetAckS68k;
-  PicoCpuS68k.UnrecognizedCallback=SekUnrecognizedOpcodeS68k;
+  memset(&PicoCpuCS68k,0,sizeof(PicoCpuCS68k));
+  PicoCpuCS68k.IrqCallback=SekIntAckS68k;
+  PicoCpuCS68k.ResetCallback=SekResetAckS68k;
+  PicoCpuCS68k.UnrecognizedCallback=SekUnrecognizedOpcodeS68k;
 #endif
 #ifdef EMU_M68K
   {
     // Musashi is not very context friendly..
     void *oldcontext = m68ki_cpu_p;
-    m68k_set_context(&PicoS68kCPU);
+    m68k_set_context(&PicoCpuMS68k);
     m68k_set_cpu_type(M68K_CPU_TYPE_68000);
     m68k_init();
-    m68k_set_int_ack_callback(SekIntAckS68kM);
+    m68k_set_int_ack_callback(SekIntAckMS68k);
 //  m68k_pulse_reset(); // not yet, memmap is not set up
     m68k_set_context(oldcontext);
   }
 #endif
+#ifdef EMU_F68K
+  {
+    void *oldcontext = g_m68kcontext;
+    g_m68kcontext = &PicoCpuFS68k;
+    memset(&PicoCpuFS68k, 0, sizeof(PicoCpuFS68k));
+    m68k_init();
+    PicoCpuFS68k.iack_handler = SekIntAckFS68k;
+    g_m68kcontext = oldcontext;
+  }
+#endif
 
   return 0;
 }
@@ -98,26 +122,34 @@ PICO_INTERNAL int SekResetS68k()
   if (Pico.rom==NULL) return 1;
 
 #ifdef EMU_C68K
-  PicoCpuS68k.state_flags=0;
-  PicoCpuS68k.osp=0;
-  PicoCpuS68k.srh =0x27; // Supervisor mode
-  PicoCpuS68k.flags=4;   // Z set
-  PicoCpuS68k.irq=0;
-  PicoCpuS68k.a[7]=PicoCpuS68k.read32(0); // Stack Pointer
-  PicoCpuS68k.membase=0;
-  PicoCpuS68k.pc=PicoCpuS68k.checkpc(PicoCpuS68k.read32(4)); // Program Counter
+  PicoCpuCS68k.state_flags=0;
+  PicoCpuCS68k.osp=0;
+  PicoCpuCS68k.srh =0x27; // Supervisor mode
+  PicoCpuCS68k.flags=4;   // Z set
+  PicoCpuCS68k.irq=0;
+  PicoCpuCS68k.a[7]=PicoCpuCS68k.read32(0); // Stack Pointer
+  PicoCpuCS68k.membase=0;
+  PicoCpuCS68k.pc=PicoCpuCS68k.checkpc(PicoCpuCS68k.read32(4)); // Program Counter
 #endif
 #ifdef EMU_M68K
   {
     void *oldcontext = m68ki_cpu_p;
 
-    m68k_set_context(&PicoS68kCPU);
+    m68k_set_context(&PicoCpuMS68k);
     m68ki_cpu.sp[0]=0;
     m68k_set_irq(0);
     m68k_pulse_reset();
     m68k_set_context(oldcontext);
   }
 #endif
+#ifdef EMU_F68K
+  {
+    void *oldcontext = g_m68kcontext;
+    g_m68kcontext = &PicoCpuFS68k;
+    m68k_reset();
+    g_m68kcontext = oldcontext;
+  }
+#endif
 
   return 0;
 }
@@ -127,16 +159,19 @@ PICO_INTERNAL int SekInterruptS68k(int irq)
   int irqs, real_irq = 1;
   Pico_mcd->m.s68k_pend_ints |= 1 << irq;
   irqs = Pico_mcd->m.s68k_pend_ints >> 1;
-  while ((irqs >>= 1)) real_irq++; // this is probably only needed for Cyclone
+  while ((irqs >>= 1)) real_irq++;
 
 #ifdef EMU_C68K
-  PicoCpuS68k.irq=real_irq;
+  PicoCpuCS68k.irq=real_irq;
 #endif
 #ifdef EMU_M68K
   void *oldcontext = m68ki_cpu_p;
-  m68k_set_context(&PicoS68kCPU);
-  m68k_set_irq(real_irq); // raise irq (gets lowered after taken or must be done in ack)
+  m68k_set_context(&PicoCpuMS68k);
+  m68k_set_irq(real_irq);
   m68k_set_context(oldcontext);
+#endif
+#ifdef EMU_F68K
+  PicoCpuFS68k.interrupts[0]=real_irq;
 #endif
   return 0;
 }