[picodrive.git] / pico / sek.c

/*\r
 * PicoDrive\r
 * (c) Copyright Dave, 2004\r
 * (C) notaz, 2006-2009\r
 *\r
 * This work is licensed under the terms of MAME license.\r
 * See COPYING file in the top-level directory.\r
 */\r
\r
#include "pico_int.h"\r
#include "memory.h"\r
\r
\r
int SekCycleCnt=0; // cycles done in this frame\r
int SekCycleAim=0; // cycle aim\r
unsigned int SekCycleCntT=0;\r
\r
\r
/* context */\r
// Cyclone 68000\r
#ifdef EMU_C68K\r
struct Cyclone PicoCpuCM68k;\r
#endif\r
// MUSASHI 68000\r
#ifdef EMU_M68K\r
m68ki_cpu_core PicoCpuMM68k;\r
#endif\r
// FAME 68000\r
#ifdef EMU_F68K\r
M68K_CONTEXT PicoCpuFM68k;\r
#endif\r
\r
\r
/* callbacks */\r
#ifdef EMU_C68K\r
// interrupt acknowledgment\r
static int SekIntAck(int level)\r
{\r
  // try to emulate VDP's reaction to 68000 int ack\r
  if     (level == 4) { Pico.video.pending_ints  =  0;    elprintf(EL_INTS, "hack: @ %06x [%i]", SekPc, SekCycleCnt); }\r
  else if(level == 6) { Pico.video.pending_ints &= ~0x20; elprintf(EL_INTS, "vack: @ %06x [%i]", SekPc, SekCycleCnt); }\r
  PicoCpuCM68k.irq = 0;\r
  return CYCLONE_INT_ACK_AUTOVECTOR;\r
}\r
\r
static void SekResetAck(void)\r
{\r
  elprintf(EL_ANOMALY, "Reset encountered @ %06x", SekPc);\r
}\r
\r
static int SekUnrecognizedOpcode()\r
{\r
  unsigned int pc;\r
  pc = SekPc;\r
  elprintf(EL_ANOMALY, "Unrecognized Opcode @ %06x", pc);\r
  // see if we are still in a mapped region\r
  pc &= 0x00ffffff;\r
  if (map_flag_set(m68k_read16_map[pc >> M68K_MEM_SHIFT])) {\r
    elprintf(EL_STATUS|EL_ANOMALY, "m68k crash @%06x", pc);\r
    PicoCpuCM68k.cycles = 0;\r
    PicoCpuCM68k.state_flags |= 1;\r
    return 1;\r
  }\r
#ifdef EMU_M68K // debugging cyclone\r
  {\r
    extern int have_illegal;\r
    have_illegal = 1;\r
  }\r
#endif\r
  return 0;\r
}\r
#endif\r
\r
\r
#ifdef EMU_M68K\r
static int SekIntAckM68K(int level)\r
{\r
  if     (level == 4) { Pico.video.pending_ints  =  0;    elprintf(EL_INTS, "hack: @ %06x [%i]", SekPc, SekCycleCnt); }\r
  else if(level == 6) { Pico.video.pending_ints &= ~0x20; elprintf(EL_INTS, "vack: @ %06x [%i]", SekPc, SekCycleCnt); }\r
  CPU_INT_LEVEL = 0;\r
  return M68K_INT_ACK_AUTOVECTOR;\r
}\r
\r
static int SekTasCallback(void)\r
{\r
  return 0; // no writeback\r
}\r
#endif\r
\r
\r
#ifdef EMU_F68K\r
static void SekIntAckF68K(unsigned level)\r
{\r
  if     (level == 4) { Pico.video.pending_ints  =  0;    elprintf(EL_INTS, "hack: @ %06x [%i]", SekPc, SekCycleCnt); }\r
  else if(level == 6) { Pico.video.pending_ints &= ~0x20; elprintf(EL_INTS, "vack: @ %06x [%i]", SekPc, SekCycleCnt); }\r
  PicoCpuFM68k.interrupts[0] = 0;\r
}\r
#endif\r
\r
\r
PICO_INTERNAL void SekInit(void)\r
{\r
#ifdef EMU_C68K\r
  CycloneInit();\r
  memset(&PicoCpuCM68k,0,sizeof(PicoCpuCM68k));\r
  PicoCpuCM68k.IrqCallback=SekIntAck;\r
  PicoCpuCM68k.ResetCallback=SekResetAck;\r
  PicoCpuCM68k.UnrecognizedCallback=SekUnrecognizedOpcode;\r
  PicoCpuCM68k.flags=4;   // Z set\r
#endif\r
#ifdef EMU_M68K\r
  {\r
    void *oldcontext = m68ki_cpu_p;\r
    m68k_set_context(&PicoCpuMM68k);\r
    m68k_set_cpu_type(M68K_CPU_TYPE_68000);\r
    m68k_init();\r
    m68k_set_int_ack_callback(SekIntAckM68K);\r
    m68k_set_tas_instr_callback(SekTasCallback);\r
    //m68k_pulse_reset();\r
    m68k_set_context(oldcontext);\r
  }\r
#endif\r
#ifdef EMU_F68K\r
  {\r
    void *oldcontext = g_m68kcontext;\r
    g_m68kcontext = &PicoCpuFM68k;\r
    memset(&PicoCpuFM68k, 0, sizeof(PicoCpuFM68k));\r
    fm68k_init();\r
    PicoCpuFM68k.iack_handler = SekIntAckF68K;\r
    PicoCpuFM68k.sr = 0x2704; // Z flag\r
    g_m68kcontext = oldcontext;\r
  }\r
#endif\r
}\r
\r
\r
// Reset the 68000:\r
PICO_INTERNAL int SekReset(void)\r
{\r
  if (Pico.rom==NULL) return 1;\r
\r
#ifdef EMU_C68K\r
  CycloneReset(&PicoCpuCM68k);\r
#endif\r
#ifdef EMU_M68K\r
  m68k_set_context(&PicoCpuMM68k); // if we ever reset m68k, we always need it's context to be set\r
  m68ki_cpu.sp[0]=0;\r
  m68k_set_irq(0);\r
  m68k_pulse_reset();\r
  REG_USP = 0; // ?\r
#endif\r
#ifdef EMU_F68K\r
  {\r
    g_m68kcontext = &PicoCpuFM68k;\r
    fm68k_reset();\r
  }\r
#endif\r
\r
  return 0;\r
}\r
\r
void SekStepM68k(void)\r
{\r
  SekCycleAim=SekCycleCnt+1;\r
#if defined(EMU_CORE_DEBUG)\r
  SekCycleCnt+=CM_compareRun(1, 0);\r
#elif defined(EMU_C68K)\r
  PicoCpuCM68k.cycles=1;\r
  CycloneRun(&PicoCpuCM68k);\r
  SekCycleCnt+=1-PicoCpuCM68k.cycles;\r
#elif defined(EMU_M68K)\r
  SekCycleCnt+=m68k_execute(1);\r
#elif defined(EMU_F68K)\r
  SekCycleCnt+=fm68k_emulate(1, 0, 0);\r
#endif\r
}\r
\r
PICO_INTERNAL void SekSetRealTAS(int use_real)\r
{\r
#ifdef EMU_C68K\r
  CycloneSetRealTAS(use_real);\r
#endif\r
#ifdef EMU_F68K\r
  // TODO\r
#endif\r
}\r
\r
// Pack the cpu into a common format:\r
// XXX: rename\r
PICO_INTERNAL void SekPackCpu(unsigned char *cpu, int is_sub)\r
{\r
  unsigned int pc=0;\r
\r
#if defined(EMU_C68K)\r
  struct Cyclone *context = is_sub ? &PicoCpuCS68k : &PicoCpuCM68k;\r
  memcpy(cpu,context->d,0x40);\r
  pc=context->pc-context->membase;\r
  *(unsigned int *)(cpu+0x44)=CycloneGetSr(context);\r
  *(unsigned int *)(cpu+0x48)=context->osp;\r
  cpu[0x4c] = context->irq;\r
  cpu[0x4d] = context->state_flags & 1;\r
#elif defined(EMU_M68K)\r
  void *oldcontext = m68ki_cpu_p;\r
  m68k_set_context(is_sub ? &PicoCpuMS68k : &PicoCpuMM68k);\r
  memcpy(cpu,m68ki_cpu_p->dar,0x40);\r
  pc=m68ki_cpu_p->pc;\r
  *(unsigned int  *)(cpu+0x44)=m68k_get_reg(NULL, M68K_REG_SR);\r
  *(unsigned int  *)(cpu+0x48)=m68ki_cpu_p->sp[m68ki_cpu_p->s_flag^SFLAG_SET];\r
  cpu[0x4c] = CPU_INT_LEVEL>>8;\r
  cpu[0x4d] = CPU_STOPPED;\r
  m68k_set_context(oldcontext);\r
#elif defined(EMU_F68K)\r
  M68K_CONTEXT *context = is_sub ? &PicoCpuFS68k : &PicoCpuFM68k;\r
  memcpy(cpu,context->dreg,0x40);\r
  pc=context->pc;\r
  *(unsigned int  *)(cpu+0x44)=context->sr;\r
  *(unsigned int  *)(cpu+0x48)=context->asp;\r
  cpu[0x4c] = context->interrupts[0];\r
  cpu[0x4d] = (context->execinfo & FM68K_HALTED) ? 1 : 0;\r
#endif\r
\r
  *(unsigned int *)(cpu+0x40)=pc;\r
}\r
\r
PICO_INTERNAL void SekUnpackCpu(const unsigned char *cpu, int is_sub)\r
{\r
#if defined(EMU_C68K)\r
  struct Cyclone *context = is_sub ? &PicoCpuCS68k : &PicoCpuCM68k;\r
  CycloneSetSr(context, *(unsigned int *)(cpu+0x44));\r
  context->osp=*(unsigned int *)(cpu+0x48);\r
  memcpy(context->d,cpu,0x40);\r
  context->membase = 0;\r
  context->pc = *(unsigned int *)(cpu+0x40);\r
  CycloneUnpack(context, NULL); // rebase PC\r
  context->irq = cpu[0x4c];\r
  context->state_flags = 0;\r
  if (cpu[0x4d])\r
    context->state_flags |= 1;\r
#elif defined(EMU_M68K)\r
  void *oldcontext = m68ki_cpu_p;\r
  m68k_set_context(is_sub ? &PicoCpuMS68k : &PicoCpuMM68k);\r
  m68k_set_reg(M68K_REG_SR, *(unsigned int *)(cpu+0x44));\r
  memcpy(m68ki_cpu_p->dar,cpu,0x40);\r
  m68ki_cpu_p->pc=*(unsigned int *)(cpu+0x40);\r
  m68ki_cpu_p->sp[m68ki_cpu_p->s_flag^SFLAG_SET]=*(unsigned int *)(cpu+0x48);\r
  CPU_INT_LEVEL = cpu[0x4c] << 8;\r
  CPU_STOPPED = cpu[0x4d];\r
  m68k_set_context(oldcontext);\r
#elif defined(EMU_F68K)\r
  M68K_CONTEXT *context = is_sub ? &PicoCpuFS68k : &PicoCpuFM68k;\r
  memcpy(context->dreg,cpu,0x40);\r
  context->pc =*(unsigned int *)(cpu+0x40);\r
  context->sr =*(unsigned int *)(cpu+0x44);\r
  context->asp=*(unsigned int *)(cpu+0x48);\r
  context->interrupts[0] = cpu[0x4c];\r
  context->execinfo &= ~FM68K_HALTED;\r
  if (cpu[0x4d]&1) context->execinfo |= FM68K_HALTED;\r
#endif\r
}\r
\r
\r
/* idle loop detection, not to be used in CD mode */\r
#ifdef EMU_C68K\r
#include "cpu/cyclone/tools/idle.h"\r
#endif\r
\r
static unsigned short **idledet_ptrs = NULL;\r
static int idledet_count = 0, idledet_bads = 0;\r
int idledet_start_frame = 0;\r
\r
#if 0\r
#define IDLE_STATS 1\r
unsigned int idlehit_addrs[128], idlehit_counts[128];\r
\r
void SekRegisterIdleHit(unsigned int pc)\r
{\r
  int i;\r
  for (i = 0; i < 127 && idlehit_addrs[i]; i++) {\r
    if (idlehit_addrs[i] == pc) {\r
      idlehit_counts[i]++;\r
      return;\r
    }\r
  }\r
  idlehit_addrs[i] = pc;\r
  idlehit_counts[i] = 1;\r
  idlehit_addrs[i+1] = 0;\r
}\r
#endif\r
\r
void SekInitIdleDet(void)\r
{\r
  unsigned short **tmp = realloc(idledet_ptrs, 0x200*4);\r
  if (tmp == NULL) {\r
    free(idledet_ptrs);\r
    idledet_ptrs = NULL;\r
  }\r
  else\r
    idledet_ptrs = tmp;\r
  idledet_count = idledet_bads = 0;\r
  idledet_start_frame = Pico.m.frame_count + 360;\r
#ifdef IDLE_STATS\r
  idlehit_addrs[0] = 0;\r
#endif\r
\r
#ifdef EMU_C68K\r
  CycloneInitIdle();\r
#endif\r
#ifdef EMU_F68K\r
  fm68k_emulate(0, 0, 1);\r
#endif\r
}\r
\r
int SekIsIdleCode(unsigned short *dst, int bytes)\r
{\r
  // printf("SekIsIdleCode %04x %i\n", *dst, bytes);\r
  switch (bytes)\r
  {\r
    case 2:\r
      if ((*dst & 0xf000) != 0x6000)     // not another branch\r
        return 1;\r
      break;\r
    case 4:\r
      if (  (*dst & 0xfff8) == 0x4a10 || // tst.b ($aX)      // there should be no need to wait\r
            (*dst & 0xfff8) == 0x4a28 || // tst.b ($xxxx,a0) // for byte change anywhere\r
            (*dst & 0xff3f) == 0x4a38 || // tst.x ($xxxx.w); tas ($xxxx.w)\r
            (*dst & 0xc1ff) == 0x0038 || // move.x ($xxxx.w), dX\r
            (*dst & 0xf13f) == 0xb038)   // cmp.x ($xxxx.w), dX\r
        return 1;\r
      break;\r
    case 6:\r
      if ( ((dst[1] & 0xe0) == 0xe0 && ( // RAM and\r
            *dst == 0x4a39 ||            //   tst.b ($xxxxxxxx)\r
            *dst == 0x4a79 ||            //   tst.w ($xxxxxxxx)\r
            *dst == 0x4ab9 ||            //   tst.l ($xxxxxxxx)\r
            (*dst & 0xc1ff) == 0x0039 || //   move.x ($xxxxxxxx), dX\r
            (*dst & 0xf13f) == 0xb039))||//   cmp.x ($xxxxxxxx), dX\r
            *dst == 0x0838 ||            // btst $X, ($xxxx.w) [6 byte op]\r
            (*dst & 0xffbf) == 0x0c38)   // cmpi.{b,w} $X, ($xxxx.w)\r
        return 1;\r
      break;\r
    case 8:\r
      if ( ((dst[2] & 0xe0) == 0xe0 && ( // RAM and\r
            *dst == 0x0839 ||            //   btst $X, ($xxxxxxxx.w) [8 byte op]\r
            (*dst & 0xffbf) == 0x0c39))||//   cmpi.{b,w} $X, ($xxxxxxxx)\r
            *dst == 0x0cb8)              // cmpi.l $X, ($xxxx.w)\r
        return 1;\r
      break;\r
    case 12:\r
       if ((*dst & 0xf1f8) == 0x3010 && // move.w (aX), dX\r
            (dst[1]&0xf100) == 0x0000 && // arithmetic\r
            (dst[3]&0xf100) == 0x0000)   // arithmetic\r
        return 1;\r
      break;\r
  }\r
\r
  return 0;\r
}\r
\r
int SekRegisterIdlePatch(unsigned int pc, int oldop, int newop, void *ctx)\r
{\r
  int is_main68k = 1;\r
  u16 *target;\r
  uptr v;\r
\r
#if   defined(EMU_C68K)\r
  struct Cyclone *cyc = ctx;\r
  is_main68k = cyc == &PicoCpuCM68k;\r
  pc -= cyc->membase;\r
#elif defined(EMU_F68K)\r
  is_main68k = ctx == &PicoCpuFM68k;\r
#endif\r
  pc &= ~0xff000000;\r
  elprintf(EL_IDLE, "idle: patch %06x %04x %04x %c %c #%i", pc, oldop, newop,\r
    (newop&0x200)?'n':'y', is_main68k?'m':'s', idledet_count);\r
\r
  // XXX: probably shouldn't patch RAM too\r
  v = m68k_read16_map[pc >> M68K_MEM_SHIFT];\r
  if (!(v & 0x80000000))\r
    target = (u16 *)((v << 1) + pc);\r
  else {\r
    if (++idledet_bads > 128)\r
      return 2; // remove detector\r
    return 1; // don't patch\r
  }\r
\r
  if (idledet_count >= 0x200 && (idledet_count & 0x1ff) == 0) {\r
    unsigned short **tmp = realloc(idledet_ptrs, (idledet_count+0x200)*4);\r
    if (tmp == NULL)\r
      return 1;\r
    idledet_ptrs = tmp;\r
  }\r
\r
  idledet_ptrs[idledet_count++] = target;\r
\r
  return 0;\r
}\r
\r
void SekFinishIdleDet(void)\r
{\r
#ifdef EMU_C68K\r
  CycloneFinishIdle();\r
#endif\r
#ifdef EMU_F68K\r
  fm68k_emulate(0, 0, 2);\r
#endif\r
  while (idledet_count > 0)\r
  {\r
    unsigned short *op = idledet_ptrs[--idledet_count];\r
    if      ((*op & 0xfd00) == 0x7100)\r
      *op &= 0xff, *op |= 0x6600;\r
    else if ((*op & 0xfd00) == 0x7500)\r
      *op &= 0xff, *op |= 0x6700;\r
    else if ((*op & 0xfd00) == 0x7d00)\r
      *op &= 0xff, *op |= 0x6000;\r
    else\r
      elprintf(EL_STATUS|EL_IDLE, "idle: don't know how to restore %04x", *op);\r
  }\r
}\r
\r
\r
#if defined(EMU_M68K) && M68K_INSTRUCTION_HOOK == OPT_SPECIFY_HANDLER\r
static unsigned char op_flags[0x400000/2] = { 0, };\r
static int atexit_set = 0;\r
\r
static void make_idc(void)\r
{\r
  FILE *f = fopen("idc.idc", "w");\r
  int i;\r
  if (!f) return;\r
  fprintf(f, "#include <idc.idc>\nstatic main() {\n");\r
  for (i = 0; i < 0x400000/2; i++)\r
    if (op_flags[i] != 0)\r
      fprintf(f, "  MakeCode(0x%06x);\n", i*2);\r
  fprintf(f, "}\n");\r
  fclose(f);\r
}\r
\r
void instruction_hook(void)\r
{\r
  if (!atexit_set) {\r
    atexit(make_idc);\r
    atexit_set = 1;\r
  }\r
  if (REG_PC < 0x400000)\r
    op_flags[REG_PC/2] = 1;\r
}\r
#endif\r
Commit	Line	Data
cff531af	1	/*\r
	2	* PicoDrive\r
	3	* (c) Copyright Dave, 2004\r
	4	* (C) notaz, 2006-2009\r
	5	*\r
	6	* This work is licensed under the terms of MAME license.\r
	7	* See COPYING file in the top-level directory.\r
	8	*/\r
