123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143 |
- // (c) Copyright 2006 notaz, All rights reserved.
- #include "../PicoInt.h"
- int SekCycleCntS68k=0; // cycles done in this frame
- int SekCycleAimS68k=0; // cycle aim
- #ifdef EMU_C68K
- // ---------------------- Cyclone 68000 ----------------------
- struct Cyclone PicoCpuS68k;
- #endif
- #ifdef EMU_M68K
- // ---------------------- MUSASHI 68000 ----------------------
- m68ki_cpu_core PicoS68kCPU; // Mega CD's CPU
- #endif
- 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 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)
- {
- int level_new = new_irq_level(level);
- dprintf("s68kACK %i -> %i", level, level_new);
- PicoCpuS68k.irq = level_new;
- return CYCLONE_INT_ACK_AUTOVECTOR;
- }
- static void SekResetAckS68k(void)
- {
- dprintf("s68k: Reset encountered @ %06x", SekPcS68k);
- }
- static int SekUnrecognizedOpcodeS68k(void)
- {
- unsigned int pc, op;
- pc = SekPcS68k;
- op = PicoCpuS68k.read16(pc);
- dprintf("Unrecognized Opcode %04x @ %06x", op, pc);
- //exit(1);
- return 0;
- }
- #endif
- PICO_INTERNAL int SekInitS68k()
- {
- #ifdef EMU_C68K
- // CycloneInit();
- memset(&PicoCpuS68k,0,sizeof(PicoCpuS68k));
- PicoCpuS68k.IrqCallback=SekIntAckS68k;
- PicoCpuS68k.ResetCallback=SekResetAckS68k;
- PicoCpuS68k.UnrecognizedCallback=SekUnrecognizedOpcodeS68k;
- #endif
- #ifdef EMU_M68K
- {
- // Musashi is not very context friendly..
- void *oldcontext = m68ki_cpu_p;
- m68k_set_context(&PicoS68kCPU);
- m68k_set_cpu_type(M68K_CPU_TYPE_68000);
- m68k_init();
- m68k_set_int_ack_callback(SekIntAckS68kM);
- // m68k_pulse_reset(); // not yet, memmap is not set up
- m68k_set_context(oldcontext);
- }
- #endif
- return 0;
- }
- // Reset the 68000:
- 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
- #endif
- #ifdef EMU_M68K
- {
- 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);
- }
- #endif
- return 0;
- }
- 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
- #ifdef EMU_C68K
- PicoCpuS68k.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(oldcontext);
- #endif
- return 0;
- }
|