X-Git-Url: https://notaz.gp2x.de/cgi-bin/gitweb.cgi?a=blobdiff_plain;f=Pico%2Fcd%2FSek.c;h=f28b1423e5d75fe76dcb3565f197ca6286865e0a;hb=3335750a7df62a52857348365e9dbbf6f23a0d29;hp=5def9c198f47edf36ea578bf19b0764f0b10ae55;hpb=b837b69b3fcff1737431c8be1c78d1cfd64003a6;p=picodrive.git

diff --git a/Pico/cd/Sek.c b/Pico/cd/Sek.c
index 5def9c1..f28b142 100644
--- a/Pico/cd/Sek.c
+++ b/Pico/cd/Sek.c
@@ -1,10 +1,4 @@
-// This is part of Pico Library
-
-// (c) Copyright 2004 Dave, All rights reserved.
 // (c) Copyright 2006 notaz, All rights reserved.
-// Free for non-commercial use.
-
-// For commercial use, separate licencing terms must be obtained.
 
 
 #include "../PicoInt.h"
@@ -23,20 +17,21 @@ struct Cyclone PicoCpuS68k;
 m68ki_cpu_core PicoS68kCPU; // Mega CD's CPU
 #endif
 
-static int irqs = 0; // TODO: 2 context
+static int new_irq_level(int level)
+{
+  int level_new = 0, irqs;
+  Pico_mcd->m.s68k_pend_ints &= ~(1 << level);
+  irqs = Pico_mcd->m.s68k_pend_ints;
+  irqs &= Pico_mcd->s68k_regs[0x33];
+  while ((irqs >>= 1)) level_new++;
 
+  return level_new;
+}
 
 #ifdef EMU_M68K
-static int SekIntAckS68k(int level)
+static int SekIntAckS68kM(int level)
 {
-  int level_new = 0;
-  irqs &= ~(1 << level);
-  irqs &= Pico_mcd->s68k_regs[0x33];
-  if (irqs) {
-    level_new = 6;
-    while (level_new > 0) { if (irqs & (1 << level_new)) break; level_new--; }
-  }
-
+  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;
@@ -45,15 +40,9 @@ static int SekIntAckS68k(int level)
 
 #ifdef EMU_C68K
 // interrupt acknowledgment
-static void SekIntAck(int level)
+static void SekIntAckS68k(int level)
 {
-  int level_new = 0;
-  irqs &= ~(1 << level);
-  irqs &= Pico_mcd->s68k_regs[0x33];
-  if (irqs) {
-    level_new = 6;
-    while (level_new > 0) { if (irqs & (1 << level_new)) break; level_new--; }
-  }
+  int level_new = new_irq_level(level);
 
   dprintf("s68kACK %i -> %i", level, level_new);
   PicoCpuS68k.irq = level_new;
@@ -82,7 +71,7 @@ int SekInitS68k()
 #ifdef EMU_C68K
 //  CycloneInit();
   memset(&PicoCpuS68k,0,sizeof(PicoCpuS68k));
-  PicoCpuS68k.IrqCallback=SekIntAck;
+  PicoCpuS68k.IrqCallback=SekIntAckS68k;
   PicoCpuS68k.ResetCallback=SekResetAck;
   PicoCpuS68k.UnrecognizedCallback=SekUnrecognizedOpcode;
 #endif
@@ -93,7 +82,7 @@ int SekInitS68k()
     m68k_set_context(&PicoS68kCPU);
     m68k_set_cpu_type(M68K_CPU_TYPE_68000);
     m68k_init();
-    m68k_set_int_ack_callback(SekIntAckS68k);
+    m68k_set_int_ack_callback(SekIntAckS68kM);
 //  m68k_pulse_reset(); // not yet, memmap is not set up
     m68k_set_context(oldcontext);
   }
@@ -122,6 +111,8 @@ int SekResetS68k()
     void *oldcontext = m68ki_cpu_p;
 
     m68k_set_context(&PicoS68kCPU);
+    m68ki_cpu.sp[0]=0;
+    m68k_set_irq(0);
     m68k_pulse_reset();
     m68k_set_context(oldcontext);
   }
@@ -132,14 +123,18 @@ int SekResetS68k()
 
 int SekInterruptS68k(int irq)
 {
-  irqs |= 1 << 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
+
 #ifdef EMU_C68K
-  PicoCpuS68k.irq=irq;
+  PicoCpuS68k.irq=real_irq;
 #endif
 #ifdef EMU_M68K
   void *oldcontext = m68ki_cpu_p;
   m68k_set_context(&PicoS68kCPU);
-  m68k_set_irq(irq); // raise irq (gets lowered after taken or must be done in ack)
+  m68k_set_irq(real_irq); // raise irq (gets lowered after taken or must be done in ack)
   m68k_set_context(oldcontext);
 #endif
   return 0;