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