cd sync improvements
[picodrive.git] / pico / cd / memory.c
1 /*\r
2  * Memory I/O handlers for Sega/Mega CD.\r
3  * (C) notaz, 2007-2009\r
4  *\r
5  * This work is licensed under the terms of MAME license.\r
6  * See COPYING file in the top-level directory.\r
7  */\r
8 \r
9 #include "../pico_int.h"\r
10 #include "../memory.h"\r
11 \r
12 #include "gfx_cd.h"\r
13 #include "pcm.h"\r
14 \r
15 uptr s68k_read8_map  [0x1000000 >> M68K_MEM_SHIFT];\r
16 uptr s68k_read16_map [0x1000000 >> M68K_MEM_SHIFT];\r
17 uptr s68k_write8_map [0x1000000 >> M68K_MEM_SHIFT];\r
18 uptr s68k_write16_map[0x1000000 >> M68K_MEM_SHIFT];\r
19 \r
20 MAKE_68K_READ8(s68k_read8, s68k_read8_map)\r
21 MAKE_68K_READ16(s68k_read16, s68k_read16_map)\r
22 MAKE_68K_READ32(s68k_read32, s68k_read16_map)\r
23 MAKE_68K_WRITE8(s68k_write8, s68k_write8_map)\r
24 MAKE_68K_WRITE16(s68k_write16, s68k_write16_map)\r
25 MAKE_68K_WRITE32(s68k_write32, s68k_write16_map)\r
26 \r
27 // -----------------------------------------------------------------\r
28 \r
29 // provided by ASM code:\r
30 #ifdef _ASM_CD_MEMORY_C\r
31 u32 PicoReadM68k8_io(u32 a);\r
32 u32 PicoReadM68k16_io(u32 a);\r
33 void PicoWriteM68k8_io(u32 a, u32 d);\r
34 void PicoWriteM68k16_io(u32 a, u32 d);\r
35 \r
36 u32 PicoReadS68k8_pr(u32 a);\r
37 u32 PicoReadS68k16_pr(u32 a);\r
38 void PicoWriteS68k8_pr(u32 a, u32 d);\r
39 void PicoWriteS68k16_pr(u32 a, u32 d);\r
40 \r
41 u32 PicoReadM68k8_cell0(u32 a);\r
42 u32 PicoReadM68k8_cell1(u32 a);\r
43 u32 PicoReadM68k16_cell0(u32 a);\r
44 u32 PicoReadM68k16_cell1(u32 a);\r
45 void PicoWriteM68k8_cell0(u32 a, u32 d);\r
46 void PicoWriteM68k8_cell1(u32 a, u32 d);\r
47 void PicoWriteM68k16_cell0(u32 a, u32 d);\r
48 void PicoWriteM68k16_cell1(u32 a, u32 d);\r
49 \r
50 u32 PicoReadS68k8_dec0(u32 a);\r
51 u32 PicoReadS68k8_dec1(u32 a);\r
52 u32 PicoReadS68k16_dec0(u32 a);\r
53 u32 PicoReadS68k16_dec1(u32 a);\r
54 void PicoWriteS68k8_dec_m0b0(u32 a, u32 d);\r
55 void PicoWriteS68k8_dec_m1b0(u32 a, u32 d);\r
56 void PicoWriteS68k8_dec_m2b0(u32 a, u32 d);\r
57 void PicoWriteS68k8_dec_m0b1(u32 a, u32 d);\r
58 void PicoWriteS68k8_dec_m1b1(u32 a, u32 d);\r
59 void PicoWriteS68k8_dec_m2b1(u32 a, u32 d);\r
60 void PicoWriteS68k16_dec_m0b0(u32 a, u32 d);\r
61 void PicoWriteS68k16_dec_m1b0(u32 a, u32 d);\r
62 void PicoWriteS68k16_dec_m2b0(u32 a, u32 d);\r
63 void PicoWriteS68k16_dec_m0b1(u32 a, u32 d);\r
64 void PicoWriteS68k16_dec_m1b1(u32 a, u32 d);\r
65 void PicoWriteS68k16_dec_m2b1(u32 a, u32 d);\r
66 #endif\r
67 \r
68 static void remap_prg_window(void);\r
69 static void remap_word_ram(int r3);\r
70 \r
71 // poller detection\r
72 #define POLL_LIMIT 16\r
73 #define POLL_CYCLES 124\r
74 unsigned int s68k_poll_adclk, s68k_poll_cnt;\r
75 \r
76 void m68k_comm_check(u32 a)\r
77 {\r
78   pcd_sync_s68k(SekCyclesDone());\r
79   /*if (Pico_mcd->m.m68k_comm_dirty & (1 << a/2)) {\r
80     Pico_mcd->m.m68k_comm_dirty &= ~(1 << a/2);\r
81     Pico_mcd->m.m68k_poll_a = Pico_mcd->m.m68k_poll_cnt = 0;\r
82     return;\r
83   }\r
84   if (a != Pico_mcd->m.m68k_poll_a) {\r
85     Pico_mcd->m.m68k_poll_a = a;\r
86     Pico_mcd->m.m68k_poll_cnt = 0;\r
87     return;\r
88   }\r
89   if (++Pico_mcd->m.m68k_poll_cnt > 5)\r
90     SekCyclesBurnRun(122);\r
91 \r
92   elprintf(EL_CDPOLL, "m68k poll [%02x] %d %u", a,\r
93     Pico_mcd->m.m68k_poll_cnt, SekCyclesDone());*/\r
94 }\r
95 \r
96 #ifndef _ASM_CD_MEMORY_C\r
97 static u32 m68k_reg_read16(u32 a)\r
98 {\r
99   u32 d=0;\r
100   a &= 0x3e;\r
101 \r
102   switch (a) {\r
103     case 0:\r
104       d = ((Pico_mcd->s68k_regs[0x33]<<13)&0x8000) | Pico_mcd->m.busreq; // here IFL2 is always 0, just like in Gens\r
105       goto end;\r
106     case 2:\r
107       m68k_comm_check(a);\r
108       d = (Pico_mcd->s68k_regs[a]<<8) | (Pico_mcd->s68k_regs[a+1]&0xc7);\r
109       elprintf(EL_CDREG3, "m68k_regs r3: %02x @%06x", (u8)d, SekPc);\r
110       goto end;\r
111     case 4:\r
112       d = Pico_mcd->s68k_regs[4]<<8;\r
113       goto end;\r
114     case 6:\r
115       d = *(u16 *)(Pico_mcd->bios + 0x72);\r
116       goto end;\r
117     case 8:\r
118       d = Read_CDC_Host(0);\r
119       goto end;\r
120     case 0xA:\r
121       elprintf(EL_UIO, "m68k FIXME: reserved read");\r
122       goto end;\r
123     case 0xC: // 384 cycle stopwatch timer\r
124       // ugh..\r
125       d = pcd_cycles_m68k_to_s68k(SekCyclesDone());\r
126       d = (d - Pico_mcd->m.stopwatch_base_c) / 384;\r
127       d &= 0x0fff;\r
128       elprintf(EL_CDREGS, "m68k stopwatch timer read (%04x)", d);\r
129       goto end;\r
130   }\r
131 \r
132   if (a < 0x30) {\r
133     // comm flag/cmd/status (0xE-0x2F)\r
134     m68k_comm_check(a);\r
135     d = (Pico_mcd->s68k_regs[a]<<8) | Pico_mcd->s68k_regs[a+1];\r
136     goto end;\r
137   }\r
138 \r
139   elprintf(EL_UIO, "m68k_regs FIXME invalid read @ %02x", a);\r
140 \r
141 end:\r
142 \r
143   return d;\r
144 }\r
145 #endif\r
146 \r
147 #ifndef _ASM_CD_MEMORY_C\r
148 static\r
149 #endif\r
150 void m68k_reg_write8(u32 a, u32 d)\r
151 {\r
152   u32 dold;\r
153   a &= 0x3f;\r
154 \r
155   Pico_mcd->m.m68k_poll_a = 0;\r
156 \r
157   switch (a) {\r
158     case 0:\r
159       d &= 1;\r
160       if ((d&1) && (Pico_mcd->s68k_regs[0x33]&(1<<2))) { elprintf(EL_INTS, "m68k: s68k irq 2"); SekInterruptS68k(2); }\r
161       return;\r
162     case 1:\r
163       d &= 3;\r
164           elprintf(EL_CDREGS, "d m.busreq %u %u", d, Pico_mcd->m.busreq);\r
165       if (d == Pico_mcd->m.busreq)\r
166         return;\r
167       pcd_sync_s68k(SekCyclesDone());\r
168 \r
169       if ((Pico_mcd->m.busreq ^ d) & 1) {\r
170         elprintf(EL_INTSW, "m68k: s68k reset %i", !(d&1));\r
171         if (!(d & 1))\r
172           d |= 2; // verified: reset also gives bus\r
173         else {\r
174           elprintf(EL_CDREGS, "m68k: resetting s68k");\r
175           SekResetS68k();\r
176         }\r
177       }\r
178       if ((Pico_mcd->m.busreq ^ d) & 2) {\r
179         elprintf(EL_INTSW, "m68k: s68k brq %i", d >> 1);\r
180         remap_prg_window();\r
181       }\r
182       Pico_mcd->m.busreq = d;\r
183       return;\r
184     case 2:\r
185       elprintf(EL_CDREGS, "m68k: prg wp=%02x", d);\r
186       Pico_mcd->s68k_regs[2] = d; // really use s68k side register\r
187       return;\r
188     case 3:\r
189       dold = Pico_mcd->s68k_regs[3];\r
190       elprintf(EL_CDREG3, "m68k_regs w3: %02x @%06x", (u8)d, SekPc);\r
191       //if ((Pico_mcd->s68k_regs[3]&4) != (d&4)) dprintf("m68k: ram mode %i mbit", (d&4) ? 1 : 2);\r
192       //if ((Pico_mcd->s68k_regs[3]&2) != (d&2)) dprintf("m68k: %s", (d&4) ? ((d&2) ? "word swap req" : "noop?") :\r
193       //                                             ((d&2) ? "word ram to s68k" : "word ram to m68k"));\r
194       if (dold & 4) {   // 1M mode\r
195         d ^= 2;         // writing 0 to DMNA actually sets it, 1 does nothing\r
196       } else {\r
197         if ((d ^ dold) & d & 2) { // DMNA is being set\r
198           dold &= ~1;   // return word RAM to s68k\r
199           /* Silpheed hack: bset(w3), r3, btst, bne, r3 */\r
200           SekEndRun(20+16+10+12+16);\r
201         }\r
202       }\r
203       Pico_mcd->s68k_regs[3] = (d & 0xc2) | (dold & 0x1f);\r
204       if ((d ^ dold) & 0xc0) {\r
205         elprintf(EL_CDREGS, "m68k: prg bank: %i -> %i", (Pico_mcd->s68k_regs[a]>>6), ((d>>6)&3));\r
206         remap_prg_window();\r
207       }\r
208 #ifdef USE_POLL_DETECT\r
209       if ((s68k_poll_adclk&0xfe) == 2 && s68k_poll_cnt > POLL_LIMIT) {\r
210         SekSetStopS68k(0); s68k_poll_adclk = 0;\r
211         elprintf(EL_CDPOLL, "s68k poll release, a=%02x", a);\r
212       }\r
213 #endif\r
214       return;\r
215     case 6:\r
216       Pico_mcd->bios[0x72 + 1] = d; // simple hint vector changer\r
217       return;\r
218     case 7:\r
219       Pico_mcd->bios[0x72] = d;\r
220       elprintf(EL_CDREGS, "hint vector set to %04x%04x",\r
221         ((u16 *)Pico_mcd->bios)[0x70/2], ((u16 *)Pico_mcd->bios)[0x72/2]);\r
222       return;\r
223     case 0xf:\r
224       d = (d << 1) | ((d >> 7) & 1); // rol8 1 (special case)\r
225     case 0xe:\r
226       if (d != Pico_mcd->s68k_regs[0xe]) {\r
227         pcd_sync_s68k(SekCyclesDone());\r
228         Pico_mcd->s68k_regs[0xe] = d;\r
229       }\r
230 #ifdef USE_POLL_DETECT\r
231       if ((s68k_poll_adclk&0xfe) == 0xe && s68k_poll_cnt > POLL_LIMIT) {\r
232         SekSetStopS68k(0); s68k_poll_adclk = 0;\r
233         elprintf(EL_CDPOLL, "s68k poll release, a=%02x", a);\r
234       }\r
235 #endif\r
236       return;\r
237   }\r
238 \r
239   if ((a&0xf0) == 0x10) {\r
240       Pico_mcd->s68k_regs[a] = d;\r
241 #ifdef USE_POLL_DETECT\r
242       if ((a&0xfe) == (s68k_poll_adclk&0xfe) && s68k_poll_cnt > POLL_LIMIT) {\r
243         SekSetStopS68k(0); s68k_poll_adclk = 0;\r
244         elprintf(EL_CDPOLL, "s68k poll release, a=%02x", a);\r
245       }\r
246 #endif\r
247       return;\r
248   }\r
249 \r
250   elprintf(EL_UIO, "m68k FIXME: invalid write? [%02x] %02x", a, d);\r
251 }\r
252 \r
253 #ifndef _ASM_CD_MEMORY_C\r
254 static\r
255 #endif\r
256 u32 s68k_poll_detect(u32 a, u32 d)\r
257 {\r
258 #ifdef USE_POLL_DETECT\r
259   // needed mostly for Cyclone, which doesn't always check it's cycle counter\r
260   if (SekIsStoppedS68k()) return d;\r
261   // polling detection\r
262   if (a == (s68k_poll_adclk&0xff)) {\r
263     unsigned int clkdiff = SekCyclesDoneS68k() - (s68k_poll_adclk>>8);\r
264     if (clkdiff <= POLL_CYCLES) {\r
265       s68k_poll_cnt++;\r
266       //printf("-- diff: %u, cnt = %i\n", clkdiff, s68k_poll_cnt);\r
267       if (s68k_poll_cnt > POLL_LIMIT) {\r
268         SekSetStopS68k(1);\r
269         elprintf(EL_CDPOLL, "s68k poll detected @ %06x, a=%02x", SekPcS68k, a);\r
270       }\r
271       s68k_poll_adclk = (SekCyclesDoneS68k() << 8) | a;\r
272       return d;\r
273     }\r
274   }\r
275   s68k_poll_adclk = (SekCyclesDoneS68k() << 8) | a;\r
276   s68k_poll_cnt = 0;\r
277 #endif\r
278   return d;\r
279 }\r
280 \r
281 #define READ_FONT_DATA(basemask) \\r
282 { \\r
283       unsigned int fnt = *(unsigned int *)(Pico_mcd->s68k_regs + 0x4c); \\r
284       unsigned int col0 = (fnt >> 8) & 0x0f, col1 = (fnt >> 12) & 0x0f;   \\r
285       if (fnt & (basemask << 0)) d  = col1      ; else d  = col0;       \\r
286       if (fnt & (basemask << 1)) d |= col1 <<  4; else d |= col0 <<  4; \\r
287       if (fnt & (basemask << 2)) d |= col1 <<  8; else d |= col0 <<  8; \\r
288       if (fnt & (basemask << 3)) d |= col1 << 12; else d |= col0 << 12; \\r
289 }\r
290 \r
291 \r
292 #ifndef _ASM_CD_MEMORY_C\r
293 static\r
294 #endif\r
295 u32 s68k_reg_read16(u32 a)\r
296 {\r
297   u32 d=0;\r
298 \r
299   switch (a) {\r
300     case 0:\r
301       return ((Pico_mcd->s68k_regs[0]&3)<<8) | 1; // ver = 0, not in reset state\r
302     case 2:\r
303       d = (Pico_mcd->s68k_regs[2]<<8) | (Pico_mcd->s68k_regs[3]&0x1f);\r
304       elprintf(EL_CDREG3, "s68k_regs r3: %02x @%06x", (u8)d, SekPcS68k);\r
305       return s68k_poll_detect(a, d);\r
306     case 6:\r
307       return CDC_Read_Reg();\r
308     case 8:\r
309       return Read_CDC_Host(1); // Gens returns 0 here on byte reads\r
310     case 0xC:\r
311       d = SekCyclesDoneS68k() - Pico_mcd->m.stopwatch_base_c;\r
312       d /= 384;\r
313       d &= 0x0fff;\r
314       elprintf(EL_CDREGS, "s68k stopwatch timer read (%04x)", d);\r
315       return d;\r
316     case 0x30:\r
317       elprintf(EL_CDREGS, "s68k int3 timer read (%02x)", Pico_mcd->s68k_regs[31]);\r
318       return Pico_mcd->s68k_regs[31];\r
319     case 0x34: // fader\r
320       return 0; // no busy bit\r
321     case 0x50: // font data (check: Lunar 2, Silpheed)\r
322       READ_FONT_DATA(0x00100000);\r
323       return d;\r
324     case 0x52:\r
325       READ_FONT_DATA(0x00010000);\r
326       return d;\r
327     case 0x54:\r
328       READ_FONT_DATA(0x10000000);\r
329       return d;\r
330     case 0x56:\r
331       READ_FONT_DATA(0x01000000);\r
332       return d;\r
333   }\r
334 \r
335   d = (Pico_mcd->s68k_regs[a]<<8) | Pico_mcd->s68k_regs[a+1];\r
336 \r
337   if (a >= 0x0e && a < 0x30)\r
338     return s68k_poll_detect(a, d);\r
339 \r
340   return d;\r
341 }\r
342 \r
343 #ifndef _ASM_CD_MEMORY_C\r
344 static\r
345 #endif\r
346 void s68k_reg_write8(u32 a, u32 d)\r
347 {\r
348   // Warning: d might have upper bits set\r
349   switch (a) {\r
350     case 2:\r
351       return; // only m68k can change WP\r
352     case 3: {\r
353       int dold = Pico_mcd->s68k_regs[3];\r
354       elprintf(EL_CDREG3, "s68k_regs w3: %02x @%06x", (u8)d, SekPcS68k);\r
355       d &= 0x1d;\r
356       d |= dold & 0xc2;\r
357       if (d & 4)\r
358       {\r
359         if ((d ^ dold) & 0x1d) {\r
360           d &= ~2; // in case of mode or bank change we clear DMNA (m68k req) bit\r
361           remap_word_ram(d);\r
362         }\r
363         if (!(dold & 4)) {\r
364           elprintf(EL_CDREG3, "wram mode 2M->1M");\r
365           wram_2M_to_1M(Pico_mcd->word_ram2M);\r
366         }\r
367       }\r
368       else\r
369       {\r
370         if (dold & 4) {\r
371           elprintf(EL_CDREG3, "wram mode 1M->2M");\r
372           if (!(d&1)) { // it didn't set the ret bit, which means it doesn't want to give WRAM to m68k\r
373             d &= ~3;\r
374             d |= (dold&1) ? 2 : 1; // then give it to the one which had bank0 in 1M mode\r
375           }\r
376           wram_1M_to_2M(Pico_mcd->word_ram2M);\r
377           remap_word_ram(d);\r
378         }\r
379         // s68k can only set RET, writing 0 has no effect\r
380         else if ((dold ^ d) & d & 1) {   // RET being set\r
381           SekEndRunS68k(20+16+10+12+16); // see DMNA case\r
382         } else\r
383           d |= dold & 1;\r
384         if (d & 1)\r
385           d &= ~2;                       // DMNA clears\r
386       }\r
387       break;\r
388     }\r
389     case 4:\r
390       elprintf(EL_CDREGS, "s68k CDC dest: %x", d&7);\r
391       Pico_mcd->s68k_regs[4] = (Pico_mcd->s68k_regs[4]&0xC0) | (d&7); // CDC mode\r
392       return;\r
393     case 5:\r
394       //dprintf("s68k CDC reg addr: %x", d&0xf);\r
395       break;\r
396     case 7:\r
397       CDC_Write_Reg(d);\r
398       return;\r
399     case 0xa:\r
400       elprintf(EL_CDREGS, "s68k set CDC dma addr");\r
401       break;\r
402     case 0xc:\r
403     case 0xd: // 384 cycle stopwatch timer\r
404       elprintf(EL_CDREGS|EL_CD, "s68k clear stopwatch (%x)", d);\r
405       // does this also reset internal 384 cycle counter?\r
406       Pico_mcd->m.stopwatch_base_c = SekCyclesDoneS68k();\r
407       return;\r
408     case 0xe:\r
409       d = (d>>1) | (d<<7); // ror8 1, Gens note: Dragons lair\r
410       break;\r
411     case 0x31: // 384 cycle int3 timer\r
412       d &= 0xff;\r
413       elprintf(EL_CDREGS|EL_CD, "s68k set int3 timer: %02x", d);\r
414       Pico_mcd->s68k_regs[a] = (u8) d;\r
415       if (d) // d or d+1??\r
416         pcd_event_schedule_s68k(PCD_EVENT_TIMER3, d * 384);\r
417       else\r
418         pcd_event_schedule(0, PCD_EVENT_TIMER3, 0);\r
419       break;\r
420     case 0x33: // IRQ mask\r
421       elprintf(EL_CDREGS|EL_CD, "s68k irq mask: %02x", d);\r
422       d &= 0x7e;\r
423       if ((d ^ Pico_mcd->s68k_regs[0x33]) & d & PCDS_IEN4) {\r
424         if (Pico_mcd->s68k_regs[0x37] & 4)\r
425           CDD_Export_Status();\r
426       }\r
427       break;\r
428     case 0x34: // fader\r
429       Pico_mcd->s68k_regs[a] = (u8) d & 0x7f;\r
430       return;\r
431     case 0x36:\r
432       return; // d/m bit is unsetable\r
433     case 0x37: {\r
434       u32 d_old = Pico_mcd->s68k_regs[0x37];\r
435       Pico_mcd->s68k_regs[0x37] = d&7;\r
436       if ((d&4) && !(d_old&4)) {\r
437         CDD_Export_Status();\r
438       }\r
439       return;\r
440     }\r
441     case 0x4b:\r
442       Pico_mcd->s68k_regs[a] = (u8) d;\r
443       CDD_Import_Command();\r
444       return;\r
445   }\r
446 \r
447   if ((a&0x1f0) == 0x10 || (a >= 0x38 && a < 0x42))\r
448   {\r
449     elprintf(EL_UIO, "s68k FIXME: invalid write @ %02x?", a);\r
450     return;\r
451   }\r
452 \r
453   if (a < 0x30)\r
454     Pico_mcd->m.m68k_comm_dirty |= (1 << a/2);\r
455 \r
456   Pico_mcd->s68k_regs[a] = (u8) d;\r
457 }\r
458 \r
459 // -----------------------------------------------------------------\r
460 //                          Main 68k\r
461 // -----------------------------------------------------------------\r
462 \r
463 #ifndef _ASM_CD_MEMORY_C\r
464 #include "cell_map.c"\r
465 \r
466 // WORD RAM, cell aranged area (220000 - 23ffff)\r
467 static u32 PicoReadM68k8_cell0(u32 a)\r
468 {\r
469   a = (a&3) | (cell_map(a >> 2) << 2); // cell arranged\r
470   return Pico_mcd->word_ram1M[0][a ^ 1];\r
471 }\r
472 \r
473 static u32 PicoReadM68k8_cell1(u32 a)\r
474 {\r
475   a = (a&3) | (cell_map(a >> 2) << 2);\r
476   return Pico_mcd->word_ram1M[1][a ^ 1];\r
477 }\r
478 \r
479 static u32 PicoReadM68k16_cell0(u32 a)\r
480 {\r
481   a = (a&2) | (cell_map(a >> 2) << 2);\r
482   return *(u16 *)(Pico_mcd->word_ram1M[0] + a);\r
483 }\r
484 \r
485 static u32 PicoReadM68k16_cell1(u32 a)\r
486 {\r
487   a = (a&2) | (cell_map(a >> 2) << 2);\r
488   return *(u16 *)(Pico_mcd->word_ram1M[1] + a);\r
489 }\r
490 \r
491 static void PicoWriteM68k8_cell0(u32 a, u32 d)\r
492 {\r
493   a = (a&3) | (cell_map(a >> 2) << 2);\r
494   Pico_mcd->word_ram1M[0][a ^ 1] = d;\r
495 }\r
496 \r
497 static void PicoWriteM68k8_cell1(u32 a, u32 d)\r
498 {\r
499   a = (a&3) | (cell_map(a >> 2) << 2);\r
500   Pico_mcd->word_ram1M[1][a ^ 1] = d;\r
501 }\r
502 \r
503 static void PicoWriteM68k16_cell0(u32 a, u32 d)\r
504 {\r
505   a = (a&3) | (cell_map(a >> 2) << 2);\r
506   *(u16 *)(Pico_mcd->word_ram1M[0] + a) = d;\r
507 }\r
508 \r
509 static void PicoWriteM68k16_cell1(u32 a, u32 d)\r
510 {\r
511   a = (a&3) | (cell_map(a >> 2) << 2);\r
512   *(u16 *)(Pico_mcd->word_ram1M[1] + a) = d;\r
513 }\r
514 #endif\r
515 \r
516 // RAM cart (40000 - 7fffff, optional)\r
517 static u32 PicoReadM68k8_ramc(u32 a)\r
518 {\r
519   u32 d = 0;\r
520   if (a == 0x400001) {\r
521     if (SRam.data != NULL)\r
522       d = 3; // 64k cart\r
523     return d;\r
524   }\r
525 \r
526   if ((a & 0xfe0000) == 0x600000) {\r
527     if (SRam.data != NULL)\r
528       d = SRam.data[((a >> 1) & 0xffff) + 0x2000];\r
529     return d;\r
530   }\r
531 \r
532   if (a == 0x7fffff)\r
533     return Pico_mcd->m.bcram_reg;\r
534 \r
535   elprintf(EL_UIO, "m68k unmapped r8  [%06x] @%06x", a, SekPc);\r
536   return d;\r
537 }\r
538 \r
539 static u32 PicoReadM68k16_ramc(u32 a)\r
540 {\r
541   elprintf(EL_ANOMALY, "ramcart r16: [%06x] @%06x", a, SekPcS68k);\r
542   return PicoReadM68k8_ramc(a + 1);\r
543 }\r
544 \r
545 static void PicoWriteM68k8_ramc(u32 a, u32 d)\r
546 {\r
547   if ((a & 0xfe0000) == 0x600000) {\r
548     if (SRam.data != NULL && (Pico_mcd->m.bcram_reg & 1)) {\r
549       SRam.data[((a>>1) & 0xffff) + 0x2000] = d;\r
550       SRam.changed = 1;\r
551     }\r
552     return;\r
553   }\r
554 \r
555   if (a == 0x7fffff) {\r
556     Pico_mcd->m.bcram_reg = d;\r
557     return;\r
558   }\r
559 \r
560   elprintf(EL_UIO, "m68k unmapped w8  [%06x]   %02x @%06x", a, d & 0xff, SekPc);\r
561 }\r
562 \r
563 static void PicoWriteM68k16_ramc(u32 a, u32 d)\r
564 {\r
565   elprintf(EL_ANOMALY, "ramcart w16: [%06x] %04x @%06x", a, d, SekPcS68k);\r
566   PicoWriteM68k8_ramc(a + 1, d);\r
567 }\r
568 \r
569 // IO/control/cd registers (a10000 - ...)\r
570 #ifndef _ASM_CD_MEMORY_C\r
571 static u32 PicoReadM68k8_io(u32 a)\r
572 {\r
573   u32 d;\r
574   if ((a & 0xff00) == 0x2000) { // a12000 - a120ff\r
575     d = m68k_reg_read16(a); // TODO: m68k_reg_read8\r
576     if (!(a & 1))\r
577       d >>= 8;\r
578     d &= 0xff;\r
579     elprintf(EL_CDREGS, "m68k_regs r8:  [%02x]   %02x @%06x", a & 0x3f, d, SekPc);\r
580     return d;\r
581   }\r
582 \r
583   // fallback to default MD handler\r
584   return PicoRead8_io(a);\r
585 }\r
586 \r
587 static u32 PicoReadM68k16_io(u32 a)\r
588 {\r
589   u32 d;\r
590   if ((a & 0xff00) == 0x2000) {\r
591     d = m68k_reg_read16(a);\r
592     elprintf(EL_CDREGS, "m68k_regs r16: [%02x] %04x @%06x", a & 0x3f, d, SekPc);\r
593     return d;\r
594   }\r
595 \r
596   return PicoRead16_io(a);\r
597 }\r
598 \r
599 static void PicoWriteM68k8_io(u32 a, u32 d)\r
600 {\r
601   if ((a & 0xff00) == 0x2000) { // a12000 - a120ff\r
602     elprintf(EL_CDREGS, "m68k_regs w8:  [%02x]   %02x @%06x", a&0x3f, d, SekPc);\r
603     m68k_reg_write8(a, d);\r
604     return;\r
605   }\r
606 \r
607   PicoWrite16_io(a, d);\r
608 }\r
609 \r
610 static void PicoWriteM68k16_io(u32 a, u32 d)\r
611 {\r
612   if ((a & 0xff00) == 0x2000) { // a12000 - a120ff\r
613     elprintf(EL_CDREGS, "m68k_regs w16: [%02x] %04x @%06x", a&0x3f, d, SekPc);\r
614 /* TODO FIXME?\r
615     if (a == 0xe) { // special case, 2 byte writes would be handled differently\r
616       Pico_mcd->s68k_regs[0xe] = d >> 8;\r
617 #ifdef USE_POLL_DETECT\r
618       if ((s68k_poll_adclk&0xfe) == 0xe && s68k_poll_cnt > POLL_LIMIT) {\r
619         SekSetStopS68k(0); s68k_poll_adclk = 0;\r
620         elprintf(EL_CDPOLL, "s68k poll release, a=%02x", a);\r
621       }\r
622 #endif\r
623       return;\r
624     }\r
625 */\r
626     m68k_reg_write8(a,     d >> 8);\r
627     m68k_reg_write8(a + 1, d & 0xff);\r
628     return;\r
629   }\r
630 \r
631   PicoWrite16_io(a, d);\r
632 }\r
633 #endif\r
634 \r
635 // -----------------------------------------------------------------\r
636 //                           Sub 68k\r
637 // -----------------------------------------------------------------\r
638 \r
639 static u32 s68k_unmapped_read8(u32 a)\r
640 {\r
641   elprintf(EL_UIO, "s68k unmapped r8  [%06x] @%06x", a, SekPc);\r
642   return 0;\r
643 }\r
644 \r
645 static u32 s68k_unmapped_read16(u32 a)\r
646 {\r
647   elprintf(EL_UIO, "s68k unmapped r16 [%06x] @%06x", a, SekPc);\r
648   return 0;\r
649 }\r
650 \r
651 static void s68k_unmapped_write8(u32 a, u32 d)\r
652 {\r
653   elprintf(EL_UIO, "s68k unmapped w8  [%06x]   %02x @%06x", a, d & 0xff, SekPc);\r
654 }\r
655 \r
656 static void s68k_unmapped_write16(u32 a, u32 d)\r
657 {\r
658   elprintf(EL_UIO, "s68k unmapped w16 [%06x] %04x @%06x", a, d & 0xffff, SekPc);\r
659 }\r
660 \r
661 // PRG RAM protected range (000000 - 00ff00)?\r
662 // XXX verify: ff00 or 1fe00 max?\r
663 static void PicoWriteS68k8_prgwp(u32 a, u32 d)\r
664 {\r
665   if (a >= (Pico_mcd->s68k_regs[2] << 8))\r
666     Pico_mcd->prg_ram[a ^ 1] = d;\r
667 }\r
668 \r
669 static void PicoWriteS68k16_prgwp(u32 a, u32 d)\r
670 {\r
671   if (a >= (Pico_mcd->s68k_regs[2] << 8))\r
672     *(u16 *)(Pico_mcd->prg_ram + a) = d;\r
673 }\r
674 \r
675 #ifndef _ASM_CD_MEMORY_C\r
676 \r
677 // decode (080000 - 0bffff, in 1M mode)\r
678 static u32 PicoReadS68k8_dec0(u32 a)\r
679 {\r
680   u32 d = Pico_mcd->word_ram1M[0][((a >> 1) ^ 1) & 0x1ffff];\r
681   if (a & 1)\r
682     d &= 0x0f;\r
683   else\r
684     d >>= 4;\r
685   return d;\r
686 }\r
687 \r
688 static u32 PicoReadS68k8_dec1(u32 a)\r
689 {\r
690   u32 d = Pico_mcd->word_ram1M[1][((a >> 1) ^ 1) & 0x1ffff];\r
691   if (a & 1)\r
692     d &= 0x0f;\r
693   else\r
694     d >>= 4;\r
695   return d;\r
696 }\r
697 \r
698 static u32 PicoReadS68k16_dec0(u32 a)\r
699 {\r
700   u32 d = Pico_mcd->word_ram1M[0][((a >> 1) ^ 1) & 0x1ffff];\r
701   d |= d << 4;\r
702   d &= ~0xf0;\r
703   return d;\r
704 }\r
705 \r
706 static u32 PicoReadS68k16_dec1(u32 a)\r
707 {\r
708   u32 d = Pico_mcd->word_ram1M[1][((a >> 1) ^ 1) & 0x1ffff];\r
709   d |= d << 4;\r
710   d &= ~0xf0;\r
711   return d;\r
712 }\r
713 \r
714 /* check: jaguar xj 220 (draws entire world using decode) */\r
715 #define mk_decode_w8(bank)                                        \\r
716 static void PicoWriteS68k8_dec_m0b##bank(u32 a, u32 d)            \\r
717 {                                                                 \\r
718   u8 *pd = &Pico_mcd->word_ram1M[bank][((a >> 1) ^ 1) & 0x1ffff]; \\r
719                                                                   \\r
720   if (!(a & 1))                                                   \\r
721     *pd = (*pd & 0x0f) | (d << 4);                                \\r
722   else                                                            \\r
723     *pd = (*pd & 0xf0) | (d & 0x0f);                              \\r
724 }                                                                 \\r
725                                                                   \\r
726 static void PicoWriteS68k8_dec_m1b##bank(u32 a, u32 d)            \\r
727 {                                                                 \\r
728   u8 *pd = &Pico_mcd->word_ram1M[bank][((a >> 1) ^ 1) & 0x1ffff]; \\r
729   u8 mask = (a & 1) ? 0x0f : 0xf0;                                \\r
730                                                                   \\r
731   if (!(*pd & mask) && (d & 0x0f)) /* underwrite */               \\r
732     PicoWriteS68k8_dec_m0b##bank(a, d);                           \\r
733 }                                                                 \\r
734                                                                   \\r
735 static void PicoWriteS68k8_dec_m2b##bank(u32 a, u32 d) /* ...and m3? */ \\r
736 {                                                                 \\r
737   if (d & 0x0f) /* overwrite */                                   \\r
738     PicoWriteS68k8_dec_m0b##bank(a, d);                           \\r
739 }\r
740 \r
741 mk_decode_w8(0)\r
742 mk_decode_w8(1)\r
743 \r
744 #define mk_decode_w16(bank)                                       \\r
745 static void PicoWriteS68k16_dec_m0b##bank(u32 a, u32 d)           \\r
746 {                                                                 \\r
747   u8 *pd = &Pico_mcd->word_ram1M[bank][((a >> 1) ^ 1) & 0x1ffff]; \\r
748                                                                   \\r
749   d &= 0x0f0f;                                                    \\r
750   *pd = d | (d >> 4);                                             \\r
751 }                                                                 \\r
752                                                                   \\r
753 static void PicoWriteS68k16_dec_m1b##bank(u32 a, u32 d)           \\r
754 {                                                                 \\r
755   u8 *pd = &Pico_mcd->word_ram1M[bank][((a >> 1) ^ 1) & 0x1ffff]; \\r
756                                                                   \\r
757   d &= 0x0f0f; /* underwrite */                                   \\r
758   if (!(*pd & 0xf0)) *pd |= d >> 4;                               \\r
759   if (!(*pd & 0x0f)) *pd |= d;                                    \\r
760 }                                                                 \\r
761                                                                   \\r
762 static void PicoWriteS68k16_dec_m2b##bank(u32 a, u32 d)           \\r
763 {                                                                 \\r
764   u8 *pd = &Pico_mcd->word_ram1M[bank][((a >> 1) ^ 1) & 0x1ffff]; \\r
765                                                                   \\r
766   d &= 0x0f0f; /* overwrite */                                    \\r
767   d |= d >> 4;                                                    \\r
768                                                                   \\r
769   if (!(d & 0xf0)) d |= *pd & 0xf0;                               \\r
770   if (!(d & 0x0f)) d |= *pd & 0x0f;                               \\r
771   *pd = d;                                                        \\r
772 }\r
773 \r
774 mk_decode_w16(0)\r
775 mk_decode_w16(1)\r
776 \r
777 #endif\r
778 \r
779 // backup RAM (fe0000 - feffff)\r
780 static u32 PicoReadS68k8_bram(u32 a)\r
781 {\r
782   return Pico_mcd->bram[(a>>1)&0x1fff];\r
783 }\r
784 \r
785 static u32 PicoReadS68k16_bram(u32 a)\r
786 {\r
787   u32 d;\r
788   elprintf(EL_ANOMALY, "FIXME: s68k_bram r16: [%06x] @%06x", a, SekPcS68k);\r
789   a = (a >> 1) & 0x1fff;\r
790   d = Pico_mcd->bram[a++];\r
791   d|= Pico_mcd->bram[a++] << 8; // probably wrong, TODO: verify\r
792   return d;\r
793 }\r
794 \r
795 static void PicoWriteS68k8_bram(u32 a, u32 d)\r
796 {\r
797   Pico_mcd->bram[(a >> 1) & 0x1fff] = d;\r
798   SRam.changed = 1;\r
799 }\r
800 \r
801 static void PicoWriteS68k16_bram(u32 a, u32 d)\r
802 {\r
803   elprintf(EL_ANOMALY, "s68k_bram w16: [%06x] %04x @%06x", a, d, SekPcS68k);\r
804   a = (a >> 1) & 0x1fff;\r
805   Pico_mcd->bram[a++] = d;\r
806   Pico_mcd->bram[a++] = d >> 8; // TODO: verify..\r
807   SRam.changed = 1;\r
808 }\r
809 \r
810 #ifndef _ASM_CD_MEMORY_C\r
811 \r
812 // PCM and registers (ff0000 - ffffff)\r
813 static u32 PicoReadS68k8_pr(u32 a)\r
814 {\r
815   u32 d = 0;\r
816 \r
817   // regs\r
818   if ((a & 0xfe00) == 0x8000) {\r
819     a &= 0x1ff;\r
820     elprintf(EL_CDREGS, "s68k_regs r8: [%02x] @ %06x", a, SekPcS68k);\r
821     if (a >= 0x0e && a < 0x30) {\r
822       d = Pico_mcd->s68k_regs[a];\r
823       s68k_poll_detect(a, d);\r
824       elprintf(EL_CDREGS, "ret = %02x", (u8)d);\r
825       return d;\r
826     }\r
827     else if (a >= 0x58 && a < 0x68)\r
828          d = gfx_cd_read(a & ~1);\r
829     else d = s68k_reg_read16(a & ~1);\r
830     if (!(a & 1))\r
831       d >>= 8;\r
832     elprintf(EL_CDREGS, "ret = %02x", (u8)d);\r
833     return d & 0xff;\r
834   }\r
835 \r
836   // PCM\r
837   // XXX: verify: probably odd addrs only?\r
838   if ((a & 0x8000) == 0x0000) {\r
839     a &= 0x7fff;\r
840     if (a >= 0x2000)\r
841       d = Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a >> 1) & 0xfff];\r
842     else if (a >= 0x20) {\r
843       a &= 0x1e;\r
844       d = Pico_mcd->pcm.ch[a>>2].addr >> PCM_STEP_SHIFT;\r
845       if (a & 2)\r
846         d >>= 8;\r
847     }\r
848     return d & 0xff;\r
849   }\r
850 \r
851   return s68k_unmapped_read8(a);\r
852 }\r
853 \r
854 static u32 PicoReadS68k16_pr(u32 a)\r
855 {\r
856   u32 d = 0;\r
857 \r
858   // regs\r
859   if ((a & 0xfe00) == 0x8000) {\r
860     a &= 0x1fe;\r
861     elprintf(EL_CDREGS, "s68k_regs r16: [%02x] @ %06x", a, SekPcS68k);\r
862     if (0x58 <= a && a < 0x68)\r
863          d = gfx_cd_read(a);\r
864     else d = s68k_reg_read16(a);\r
865     elprintf(EL_CDREGS, "ret = %04x", d);\r
866     return d;\r
867   }\r
868 \r
869   // PCM\r
870   if ((a & 0x8000) == 0x0000) {\r
871     //elprintf(EL_ANOMALY, "FIXME: s68k_pcm r16: [%06x] @%06x", a, SekPcS68k);\r
872     a &= 0x7fff;\r
873     if (a >= 0x2000)\r
874       d = Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a>>1)&0xfff];\r
875     else if (a >= 0x20) {\r
876       a &= 0x1e;\r
877       d = Pico_mcd->pcm.ch[a>>2].addr >> PCM_STEP_SHIFT;\r
878       if (a & 2) d >>= 8;\r
879     }\r
880     elprintf(EL_CDREGS, "ret = %04x", d);\r
881     return d;\r
882   }\r
883 \r
884   return s68k_unmapped_read16(a);\r
885 }\r
886 \r
887 static void PicoWriteS68k8_pr(u32 a, u32 d)\r
888 {\r
889   // regs\r
890   if ((a & 0xfe00) == 0x8000) {\r
891     a &= 0x1ff;\r
892     elprintf(EL_CDREGS, "s68k_regs w8: [%02x] %02x @ %06x", a, d, SekPcS68k);\r
893     if (0x58 <= a && a < 0x68)\r
894          gfx_cd_write16(a&~1, (d<<8)|d);\r
895     else s68k_reg_write8(a,d);\r
896     return;\r
897   }\r
898 \r
899   // PCM\r
900   if ((a & 0x8000) == 0x0000) {\r
901     a &= 0x7fff;\r
902     if (a >= 0x2000)\r
903       Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a>>1)&0xfff] = d;\r
904     else if (a < 0x12)\r
905       pcm_write(a>>1, d);\r
906     return;\r
907   }\r
908 \r
909   s68k_unmapped_write8(a, d);\r
910 }\r
911 \r
912 static void PicoWriteS68k16_pr(u32 a, u32 d)\r
913 {\r
914   // regs\r
915   if ((a & 0xfe00) == 0x8000) {\r
916     a &= 0x1fe;\r
917     elprintf(EL_CDREGS, "s68k_regs w16: [%02x] %04x @ %06x", a, d, SekPcS68k);\r
918     if (a >= 0x58 && a < 0x68)\r
919       gfx_cd_write16(a, d);\r
920     else {\r
921       if (a == 0xe) {\r
922         // special case, 2 byte writes would be handled differently\r
923         // TODO: verify\r
924         Pico_mcd->s68k_regs[0xf] = d;\r
925         return;\r
926       }\r
927       s68k_reg_write8(a,     d >> 8);\r
928       s68k_reg_write8(a + 1, d & 0xff);\r
929     }\r
930     return;\r
931   }\r
932 \r
933   // PCM\r
934   if ((a & 0x8000) == 0x0000) {\r
935     a &= 0x7fff;\r
936     if (a >= 0x2000)\r
937       Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a>>1)&0xfff] = d;\r
938     else if (a < 0x12)\r
939       pcm_write(a>>1, d & 0xff);\r
940     return;\r
941   }\r
942 \r
943   s68k_unmapped_write16(a, d);\r
944 }\r
945 \r
946 #endif\r
947 \r
948 static const void *m68k_cell_read8[]   = { PicoReadM68k8_cell0, PicoReadM68k8_cell1 };\r
949 static const void *m68k_cell_read16[]  = { PicoReadM68k16_cell0, PicoReadM68k16_cell1 };\r
950 static const void *m68k_cell_write8[]  = { PicoWriteM68k8_cell0, PicoWriteM68k8_cell1 };\r
951 static const void *m68k_cell_write16[] = { PicoWriteM68k16_cell0, PicoWriteM68k16_cell1 };\r
952 \r
953 static const void *s68k_dec_read8[]   = { PicoReadS68k8_dec0, PicoReadS68k8_dec1 };\r
954 static const void *s68k_dec_read16[]  = { PicoReadS68k16_dec0, PicoReadS68k16_dec1 };\r
955 \r
956 static const void *s68k_dec_write8[2][4] = {\r
957   { PicoWriteS68k8_dec_m0b0, PicoWriteS68k8_dec_m1b0, PicoWriteS68k8_dec_m2b0, PicoWriteS68k8_dec_m2b0 },\r
958   { PicoWriteS68k8_dec_m0b1, PicoWriteS68k8_dec_m1b1, PicoWriteS68k8_dec_m2b1, PicoWriteS68k8_dec_m2b1 },\r
959 };\r
960 \r
961 static const void *s68k_dec_write16[2][4] = {\r
962   { PicoWriteS68k16_dec_m0b0, PicoWriteS68k16_dec_m1b0, PicoWriteS68k16_dec_m2b0, PicoWriteS68k16_dec_m2b0 },\r
963   { PicoWriteS68k16_dec_m0b1, PicoWriteS68k16_dec_m1b1, PicoWriteS68k16_dec_m2b1, PicoWriteS68k16_dec_m2b1 },\r
964 };\r
965 \r
966 // -----------------------------------------------------------------\r
967 \r
968 static void remap_prg_window(void)\r
969 {\r
970   // PRG RAM\r
971   if (Pico_mcd->m.busreq & 2) {\r
972     void *bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3] >> 6];\r
973     cpu68k_map_all_ram(0x020000, 0x03ffff, bank, 0);\r
974   }\r
975   else {\r
976     m68k_map_unmap(0x020000, 0x03ffff);\r
977   }\r
978 }\r
979 \r
980 static void remap_word_ram(int r3)\r
981 {\r
982   void *bank;\r
983 \r
984   // WORD RAM\r
985   if (!(r3 & 4)) {\r
986     // 2M mode. XXX: allowing access in all cases for simplicity\r
987     bank = Pico_mcd->word_ram2M;\r
988     cpu68k_map_all_ram(0x200000, 0x23ffff, bank, 0);\r
989     cpu68k_map_all_ram(0x080000, 0x0bffff, bank, 1);\r
990     // TODO: handle 0x0c0000\r
991   }\r
992   else {\r
993     int b0 = r3 & 1;\r
994     int m = (r3 & 0x18) >> 3;\r
995     bank = Pico_mcd->word_ram1M[b0];\r
996     cpu68k_map_all_ram(0x200000, 0x21ffff, bank, 0);\r
997     bank = Pico_mcd->word_ram1M[b0 ^ 1];\r
998     cpu68k_map_all_ram(0x0c0000, 0x0effff, bank, 1);\r
999     // "cell arrange" on m68k\r
1000     cpu68k_map_set(m68k_read8_map,   0x220000, 0x23ffff, m68k_cell_read8[b0], 1);\r
1001     cpu68k_map_set(m68k_read16_map,  0x220000, 0x23ffff, m68k_cell_read16[b0], 1);\r
1002     cpu68k_map_set(m68k_write8_map,  0x220000, 0x23ffff, m68k_cell_write8[b0], 1);\r
1003     cpu68k_map_set(m68k_write16_map, 0x220000, 0x23ffff, m68k_cell_write16[b0], 1);\r
1004     // "decode format" on s68k\r
1005     cpu68k_map_set(s68k_read8_map,   0x080000, 0x0bffff, s68k_dec_read8[b0 ^ 1], 1);\r
1006     cpu68k_map_set(s68k_read16_map,  0x080000, 0x0bffff, s68k_dec_read16[b0 ^ 1], 1);\r
1007     cpu68k_map_set(s68k_write8_map,  0x080000, 0x0bffff, s68k_dec_write8[b0 ^ 1][m], 1);\r
1008     cpu68k_map_set(s68k_write16_map, 0x080000, 0x0bffff, s68k_dec_write16[b0 ^ 1][m], 1);\r
1009   }\r
1010 \r
1011 #ifdef EMU_F68K\r
1012   // update fetchmap..\r
1013   int i;\r
1014   if (!(r3 & 4))\r
1015   {\r
1016     for (i = M68K_FETCHBANK1*2/16; (i<<(24-FAMEC_FETCHBITS)) < 0x240000; i++)\r
1017       PicoCpuFM68k.Fetch[i] = (unsigned long)Pico_mcd->word_ram2M - 0x200000;\r
1018   }\r
1019   else\r
1020   {\r
1021     for (i = M68K_FETCHBANK1*2/16; (i<<(24-FAMEC_FETCHBITS)) < 0x220000; i++)\r
1022       PicoCpuFM68k.Fetch[i] = (unsigned long)Pico_mcd->word_ram1M[r3 & 1] - 0x200000;\r
1023     for (i = M68K_FETCHBANK1*0x0c/0x100; (i<<(24-FAMEC_FETCHBITS)) < 0x0e0000; i++)\r
1024       PicoCpuFS68k.Fetch[i] = (unsigned long)Pico_mcd->word_ram1M[(r3&1)^1] - 0x0c0000;\r
1025   }\r
1026 #endif\r
1027 }\r
1028 \r
1029 void pcd_state_loaded_mem(void)\r
1030 {\r
1031   int r3 = Pico_mcd->s68k_regs[3];\r
1032 \r
1033   /* after load events */\r
1034   if (r3 & 4) // 1M mode?\r
1035     wram_2M_to_1M(Pico_mcd->word_ram2M);\r
1036   remap_word_ram(r3);\r
1037   remap_prg_window();\r
1038 \r
1039   // restore hint vector\r
1040   *(unsigned short *)(Pico_mcd->bios + 0x72) = Pico_mcd->m.hint_vector;\r
1041 }\r
1042 \r
1043 #ifdef EMU_M68K\r
1044 static void m68k_mem_setup_cd(void);\r
1045 #endif\r
1046 \r
1047 PICO_INTERNAL void PicoMemSetupCD(void)\r
1048 {\r
1049   // setup default main68k map\r
1050   PicoMemSetup();\r
1051 \r
1052   // main68k map (BIOS mapped by PicoMemSetup()):\r
1053   // RAM cart\r
1054   if (PicoOpt & POPT_EN_MCD_RAMCART) {\r
1055     cpu68k_map_set(m68k_read8_map,   0x400000, 0x7fffff, PicoReadM68k8_ramc, 1);\r
1056     cpu68k_map_set(m68k_read16_map,  0x400000, 0x7fffff, PicoReadM68k16_ramc, 1);\r
1057     cpu68k_map_set(m68k_write8_map,  0x400000, 0x7fffff, PicoWriteM68k8_ramc, 1);\r
1058     cpu68k_map_set(m68k_write16_map, 0x400000, 0x7fffff, PicoWriteM68k16_ramc, 1);\r
1059   }\r
1060 \r
1061   // registers/IO:\r
1062   cpu68k_map_set(m68k_read8_map,   0xa10000, 0xa1ffff, PicoReadM68k8_io, 1);\r
1063   cpu68k_map_set(m68k_read16_map,  0xa10000, 0xa1ffff, PicoReadM68k16_io, 1);\r
1064   cpu68k_map_set(m68k_write8_map,  0xa10000, 0xa1ffff, PicoWriteM68k8_io, 1);\r
1065   cpu68k_map_set(m68k_write16_map, 0xa10000, 0xa1ffff, PicoWriteM68k16_io, 1);\r
1066 \r
1067   // sub68k map\r
1068   cpu68k_map_set(s68k_read8_map,   0x000000, 0xffffff, s68k_unmapped_read8, 1);\r
1069   cpu68k_map_set(s68k_read16_map,  0x000000, 0xffffff, s68k_unmapped_read16, 1);\r
1070   cpu68k_map_set(s68k_write8_map,  0x000000, 0xffffff, s68k_unmapped_write8, 1);\r
1071   cpu68k_map_set(s68k_write16_map, 0x000000, 0xffffff, s68k_unmapped_write16, 1);\r
1072 \r
1073   // PRG RAM\r
1074   cpu68k_map_set(s68k_read8_map,   0x000000, 0x07ffff, Pico_mcd->prg_ram, 0);\r
1075   cpu68k_map_set(s68k_read16_map,  0x000000, 0x07ffff, Pico_mcd->prg_ram, 0);\r
1076   cpu68k_map_set(s68k_write8_map,  0x000000, 0x07ffff, Pico_mcd->prg_ram, 0);\r
1077   cpu68k_map_set(s68k_write16_map, 0x000000, 0x07ffff, Pico_mcd->prg_ram, 0);\r
1078   cpu68k_map_set(s68k_write8_map,  0x000000, 0x00ffff, PicoWriteS68k8_prgwp, 1);\r
1079   cpu68k_map_set(s68k_write16_map, 0x000000, 0x00ffff, PicoWriteS68k16_prgwp, 1);\r
1080 \r
1081   // BRAM\r
1082   cpu68k_map_set(s68k_read8_map,   0xfe0000, 0xfeffff, PicoReadS68k8_bram, 1);\r
1083   cpu68k_map_set(s68k_read16_map,  0xfe0000, 0xfeffff, PicoReadS68k16_bram, 1);\r
1084   cpu68k_map_set(s68k_write8_map,  0xfe0000, 0xfeffff, PicoWriteS68k8_bram, 1);\r
1085   cpu68k_map_set(s68k_write16_map, 0xfe0000, 0xfeffff, PicoWriteS68k16_bram, 1);\r
1086 \r
1087   // PCM, regs\r
1088   cpu68k_map_set(s68k_read8_map,   0xff0000, 0xffffff, PicoReadS68k8_pr, 1);\r
1089   cpu68k_map_set(s68k_read16_map,  0xff0000, 0xffffff, PicoReadS68k16_pr, 1);\r
1090   cpu68k_map_set(s68k_write8_map,  0xff0000, 0xffffff, PicoWriteS68k8_pr, 1);\r
1091   cpu68k_map_set(s68k_write16_map, 0xff0000, 0xffffff, PicoWriteS68k16_pr, 1);\r
1092 \r
1093   // RAMs\r
1094   remap_word_ram(1);\r
1095 \r
1096 #ifdef EMU_C68K\r
1097   // s68k\r
1098   PicoCpuCS68k.read8  = (void *)s68k_read8_map;\r
1099   PicoCpuCS68k.read16 = (void *)s68k_read16_map;\r
1100   PicoCpuCS68k.read32 = (void *)s68k_read16_map;\r
1101   PicoCpuCS68k.write8  = (void *)s68k_write8_map;\r
1102   PicoCpuCS68k.write16 = (void *)s68k_write16_map;\r
1103   PicoCpuCS68k.write32 = (void *)s68k_write16_map;\r
1104   PicoCpuCS68k.checkpc = NULL; /* unused */\r
1105   PicoCpuCS68k.fetch8  = NULL;\r
1106   PicoCpuCS68k.fetch16 = NULL;\r
1107   PicoCpuCS68k.fetch32 = NULL;\r
1108 #endif\r
1109 #ifdef EMU_F68K\r
1110   // s68k\r
1111   PicoCpuFS68k.read_byte  = s68k_read8;\r
1112   PicoCpuFS68k.read_word  = s68k_read16;\r
1113   PicoCpuFS68k.read_long  = s68k_read32;\r
1114   PicoCpuFS68k.write_byte = s68k_write8;\r
1115   PicoCpuFS68k.write_word = s68k_write16;\r
1116   PicoCpuFS68k.write_long = s68k_write32;\r
1117 \r
1118   // setup FAME fetchmap\r
1119   {\r
1120     int i;\r
1121     // M68k\r
1122     // by default, point everything to fitst 64k of ROM (BIOS)\r
1123     for (i = 0; i < M68K_FETCHBANK1; i++)\r
1124       PicoCpuFM68k.Fetch[i] = (unsigned long)Pico.rom - (i<<(24-FAMEC_FETCHBITS));\r
1125     // now real ROM (BIOS)\r
1126     for (i = 0; i < M68K_FETCHBANK1 && (i<<(24-FAMEC_FETCHBITS)) < Pico.romsize; i++)\r
1127       PicoCpuFM68k.Fetch[i] = (unsigned long)Pico.rom;\r
1128     // .. and RAM\r
1129     for (i = M68K_FETCHBANK1*14/16; i < M68K_FETCHBANK1; i++)\r
1130       PicoCpuFM68k.Fetch[i] = (unsigned long)Pico.ram - (i<<(24-FAMEC_FETCHBITS));\r
1131     // S68k\r
1132     // PRG RAM is default\r
1133     for (i = 0; i < M68K_FETCHBANK1; i++)\r
1134       PicoCpuFS68k.Fetch[i] = (unsigned long)Pico_mcd->prg_ram - (i<<(24-FAMEC_FETCHBITS));\r
1135     // real PRG RAM\r
1136     for (i = 0; i < M68K_FETCHBANK1 && (i<<(24-FAMEC_FETCHBITS)) < 0x80000; i++)\r
1137       PicoCpuFS68k.Fetch[i] = (unsigned long)Pico_mcd->prg_ram;\r
1138     // WORD RAM 2M area\r
1139     for (i = M68K_FETCHBANK1*0x08/0x100; i < M68K_FETCHBANK1 && (i<<(24-FAMEC_FETCHBITS)) < 0xc0000; i++)\r
1140       PicoCpuFS68k.Fetch[i] = (unsigned long)Pico_mcd->word_ram2M - 0x80000;\r
1141     // remap_word_ram() will setup word ram for both\r
1142   }\r
1143 #endif\r
1144 #ifdef EMU_M68K\r
1145   m68k_mem_setup_cd();\r
1146 #endif\r
1147 \r
1148   // m68k_poll_addr = m68k_poll_cnt = 0;\r
1149   s68k_poll_adclk = s68k_poll_cnt = 0;\r
1150 }\r
1151 \r
1152 \r
1153 #ifdef EMU_M68K\r
1154 u32  m68k_read8(u32 a);\r
1155 u32  m68k_read16(u32 a);\r
1156 u32  m68k_read32(u32 a);\r
1157 void m68k_write8(u32 a, u8 d);\r
1158 void m68k_write16(u32 a, u16 d);\r
1159 void m68k_write32(u32 a, u32 d);\r
1160 \r
1161 static unsigned int PicoReadCD8w (unsigned int a) {\r
1162         return m68ki_cpu_p == &PicoCpuMS68k ? s68k_read8(a) : m68k_read8(a);\r
1163 }\r
1164 static unsigned int PicoReadCD16w(unsigned int a) {\r
1165         return m68ki_cpu_p == &PicoCpuMS68k ? s68k_read16(a) : m68k_read16(a);\r
1166 }\r
1167 static unsigned int PicoReadCD32w(unsigned int a) {\r
1168         return m68ki_cpu_p == &PicoCpuMS68k ? s68k_read32(a) : m68k_read32(a);\r
1169 }\r
1170 static void PicoWriteCD8w (unsigned int a, unsigned char d) {\r
1171         if (m68ki_cpu_p == &PicoCpuMS68k) s68k_write8(a, d); else m68k_write8(a, d);\r
1172 }\r
1173 static void PicoWriteCD16w(unsigned int a, unsigned short d) {\r
1174         if (m68ki_cpu_p == &PicoCpuMS68k) s68k_write16(a, d); else m68k_write16(a, d);\r
1175 }\r
1176 static void PicoWriteCD32w(unsigned int a, unsigned int d) {\r
1177         if (m68ki_cpu_p == &PicoCpuMS68k) s68k_write32(a, d); else m68k_write32(a, d);\r
1178 }\r
1179 \r
1180 extern unsigned int (*pm68k_read_memory_8) (unsigned int address);\r
1181 extern unsigned int (*pm68k_read_memory_16)(unsigned int address);\r
1182 extern unsigned int (*pm68k_read_memory_32)(unsigned int address);\r
1183 extern void (*pm68k_write_memory_8) (unsigned int address, unsigned char  value);\r
1184 extern void (*pm68k_write_memory_16)(unsigned int address, unsigned short value);\r
1185 extern void (*pm68k_write_memory_32)(unsigned int address, unsigned int   value);\r
1186 \r
1187 static void m68k_mem_setup_cd(void)\r
1188 {\r
1189   pm68k_read_memory_8  = PicoReadCD8w;\r
1190   pm68k_read_memory_16 = PicoReadCD16w;\r
1191   pm68k_read_memory_32 = PicoReadCD32w;\r
1192   pm68k_write_memory_8  = PicoWriteCD8w;\r
1193   pm68k_write_memory_16 = PicoWriteCD16w;\r
1194   pm68k_write_memory_32 = PicoWriteCD32w;\r
1195 }\r
1196 #endif // EMU_M68K\r
1197 \r
1198 // vim:shiftwidth=2:ts=2:expandtab\r