/* Autor: Oscar Orallo Pelaez */\r
/* Fecha de comienzo: 03-10-2006 */\r
/* Ultima actualizacion: 08-10-2006 */\r
-/* Based on the excellent FAMEC emulator by Stèphane Dallongueville */\r
+/* Based on the excellent C68K emulator by Stèphane Dallongueville */\r
/****************************************************************************/\r
\r
#include <stdio.h>\r
#define FAMEC_CHECK_BRANCHES\r
#define FAMEC_EXTRA_INLINE\r
// #define FAMEC_DEBUG\r
-//#define FAMEC_NO_GOTOS\r
+#define FAMEC_NO_GOTOS\r
#define FAMEC_ADR_BITS 24\r
// #define FAMEC_FETCHBITS 8\r
#define FAMEC_DATABITS 8\r
\r
#define USE_CYCLONE_TIMING\r
#define USE_CYCLONE_TIMING_DIV\r
+#define PICODRIVE_HACK\r
// Options //\r
\r
\r
#undef INLINE\r
-#ifndef INLINE\r
+#ifdef _MSC_VER\r
+#define INLINE\r
+#else\r
#define INLINE __inline__\r
#endif\r
\r
((u32)PC - BasePC)\r
\r
\r
+#ifdef FAMEC_CHECK_BRANCHES\r
+#define FORCE_ALIGNMENT(pc)\r
+#else\r
+#define FORCE_ALIGNMENT(pc) pc&=~1;\r
+#endif\r
+\r
#ifndef FAMEC_32BIT_PC\r
\r
#define SET_PC(A) \\r
{ \\r
u32 pc = A; \\r
+ FORCE_ALIGNMENT(pc); \\r
BasePC = m68kcontext.Fetch[(pc >> M68K_FETCHSFT) & M68K_FETCHMASK]; \\r
PC = (u16*)((pc & M68K_ADR_MASK) + BasePC); \\r
}\r
#define SET_PC(A) \\r
{ \\r
u32 pc = A; \\r
+ FORCE_ALIGNMENT(pc); \\r
BasePC = m68kcontext.Fetch[(pc >> M68K_FETCHSFT) & M68K_FETCHMASK]; \\r
BasePC -= pc & 0xFF000000; \\r
PC = (u16*)(pc + BasePC); \\r
#endif\r
\r
\r
-static int init_jump_table(void);\r
-\r
// global variable\r
///////////////////\r
\r
static s32 cycles_needed;\r
static u16 *PC;\r
static u32 BasePC;\r
+static u32 flag_C;\r
static u32 flag_V;\r
static u32 flag_NotZ;\r
static u32 flag_N;\r
\r
static u32 initialised = 0;\r
\r
+#ifdef PICODRIVE_HACK\r
+extern M68K_CONTEXT PicoCpuFM68k, PicoCpuFS68k;\r
+#endif\r
+\r
/* Custom function handler */\r
typedef void (*opcode_func)(void);\r
\r
#endif\r
\r
if (!initialised)\r
- fm68k_emulate(0);\r
+ fm68k_emulate(0, 0, 0);\r
\r
#ifdef FAMEC_DEBUG\r
puts("FAME initialized.");\r
int fm68k_reset(void)\r
{\r
if (!initialised)\r
- fm68k_emulate(0);\r
+ fm68k_emulate(0, 0, 0);\r
\r
// Si la CPU esta en ejecucion, salir con M68K_RUNNING\r
if (m68kcontext.execinfo & M68K_RUNNING)\r
#ifndef FAMEC_32BIT_PC\r
newPC&=M68K_ADR_MASK\r
#endif\r
+#ifdef FAMEC_CHECK_BRANCHES\r
newPC&=~1; // don't crash on games with bad vector tables\r
+#endif\r
\r
// SET_PC(newPC)\r
\r
// main exec function\r
//////////////////////\r
\r
-int fm68k_emulate(s32 cycles)\r
+int fm68k_emulate(s32 cycles, int dualcore, int idle_mode)\r
{\r
#ifndef FAMEC_NO_GOTOS\r
u32 Opcode;\r
\r
if (!initialised)\r
{\r
-#ifdef FAMEC_NO_GOTOS\r
- init_jump_table();\r
- return 0;\r
-#else\r
goto init_jump_table;\r
-#endif\r
}\r
\r
+#ifdef PICODRIVE_HACK\r
+ if (dualcore) goto dualcore_mode;\r
+ if (idle_mode == 1) goto idle_install;\r
+ else if (idle_mode == 2) goto idle_remove;\r
+famec_restart:\r
+#endif\r
+\r
// won't emulate double fault\r
// if (m68kcontext.execinfo & M68K_FAULTED) return -1;\r
\r
+ // Cache PPL\r
+ flag_I = M68K_PPL;\r
+\r
if (m68kcontext.execinfo & FM68K_HALTED)\r
{\r
if (interrupt_chk__() <= 0)\r
// Cache SR\r
SET_SR(m68kcontext.sr)\r
\r
- // Cache PPL\r
- flag_I = M68K_PPL;\r
-\r
// Fijar PC\r
SET_PC(m68kcontext.pc)\r
\r
#endif\r
if (cycles_needed != 0)\r
{\r
+ u32 line;\r
m68kcontext.io_cycle_counter = cycles_needed;\r
cycles_needed = 0;\r
- s32 line=interrupt_chk__();\r
+ line=interrupt_chk__();\r
if (line>0)\r
{\r
if (m68kcontext.iack_handler != NULL)\r
printf("pc: 0x%08x\n",m68kcontext.pc);\r
#endif\r
\r
- return cycles - m68kcontext.io_cycle_counter;\r
+#ifdef PICODRIVE_HACK\r
+ if (!dualcore)\r
+#endif\r
+ return cycles - m68kcontext.io_cycle_counter;\r
\r
-#ifdef FAMEC_NO_GOTOS\r
-}\r
+#ifdef PICODRIVE_HACK\r
+dualcore_mode:\r
+\r
+ while (1)\r
+ {\r
+ extern int SekCycleAim, SekCycleCnt, SekCycleAimS68k, SekCycleCntS68k;\r
+ #define PS_STEP_M68K ((488<<16)/20) // ~24\r
+ if (dualcore == 1)\r
+ {\r
+ dualcore = (488<<16); // ~ cycn in Pico.c\r
+ // adjust for first iteration\r
+ g_m68kcontext = &PicoCpuFS68k;\r
+ cycles = m68kcontext.io_cycle_counter = 0;\r
+ }\r
+ if (g_m68kcontext == &PicoCpuFS68k)\r
+ {\r
+ SekCycleCntS68k += cycles - m68kcontext.io_cycle_counter;\r
+ // end?\r
+ dualcore -= PS_STEP_M68K;\r
+ if (dualcore < 0) return 0;\r
+ // become main 68k\r
+ g_m68kcontext = &PicoCpuFM68k;\r
+ if ((cycles = SekCycleAim-SekCycleCnt-(dualcore>>16)) > 0)\r
+ {\r
+ if ((m68kcontext.execinfo & FM68K_HALTED) && m68kcontext.interrupts[0] <= (M68K_PPL))\r
+ SekCycleCnt += cycles; // halted\r
+ else goto famec_restart;\r
+ //else { printf("go main %i\n", cycles); goto famec_restart; }\r
+ }\r
+ cycles = m68kcontext.io_cycle_counter = 0;\r
+ }\r
+ if (g_m68kcontext == &PicoCpuFM68k)\r
+ {\r
+ int cycn_s68k = (dualcore + dualcore/2 + dualcore/8) >> 16;\r
+ SekCycleCnt += cycles - m68kcontext.io_cycle_counter;\r
+ // become sub 68k\r
+ g_m68kcontext = &PicoCpuFS68k;\r
+ if ((cycles = SekCycleAimS68k-SekCycleCntS68k-cycn_s68k) > 0)\r
+ {\r
+ if ((m68kcontext.execinfo & FM68K_HALTED) && m68kcontext.interrupts[0] <= (M68K_PPL))\r
+ SekCycleCntS68k += cycles; // halted\r
+ else goto famec_restart;\r
+ }\r
+ cycles = m68kcontext.io_cycle_counter = 0;\r
+ }\r
+ }\r
+#endif\r
\r
-static int init_jump_table(void)\r
-{{\r
-#else\r
init_jump_table:\r
{\r
-#endif\r
u32 i, j;\r
\r
- m68kcontext.sr = 0x2704; // Z flag\r
-\r
for(i = 0x0000; i <= 0xFFFF; i += 0x0001)\r
JumpTable[0x0000 + i] = CAST_OP(0x4AFC);\r
for(i = 0x0000; i <= 0x0007; i += 0x0001)\r
\r
initialised = 1;\r
return 0;\r
-}}\r
+}\r
+\r
+#ifdef PICODRIVE_HACK\r
+\r
+#define INSTALL_IDLE(fake_op_base,real_op,detector,idle_handler,normal_handler) \\r
+ JumpTable[fake_op_base] = CAST_OP(idle_handler); \\r
+ JumpTable[fake_op_base|0x0200] = CAST_OP(normal_handler); \\r
+ JumpTable[real_op] = CAST_OP(detector)\r
+\r
+#define UNDO_IDLE(fake_op_base,real_op,normal_handler) \\r
+ JumpTable[fake_op_base] = JumpTable[fake_op_base|0x0200] = CAST_OP(0x4AFC); \\r
+ JumpTable[real_op] = CAST_OP(normal_handler)\r
+\r
+idle_install:\r
+ printf("install..\n");\r
+ INSTALL_IDLE(0x71fa, 0x66fa, idle_detector_bcc8, 0x6601_idle, 0x6601);\r
+ INSTALL_IDLE(0x71f8, 0x66f8, idle_detector_bcc8, 0x6601_idle, 0x6601);\r
+ INSTALL_IDLE(0x71f6, 0x66f6, idle_detector_bcc8, 0x6601_idle, 0x6601);\r
+ INSTALL_IDLE(0x71f2, 0x66f2, idle_detector_bcc8, 0x6601_idle, 0x6601);\r
+ INSTALL_IDLE(0x75fa, 0x67fa, idle_detector_bcc8, 0x6701_idle, 0x6701);\r
+ INSTALL_IDLE(0x75f8, 0x67f8, idle_detector_bcc8, 0x6701_idle, 0x6701);\r
+ INSTALL_IDLE(0x75f6, 0x67f6, idle_detector_bcc8, 0x6701_idle, 0x6701);\r
+ INSTALL_IDLE(0x75f2, 0x67f2, idle_detector_bcc8, 0x6701_idle, 0x6701);\r
+ INSTALL_IDLE(0x7dfe, 0x60fe, idle_detector_dead, 0x6001_idle, 0x6001);\r
+ INSTALL_IDLE(0x7dfc, 0x60fc, idle_detector_dead, 0x6001_idle, 0x6001);\r
+ return 0;\r
+\r
+idle_remove:\r
+ printf("remove..\n");\r
+ UNDO_IDLE(0x71fa, 0x66fa, 0x6601);\r
+ UNDO_IDLE(0x71f8, 0x66f8, 0x6601);\r
+ UNDO_IDLE(0x71f6, 0x66f6, 0x6601);\r
+ UNDO_IDLE(0x71f2, 0x66f2, 0x6601);\r
+ UNDO_IDLE(0x75fa, 0x67fa, 0x6701);\r
+ UNDO_IDLE(0x75f8, 0x67f8, 0x6701);\r
+ UNDO_IDLE(0x75f6, 0x67f6, 0x6701);\r
+ UNDO_IDLE(0x75f2, 0x67f2, 0x6701);\r
+ UNDO_IDLE(0x7dfe, 0x60fe, 0x6001);\r
+ UNDO_IDLE(0x7dfc, 0x60fc, 0x6001);\r
+ return 0;\r
+\r
+#endif\r
+}\r
\r
+void *get_jumptab(void) { return JumpTable; }\r
\r
notaz.gp2x.de / picodrive.git / blobdiff