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