cc68a136	9	\r
efcba75f	10	#include "pico_int.h"\r
488c0bbf	11	#include "memory.h"\r
cc68a136	12	\r
	13	\r
	14	int SekCycleCnt=0; // cycles done in this frame\r
	15	int SekCycleAim=0; // cycle aim\r
	16	unsigned int SekCycleCntT=0;\r
	17	\r
70357ce5	18	\r
	19	/* context */\r
	20	// Cyclone 68000\r
cc68a136	21	#ifdef EMU_C68K\r
3aa1e148	22	struct Cyclone PicoCpuCM68k;\r
cc68a136	23	#endif\r
70357ce5	24	// MUSASHI 68000\r
cc68a136	25	#ifdef EMU_M68K\r
3aa1e148	26	m68ki_cpu_core PicoCpuMM68k;\r
cc68a136	27	#endif\r
70357ce5	28	// FAME 68000\r
70357ce5	29	#ifdef EMU_F68K\r
3aa1e148	30	M68K_CONTEXT PicoCpuFM68k;\r
cc68a136	31	#endif\r
	32	\r
	33	\r
70357ce5	34	/* callbacks */\r
cc68a136	35	#ifdef EMU_C68K\r
b837b69b	36	// interrupt acknowledgment\r
0af33fe0	37	static int SekIntAck(int level)\r
cc68a136	38	{\r
cc68a136	39	// try to emulate VDP's reaction to 68000 int ack\r
69996cb7	40	if (level == 4) { Pico.video.pending_ints = 0; elprintf(EL_INTS, "hack: @ %06x [%i]", SekPc, SekCycleCnt); }\r
69996cb7	41	else if(level == 6) { Pico.video.pending_ints &= ~0x20; elprintf(EL_INTS, "vack: @ %06x [%i]", SekPc, SekCycleCnt); }\r
3aa1e148	42	PicoCpuCM68k.irq = 0;\r
0af33fe0	43	return CYCLONE_INT_ACK_AUTOVECTOR;\r
cc68a136	44	}\r
cc68a136	45	\r
69996cb7	46	static void SekResetAck(void)\r
cc68a136	47	{\r
69996cb7	48	elprintf(EL_ANOMALY, "Reset encountered @ %06x", SekPc);\r
cc68a136	49	}\r
	50	\r
	51	static int SekUnrecognizedOpcode()\r
	52	{\r
b4db550e	53	unsigned int pc;\r
cc68a136	54	pc = SekPc;\r
b4db550e	55	elprintf(EL_ANOMALY, "Unrecognized Opcode @ %06x", pc);\r
	56	// see if we are still in a mapped region\r
	57	pc &= 0x00ffffff;\r
	58	if (map_flag_set(m68k_read16_map[pc >> M68K_MEM_SHIFT])) {\r
	59	elprintf(EL_STATUS\|EL_ANOMALY, "m68k crash @%06x", pc);\r
3aa1e148	60	PicoCpuCM68k.cycles = 0;\r
3aa1e148	61	PicoCpuCM68k.state_flags \|= 1;\r
cc68a136	62	return 1;\r
cc68a136	63	}\r
2d0b15bb	64	#ifdef EMU_M68K // debugging cyclone\r
	65	{\r
	66	extern int have_illegal;\r
	67	have_illegal = 1;\r
	68	}\r
	69	#endif\r
cc68a136	70	return 0;\r
	71	}\r
	72	#endif\r
	73	\r
	74	\r
	75	#ifdef EMU_M68K\r
	76	static int SekIntAckM68K(int level)\r
	77	{\r
69996cb7	78	if (level == 4) { Pico.video.pending_ints = 0; elprintf(EL_INTS, "hack: @ %06x [%i]", SekPc, SekCycleCnt); }\r
69996cb7	79	else if(level == 6) { Pico.video.pending_ints &= ~0x20; elprintf(EL_INTS, "vack: @ %06x [%i]", SekPc, SekCycleCnt); }\r
cc68a136	80	CPU_INT_LEVEL = 0;\r
	81	return M68K_INT_ACK_AUTOVECTOR;\r
	82	}\r
