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