123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440 |
- /*
- * PicoDrive
- * (C) notaz, 2007,2013
- *
- * This work is licensed under the terms of MAME license.
- * See COPYING file in the top-level directory.
- */
- #include "../pico_int.h"
- #include "../sound/ym2612.h"
- extern unsigned char formatted_bram[4*0x10];
- static unsigned int mcd_m68k_cycle_mult;
- static unsigned int mcd_s68k_cycle_mult;
- static unsigned int mcd_m68k_cycle_base;
- static unsigned int mcd_s68k_cycle_base;
- PICO_INTERNAL void PicoInitMCD(void)
- {
- SekInitS68k();
- }
- PICO_INTERNAL void PicoExitMCD(void)
- {
- cdd_unload();
- }
- PICO_INTERNAL void PicoPowerMCD(void)
- {
- int fmt_size;
- SekCycleCntS68k = SekCycleAimS68k = 0;
- fmt_size = sizeof(formatted_bram);
- memset(Pico_mcd->prg_ram, 0, sizeof(Pico_mcd->prg_ram));
- memset(Pico_mcd->word_ram2M, 0, sizeof(Pico_mcd->word_ram2M));
- memset(Pico_mcd->pcm_ram, 0, sizeof(Pico_mcd->pcm_ram));
- memset(Pico_mcd->bram, 0, sizeof(Pico_mcd->bram));
- memcpy(Pico_mcd->bram + sizeof(Pico_mcd->bram) - fmt_size,
- formatted_bram, fmt_size);
- memset(Pico_mcd->s68k_regs, 0, sizeof(Pico_mcd->s68k_regs));
- memset(&Pico_mcd->pcm, 0, sizeof(Pico_mcd->pcm));
- memset(&Pico_mcd->m, 0, sizeof(Pico_mcd->m));
- cdc_init();
- gfx_init();
- // cold reset state (tested)
- Pico_mcd->m.state_flags = PCD_ST_S68K_RST;
- Pico_mcd->m.busreq = 2; // busreq on, s68k in reset
- Pico_mcd->s68k_regs[3] = 1; // 2M word RAM mode, m68k access
- memset(Pico_mcd->bios + 0x70, 0xff, 4);
- }
- void pcd_soft_reset(void)
- {
- elprintf(EL_CD, "cd: soft reset");
- Pico_mcd->m.s68k_pend_ints = 0;
- cdc_reset();
- cdd_reset();
- #ifdef _ASM_CD_MEMORY_C
- //PicoMemResetCDdecode(1); // don't have to call this in 2M mode
- #endif
- memset(&Pico_mcd->s68k_regs[0x38], 0, 9);
- Pico_mcd->s68k_regs[0x38+9] = 0x0f; // default checksum
- pcd_event_schedule_s68k(PCD_EVENT_CDC, 12500000/75);
- // TODO: test if register state/timers change
- }
- PICO_INTERNAL int PicoResetMCD(void)
- {
- // reset button doesn't affect MCD hardware
- // use Pico.sv.data for RAM cart
- if (PicoIn.opt & POPT_EN_MCD_RAMCART) {
- if (Pico.sv.data == NULL)
- Pico.sv.data = calloc(1, 0x12000);
- }
- else if (Pico.sv.data != NULL) {
- free(Pico.sv.data);
- Pico.sv.data = NULL;
- }
- Pico.sv.start = Pico.sv.end = 0; // unused
- return 0;
- }
- static void SekRunM68kOnce(void)
- {
- int cyc_do;
- pevt_log_m68k_o(EVT_RUN_START);
- if ((cyc_do = Pico.t.m68c_aim - Pico.t.m68c_cnt) > 0) {
- Pico.t.m68c_cnt += cyc_do;
- #if defined(EMU_C68K)
- PicoCpuCM68k.cycles = cyc_do;
- CycloneRun(&PicoCpuCM68k);
- Pico.t.m68c_cnt -= PicoCpuCM68k.cycles;
- #elif defined(EMU_M68K)
- Pico.t.m68c_cnt += m68k_execute(cyc_do) - cyc_do;
- #elif defined(EMU_F68K)
- Pico.t.m68c_cnt += fm68k_emulate(&PicoCpuFM68k, cyc_do, 0) - cyc_do;
- #endif
- }
- SekCyclesLeft = 0;
- SekTrace(0);
- pevt_log_m68k_o(EVT_RUN_END);
- }
- static void SekRunS68k(unsigned int to)
- {
- int cyc_do;
- SekCycleAimS68k = to;
- if ((cyc_do = SekCycleAimS68k - SekCycleCntS68k) <= 0)
- return;
- pprof_start(s68k);
- SekCycleCntS68k += cyc_do;
- #if defined(EMU_C68K)
- PicoCpuCS68k.cycles = cyc_do;
- CycloneRun(&PicoCpuCS68k);
- SekCycleCntS68k -= PicoCpuCS68k.cycles;
- #elif defined(EMU_M68K)
- m68k_set_context(&PicoCpuMS68k);
- SekCycleCntS68k += m68k_execute(cyc_do) - cyc_do;
- m68k_set_context(&PicoCpuMM68k);
- #elif defined(EMU_F68K)
- SekCycleCntS68k += fm68k_emulate(&PicoCpuFS68k, cyc_do, 0) - cyc_do;
- #endif
- SekCyclesLeftS68k = 0;
- pprof_end(s68k);
- }
- static void pcd_set_cycle_mult(void)
- {
- unsigned int div;
- if (Pico.m.pal)
- div = 50*313*488;
- else
- div = 60*262*488;
- // ~1.63 for NTSC, ~1.645 for PAL; round to nearest, x/y+0.5 -> (x+y/2)/y
- mcd_m68k_cycle_mult = ((12500000ull << 16) + div/2) / div;
- mcd_s68k_cycle_mult = ((1ull*div << 16) + 6250000) / 12500000;
- }
- unsigned int pcd_cycles_m68k_to_s68k(unsigned int c)
- {
- return (long long)c * mcd_m68k_cycle_mult >> 16;
- }
- /* events */
- static void pcd_cdc_event(unsigned int now)
- {
- // 75Hz CDC update
- cdd_update();
- /* check if a new CDD command has been processed */
- if (!(Pico_mcd->s68k_regs[0x4b] & 0xf0))
- {
- /* reset CDD command wait flag */
- Pico_mcd->s68k_regs[0x4b] = 0xf0;
- if (Pico_mcd->s68k_regs[0x33] & PCDS_IEN4) {
- elprintf(EL_INTS|EL_CD, "s68k: cdd irq 4");
- pcd_irq_s68k(4, 1);
- }
- }
- pcd_event_schedule(now, PCD_EVENT_CDC, 12500000/75);
- }
- static void pcd_int3_timer_event(unsigned int now)
- {
- if (Pico_mcd->s68k_regs[0x33] & PCDS_IEN3) {
- elprintf(EL_INTS|EL_CD, "s68k: timer irq 3");
- pcd_irq_s68k(3, 1);
- }
- if (Pico_mcd->s68k_regs[0x31] != 0)
- pcd_event_schedule(now, PCD_EVENT_TIMER3,
- Pico_mcd->s68k_regs[0x31] * 384);
- }
- static void pcd_dma_event(unsigned int now)
- {
- cdc_dma_update();
- }
- typedef void (event_cb)(unsigned int now);
- /* times are in s68k (12.5MHz) cycles */
- unsigned int pcd_event_times[PCD_EVENT_COUNT];
- static unsigned int event_time_next;
- static event_cb *pcd_event_cbs[PCD_EVENT_COUNT] = {
- pcd_cdc_event, // PCD_EVENT_CDC
- pcd_int3_timer_event, // PCD_EVENT_TIMER3
- gfx_update, // PCD_EVENT_GFX
- pcd_dma_event, // PCD_EVENT_DMA
- };
- void pcd_event_schedule(unsigned int now, enum pcd_event event, int after)
- {
- unsigned int when;
- when = now + after;
- if (when == 0) {
- // event cancelled
- pcd_event_times[event] = 0;
- return;
- }
- when |= 1;
- elprintf(EL_CD, "cd: new event #%u %u->%u", event, now, when);
- pcd_event_times[event] = when;
- if (event_time_next == 0 || CYCLES_GT(event_time_next, when))
- event_time_next = when;
- }
- void pcd_event_schedule_s68k(enum pcd_event event, int after)
- {
- if (SekCyclesLeftS68k > after)
- SekEndRunS68k(after);
- pcd_event_schedule(SekCyclesDoneS68k(), event, after);
- }
- static void pcd_run_events(unsigned int until)
- {
- int oldest, oldest_diff, time;
- int i, diff;
- while (1) {
- oldest = -1, oldest_diff = 0x7fffffff;
- for (i = 0; i < PCD_EVENT_COUNT; i++) {
- if (pcd_event_times[i]) {
- diff = pcd_event_times[i] - until;
- if (diff < oldest_diff) {
- oldest_diff = diff;
- oldest = i;
- }
- }
- }
- if (oldest_diff <= 0) {
- time = pcd_event_times[oldest];
- pcd_event_times[oldest] = 0;
- elprintf(EL_CD, "cd: run event #%d %u", oldest, time);
- pcd_event_cbs[oldest](time);
- }
- else if (oldest_diff < 0x7fffffff) {
- event_time_next = pcd_event_times[oldest];
- break;
- }
- else {
- event_time_next = 0;
- break;
- }
- }
- if (oldest != -1)
- elprintf(EL_CD, "cd: next event #%d at %u",
- oldest, event_time_next);
- }
- void pcd_irq_s68k(int irq, int state)
- {
- if (state) {
- SekInterruptS68k(irq);
- SekSetStopS68k(0);
- Pico_mcd->m.s68k_poll_a = 0;
- } else
- SekInterruptClearS68k(irq);
- }
- int pcd_sync_s68k(unsigned int m68k_target, int m68k_poll_sync)
- {
- #define now SekCycleCntS68k
- unsigned int s68k_target;
- unsigned int target;
- target = m68k_target - mcd_m68k_cycle_base;
- s68k_target = mcd_s68k_cycle_base +
- ((unsigned long long)target * mcd_m68k_cycle_mult >> 16);
- elprintf(EL_CD, "s68k sync to %u, %u->%u",
- m68k_target, now, s68k_target);
- if (Pico_mcd->m.busreq != 1) { /* busreq/reset */
- SekCycleCntS68k = SekCycleAimS68k = s68k_target;
- pcd_run_events(s68k_target);
- return 0;
- }
- while (CYCLES_GT(s68k_target, now)) {
- if (event_time_next && CYCLES_GE(now, event_time_next))
- pcd_run_events(now);
- target = s68k_target;
- if (event_time_next && CYCLES_GT(target, event_time_next))
- target = event_time_next;
- if (SekIsStoppedS68k())
- SekCycleCntS68k = SekCycleAimS68k = target;
- else
- SekRunS68k(target);
- if (m68k_poll_sync && Pico_mcd->m.m68k_poll_cnt == 0)
- break;
- }
- return s68k_target - now;
- #undef now
- }
- #define pcd_run_cpus_normal pcd_run_cpus
- //#define pcd_run_cpus_lockstep pcd_run_cpus
- static void SekSyncM68k(void);
- void pcd_run_cpus_normal(int m68k_cycles)
- {
- Pico.t.m68c_aim += m68k_cycles;
- while (CYCLES_GT(Pico.t.m68c_aim, Pico.t.m68c_cnt)) {
- if (SekShouldInterrupt())
- Pico_mcd->m.m68k_poll_cnt = 0;
- #ifdef USE_POLL_DETECT
- if (Pico_mcd->m.m68k_poll_cnt >= 16) {
- // main CPU is polling, (wake and) run sub only
- SekSetStopS68k(0);
- pcd_sync_s68k(Pico.t.m68c_aim, 1);
- Pico.t.m68c_cnt = Pico.t.m68c_aim;
- if (SekIsStoppedS68k()) {
- // slave has stopped, wake master to avoid lockups
- Pico_mcd->m.m68k_poll_cnt = 0;
- }
- elprintf(EL_CDPOLL, "m68k poll [%02x] x%d @%06x",
- Pico_mcd->m.m68k_poll_a, Pico_mcd->m.m68k_poll_cnt, SekPc);
- }
- #endif
- SekRunM68kOnce();
- if (Pico_mcd->m.need_sync) {
- Pico_mcd->m.need_sync = 0;
- pcd_sync_s68k(Pico.t.m68c_cnt, 0);
- }
- }
- }
- void pcd_run_cpus_lockstep(int m68k_cycles)
- {
- unsigned int target = Pico.t.m68c_aim + m68k_cycles;
- do {
- Pico.t.m68c_aim += 8;
- SekSyncM68k();
- pcd_sync_s68k(Pico.t.m68c_aim, 0);
- } while (CYCLES_GT(target, Pico.t.m68c_aim));
- Pico.t.m68c_aim = target;
- }
- #define PICO_CD
- #define CPUS_RUN(m68k_cycles) \
- pcd_run_cpus(m68k_cycles)
- #include "../pico_cmn.c"
- void pcd_prepare_frame(void)
- {
- pcd_set_cycle_mult();
- // need this because we can't have direct mapping between
- // master<->slave cycle counters because of overflows
- mcd_m68k_cycle_base = Pico.t.m68c_aim;
- mcd_s68k_cycle_base = SekCycleAimS68k;
- }
- PICO_INTERNAL void PicoFrameMCD(void)
- {
- PicoFrameStart();
- pcd_prepare_frame();
- PicoFrameHints();
- }
- void pcd_state_loaded(void)
- {
- unsigned int cycles;
- int diff;
- pcd_set_cycle_mult();
- pcd_state_loaded_mem();
- memset(Pico_mcd->pcm_mixbuf, 0, sizeof(Pico_mcd->pcm_mixbuf));
- Pico_mcd->pcm_mixbuf_dirty = 0;
- Pico_mcd->pcm_mixpos = 0;
- Pico_mcd->pcm_regs_dirty = 1;
- // old savestates..
- cycles = pcd_cycles_m68k_to_s68k(Pico.t.m68c_aim);
- diff = cycles - SekCycleAimS68k;
- if (diff < -1000 || diff > 1000) {
- SekCycleCntS68k = SekCycleAimS68k = cycles;
- }
- if (pcd_event_times[PCD_EVENT_CDC] == 0) {
- pcd_event_schedule(SekCycleAimS68k, PCD_EVENT_CDC, 12500000/75);
- if (Pico_mcd->s68k_regs[0x31])
- pcd_event_schedule(SekCycleAimS68k, PCD_EVENT_TIMER3,
- Pico_mcd->s68k_regs[0x31] * 384);
- }
- diff = cycles - Pico_mcd->pcm.update_cycles;
- if ((unsigned int)diff > 12500000/50)
- Pico_mcd->pcm.update_cycles = cycles;
- // reschedule
- event_time_next = 0;
- pcd_run_events(SekCycleCntS68k);
- }
- // vim:shiftwidth=2:ts=2:expandtab
|