0af33fe0	83	\r
	84	static int SekTasCallback(void)\r
	85	{\r
	86	return 0; // no writeback\r
	87	}\r
cc68a136	88	#endif\r
	89	\r
	90	\r
70357ce5	91	#ifdef EMU_F68K\r
3aa1e148	92	static void SekIntAckF68K(unsigned level)\r
70357ce5	93	{\r
	94	if (level == 4) { Pico.video.pending_ints = 0; elprintf(EL_INTS, "hack: @ %06x [%i]", SekPc, SekCycleCnt); }\r
	95	else if(level == 6) { Pico.video.pending_ints &= ~0x20; elprintf(EL_INTS, "vack: @ %06x [%i]", SekPc, SekCycleCnt); }\r
3aa1e148	96	PicoCpuFM68k.interrupts[0] = 0;\r
70357ce5	97	}\r
	98	#endif\r
	99	\r
cc68a136	100	\r
2aa27095	101	PICO_INTERNAL void SekInit(void)\r
cc68a136	102	{\r
	103	#ifdef EMU_C68K\r
	104	CycloneInit();\r
3aa1e148	105	memset(&PicoCpuCM68k,0,sizeof(PicoCpuCM68k));\r
	106	PicoCpuCM68k.IrqCallback=SekIntAck;\r
	107	PicoCpuCM68k.ResetCallback=SekResetAck;\r
	108	PicoCpuCM68k.UnrecognizedCallback=SekUnrecognizedOpcode;\r
03e4f2a3	109	PicoCpuCM68k.flags=4; // Z set\r
cc68a136	110	#endif\r
cc68a136	111	#ifdef EMU_M68K\r
	112	{\r
	113	void *oldcontext = m68ki_cpu_p;\r
3aa1e148	114	m68k_set_context(&PicoCpuMM68k);\r
cc68a136	115	m68k_set_cpu_type(M68K_CPU_TYPE_68000);\r
	116	m68k_init();\r
	117	m68k_set_int_ack_callback(SekIntAckM68K);\r
0af33fe0	118	m68k_set_tas_instr_callback(SekTasCallback);\r
9037e45d	119	//m68k_pulse_reset();\r
cc68a136	120	m68k_set_context(oldcontext);\r
	121	}\r
	122	#endif\r
70357ce5	123	#ifdef EMU_F68K\r
	124	{\r
	125	void *oldcontext = g_m68kcontext;\r
3aa1e148	126	g_m68kcontext = &PicoCpuFM68k;\r
3aa1e148	127	memset(&PicoCpuFM68k, 0, sizeof(PicoCpuFM68k));\r
03e4f2a3	128	fm68k_init();\r
3aa1e148	129	PicoCpuFM68k.iack_handler = SekIntAckF68K;\r
b5e5172d	130	PicoCpuFM68k.sr = 0x2704; // Z flag\r
70357ce5	131	g_m68kcontext = oldcontext;\r
	132	}\r
	133	#endif\r
cc68a136	134	}\r
cc68a136	135	\r
70357ce5	136	\r
cc68a136	137	// Reset the 68000:\r
2aa27095	138	PICO_INTERNAL int SekReset(void)\r
cc68a136	139	{\r
	140	if (Pico.rom==NULL) return 1;\r
	141	\r
	142	#ifdef EMU_C68K\r
5e89f0f5	143	CycloneReset(&PicoCpuCM68k);\r
cc68a136	144	#endif\r
cc68a136	145	#ifdef EMU_M68K\r
3aa1e148	146	m68k_set_context(&PicoCpuMM68k); // if we ever reset m68k, we always need it's context to be set\r
2d0b15bb	147	m68ki_cpu.sp[0]=0;\r
2d0b15bb	148	m68k_set_irq(0);\r
b837b69b	149	m68k_pulse_reset();\r
99464b62	150	REG_USP = 0; // ?\r
cc68a136	151	#endif\r
70357ce5	152	#ifdef EMU_F68K\r
70357ce5	153	{\r
3aa1e148	154	g_m68kcontext = &PicoCpuFM68k;\r
03e4f2a3	155	fm68k_reset();\r
70357ce5	156	}\r
70357ce5	157	#endif\r
cc68a136	158	\r
	159	return 0;\r
	160	}\r
	161	\r
