famec: eliminate global context ptr
[picodrive.git] / pico / cd / mcd.c
... / ...
CommitLineData
1/*
2 * PicoDrive
3 * (C) notaz, 2007,2013
4 *
5 * This work is licensed under the terms of MAME license.
6 * See COPYING file in the top-level directory.
7 */
8
9#include "../pico_int.h"
10#include "../sound/ym2612.h"
11
12extern unsigned char formatted_bram[4*0x10];
13
14static unsigned int mcd_m68k_cycle_mult;
15static unsigned int mcd_m68k_cycle_base;
16static unsigned int mcd_s68k_cycle_base;
17
18void (*PicoMCDopenTray)(void) = NULL;
19void (*PicoMCDcloseTray)(void) = NULL;
20
21
22PICO_INTERNAL void PicoInitMCD(void)
23{
24 SekInitS68k();
25}
26
27PICO_INTERNAL void PicoExitMCD(void)
28{
29}
30
31PICO_INTERNAL void PicoPowerMCD(void)
32{
33 int fmt_size;
34
35 SekCycleCntS68k = SekCycleAimS68k = 0;
36
37 fmt_size = sizeof(formatted_bram);
38 memset(Pico_mcd->prg_ram, 0, sizeof(Pico_mcd->prg_ram));
39 memset(Pico_mcd->word_ram2M, 0, sizeof(Pico_mcd->word_ram2M));
40 memset(Pico_mcd->pcm_ram, 0, sizeof(Pico_mcd->pcm_ram));
41 memset(Pico_mcd->bram, 0, sizeof(Pico_mcd->bram));
42 memcpy(Pico_mcd->bram + sizeof(Pico_mcd->bram) - fmt_size,
43 formatted_bram, fmt_size);
44 memset(Pico_mcd->s68k_regs, 0, sizeof(Pico_mcd->s68k_regs));
45 memset(&Pico_mcd->pcm, 0, sizeof(Pico_mcd->pcm));
46 memset(&Pico_mcd->m, 0, sizeof(Pico_mcd->m));
47
48 cdc_init();
49 gfx_init();
50
51 // cold reset state (tested)
52 Pico_mcd->m.state_flags = PCD_ST_S68K_RST;
53 Pico_mcd->m.busreq = 2; // busreq on, s68k in reset
54 Pico_mcd->s68k_regs[3] = 1; // 2M word RAM mode, m68k access
55 memset(Pico_mcd->bios + 0x70, 0xff, 4);
56}
57
58void pcd_soft_reset(void)
59{
60 elprintf(EL_CD, "cd: soft reset");
61
62 Pico_mcd->m.s68k_pend_ints = 0;
63 cdc_reset();
64 cdd_reset();
65#ifdef _ASM_CD_MEMORY_C
66 //PicoMemResetCDdecode(1); // don't have to call this in 2M mode
67#endif
68
69 memset(&Pico_mcd->s68k_regs[0x38], 0, 9);
70 Pico_mcd->s68k_regs[0x38+9] = 0x0f; // default checksum
71
72 pcd_event_schedule_s68k(PCD_EVENT_CDC, 12500000/75);
73
74 // TODO: test if register state/timers change
75}
76
77PICO_INTERNAL int PicoResetMCD(void)
78{
79 // reset button doesn't affect MCD hardware
80
81 // use Pico.sv.data for RAM cart
82 if (PicoOpt & POPT_EN_MCD_RAMCART) {
83 if (Pico.sv.data == NULL)
84 Pico.sv.data = calloc(1, 0x12000);
85 }
86 else if (Pico.sv.data != NULL) {
87 free(Pico.sv.data);
88 Pico.sv.data = NULL;
89 }
90 Pico.sv.start = Pico.sv.end = 0; // unused
91
92 return 0;
93}
94
95static void SekRunM68kOnce(void)
96{
97 int cyc_do;
98 pevt_log_m68k_o(EVT_RUN_START);
99
100 if ((cyc_do = Pico.t.m68c_aim - Pico.t.m68c_cnt) > 0) {
101 Pico.t.m68c_cnt += cyc_do;
102
103#if defined(EMU_C68K)
104 PicoCpuCM68k.cycles = cyc_do;
105 CycloneRun(&PicoCpuCM68k);
106 Pico.t.m68c_cnt -= PicoCpuCM68k.cycles;
107#elif defined(EMU_M68K)
108 Pico.t.m68c_cnt += m68k_execute(cyc_do) - cyc_do;
109#elif defined(EMU_F68K)
110 Pico.t.m68c_cnt += fm68k_emulate(&PicoCpuFM68k, cyc_do, 0) - cyc_do;
111#endif
112 }
113
114 SekCyclesLeft = 0;
115
116 SekTrace(0);
117 pevt_log_m68k_o(EVT_RUN_END);
118}
119
120static void SekRunS68k(unsigned int to)
121{
122 int cyc_do;
123
124 SekCycleAimS68k = to;
125 if ((cyc_do = SekCycleAimS68k - SekCycleCntS68k) <= 0)
126 return;
127
128 if (SekShouldInterrupt())
129 Pico_mcd->m.s68k_poll_a = 0;
130
131 SekCycleCntS68k += cyc_do;
132#if defined(EMU_C68K)
133 PicoCpuCS68k.cycles = cyc_do;
134 CycloneRun(&PicoCpuCS68k);
135 SekCycleCntS68k -= PicoCpuCS68k.cycles;
136#elif defined(EMU_M68K)
137 m68k_set_context(&PicoCpuMS68k);
138 SekCycleCntS68k += m68k_execute(cyc_do) - cyc_do;
139 m68k_set_context(&PicoCpuMM68k);
140#elif defined(EMU_F68K)
141 SekCycleCntS68k += fm68k_emulate(&PicoCpuFS68k, cyc_do, 0) - cyc_do;
142#endif
143}
144
145static void pcd_set_cycle_mult(void)
146{
147 // ~1.63 for NTSC, ~1.645 for PAL
148 if (Pico.m.pal)
149 mcd_m68k_cycle_mult = ((12500000ull << 16) / (50*313*488));
150 else
151 mcd_m68k_cycle_mult = ((12500000ull << 16) / (60*262*488)) + 1;
152}
153
154unsigned int pcd_cycles_m68k_to_s68k(unsigned int c)
155{
156 return (long long)c * mcd_m68k_cycle_mult >> 16;
157}
158
159/* events */
160static void pcd_cdc_event(unsigned int now)
161{
162 // 75Hz CDC update
163 cdd_update();
164
165 /* check if a new CDD command has been processed */
166 if (!(Pico_mcd->s68k_regs[0x4b] & 0xf0))
167 {
168 /* reset CDD command wait flag */
169 Pico_mcd->s68k_regs[0x4b] = 0xf0;
170
171 if (Pico_mcd->s68k_regs[0x33] & PCDS_IEN4) {
172 elprintf(EL_INTS|EL_CD, "s68k: cdd irq 4");
173 SekInterruptS68k(4);
174 }
175 }
176
177 pcd_event_schedule(now, PCD_EVENT_CDC, 12500000/75);
178}
179
180static void pcd_int3_timer_event(unsigned int now)
181{
182 if (Pico_mcd->s68k_regs[0x33] & PCDS_IEN3) {
183 elprintf(EL_INTS|EL_CD, "s68k: timer irq 3");
184 SekInterruptS68k(3);
185 }
186
187 if (Pico_mcd->s68k_regs[0x31] != 0)
188 pcd_event_schedule(now, PCD_EVENT_TIMER3,
189 Pico_mcd->s68k_regs[0x31] * 384);
190}
191
192static void pcd_dma_event(unsigned int now)
193{
194 cdc_dma_update();
195}
196
197typedef void (event_cb)(unsigned int now);
198
199/* times are in s68k (12.5MHz) cycles */
200unsigned int pcd_event_times[PCD_EVENT_COUNT];
201static unsigned int event_time_next;
202static event_cb *pcd_event_cbs[PCD_EVENT_COUNT] = {
203 pcd_cdc_event, // PCD_EVENT_CDC
204 pcd_int3_timer_event, // PCD_EVENT_TIMER3
205 gfx_update, // PCD_EVENT_GFX
206 pcd_dma_event, // PCD_EVENT_DMA
207};
208
209void pcd_event_schedule(unsigned int now, enum pcd_event event, int after)
210{
211 unsigned int when;
212
213 when = now + after;
214 if (when == 0) {
215 // event cancelled
216 pcd_event_times[event] = 0;
217 return;
218 }
219
220 when |= 1;
221
222 elprintf(EL_CD, "cd: new event #%u %u->%u", event, now, when);
223 pcd_event_times[event] = when;
224
225 if (event_time_next == 0 || CYCLES_GT(event_time_next, when))
226 event_time_next = when;
227}
228
229void pcd_event_schedule_s68k(enum pcd_event event, int after)
230{
231 if (SekCyclesLeftS68k > after)
232 SekEndRunS68k(after);
233
234 pcd_event_schedule(SekCyclesDoneS68k(), event, after);
235}
236
237static void pcd_run_events(unsigned int until)
238{
239 int oldest, oldest_diff, time;
240 int i, diff;
241
242 while (1) {
243 oldest = -1, oldest_diff = 0x7fffffff;
244
245 for (i = 0; i < PCD_EVENT_COUNT; i++) {
246 if (pcd_event_times[i]) {
247 diff = pcd_event_times[i] - until;
248 if (diff < oldest_diff) {
249 oldest_diff = diff;
250 oldest = i;
251 }
252 }
253 }
254
255 if (oldest_diff <= 0) {
256 time = pcd_event_times[oldest];
257 pcd_event_times[oldest] = 0;
258 elprintf(EL_CD, "cd: run event #%d %u", oldest, time);
259 pcd_event_cbs[oldest](time);
260 }
261 else if (oldest_diff < 0x7fffffff) {
262 event_time_next = pcd_event_times[oldest];
263 break;
264 }
265 else {
266 event_time_next = 0;
267 break;
268 }
269 }
270
271 if (oldest != -1)
272 elprintf(EL_CD, "cd: next event #%d at %u",
273 oldest, event_time_next);
274}
275
276int pcd_sync_s68k(unsigned int m68k_target, int m68k_poll_sync)
277{
278 #define now SekCycleCntS68k
279 unsigned int s68k_target;
280 unsigned int target;
281
282 target = m68k_target - mcd_m68k_cycle_base;
283 s68k_target = mcd_s68k_cycle_base +
284 ((unsigned long long)target * mcd_m68k_cycle_mult >> 16);
285
286 elprintf(EL_CD, "s68k sync to %u, %u->%u",
287 m68k_target, now, s68k_target);
288
289 if (Pico_mcd->m.busreq != 1) { /* busreq/reset */
290 SekCycleCntS68k = SekCycleAimS68k = s68k_target;
291 pcd_run_events(m68k_target);
292 return 0;
293 }
294
295 while (CYCLES_GT(s68k_target, now)) {
296 if (event_time_next && CYCLES_GE(now, event_time_next))
297 pcd_run_events(now);
298
299 target = s68k_target;
300 if (event_time_next && CYCLES_GT(target, event_time_next))
301 target = event_time_next;
302
303 SekRunS68k(target);
304 if (m68k_poll_sync && Pico_mcd->m.m68k_poll_cnt == 0)
305 break;
306 }
307
308 return s68k_target - now;
309 #undef now
310}
311
312#define pcd_run_cpus_normal pcd_run_cpus
313//#define pcd_run_cpus_lockstep pcd_run_cpus
314
315static void SekSyncM68k(void);
316
317void pcd_run_cpus_normal(int m68k_cycles)
318{
319 Pico.t.m68c_aim += m68k_cycles;
320 if (SekShouldInterrupt() || Pico_mcd->m.m68k_poll_cnt < 12)
321 Pico_mcd->m.m68k_poll_cnt = 0;
322 else if (Pico_mcd->m.m68k_poll_cnt >= 16) {
323 int s68k_left = pcd_sync_s68k(Pico.t.m68c_aim, 1);
324 if (s68k_left <= 0) {
325 elprintf(EL_CDPOLL, "m68k poll [%02x] x%d @%06x",
326 Pico_mcd->m.m68k_poll_a, Pico_mcd->m.m68k_poll_cnt, SekPc);
327 Pico.t.m68c_cnt = Pico.t.m68c_aim;
328 return;
329 }
330 Pico.t.m68c_cnt = Pico.t.m68c_aim - (s68k_left * 40220 >> 16);
331 }
332
333 while (CYCLES_GT(Pico.t.m68c_aim, Pico.t.m68c_cnt)) {
334 SekRunM68kOnce();
335 if (Pico_mcd->m.need_sync) {
336 Pico_mcd->m.need_sync = 0;
337 pcd_sync_s68k(Pico.t.m68c_cnt, 0);
338 }
339 }
340}
341
342void pcd_run_cpus_lockstep(int m68k_cycles)
343{
344 unsigned int target = Pico.t.m68c_aim + m68k_cycles;
345 do {
346 Pico.t.m68c_aim += 8;
347 SekSyncM68k();
348 pcd_sync_s68k(Pico.t.m68c_aim, 0);
349 } while (CYCLES_GT(target, Pico.t.m68c_aim));
350
351 Pico.t.m68c_aim = target;
352}
353
354#define PICO_CD
355#define CPUS_RUN(m68k_cycles) \
356 pcd_run_cpus(m68k_cycles)
357
358#include "../pico_cmn.c"
359
360
361void pcd_prepare_frame(void)
362{
363 pcd_set_cycle_mult();
364
365 // need this because we can't have direct mapping between
366 // master<->slave cycle counters because of overflows
367 mcd_m68k_cycle_base = Pico.t.m68c_aim;
368 mcd_s68k_cycle_base = SekCycleAimS68k;
369}
370
371PICO_INTERNAL void PicoFrameMCD(void)
372{
373 PicoFrameStart();
374
375 pcd_prepare_frame();
376 PicoFrameHints();
377}
378
379void pcd_state_loaded(void)
380{
381 unsigned int cycles;
382 int diff;
383
384 pcd_set_cycle_mult();
385 pcd_state_loaded_mem();
386
387 memset(Pico_mcd->pcm_mixbuf, 0, sizeof(Pico_mcd->pcm_mixbuf));
388 Pico_mcd->pcm_mixbuf_dirty = 0;
389 Pico_mcd->pcm_mixpos = 0;
390 Pico_mcd->pcm_regs_dirty = 1;
391
392 // old savestates..
393 cycles = pcd_cycles_m68k_to_s68k(Pico.t.m68c_aim);
394 diff = cycles - SekCycleAimS68k;
395 if (diff < -1000 || diff > 1000) {
396 SekCycleCntS68k = SekCycleAimS68k = cycles;
397 }
398 if (pcd_event_times[PCD_EVENT_CDC] == 0) {
399 pcd_event_schedule(SekCycleAimS68k, PCD_EVENT_CDC, 12500000/75);
400
401 if (Pico_mcd->s68k_regs[0x31])
402 pcd_event_schedule(SekCycleAimS68k, PCD_EVENT_TIMER3,
403 Pico_mcd->s68k_regs[0x31] * 384);
404 }
405
406 diff = cycles - Pico_mcd->pcm.update_cycles;
407 if ((unsigned int)diff > 12500000/50)
408 Pico_mcd->pcm.update_cycles = cycles;
409
410 // reschedule
411 event_time_next = 0;
412 pcd_run_events(SekCycleCntS68k);
413}
414
415// vim:shiftwidth=2:ts=2:expandtab