[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
/* 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
static int do_ack(int level)\r
{\r
  struct PicoVideo *pv = &Pico.video;\r
\r
  elprintf(EL_INTS, "%cack: @ %06x [%u], p=%02x",\r
    level == 6 ? 'v' : 'h', SekPc, SekCyclesDone(), pv->pending_ints);\r
  // the VDP doesn't look at the 68k level\r
  if (pv->pending_ints & pv->reg[1] & 0x20) {\r
    pv->pending_ints &= ~0x20;\r
    pv->status &= ~SR_F;\r
    if (pv->reg[0] & pv->pending_ints & 0x10)\r
      return pv->hint_irq;\r
  }\r
  else if (pv->pending_ints & pv->reg[0] & 0x10)\r
    pv->pending_ints &= ~0x10;\r
\r
  return (PicoIn.AHW & PAHW_PICO ? PicoPicoIrqAck(level) : 0);\r
}\r
\r
/* callbacks */\r
#ifdef EMU_C68K\r
// interrupt acknowledgment\r
static int SekIntAck(int level)\r
{\r
  PicoCpuCM68k.irq = do_ack(level);\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
  // happened once - may happen again\r
  SekFinishIdleDet();\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
  CPU_INT_LEVEL = do_ack(level) << 8;\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
  PicoCpuFM68k.interrupts[0] = do_ack(level);\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
  memset(&PicoCpuFM68k, 0, sizeof(PicoCpuFM68k));\r
  fm68k_init();\r
  PicoCpuFM68k.iack_handler = SekIntAckF68K;\r
  PicoCpuFM68k.sr = 0x2704; // Z flag\r
#endif\r
}\r
\r
\r
// Reset the 68000:\r
PICO_INTERNAL int SekReset(void)\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
  fm68k_reset(&PicoCpuFM68k);\r
#endif\r
\r
  return 0;\r
}\r
\r
void SekStepM68k(void)\r
{\r
  Pico.t.m68c_aim = Pico.t.m68c_cnt + 1;\r
#if defined(EMU_CORE_DEBUG)\r
  Pico.t.m68c_cnt += CM_compareRun(1, 0);\r
#elif defined(EMU_C68K)\r
  PicoCpuCM68k.cycles=1;\r
  CycloneRun(&PicoCpuCM68k);\r
  Pico.t.m68c_cnt += 1 - PicoCpuCM68k.cycles;\r
#elif defined(EMU_M68K)\r
  Pico.t.m68c_cnt += m68k_execute(1);\r
#elif defined(EMU_F68K)\r
  Pico.t.m68c_cnt += fm68k_emulate(&PicoCpuFM68k, 1, 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
#if defined(EMU_C68K)\r
  struct Cyclone *context = is_sub ? &PicoCpuCS68k : &PicoCpuCM68k;\r
  memcpy(cpu,context->d,0x40);\r
  *(u32 *)(cpu+0x40)=context->pc-context->membase;\r
  *(u32 *)(cpu+0x44)=CycloneGetSr(context);\r
  *(u32 *)(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
  *(u32  *)(cpu+0x40)=m68ki_cpu_p->pc;\r
  *(u32  *)(cpu+0x44)=m68k_get_reg(NULL, M68K_REG_SR);\r
  *(u32  *)(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
  *(u32  *)(cpu+0x40)=context->pc;\r
  *(u32  *)(cpu+0x44)=context->sr;\r
  *(u32  *)(cpu+0x48)=context->asp;\r
  cpu[0x4c] = context->interrupts[0];\r
  cpu[0x4d] = (context->execinfo & FM68K_HALTED) ? 1 : 0;\r
#endif\r
\r
  if (is_sub) {\r
    *(u32 *)(cpu+0x50) = SekCycleCntS68k;\r
    *(s16 *)(cpu+0x4e) = SekCycleCntS68k - SekCycleAimS68k;\r
  } else {\r
    *(u32 *)(cpu+0x50) = Pico.t.m68c_cnt;\r
    *(s16 *)(cpu+0x4e) = Pico.t.m68c_cnt - Pico.t.m68c_aim;\r
    *(u16 *)(cpu+0x54) = Pico.t.refresh_delay;\r
    *(u16 *)(cpu+0x56) = Pico.t.z80_buscycles;\r
  }\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, *(u32 *)(cpu+0x44));\r
  context->osp=*(u32 *)(cpu+0x48);\r
  memcpy(context->d,cpu,0x40);\r
  context->membase = 0;\r
  context->pc = *(u32 *)(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, *(u32 *)(cpu+0x44));\r
  memcpy(m68ki_cpu_p->dar,cpu,0x40);\r
  m68ki_cpu_p->pc=*(u32 *)(cpu+0x40);\r
  m68ki_cpu_p->sp[m68ki_cpu_p->s_flag^SFLAG_SET]=*(u32 *)(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 =*(u32 *)(cpu+0x40);\r
  context->sr =*(u32 *)(cpu+0x44);\r
  context->asp=*(u32 *)(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
  if (is_sub) {\r
    SekCycleCntS68k = *(u32 *)(cpu+0x50);\r
    SekCycleAimS68k = SekCycleCntS68k - *(s16 *)(cpu+0x4e);\r
  } else {\r
    Pico.t.m68c_cnt = *(u32 *)(cpu+0x50);\r
    Pico.t.m68c_aim = Pico.t.m68c_cnt - *(s16 *)(cpu+0x4e);\r
    Pico.t.refresh_delay = *(u16 *)(cpu+0x54);\r
    Pico.t.z80_buscycles = *(u16 *)(cpu+0x56);\r
  }\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
static 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
  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_idle_install();\r
#endif\r
}\r
\r
int SekIsIdleReady(void)\r
{\r
	return (Pico.m.frame_count >= idledet_start_frame);\r
}\r
\r
int SekIsIdleCode(unsigned short *dst, int bytes)\r
{\r
  // printf("SekIsIdleCode %04x %i\n", *dst, bytes);\r
  if (idledet_count >= 0) 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 & 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
      if (PicoIn.AHW & (PAHW_MCD|PAHW_32X))\r
        break;\r
      // with no addons, there should be no need to wait\r
      // for byte change anywhere\r
      if ( (*dst & 0xfff8) == 0x4a10 || // tst.b ($aX)\r
           (*dst & 0xfff8) == 0x4a28)   // tst.b ($xxxx,a0)\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 (PicoIn.AHW & (PAHW_MCD|PAHW_32X))\r
        break;\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
  if (!(newop&0x200))\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
  if (is_main68k)\r
    v = m68k_read16_map[pc >> M68K_MEM_SHIFT];\r
  else\r
    v = s68k_read16_map[pc >> M68K_MEM_SHIFT];\r
  if (~v & ~((uptr)-1LL >> 1)) // MSB clear?\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_ptrs || (idledet_count & 0x1ff) == 0) {\r
    unsigned short **tmp;\r
    tmp = realloc(idledet_ptrs, (idledet_count+0x200) * sizeof(tmp[0]));\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
  if (idledet_count < 0)\r
    return;\r
#ifdef EMU_C68K\r
  CycloneFinishIdle();\r
#endif\r
#ifdef EMU_F68K\r
  fm68k_idle_remove();\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
  idledet_count = -1;\r
  if (idledet_ptrs)\r
    free(idledet_ptrs);\r
  idledet_ptrs = NULL;\r
}\r
\r
\r
#if defined(CPU_CMP_R) || defined(CPU_CMP_W)\r
#include "debug.h"\r
\r
struct ref_68k {\r
  u32 dar[16];\r
  u32 pc;\r
  u32 sr;\r
  u32 cycles;\r
  u32 pc_prev;\r
};\r
struct ref_68k ref_68ks[2];\r
static int current_68k;\r
\r
void SekTrace(int is_s68k)\r
{\r
  struct ref_68k *x68k = &ref_68ks[is_s68k];\r
  u32 pc = is_s68k ? SekPcS68k : SekPc;\r
  u32 sr = is_s68k ? SekSrS68k : SekSr;\r
  u32 cycles = is_s68k ? SekCycleCntS68k : Pico.t.m68c_cnt;\r
  u32 r;\r
  u8 cmd;\r
#ifdef CPU_CMP_W\r
  int i;\r
\r
  if (is_s68k != current_68k) {\r
    current_68k = is_s68k;\r
    cmd = CTL_68K_SLAVE | current_68k;\r
    tl_write(&cmd, sizeof(cmd));\r
  }\r
  if (pc != x68k->pc) {\r
    x68k->pc = pc;\r
    tl_write_uint(CTL_68K_PC, x68k->pc);\r
  }\r
  if (sr != x68k->sr) {\r
    x68k->sr = sr;\r
    tl_write_uint(CTL_68K_SR, x68k->sr);\r
  }\r
  for (i = 0; i < 16; i++) {\r
    r = is_s68k ? SekDarS68k(i) : SekDar(i);\r
    if (r != x68k->dar[i]) {\r
      x68k->dar[i] = r;\r
      tl_write_uint(CTL_68K_R + i, r);\r
    }\r
  }\r
  tl_write_uint(CTL_68K_CYCLES, cycles);\r
#else\r
  int i, bad = 0;\r
\r
  while (1)\r
  {\r
    int ret = tl_read(&cmd, sizeof(cmd));\r
    if (ret == 0) {\r
      elprintf(EL_STATUS, "EOF");\r
      exit(1);\r
    }\r
    switch (cmd) {\r
    case CTL_68K_SLAVE:\r
    case CTL_68K_SLAVE + 1:\r
      current_68k = cmd & 1;\r
      break;\r
    case CTL_68K_PC:\r
      tl_read_uint(&x68k->pc);\r
      break;\r
    case CTL_68K_SR:\r
      tl_read_uint(&x68k->sr);\r
      break;\r
    case CTL_68K_CYCLES:\r
      tl_read_uint(&x68k->cycles);\r
      goto breakloop;\r
    default:\r
      if (CTL_68K_R <= cmd && cmd < CTL_68K_R + 0x10)\r
        tl_read_uint(&x68k->dar[cmd - CTL_68K_R]);\r
      else\r
        elprintf(EL_STATUS, "invalid cmd: %02x", cmd);\r
    }\r
  }\r
\r
breakloop:\r
  if (is_s68k != current_68k) {\r
		printf("bad 68k: %d %d\n", is_s68k, current_68k);\r
    bad = 1;\r
  }\r
  if (cycles != x68k->cycles) {\r
		printf("bad cycles: %u %u\n", cycles, x68k->cycles);\r
    bad = 1;\r
  }\r
  if ((pc ^ x68k->pc) & 0xffffff) {\r
		printf("bad PC: %08x %08x\n", pc, x68k->pc);\r
    bad = 1;\r
  }\r
  if (sr != x68k->sr) {\r
		printf("bad SR:  %03x %03x\n", sr, x68k->sr);\r
    bad = 1;\r
  }\r
  for (i = 0; i < 16; i++) {\r
    r = is_s68k ? SekDarS68k(i) : SekDar(i);\r
    if (r != x68k->dar[i]) {\r
		  printf("bad %c%d: %08x %08x\n", i < 8 ? 'D' : 'A', i & 7,\r
        r, x68k->dar[i]);\r
      bad = 1;\r
    }\r
  }\r
  if (bad) {\r
    for (i = 0; i < 8; i++)\r
			printf("D%d: %08x  A%d: %08x\n", i, x68k->dar[i],\r
        i, x68k->dar[i + 8]);\r
		printf("PC: %08x, %08x\n", x68k->pc, x68k->pc_prev);\r
		printf("SR: %04x\n", x68k->sr);\r
\r
    PDebugDumpMem();\r
    exit(1);\r
  }\r
  x68k->pc_prev = x68k->pc;\r
#endif\r
}\r
#endif // CPU_CMP_*\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
\r
// vim:shiftwidth=2:ts=2:expandtab\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
70357ce5	13	/* context */\r
70357ce5	14	// Cyclone 68000\r
cc68a136	15	#ifdef EMU_C68K\r
3aa1e148	16	struct Cyclone PicoCpuCM68k;\r
cc68a136	17	#endif\r
70357ce5	18	// MUSASHI 68000\r
cc68a136	19	#ifdef EMU_M68K\r
3aa1e148	20	m68ki_cpu_core PicoCpuMM68k;\r
cc68a136	21	#endif\r
70357ce5	22	// FAME 68000\r
70357ce5	23	#ifdef EMU_F68K\r
3aa1e148	24	M68K_CONTEXT PicoCpuFM68k;\r
cc68a136	25	#endif\r
	26	\r
	27	\r
22814963	28	static int do_ack(int level)\r
	29	{\r
	30	struct PicoVideo *pv = &Pico.video;\r
	31	\r
	32	elprintf(EL_INTS, "%cack: @ %06x [%u], p=%02x",\r
	33	level == 6 ? 'v' : 'h', SekPc, SekCyclesDone(), pv->pending_ints);\r
	34	// the VDP doesn't look at the 68k level\r
	35	if (pv->pending_ints & pv->reg[1] & 0x20) {\r
	36	pv->pending_ints &= ~0x20;\r
0e4bde9b	37	pv->status &= ~SR_F;\r
ba2b97dc	38	if (pv->reg[0] & pv->pending_ints & 0x10)\r
ba2b97dc	39	return pv->hint_irq;\r
22814963	40	}\r
	41	else if (pv->pending_ints & pv->reg[0] & 0x10)\r
	42	pv->pending_ints &= ~0x10;\r
	43	\r
f1b425e3	44	return (PicoIn.AHW & PAHW_PICO ? PicoPicoIrqAck(level) : 0);\r
22814963	45	}\r
22814963	46	\r
70357ce5	47	/* callbacks */\r
cc68a136	48	#ifdef EMU_C68K\r
b837b69b	49	// interrupt acknowledgment\r
0af33fe0	50	static int SekIntAck(int level)\r
cc68a136	51	{\r
22814963	52	PicoCpuCM68k.irq = do_ack(level);\r
0af33fe0	53	return CYCLONE_INT_ACK_AUTOVECTOR;\r
cc68a136	54	}\r
cc68a136	55	\r
69996cb7	56	static void SekResetAck(void)\r
cc68a136	57	{\r
69996cb7	58	elprintf(EL_ANOMALY, "Reset encountered @ %06x", SekPc);\r
cc68a136	59	}\r
	60	\r
	61	static int SekUnrecognizedOpcode()\r
	62	{\r
b4db550e	63	unsigned int pc;\r
cc68a136	64	pc = SekPc;\r
b4db550e	65	elprintf(EL_ANOMALY, "Unrecognized Opcode @ %06x", pc);\r
	66	// see if we are still in a mapped region\r
	67	pc &= 0x00ffffff;\r
	68	if (map_flag_set(m68k_read16_map[pc >> M68K_MEM_SHIFT])) {\r
	69	elprintf(EL_STATUS\|EL_ANOMALY, "m68k crash @%06x", pc);\r
3aa1e148	70	PicoCpuCM68k.cycles = 0;\r
3aa1e148	71	PicoCpuCM68k.state_flags \|= 1;\r
cc68a136	72	return 1;\r
cc68a136	73	}\r
2b15cea8	74	// happened once - may happen again\r
2b15cea8	75	SekFinishIdleDet();\r
2d0b15bb	76	#ifdef EMU_M68K // debugging cyclone\r
	77	{\r
	78	extern int have_illegal;\r
	79	have_illegal = 1;\r
	80	}\r
	81	#endif\r
cc68a136	82	return 0;\r
	83	}\r
	84	#endif\r
	85	\r
	86	\r
	87	#ifdef EMU_M68K\r
	88	static int SekIntAckM68K(int level)\r
	89	{\r
22814963	90	CPU_INT_LEVEL = do_ack(level) << 8;\r
cc68a136	91	return M68K_INT_ACK_AUTOVECTOR;\r
cc68a136	92	}\r
0af33fe0	93	\r
	94	static int SekTasCallback(void)\r
	95	{\r
	96	return 0; // no writeback\r
	97	}\r
cc68a136	98	#endif\r
	99	\r
	100	\r
70357ce5	101	#ifdef EMU_F68K\r
3aa1e148	102	static void SekIntAckF68K(unsigned level)\r
70357ce5	103	{\r
22814963	104	PicoCpuFM68k.interrupts[0] = do_ack(level);\r
70357ce5	105	}\r
	106	#endif\r
	107	\r
cc68a136	108	\r
2aa27095	109	PICO_INTERNAL void SekInit(void)\r
cc68a136	110	{\r
	111	#ifdef EMU_C68K\r
	112	CycloneInit();\r
3aa1e148	113	memset(&PicoCpuCM68k,0,sizeof(PicoCpuCM68k));\r
	114	PicoCpuCM68k.IrqCallback=SekIntAck;\r
	115	PicoCpuCM68k.ResetCallback=SekResetAck;\r
	116	PicoCpuCM68k.UnrecognizedCallback=SekUnrecognizedOpcode;\r
03e4f2a3	117	PicoCpuCM68k.flags=4; // Z set\r
cc68a136	118	#endif\r
cc68a136	119	#ifdef EMU_M68K\r
	120	{\r
	121	void *oldcontext = m68ki_cpu_p;\r
3aa1e148	122	m68k_set_context(&PicoCpuMM68k);\r
cc68a136	123	m68k_set_cpu_type(M68K_CPU_TYPE_68000);\r
	124	m68k_init();\r
	125	m68k_set_int_ack_callback(SekIntAckM68K);\r
0af33fe0	126	m68k_set_tas_instr_callback(SekTasCallback);\r
9037e45d	127	//m68k_pulse_reset();\r
cc68a136	128	m68k_set_context(oldcontext);\r
	129	}\r
	130	#endif\r
70357ce5	131	#ifdef EMU_F68K\r
7669591e	132	memset(&PicoCpuFM68k, 0, sizeof(PicoCpuFM68k));\r
	133	fm68k_init();\r
	134	PicoCpuFM68k.iack_handler = SekIntAckF68K;\r
	135	PicoCpuFM68k.sr = 0x2704; // Z flag\r
70357ce5	136	#endif\r
cc68a136	137	}\r
cc68a136	138	\r
70357ce5	139	\r
cc68a136	140	// Reset the 68000:\r
2aa27095	141	PICO_INTERNAL int SekReset(void)\r
cc68a136	142	{\r
cc68a136	143	#ifdef EMU_C68K\r
5e89f0f5	144	CycloneReset(&PicoCpuCM68k);\r
cc68a136	145	#endif\r
cc68a136	146	#ifdef EMU_M68K\r
3aa1e148	147	m68k_set_context(&PicoCpuMM68k); // if we ever reset m68k, we always need it's context to be set\r
2d0b15bb	148	m68ki_cpu.sp[0]=0;\r
2d0b15bb	149	m68k_set_irq(0);\r
b837b69b	150	m68k_pulse_reset();\r
99464b62	151	REG_USP = 0; // ?\r
cc68a136	152	#endif\r
70357ce5	153	#ifdef EMU_F68K\r
12f23dac	154	fm68k_reset(&PicoCpuFM68k);\r
70357ce5	155	#endif\r
cc68a136	156	\r
	157	return 0;\r
	158	}\r
	159	\r
5f9a0d16	160	void SekStepM68k(void)\r
5f9a0d16	161	{\r
88fd63ad	162	Pico.t.m68c_aim = Pico.t.m68c_cnt + 1;\r
5f9a0d16	163	#if defined(EMU_CORE_DEBUG)\r
88fd63ad	164	Pico.t.m68c_cnt += CM_compareRun(1, 0);\r
5f9a0d16	165	#elif defined(EMU_C68K)\r
	166	PicoCpuCM68k.cycles=1;\r
	167	CycloneRun(&PicoCpuCM68k);\r
88fd63ad	168	Pico.t.m68c_cnt += 1 - PicoCpuCM68k.cycles;\r
5f9a0d16	169	#elif defined(EMU_M68K)\r
88fd63ad	170	Pico.t.m68c_cnt += m68k_execute(1);\r
5f9a0d16	171	#elif defined(EMU_F68K)\r
12f23dac	172	Pico.t.m68c_cnt += fm68k_emulate(&PicoCpuFM68k, 1, 0);\r
5f9a0d16	173	#endif\r
5f9a0d16	174	}\r
cc68a136	175	\r
eff55556	176	PICO_INTERNAL void SekSetRealTAS(int use_real)\r
2433f409	177	{\r
	178	#ifdef EMU_C68K\r
	179	CycloneSetRealTAS(use_real);\r
	180	#endif\r
70357ce5	181	#ifdef EMU_F68K\r
	182	// TODO\r
	183	#endif\r
2433f409	184	}\r
2433f409	185	\r
b4db550e	186	// Pack the cpu into a common format:\r
	187	// XXX: rename\r
	188	PICO_INTERNAL void SekPackCpu(unsigned char *cpu, int is_sub)\r
	189	{\r
b4db550e	190	#if defined(EMU_C68K)\r
	191	struct Cyclone *context = is_sub ? &PicoCpuCS68k : &PicoCpuCM68k;\r
	192	memcpy(cpu,context->d,0x40);\r
dfda3442	193	(u32 )(cpu+0x40)=context->pc-context->membase;\r
91ea9406	194	(u32 )(cpu+0x44)=CycloneGetSr(context);\r
91ea9406	195	(u32 )(cpu+0x48)=context->osp;\r
b4db550e	196	cpu[0x4c] = context->irq;\r
	197	cpu[0x4d] = context->state_flags & 1;\r
	198	#elif defined(EMU_M68K)\r
	199	void *oldcontext = m68ki_cpu_p;\r
	200	m68k_set_context(is_sub ? &PicoCpuMS68k : &PicoCpuMM68k);\r
	201	memcpy(cpu,m68ki_cpu_p->dar,0x40);\r
dfda3442	202	(u32 )(cpu+0x40)=m68ki_cpu_p->pc;\r
91ea9406	203	(u32 )(cpu+0x44)=m68k_get_reg(NULL, M68K_REG_SR);\r
91ea9406	204	(u32 )(cpu+0x48)=m68ki_cpu_p->sp[m68ki_cpu_p->s_flag^SFLAG_SET];\r
b4db550e	205	cpu[0x4c] = CPU_INT_LEVEL>>8;\r
	206	cpu[0x4d] = CPU_STOPPED;\r
	207	m68k_set_context(oldcontext);\r
	208	#elif defined(EMU_F68K)\r
	209	M68K_CONTEXT *context = is_sub ? &PicoCpuFS68k : &PicoCpuFM68k;\r
	210	memcpy(cpu,context->dreg,0x40);\r
dfda3442	211	(u32 )(cpu+0x40)=context->pc;\r
91ea9406	212	(u32 )(cpu+0x44)=context->sr;\r
91ea9406	213	(u32 )(cpu+0x48)=context->asp;\r
b4db550e	214	cpu[0x4c] = context->interrupts[0];\r
	215	cpu[0x4d] = (context->execinfo & FM68K_HALTED) ? 1 : 0;\r
	216	#endif\r
	217	\r
dfda3442	218	if (is_sub) {\r
	219	(u32 )(cpu+0x50) = SekCycleCntS68k;\r
	220	(s16 )(cpu+0x4e) = SekCycleCntS68k - SekCycleAimS68k;\r
	221	} else {\r
d4b5888a	222	(u32 )(cpu+0x50) = Pico.t.m68c_cnt;\r
df765ed9	223	(s16 )(cpu+0x4e) = Pico.t.m68c_cnt - Pico.t.m68c_aim;\r
d4b5888a	224	(u16 )(cpu+0x54) = Pico.t.refresh_delay;\r
d4b5888a	225	(u16 )(cpu+0x56) = Pico.t.z80_buscycles;\r
dfda3442	226	}\r
b4db550e	227	}\r
	228	\r
	229	PICO_INTERNAL void SekUnpackCpu(const unsigned char *cpu, int is_sub)\r
	230	{\r
	231	#if defined(EMU_C68K)\r
	232	struct Cyclone *context = is_sub ? &PicoCpuCS68k : &PicoCpuCM68k;\r
91ea9406	233	CycloneSetSr(context, (u32 )(cpu+0x44));\r
91ea9406	234	context->osp=(u32 )(cpu+0x48);\r
b4db550e	235	memcpy(context->d,cpu,0x40);\r
b4db550e	236	context->membase = 0;\r
91ea9406	237	context->pc = (u32 )(cpu+0x40);\r
b4db550e	238	CycloneUnpack(context, NULL); // rebase PC\r
	239	context->irq = cpu[0x4c];\r
	240	context->state_flags = 0;\r
	241	if (cpu[0x4d])\r
	242	context->state_flags \|= 1;\r
	243	#elif defined(EMU_M68K)\r
	244	void *oldcontext = m68ki_cpu_p;\r
	245	m68k_set_context(is_sub ? &PicoCpuMS68k : &PicoCpuMM68k);\r
91ea9406	246	m68k_set_reg(M68K_REG_SR, (u32 )(cpu+0x44));\r
b4db550e	247	memcpy(m68ki_cpu_p->dar,cpu,0x40);\r
91ea9406	248	m68ki_cpu_p->pc=(u32 )(cpu+0x40);\r
91ea9406	249	m68ki_cpu_p->sp[m68ki_cpu_p->s_flag^SFLAG_SET]=(u32 )(cpu+0x48);\r
b4db550e	250	CPU_INT_LEVEL = cpu[0x4c] << 8;\r
	251	CPU_STOPPED = cpu[0x4d];\r
	252	m68k_set_context(oldcontext);\r
	253	#elif defined(EMU_F68K)\r
	254	M68K_CONTEXT *context = is_sub ? &PicoCpuFS68k : &PicoCpuFM68k;\r
	255	memcpy(context->dreg,cpu,0x40);\r
91ea9406	256	context->pc =(u32 )(cpu+0x40);\r
	257	context->sr =(u32 )(cpu+0x44);\r
	258	context->asp=(u32 )(cpu+0x48);\r
b4db550e	259	context->interrupts[0] = cpu[0x4c];\r
	260	context->execinfo &= ~FM68K_HALTED;\r
	261	if (cpu[0x4d]&1) context->execinfo \|= FM68K_HALTED;\r
	262	#endif\r
dfda3442	263	if (is_sub) {\r
91ea9406	264	SekCycleCntS68k = (u32 )(cpu+0x50);\r
dfda3442	265	SekCycleAimS68k = SekCycleCntS68k - (s16 )(cpu+0x4e);\r
dfda3442	266	} else {\r
91ea9406	267	Pico.t.m68c_cnt = (u32 )(cpu+0x50);\r
dfda3442	268	Pico.t.m68c_aim = Pico.t.m68c_cnt - (s16 )(cpu+0x4e);\r
d4b5888a	269	Pico.t.refresh_delay = (u16 )(cpu+0x54);\r
d4b5888a	270	Pico.t.z80_buscycles = (u16 )(cpu+0x56);\r
dfda3442	271	}\r
b4db550e	272	}\r
b4db550e	273	\r
5f9a0d16	274	\r
053fd9b4	275	/* idle loop detection, not to be used in CD mode */\r
053fd9b4	276	#ifdef EMU_C68K\r
f821bb70	277	#include <cpu/cyclone/tools/idle.h>\r
053fd9b4	278	#endif\r
053fd9b4	279	\r
488c0bbf	280	static unsigned short **idledet_ptrs = NULL;\r
053fd9b4	281	static int idledet_count = 0, idledet_bads = 0;\r
0219d379	282	static int idledet_start_frame = 0;\r
053fd9b4	283	\r
5ed2a20e	284	#if 0\r
	285	#define IDLE_STATS 1\r
	286	unsigned int idlehit_addrs[128], idlehit_counts[128];\r
	287	\r
	288	void SekRegisterIdleHit(unsigned int pc)\r
	289	{\r
	290	int i;\r
	291	for (i = 0; i < 127 && idlehit_addrs[i]; i++) {\r
	292	if (idlehit_addrs[i] == pc) {\r
	293	idlehit_counts[i]++;\r
	294	return;\r
	295	}\r
	296	}\r
	297	idlehit_addrs[i] = pc;\r
	298	idlehit_counts[i] = 1;\r
	299	idlehit_addrs[i+1] = 0;\r
	300	}\r
	301	#endif\r
	302	\r
053fd9b4	303	void SekInitIdleDet(void)\r
053fd9b4	304	{\r
053fd9b4	305	idledet_count = idledet_bads = 0;\r
053fd9b4	306	idledet_start_frame = Pico.m.frame_count + 360;\r
5ed2a20e	307	#ifdef IDLE_STATS\r
	308	idlehit_addrs[0] = 0;\r
	309	#endif\r
053fd9b4	310	\r
053fd9b4	311	#ifdef EMU_C68K\r
	312	CycloneInitIdle();\r
	313	#endif\r
c060a9ab	314	#ifdef EMU_F68K\r
12f23dac	315	fm68k_idle_install();\r
c060a9ab	316	#endif\r
053fd9b4	317	}\r
053fd9b4	318	\r
0219d379	319	int SekIsIdleReady(void)\r
	320	{\r
	321	return (Pico.m.frame_count >= idledet_start_frame);\r
	322	}\r
	323	\r
053fd9b4	324	int SekIsIdleCode(unsigned short *dst, int bytes)\r
053fd9b4	325	{\r
8187ba84	326	// printf("SekIsIdleCode %04x %i\n", *dst, bytes);\r
3244eb63	327	if (idledet_count >= 0) switch (bytes)\r
053fd9b4	328	{\r
5ed2a20e	329	case 2:\r
	330	if ((*dst & 0xf000) != 0x6000) // not another branch\r
	331	return 1;\r
	332	break;\r
053fd9b4	333	case 4:\r
0219d379	334	if ( (*dst & 0xff3f) == 0x4a38 \|\| // tst.x ($xxxx.w); tas ($xxxx.w)\r
	335	(*dst & 0xc1ff) == 0x0038 \|\| // move.x ($xxxx.w), dX\r
	336	(*dst & 0xf13f) == 0xb038) // cmp.x ($xxxx.w), dX\r
	337	return 1;\r
93f9619e	338	if (PicoIn.AHW & (PAHW_MCD\|PAHW_32X))\r
0219d379	339	break;\r
	340	// with no addons, there should be no need to wait\r
	341	// for byte change anywhere\r
	342	if ( (*dst & 0xfff8) == 0x4a10 \|\| // tst.b ($aX)\r
	343	(*dst & 0xfff8) == 0x4a28) // tst.b ($xxxx,a0)\r
053fd9b4	344	return 1;\r
	345	break;\r
	346	case 6:\r
b0677887	347	if ( ((dst[1] & 0xe0) == 0xe0 && ( // RAM and\r
	348	*dst == 0x4a39 \|\| // tst.b ($xxxxxxxx)\r
	349	*dst == 0x4a79 \|\| // tst.w ($xxxxxxxx)\r
	350	*dst == 0x4ab9 \|\| // tst.l ($xxxxxxxx)\r
	351	(*dst & 0xc1ff) == 0x0039 \|\| // move.x ($xxxxxxxx), dX\r
	352	(*dst & 0xf13f) == 0xb039))\|\|// cmp.x ($xxxxxxxx), dX\r
	353	*dst == 0x0838 \|\| // btst $X, ($xxxx.w) [6 byte op]\r
	354	(*dst & 0xffbf) == 0x0c38) // cmpi.{b,w} $X, ($xxxx.w)\r
053fd9b4	355	return 1;\r
	356	break;\r
	357	case 8:\r
b0677887	358	if ( ((dst[2] & 0xe0) == 0xe0 && ( // RAM and\r
	359	*dst == 0x0839 \|\| // btst $X, ($xxxxxxxx.w) [8 byte op]\r
	360	(*dst & 0xffbf) == 0x0c39))\|\|// cmpi.{b,w} $X, ($xxxxxxxx)\r
	361	*dst == 0x0cb8) // cmpi.l $X, ($xxxx.w)\r
053fd9b4	362	return 1;\r
	363	break;\r
	364	case 12:\r
93f9619e	365	if (PicoIn.AHW & (PAHW_MCD\|PAHW_32X))\r
0219d379	366	break;\r
0219d379	367	if ( (*dst & 0xf1f8) == 0x3010 && // move.w (aX), dX\r
b0677887	368	(dst[1]&0xf100) == 0x0000 && // arithmetic\r
b0677887	369	(dst[3]&0xf100) == 0x0000) // arithmetic\r
053fd9b4	370	return 1;\r
	371	break;\r
	372	}\r
	373	\r
	374	return 0;\r
	375	}\r
	376	\r
5ed2a20e	377	int SekRegisterIdlePatch(unsigned int pc, int oldop, int newop, void *ctx)\r
053fd9b4	378	{\r
5ed2a20e	379	int is_main68k = 1;\r
488c0bbf	380	u16 *target;\r
	381	uptr v;\r
	382	\r
5ed2a20e	383	#if defined(EMU_C68K)\r
	384	struct Cyclone *cyc = ctx;\r
	385	is_main68k = cyc == &PicoCpuCM68k;\r
	386	pc -= cyc->membase;\r
	387	#elif defined(EMU_F68K)\r
	388	is_main68k = ctx == &PicoCpuFM68k;\r
053fd9b4	389	#endif\r
053fd9b4	390	pc &= ~0xff000000;\r
0219d379	391	if (!(newop&0x200))\r
5ed2a20e	392	elprintf(EL_IDLE, "idle: patch %06x %04x %04x %c %c #%i", pc, oldop, newop,\r
	393	(newop&0x200)?'n':'y', is_main68k?'m':'s', idledet_count);\r
	394	\r
488c0bbf	395	// XXX: probably shouldn't patch RAM too\r
14ebd378	396	if (is_main68k)\r
	397	v = m68k_read16_map[pc >> M68K_MEM_SHIFT];\r
	398	else\r
	399	v = s68k_read16_map[pc >> M68K_MEM_SHIFT];\r
4c2b81a0	400	if (~v & ~((uptr)-1LL >> 1)) // MSB clear?\r
488c0bbf	401	target = (u16 *)((v << 1) + pc);\r
	402	else {\r
	403	if (++idledet_bads > 128)\r
	404	return 2; // remove detector\r
053fd9b4	405	return 1; // don't patch\r
	406	}\r
	407	\r
3244eb63	408	if (!idledet_ptrs \|\| (idledet_count & 0x1ff) == 0) {\r
8f80007b	409	unsigned short **tmp;\r
8f80007b	410	tmp = realloc(idledet_ptrs, (idledet_count+0x200) * sizeof(tmp[0]));\r
488c0bbf	411	if (tmp == NULL)\r
	412	return 1;\r
	413	idledet_ptrs = tmp;\r
053fd9b4	414	}\r
053fd9b4	415	\r
488c0bbf	416	idledet_ptrs[idledet_count++] = target;\r
b0677887	417	\r
053fd9b4	418	return 0;\r
	419	}\r
	420	\r
	421	void SekFinishIdleDet(void)\r
	422	{\r
2b15cea8	423	if (idledet_count < 0)\r
2b15cea8	424	return;\r
053fd9b4	425	#ifdef EMU_C68K\r
053fd9b4	426	CycloneFinishIdle();\r
c060a9ab	427	#endif\r
c060a9ab	428	#ifdef EMU_F68K\r
12f23dac	429	fm68k_idle_remove();\r
053fd9b4	430	#endif\r
	431	while (idledet_count > 0)\r
	432	{\r
488c0bbf	433	unsigned short *op = idledet_ptrs[--idledet_count];\r
053fd9b4	434	if ((*op & 0xfd00) == 0x7100)\r
	435	op &= 0xff, op \|= 0x6600;\r
	436	else if ((*op & 0xfd00) == 0x7500)\r
	437	op &= 0xff, op \|= 0x6700;\r
	438	else if ((*op & 0xfd00) == 0x7d00)\r
	439	op &= 0xff, op \|= 0x6000;\r
	440	else\r
	441	elprintf(EL_STATUS\|EL_IDLE, "idle: don't know how to restore %04x", *op);\r
	442	}\r
3244eb63	443	\r
2b15cea8	444	idledet_count = -1;\r
3244eb63	445	if (idledet_ptrs)\r
	446	free(idledet_ptrs);\r
	447	idledet_ptrs = NULL;\r
053fd9b4	448	}\r
	449	\r
	450	\r
12da51c2	451	#if defined(CPU_CMP_R) \|\| defined(CPU_CMP_W)\r
	452	#include "debug.h"\r
	453	\r
	454	struct ref_68k {\r
	455	u32 dar[16];\r
	456	u32 pc;\r
	457	u32 sr;\r
	458	u32 cycles;\r
	459	u32 pc_prev;\r
	460	};\r
	461	struct ref_68k ref_68ks[2];\r
	462	static int current_68k;\r
	463	\r
	464	void SekTrace(int is_s68k)\r
	465	{\r
	466	struct ref_68k *x68k = &ref_68ks[is_s68k];\r
	467	u32 pc = is_s68k ? SekPcS68k : SekPc;\r
	468	u32 sr = is_s68k ? SekSrS68k : SekSr;\r
88fd63ad	469	u32 cycles = is_s68k ? SekCycleCntS68k : Pico.t.m68c_cnt;\r
12da51c2	470	u32 r;\r
	471	u8 cmd;\r
	472	#ifdef CPU_CMP_W\r
	473	int i;\r
	474	\r
	475	if (is_s68k != current_68k) {\r
	476	current_68k = is_s68k;\r
	477	cmd = CTL_68K_SLAVE \| current_68k;\r
	478	tl_write(&cmd, sizeof(cmd));\r
	479	}\r
	480	if (pc != x68k->pc) {\r
	481	x68k->pc = pc;\r
	482	tl_write_uint(CTL_68K_PC, x68k->pc);\r
	483	}\r
	484	if (sr != x68k->sr) {\r
	485	x68k->sr = sr;\r
	486	tl_write_uint(CTL_68K_SR, x68k->sr);\r
	487	}\r
	488	for (i = 0; i < 16; i++) {\r
	489	r = is_s68k ? SekDarS68k(i) : SekDar(i);\r
	490	if (r != x68k->dar[i]) {\r
	491	x68k->dar[i] = r;\r
	492	tl_write_uint(CTL_68K_R + i, r);\r
	493	}\r
	494	}\r
	495	tl_write_uint(CTL_68K_CYCLES, cycles);\r
	496	#else\r
	497	int i, bad = 0;\r
	498	\r
	499	while (1)\r
	500	{\r
	501	int ret = tl_read(&cmd, sizeof(cmd));\r
	502	if (ret == 0) {\r
	503	elprintf(EL_STATUS, "EOF");\r
	504	exit(1);\r
	505	}\r
	506	switch (cmd) {\r
	507	case CTL_68K_SLAVE:\r
	508	case CTL_68K_SLAVE + 1:\r
	509	current_68k = cmd & 1;\r
	510	break;\r
	511	case CTL_68K_PC:\r
	512	tl_read_uint(&x68k->pc);\r
	513	break;\r
	514	case CTL_68K_SR:\r
	515	tl_read_uint(&x68k->sr);\r
	516	break;\r
	517	case CTL_68K_CYCLES:\r
	518	tl_read_uint(&x68k->cycles);\r
	519	goto breakloop;\r
	520	default:\r
	521	if (CTL_68K_R <= cmd && cmd < CTL_68K_R + 0x10)\r
	522	tl_read_uint(&x68k->dar[cmd - CTL_68K_R]);\r
	523	else\r
	524	elprintf(EL_STATUS, "invalid cmd: %02x", cmd);\r
	525	}\r
	526	}\r
	527	\r
	528	breakloop:\r
	529	if (is_s68k != current_68k) {\r
	530	printf("bad 68k: %d %d\n", is_s68k, current_68k);\r
	531	bad = 1;\r
	532	}\r
	533	if (cycles != x68k->cycles) {\r
534	printf("bad cycles: %u %u\n", cycles, x68k->cycles);\r
535	bad = 1;\r
536	}\r
537	if ((pc ^ x68k->pc) & 0xffffff) {\r
538	printf("bad PC: %08x %08x\n", pc, x68k->pc);\r
539	bad = 1;\r
540	}\r
541	if (sr != x68k->sr) {\r
542	printf("bad SR: %03x %03x\n", sr, x68k->sr);\r
543	bad = 1;\r
544	}\r
545	for (i = 0; i < 16; i++) {\r
546	r = is_s68k ? SekDarS68k(i) : SekDar(i);\r
547	if (r != x68k->dar[i]) {\r
548	printf("bad %c%d: %08x %08x\n", i < 8 ? 'D' : 'A', i & 7,\r
549	r, x68k->dar[i]);\r
550	bad = 1;\r
551	}\r
552	}\r
553	if (bad) {\r
554	for (i = 0; i < 8; i++)\r
555	printf("D%d: %08x A%d: %08x\n", i, x68k->dar[i],\r
556	i, x68k->dar[i + 8]);\r
557	printf("PC: %08x, %08x\n", x68k->pc, x68k->pc_prev);\r
a39743e3	558	printf("SR: %04x\n", x68k->sr);\r
12da51c2	559	\r
	560	PDebugDumpMem();\r
	561	exit(1);\r
	562	}\r
	563	x68k->pc_prev = x68k->pc;\r
	564	#endif\r
	565	}\r
	566	#endif // CPU_CMP_*\r
	567	\r
6cab49fd	568	#if defined(EMU_M68K) && M68K_INSTRUCTION_HOOK == OPT_SPECIFY_HANDLER\r
	569	static unsigned char op_flags[0x400000/2] = { 0, };\r
	570	static int atexit_set = 0;\r
	571	\r
	572	static void make_idc(void)\r
	573	{\r
	574	FILE *f = fopen("idc.idc", "w");\r
	575	int i;\r
	576	if (!f) return;\r
	577	fprintf(f, "#include <idc.idc>\nstatic main() {\n");\r
	578	for (i = 0; i < 0x400000/2; i++)\r
	579	if (op_flags[i] != 0)\r
	580	fprintf(f, " MakeCode(0x%06x);\n", i*2);\r
	581	fprintf(f, "}\n");\r
	582	fclose(f);\r
	583	}\r
	584	\r
	585	void instruction_hook(void)\r
	586	{\r
	587	if (!atexit_set) {\r
	588	atexit(make_idc);\r
	589	atexit_set = 1;\r
	590	}\r
	591	if (REG_PC < 0x400000)\r
	592	op_flags[REG_PC/2] = 1;\r
	593	}\r
	594	#endif\r
12da51c2	595	\r
12da51c2	596	// vim:shiftwidth=2:ts=2:expandtab\r