5f9a0d16	162	void SekStepM68k(void)\r
	163	{\r
	164	SekCycleAim=SekCycleCnt+1;\r
	165	#if defined(EMU_CORE_DEBUG)\r
	166	SekCycleCnt+=CM_compareRun(1, 0);\r
	167	#elif defined(EMU_C68K)\r
	168	PicoCpuCM68k.cycles=1;\r
	169	CycloneRun(&PicoCpuCM68k);\r
	170	SekCycleCnt+=1-PicoCpuCM68k.cycles;\r
	171	#elif defined(EMU_M68K)\r
	172	SekCycleCnt+=m68k_execute(1);\r
	173	#elif defined(EMU_F68K)\r
f579f7b8	174	SekCycleCnt+=fm68k_emulate(1, 0, 0);\r
5f9a0d16	175	#endif\r
5f9a0d16	176	}\r
cc68a136	177	\r
eff55556	178	PICO_INTERNAL void SekSetRealTAS(int use_real)\r
2433f409	179	{\r
	180	#ifdef EMU_C68K\r
	181	CycloneSetRealTAS(use_real);\r
	182	#endif\r
70357ce5	183	#ifdef EMU_F68K\r
	184	// TODO\r
	185	#endif\r
2433f409	186	}\r
2433f409	187	\r
b4db550e	188	// Pack the cpu into a common format:\r
	189	// XXX: rename\r
	190	PICO_INTERNAL void SekPackCpu(unsigned char *cpu, int is_sub)\r
	191	{\r
	192	unsigned int pc=0;\r
	193	\r
	194	#if defined(EMU_C68K)\r
	195	struct Cyclone *context = is_sub ? &PicoCpuCS68k : &PicoCpuCM68k;\r
	196	memcpy(cpu,context->d,0x40);\r
	197	pc=context->pc-context->membase;\r
	198	(unsigned int )(cpu+0x44)=CycloneGetSr(context);\r
	199	(unsigned int )(cpu+0x48)=context->osp;\r
	200	cpu[0x4c] = context->irq;\r
	201	cpu[0x4d] = context->state_flags & 1;\r
	202	#elif defined(EMU_M68K)\r
	203	void *oldcontext = m68ki_cpu_p;\r
	204	m68k_set_context(is_sub ? &PicoCpuMS68k : &PicoCpuMM68k);\r
	205	memcpy(cpu,m68ki_cpu_p->dar,0x40);\r
	206	pc=m68ki_cpu_p->pc;\r
	207	(unsigned int )(cpu+0x44)=m68k_get_reg(NULL, M68K_REG_SR);\r
	208	(unsigned int )(cpu+0x48)=m68ki_cpu_p->sp[m68ki_cpu_p->s_flag^SFLAG_SET];\r
	209	cpu[0x4c] = CPU_INT_LEVEL>>8;\r
	210	cpu[0x4d] = CPU_STOPPED;\r
	211	m68k_set_context(oldcontext);\r
	212	#elif defined(EMU_F68K)\r
	213	M68K_CONTEXT *context = is_sub ? &PicoCpuFS68k : &PicoCpuFM68k;\r
	214	memcpy(cpu,context->dreg,0x40);\r
	215	pc=context->pc;\r
	216	(unsigned int )(cpu+0x44)=context->sr;\r
	217	(unsigned int )(cpu+0x48)=context->asp;\r
	218	cpu[0x4c] = context->interrupts[0];\r
	219	cpu[0x4d] = (context->execinfo & FM68K_HALTED) ? 1 : 0;\r
	220	#endif\r
	221	\r
	222	(unsigned int )(cpu+0x40)=pc;\r
	223	}\r
	224	\r
	225	PICO_INTERNAL void SekUnpackCpu(const unsigned char *cpu, int is_sub)\r
	226	{\r
	227	#if defined(EMU_C68K)\r
	228	struct Cyclone *context = is_sub ? &PicoCpuCS68k : &PicoCpuCM68k;\r
	229	CycloneSetSr(context, (unsigned int )(cpu+0x44));\r
	230	context->osp=(unsigned int )(cpu+0x48);\r
	231	memcpy(context->d,cpu,0x40);\r
	232	context->membase = 0;\r
	233	context->pc = (unsigned int )(cpu+0x40);\r
	234	CycloneUnpack(context, NULL); // rebase PC\r
	235	context->irq = cpu[0x4c];\r
	236	context->state_flags = 0;\r
	237	if (cpu[0x4d])\r
	238	context->state_flags \|= 1;\r
	239	#elif defined(EMU_M68K)\r
	240	void *oldcontext = m68ki_cpu_p;\r
	241	m68k_set_context(is_sub ? &PicoCpuMS68k : &PicoCpuMM68k);\r
	242	m68k_set_reg(M68K_REG_SR, (unsigned int )(cpu+0x44));\r
	243	memcpy(m68ki_cpu_p->dar,cpu,0x40);\r
	244	m68ki_cpu_p->pc=(unsigned int )(cpu+0x40);\r
	245	m68ki_cpu_p->sp[m68ki_cpu_p->s_flag^SFLAG_SET]=(unsigned int )(cpu+0x48);\r
	246	CPU_INT_LEVEL = cpu[0x4c] << 8;\r
	247	CPU_STOPPED = cpu[0x4d];\r
	248	m68k_set_context(oldcontext);\r
	249	#elif defined(EMU_F68K)\r
	250	M68K_CONTEXT *context = is_sub ? &PicoCpuFS68k : &PicoCpuFM68k;\r
	251	memcpy(context->dreg,cpu,0x40);\r
252	context->pc =(unsigned int )(cpu+0x40);\r
253	context->sr =(unsigned int )(cpu+0x44);\r
254	context->asp=(unsigned int )(cpu+0x48);\r
255	context->interrupts[0] = cpu[0x4c];\r
256	context->execinfo &= ~FM68K_HALTED;\r
257	if (cpu[0x4d]&1) context->execinfo \|= FM68K_HALTED;\r
258	#endif\r
259	}\r
260	\r
5f9a0d16	261	\r
053fd9b4	262	/* idle loop detection, not to be used in CD mode */\r
053fd9b4	263	#ifdef EMU_C68K\r
d4d62665	264	#include "cpu/cyclone/tools/idle.h"\r
053fd9b4	265	#endif\r
053fd9b4	266	\r
488c0bbf	267	static unsigned short **idledet_ptrs = NULL;\r
053fd9b4	268	static int idledet_count = 0, idledet_bads = 0;\r
053fd9b4	269	int idledet_start_frame = 0;\r
053fd9b4	270	\r
5ed2a20e	271	#if 0\r
	272	#define IDLE_STATS 1\r
	273	unsigned int idlehit_addrs[128], idlehit_counts[128];\r
	274	\r
	275	void SekRegisterIdleHit(unsigned int pc)\r
	276	{\r
	277	int i;\r
	278	for (i = 0; i < 127 && idlehit_addrs[i]; i++) {\r
	279	if (idlehit_addrs[i] == pc) {\r
	280	idlehit_counts[i]++;\r
	281	return;\r
	282	}\r
	283	}\r
	284	idlehit_addrs[i] = pc;\r
	285	idlehit_counts[i] = 1;\r
	286	idlehit_addrs[i+1] = 0;\r
	287	}\r
	288	#endif\r
	289	\r
