sek.c 12 KB

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