053fd9b4	290	void SekInitIdleDet(void)\r
053fd9b4	291	{\r
488c0bbf	292	unsigned short *tmp = realloc(idledet_ptrs, 0x2004);\r
053fd9b4	293	if (tmp == NULL) {\r
488c0bbf	294	free(idledet_ptrs);\r
488c0bbf	295	idledet_ptrs = NULL;\r
053fd9b4	296	}\r
053fd9b4	297	else\r
488c0bbf	298	idledet_ptrs = tmp;\r
053fd9b4	299	idledet_count = idledet_bads = 0;\r
053fd9b4	300	idledet_start_frame = Pico.m.frame_count + 360;\r
5ed2a20e	301	#ifdef IDLE_STATS\r
	302	idlehit_addrs[0] = 0;\r
	303	#endif\r
053fd9b4	304	\r
053fd9b4	305	#ifdef EMU_C68K\r
	306	CycloneInitIdle();\r
	307	#endif\r
c060a9ab	308	#ifdef EMU_F68K\r
c060a9ab	309	fm68k_emulate(0, 0, 1);\r
c060a9ab	310	#endif\r
053fd9b4	311	}\r
	312	\r
	313	int SekIsIdleCode(unsigned short *dst, int bytes)\r
	314	{\r
8187ba84	315	// printf("SekIsIdleCode %04x %i\n", *dst, bytes);\r
053fd9b4	316	switch (bytes)\r
053fd9b4	317	{\r
5ed2a20e	318	case 2:\r
	319	if ((*dst & 0xf000) != 0x6000) // not another branch\r
	320	return 1;\r
	321	break;\r
053fd9b4	322	case 4:\r
b0677887	323	if ( (*dst & 0xfff8) == 0x4a10 \|\| // tst.b ($aX) // there should be no need to wait\r
	324	(*dst & 0xfff8) == 0x4a28 \|\| // tst.b ($xxxx,a0) // for byte change anywhere\r
	325	(*dst & 0xff3f) == 0x4a38 \|\| // tst.x ($xxxx.w); tas ($xxxx.w)\r
053fd9b4	326	(*dst & 0xc1ff) == 0x0038 \|\| // move.x ($xxxx.w), dX\r
	327	(*dst & 0xf13f) == 0xb038) // cmp.x ($xxxx.w), dX\r
	328	return 1;\r
	329	break;\r
	330	case 6:\r
b0677887	331	if ( ((dst[1] & 0xe0) == 0xe0 && ( // RAM and\r
	332	*dst == 0x4a39 \|\| // tst.b ($xxxxxxxx)\r
	333	*dst == 0x4a79 \|\| // tst.w ($xxxxxxxx)\r
	334	*dst == 0x4ab9 \|\| // tst.l ($xxxxxxxx)\r
	335	(*dst & 0xc1ff) == 0x0039 \|\| // move.x ($xxxxxxxx), dX\r
	336	(*dst & 0xf13f) == 0xb039))\|\|// cmp.x ($xxxxxxxx), dX\r
	337	*dst == 0x0838 \|\| // btst $X, ($xxxx.w) [6 byte op]\r
	338	(*dst & 0xffbf) == 0x0c38) // cmpi.{b,w} $X, ($xxxx.w)\r
053fd9b4	339	return 1;\r
	340	break;\r
	341	case 8:\r
b0677887	342	if ( ((dst[2] & 0xe0) == 0xe0 && ( // RAM and\r
	343	*dst == 0x0839 \|\| // btst $X, ($xxxxxxxx.w) [8 byte op]\r
	344	(*dst & 0xffbf) == 0x0c39))\|\|// cmpi.{b,w} $X, ($xxxxxxxx)\r
	345	*dst == 0x0cb8) // cmpi.l $X, ($xxxx.w)\r
053fd9b4	346	return 1;\r
	347	break;\r
	348	case 12:\r
	349	if ((*dst & 0xf1f8) == 0x3010 && // move.w (aX), dX\r
b0677887	350	(dst[1]&0xf100) == 0x0000 && // arithmetic\r
b0677887	351	(dst[3]&0xf100) == 0x0000) // arithmetic\r
053fd9b4	352	return 1;\r
	353	break;\r
	354	}\r
	355	\r
	356	return 0;\r
	357	}\r
	358	\r
5ed2a20e	359	int SekRegisterIdlePatch(unsigned int pc, int oldop, int newop, void *ctx)\r
053fd9b4	360	{\r
5ed2a20e	361	int is_main68k = 1;\r
488c0bbf	362	u16 *target;\r
	363	uptr v;\r
	364	\r
5ed2a20e	365	#if defined(EMU_C68K)\r
	366	struct Cyclone *cyc = ctx;\r
	367	is_main68k = cyc == &PicoCpuCM68k;\r
	368	pc -= cyc->membase;\r
	369	#elif defined(EMU_F68K)\r
	370	is_main68k = ctx == &PicoCpuFM68k;\r
053fd9b4	371	#endif\r
053fd9b4	372	pc &= ~0xff000000;\r
5ed2a20e	373	elprintf(EL_IDLE, "idle: patch %06x %04x %04x %c %c #%i", pc, oldop, newop,\r
	374	(newop&0x200)?'n':'y', is_main68k?'m':'s', idledet_count);\r
	375	\r
488c0bbf	376	// XXX: probably shouldn't patch RAM too\r
	377	v = m68k_read16_map[pc >> M68K_MEM_SHIFT];\r
	378	if (!(v & 0x80000000))\r
	379	target = (u16 *)((v << 1) + pc);\r
	380	else {\r
	381	if (++idledet_bads > 128)\r
	382	return 2; // remove detector\r
053fd9b4	383	return 1; // don't patch\r
	384	}\r
	385	\r
	386	if (idledet_count >= 0x200 && (idledet_count & 0x1ff) == 0) {\r
488c0bbf	387	unsigned short *tmp = realloc(idledet_ptrs, (idledet_count+0x200)4);\r
	388	if (tmp == NULL)\r
	389	return 1;\r
	390	idledet_ptrs = tmp;\r
053fd9b4	391	}\r
053fd9b4	392	\r
488c0bbf	393	idledet_ptrs[idledet_count++] = target;\r
b0677887	394	\r
053fd9b4	395	return 0;\r
	396	}\r
	397	\r
	398	void SekFinishIdleDet(void)\r
	399	{\r
053fd9b4	400	#ifdef EMU_C68K\r
053fd9b4	401	CycloneFinishIdle();\r
c060a9ab	402	#endif\r
	403	#ifdef EMU_F68K\r
	404	fm68k_emulate(0, 0, 2);\r
053fd9b4	405	#endif\r
	406	while (idledet_count > 0)\r
	407	{\r
488c0bbf	408	unsigned short *op = idledet_ptrs[--idledet_count];\r
053fd9b4	409	if ((*op & 0xfd00) == 0x7100)\r
	410	op &= 0xff, op \|= 0x6600;\r
	411	else if ((*op & 0xfd00) == 0x7500)\r
	412	op &= 0xff, op \|= 0x6700;\r
	413	else if ((*op & 0xfd00) == 0x7d00)\r
	414	op &= 0xff, op \|= 0x6000;\r
	415	else\r
	416	elprintf(EL_STATUS\|EL_IDLE, "idle: don't know how to restore %04x", *op);\r
	417	}\r
053fd9b4	418	}\r
	419	\r
	420	\r
6cab49fd	421	#if defined(EMU_M68K) && M68K_INSTRUCTION_HOOK == OPT_SPECIFY_HANDLER\r
	422	static unsigned char op_flags[0x400000/2] = { 0, };\r
	423	static int atexit_set = 0;\r
	424	\r
	425	static void make_idc(void)\r
	426	{\r
	427	FILE *f = fopen("idc.idc", "w");\r
	428	int i;\r
	429	if (!f) return;\r
	430	fprintf(f, "#include <idc.idc>\nstatic main() {\n");\r
	431	for (i = 0; i < 0x400000/2; i++)\r
	432	if (op_flags[i] != 0)\r
	433	fprintf(f, " MakeCode(0x%06x);\n", i*2);\r
	434	fprintf(f, "}\n");\r
	435	fclose(f);\r
	436	}\r
	437	\r
	438	void instruction_hook(void)\r
	439	{\r
	440	if (!atexit_set) {\r
	441	atexit(make_idc);\r
	442	atexit_set = 1;\r
	443	}\r
	444	if (REG_PC < 0x400000)\r
	445	op_flags[REG_PC/2] = 1;\r
	446	}\r
	447	#endif\r