bugfixes, but silpheed is broken
[picodrive.git] / Pico / cd / Memory.c
1 // This is part of Pico Library\r
2 \r
3 // (c) Copyright 2004 Dave, All rights reserved.\r
4 // (c) Copyright 2007 notaz, All rights reserved.\r
5 // Free for non-commercial use.\r
6 \r
7 // For commercial use, separate licencing terms must be obtained.\r
8 \r
9 // A68K no longer supported here\r
10 \r
11 //#define __debug_io\r
12 \r
13 #include "../PicoInt.h"\r
14 \r
15 #include "../sound/sound.h"\r
16 #include "../sound/ym2612.h"\r
17 #include "../sound/sn76496.h"\r
18 \r
19 #include "gfx_cd.h"\r
20 #include "pcm.h"\r
21 \r
22 typedef unsigned char  u8;\r
23 typedef unsigned short u16;\r
24 typedef unsigned int   u32;\r
25 \r
26 //#define __debug_io\r
27 //#define __debug_io2\r
28 \r
29 //#define rdprintf dprintf\r
30 #define rdprintf(...)\r
31 //#define wrdprintf dprintf\r
32 #define wrdprintf(...)\r
33 \r
34 // -----------------------------------------------------------------\r
35 \r
36 \r
37 #ifndef _ASM_CD_MEMORY_C\r
38 static u32 m68k_reg_read16(u32 a)\r
39 {\r
40   u32 d=0;\r
41   a &= 0x3e;\r
42   // dprintf("m68k_regs r%2i: [%02x] @%06x", realsize&~1, a+(realsize&1), SekPc);\r
43 \r
44   switch (a) {\r
45     case 0:\r
46       d = ((Pico_mcd->s68k_regs[0x33]<<13)&0x8000) | Pico_mcd->m.busreq; // here IFL2 is always 0, just like in Gens\r
47       goto end;\r
48     case 2:\r
49       d = (Pico_mcd->s68k_regs[a]<<8) | (Pico_mcd->s68k_regs[a+1]&0xc7);\r
50       dprintf("m68k_regs r3: %02x @%06x", (u8)d, SekPcS68k);\r
51       goto end;\r
52     case 4:\r
53       d = Pico_mcd->s68k_regs[4]<<8;\r
54       goto end;\r
55     case 6:\r
56       d = *(u16 *)(Pico_mcd->bios + 0x72);\r
57       goto end;\r
58     case 8:\r
59       d = Read_CDC_Host(0);\r
60       goto end;\r
61     case 0xA:\r
62       dprintf("m68k FIXME: reserved read");\r
63       goto end;\r
64     case 0xC:\r
65       d = Pico_mcd->m.timer_stopwatch >> 16;\r
66       dprintf("m68k stopwatch timer read (%04x)", d);\r
67       goto end;\r
68   }\r
69 \r
70   if (a < 0x30) {\r
71     // comm flag/cmd/status (0xE-0x2F)\r
72     d = (Pico_mcd->s68k_regs[a]<<8) | Pico_mcd->s68k_regs[a+1];\r
73     goto end;\r
74   }\r
75 \r
76   dprintf("m68k_regs FIXME invalid read @ %02x", a);\r
77 \r
78 end:\r
79 \r
80   // dprintf("ret = %04x", d);\r
81   return d;\r
82 }\r
83 #endif\r
84 \r
85 #ifndef _ASM_CD_MEMORY_C\r
86 static\r
87 #endif\r
88 void m68k_reg_write8(u32 a, u32 d)\r
89 {\r
90   a &= 0x3f;\r
91   // dprintf("m68k_regs w%2i: [%02x] %02x @%06x", realsize, a, d, SekPc);\r
92 \r
93   switch (a) {\r
94     case 0:\r
95       d &= 1;\r
96       if ((d&1) && (Pico_mcd->s68k_regs[0x33]&(1<<2))) { dprintf("m68k: s68k irq 2"); SekInterruptS68k(2); }\r
97       return;\r
98     case 1:\r
99       d &= 3;\r
100       if (!(d&1)) Pico_mcd->m.state_flags |= 1; // reset pending, needed to be sure we fetch the right vectors on reset\r
101       if ( (Pico_mcd->m.busreq&1) != (d&1)) dprintf("m68k: s68k reset %i", !(d&1));\r
102       if ( (Pico_mcd->m.busreq&2) != (d&2)) dprintf("m68k: s68k brq %i", (d&2)>>1);\r
103       if ((Pico_mcd->m.state_flags&1) && (d&3)==1) {\r
104         SekResetS68k(); // S68k comes out of RESET or BRQ state\r
105         Pico_mcd->m.state_flags&=~1;\r
106         dprintf("m68k: resetting s68k, cycles=%i", SekCyclesLeft);\r
107       }\r
108       Pico_mcd->m.busreq = d;\r
109       return;\r
110     case 2:\r
111       Pico_mcd->s68k_regs[2] = d; // really use s68k side register\r
112       return;\r
113     case 3: {\r
114       u32 dold = Pico_mcd->s68k_regs[3]&0x1f;\r
115       dprintf("m68k_regs w3: %02x @%06x", (u8)d, SekPc);\r
116       d &= 0xc2;\r
117       if ((dold>>6) != ((d>>6)&3))\r
118         dprintf("m68k: prg bank: %i -> %i", (Pico_mcd->s68k_regs[a]>>6), ((d>>6)&3));\r
119       //if ((Pico_mcd->s68k_regs[3]&4) != (d&4)) dprintf("m68k: ram mode %i mbit", (d&4) ? 1 : 2);\r
120       //if ((Pico_mcd->s68k_regs[3]&2) != (d&2)) dprintf("m68k: %s", (d&4) ? ((d&2) ? "word swap req" : "noop?") :\r
121       //                                             ((d&2) ? "word ram to s68k" : "word ram to m68k"));\r
122       if (dold & 4) {\r
123         d ^= 2;                // writing 0 to DMNA actually sets it, 1 does nothing\r
124       } else {\r
125         //dold &= ~2; // ??\r
126         if (d & 2) dold &= ~1; // return word RAM to s68k in 2M mode\r
127       }\r
128       Pico_mcd->s68k_regs[3] = d | dold; // really use s68k side register\r
129 \r
130 /*\r
131      d |= Pico_mcd->s68k_regs[3]&0x1d;\r
132      if (!(d & 4) && (d & 2)) d &= ~1; // return word RAM to s68k in 2M mode\r
133      Pico_mcd->s68k_regs[3] = d; // really use s68k side register\r
134 */\r
135       return;\r
136     }\r
137     case 6:\r
138       Pico_mcd->bios[0x72 + 1] = d; // simple hint vector changer\r
139       return;\r
140     case 7:\r
141       Pico_mcd->bios[0x72] = d;\r
142       dprintf("hint vector set to %08x", PicoRead32(0x70));\r
143       return;\r
144     case 0xe:\r
145       //dprintf("m68k: comm flag: %02x", d);\r
146       Pico_mcd->s68k_regs[0xe] = d;\r
147       return;\r
148   }\r
149 \r
150   if ((a&0xf0) == 0x10) {\r
151       Pico_mcd->s68k_regs[a] = d;\r
152       return;\r
153   }\r
154 \r
155   dprintf("m68k FIXME: invalid write? [%02x] %02x", a, d);\r
156 }\r
157 \r
158 \r
159 #define READ_FONT_DATA(basemask) \\r
160 { \\r
161       unsigned int fnt = *(unsigned int *)(Pico_mcd->s68k_regs + 0x4c); \\r
162       unsigned int col0 = (fnt >> 8) & 0x0f, col1 = (fnt >> 12) & 0x0f;   \\r
163       if (fnt & (basemask << 0)) d  = col1      ; else d  = col0;       \\r
164       if (fnt & (basemask << 1)) d |= col1 <<  4; else d |= col0 <<  4; \\r
165       if (fnt & (basemask << 2)) d |= col1 <<  8; else d |= col0 <<  8; \\r
166       if (fnt & (basemask << 3)) d |= col1 << 12; else d |= col0 << 12; \\r
167 }\r
168 \r
169 \r
170 #ifndef _ASM_CD_MEMORY_C\r
171 static\r
172 #endif\r
173 u32 s68k_reg_read16(u32 a)\r
174 {\r
175   u32 d=0;\r
176 \r
177   // dprintf("s68k_regs r%2i: [%02x] @ %06x", realsize&~1, a+(realsize&1), SekPcS68k);\r
178 \r
179   switch (a) {\r
180     case 0:\r
181       d = ((Pico_mcd->s68k_regs[0]&3)<<8) | 1; // ver = 0, not in reset state\r
182       goto end;\r
183     case 2:\r
184       d = (Pico_mcd->s68k_regs[a]<<8) | (Pico_mcd->s68k_regs[a+1]&0x1f);\r
185       dprintf("s68k_regs r3: %02x @%06x", (u8)d, SekPcS68k);\r
186       goto end;\r
187     case 6:\r
188       d = CDC_Read_Reg();\r
189       goto end;\r
190     case 8:\r
191       d = Read_CDC_Host(1); // Gens returns 0 here on byte reads\r
192       goto end;\r
193     case 0xC:\r
194       d = Pico_mcd->m.timer_stopwatch >> 16;\r
195       dprintf("s68k stopwatch timer read (%04x)", d);\r
196       goto end;\r
197     case 0x30:\r
198       dprintf("s68k int3 timer read (%02x%02x)", Pico_mcd->s68k_regs[30], Pico_mcd->s68k_regs[31]);\r
199       break;\r
200     case 0x34: // fader\r
201       d = 0; // no busy bit\r
202       goto end;\r
203     case 0x50: // font data (check: Lunar 2, Silpheed)\r
204       READ_FONT_DATA(0x00100000);\r
205       goto end;\r
206     case 0x52:\r
207       READ_FONT_DATA(0x00010000);\r
208       goto end;\r
209     case 0x54:\r
210       READ_FONT_DATA(0x10000000);\r
211       goto end;\r
212     case 0x56:\r
213       READ_FONT_DATA(0x01000000);\r
214       goto end;\r
215   }\r
216 \r
217   d = (Pico_mcd->s68k_regs[a]<<8) | Pico_mcd->s68k_regs[a+1];\r
218 \r
219 end:\r
220 \r
221   // dprintf("ret = %04x", d);\r
222 \r
223   return d;\r
224 }\r
225 \r
226 #ifndef _ASM_CD_MEMORY_C\r
227 static\r
228 #endif\r
229 void s68k_reg_write8(u32 a, u32 d)\r
230 {\r
231   //dprintf("s68k_regs w%2i: [%02x] %02x @ %06x", realsize, a, d, SekPcS68k);\r
232 \r
233   // TODO: review against Gens\r
234   // Warning: d might have upper bits set\r
235   switch (a) {\r
236     case 2:\r
237       return; // only m68k can change WP\r
238     case 3: {\r
239       int dold = Pico_mcd->s68k_regs[3];\r
240       dprintf("s68k_regs w3: %02x @%06x", (u8)d, SekPc);\r
241       d &= 0x1d;\r
242       d |= dold&0xc2;\r
243       if (d&4) {\r
244         if ((d ^ dold) & 5) {\r
245           d &= ~2; // in case of mode or bank change we clear DMNA (m68k req) bit\r
246 #ifdef _ASM_CD_MEMORY_C\r
247           PicoMemResetCD(d);\r
248 #endif\r
249         }\r
250 #ifdef _ASM_CD_MEMORY_C\r
251         if ((d ^ dold) & 0x1d)\r
252           PicoMemResetCDdecode(d);\r
253 #endif\r
254         if (!(dold & 4)) {\r
255           dprintf("wram mode 2M->1M");\r
256           wram_2M_to_1M(Pico_mcd->word_ram2M);\r
257         }\r
258       } else {\r
259         if (dold & 4) {\r
260           dprintf("wram mode 1M->2M");\r
261           if (!(d&1)) { // it didn't set the ret bit, which means it doesn't want to give WRAM to m68k\r
262             d &= ~3;\r
263             d |= (dold&1) ? 2 : 1; // then give it to the one which had bank0 in 1M mode\r
264           }\r
265           wram_1M_to_2M(Pico_mcd->word_ram2M);\r
266 #ifdef _ASM_CD_MEMORY_C\r
267           PicoMemResetCD(d);\r
268 #endif\r
269         }\r
270         else\r
271           d |= dold&1;\r
272         if (d&1) d &= ~2; // return word RAM to m68k in 2M mode\r
273       }\r
274       break;\r
275     }\r
276     case 4:\r
277       dprintf("s68k CDC dest: %x", d&7);\r
278       Pico_mcd->s68k_regs[4] = (Pico_mcd->s68k_regs[4]&0xC0) | (d&7); // CDC mode\r
279       return;\r
280     case 5:\r
281       //dprintf("s68k CDC reg addr: %x", d&0xf);\r
282       break;\r
283     case 7:\r
284       CDC_Write_Reg(d);\r
285       return;\r
286     case 0xa:\r
287       dprintf("s68k set CDC dma addr");\r
288       break;\r
289     case 0xc:\r
290     case 0xd:\r
291       dprintf("s68k set stopwatch timer");\r
292       Pico_mcd->m.timer_stopwatch = 0;\r
293       return;\r
294     case 0xe:\r
295       Pico_mcd->s68k_regs[0Xf] = (d>>1) | (d<<7); // ror8, Gens note: Dragons lair\r
296       Pico_mcd->m.timer_stopwatch = 0;\r
297       return;\r
298     case 0x31:\r
299       dprintf("s68k set int3 timer: %02x", d);\r
300       Pico_mcd->m.timer_int3 = (d & 0xff) << 16;\r
301       break;\r
302     case 0x33: // IRQ mask\r
303       dprintf("s68k irq mask: %02x", d);\r
304       if ((d&(1<<4)) && (Pico_mcd->s68k_regs[0x37]&4) && !(Pico_mcd->s68k_regs[0x33]&(1<<4))) {\r
305         CDD_Export_Status();\r
306       }\r
307       break;\r
308     case 0x34: // fader\r
309       Pico_mcd->s68k_regs[a] = (u8) d & 0x7f;\r
310       return;\r
311     case 0x36:\r
312       return; // d/m bit is unsetable\r
313     case 0x37: {\r
314       u32 d_old = Pico_mcd->s68k_regs[0x37];\r
315       Pico_mcd->s68k_regs[0x37] = d&7;\r
316       if ((d&4) && !(d_old&4)) {\r
317         CDD_Export_Status();\r
318       }\r
319       return;\r
320     }\r
321     case 0x4b:\r
322       Pico_mcd->s68k_regs[a] = (u8) d;\r
323       CDD_Import_Command();\r
324       return;\r
325   }\r
326 \r
327   if ((a&0x1f0) == 0x10 || (a >= 0x38 && a < 0x42))\r
328   {\r
329     dprintf("s68k FIXME: invalid write @ %02x?", a);\r
330     return;\r
331   }\r
332 \r
333   Pico_mcd->s68k_regs[a] = (u8) d;\r
334 }\r
335 \r
336 \r
337 #ifndef _ASM_CD_MEMORY_C\r
338 static u32 OtherRead16End(u32 a, int realsize)\r
339 {\r
340   u32 d=0;\r
341 \r
342   if ((a&0xffffc0)==0xa12000) {\r
343     d=m68k_reg_read16(a);\r
344     goto end;\r
345   }\r
346 \r
347   dprintf("m68k FIXME: unusual r%i: %06x @%06x", realsize&~1, (a&0xfffffe)+(realsize&1), SekPc);\r
348 \r
349 end:\r
350   return d;\r
351 }\r
352 \r
353 \r
354 static void OtherWrite8End(u32 a, u32 d, int realsize)\r
355 {\r
356   if ((a&0xffffc0)==0xa12000) { m68k_reg_write8(a, d); return; }\r
357 \r
358   dprintf("m68k FIXME: strange w%i: %06x, %08x @%06x", realsize, a&0xffffff, d, SekPc);\r
359 }\r
360 \r
361 \r
362 #undef _ASM_MEMORY_C\r
363 #include "../MemoryCmn.c"\r
364 #include "cell_map.c"\r
365 #endif // !def _ASM_CD_MEMORY_C\r
366 \r
367 // -----------------------------------------------------------------\r
368 //                     Read Rom and read Ram\r
369 \r
370 //u8 PicoReadM68k8_(u32 a);\r
371 #ifdef _ASM_CD_MEMORY_C\r
372 u8 PicoReadM68k8(u32 a);\r
373 #else\r
374 static u8 PicoReadM68k8(u32 a)\r
375 {\r
376   u32 d=0;\r
377 \r
378   if ((a&0xe00000)==0xe00000) { d = *(u8 *)(Pico.ram+((a^1)&0xffff)); goto end; } // Ram\r
379 \r
380   a&=0xffffff;\r
381 \r
382   if (a < 0x20000) { d = *(u8 *)(Pico_mcd->bios+(a^1)); goto end; } // bios\r
383 \r
384   // prg RAM\r
385   if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&2)) {\r
386     u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
387     d = *(prg_bank+((a^1)&0x1ffff));\r
388     goto end;\r
389   }\r
390 \r
391   // word RAM\r
392   if ((a&0xfc0000)==0x200000) {\r
393     wrdprintf("m68k_wram r8: [%06x] @%06x", a, SekPc);\r
394     if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
395       int bank = Pico_mcd->s68k_regs[3]&1;\r
396       if (a >= 0x220000)\r
397            a = (a&3) | (cell_map(a >> 2) << 2); // cell arranged\r
398       else a &= 0x1ffff;\r
399       d = Pico_mcd->word_ram1M[bank][a^1];\r
400     } else {\r
401       // allow access in any mode, like Gens does\r
402       d = Pico_mcd->word_ram2M[(a^1)&0x3ffff];\r
403     }\r
404     wrdprintf("ret = %02x", (u8)d);\r
405     goto end;\r
406   }\r
407 \r
408   if ((a&0xff4000)==0xa00000) { d=z80Read8(a); goto end; } // Z80 Ram\r
409 \r
410   if ((a&0xffffc0)==0xa12000)\r
411     rdprintf("m68k_regs r8: [%02x] @%06x", a&0x3f, SekPc);\r
412 \r
413   d=OtherRead16(a&~1, 8|(a&1)); if ((a&1)==0) d>>=8;\r
414 \r
415   if ((a&0xffffc0)==0xa12000)\r
416     rdprintf("ret = %02x", (u8)d);\r
417 \r
418   end:\r
419 \r
420 #ifdef __debug_io\r
421   dprintf("r8 : %06x,   %02x @%06x", a&0xffffff, (u8)d, SekPc);\r
422 #endif\r
423   return (u8)d;\r
424 }\r
425 #endif\r
426 \r
427 \r
428 #ifdef _ASM_CD_MEMORY_C\r
429 u16 PicoReadM68k16(u32 a);\r
430 #else\r
431 static u16 PicoReadM68k16(u32 a)\r
432 {\r
433   u16 d=0;\r
434 \r
435   if ((a&0xe00000)==0xe00000) { d=*(u16 *)(Pico.ram+(a&0xfffe)); goto end; } // Ram\r
436 \r
437   a&=0xfffffe;\r
438 \r
439   if (a < 0x20000) { d = *(u16 *)(Pico_mcd->bios+a); goto end; } // bios\r
440 \r
441   // prg RAM\r
442   if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&2)) {\r
443     u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
444     d = *(u16 *)(prg_bank+(a&0x1fffe));\r
445     goto end;\r
446   }\r
447 \r
448   // word RAM\r
449   if ((a&0xfc0000)==0x200000) {\r
450     wrdprintf("m68k_wram r16: [%06x] @%06x", a, SekPc);\r
451     if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
452       int bank = Pico_mcd->s68k_regs[3]&1;\r
453       if (a >= 0x220000)\r
454            a = (a&2) | (cell_map(a >> 2) << 2); // cell arranged\r
455       else a &= 0x1fffe;\r
456       d = *(u16 *)(Pico_mcd->word_ram1M[bank]+a);\r
457     } else {\r
458       // allow access in any mode, like Gens does\r
459       d = *(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
460     }\r
461     wrdprintf("ret = %04x", d);\r
462     goto end;\r
463   }\r
464 \r
465   if ((a&0xffffc0)==0xa12000)\r
466     rdprintf("m68k_regs r16: [%02x] @%06x", a&0x3f, SekPc);\r
467 \r
468   d = (u16)OtherRead16(a, 16);\r
469 \r
470   if ((a&0xffffc0)==0xa12000)\r
471     rdprintf("ret = %04x", d);\r
472 \r
473   end:\r
474 \r
475 #ifdef __debug_io\r
476   dprintf("r16: %06x, %04x  @%06x", a&0xffffff, d, SekPc);\r
477 #endif\r
478   return d;\r
479 }\r
480 #endif\r
481 \r
482 \r
483 #ifdef _ASM_CD_MEMORY_C\r
484 u32 PicoReadM68k32(u32 a);\r
485 #else\r
486 static u32 PicoReadM68k32(u32 a)\r
487 {\r
488   u32 d=0;\r
489 \r
490   if ((a&0xe00000)==0xe00000) { u16 *pm=(u16 *)(Pico.ram+(a&0xfffe)); d = (pm[0]<<16)|pm[1]; goto end; } // Ram\r
491 \r
492   a&=0xfffffe;\r
493 \r
494   if (a < 0x20000) { u16 *pm=(u16 *)(Pico_mcd->bios+a); d = (pm[0]<<16)|pm[1]; goto end; } // bios\r
495 \r
496   // prg RAM\r
497   if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&2)) {\r
498     u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
499     u16 *pm=(u16 *)(prg_bank+(a&0x1fffe));\r
500     d = (pm[0]<<16)|pm[1];\r
501     goto end;\r
502   }\r
503 \r
504   // word RAM\r
505   if ((a&0xfc0000)==0x200000) {\r
506     wrdprintf("m68k_wram r32: [%06x] @%06x", a, SekPc);\r
507     if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
508       int bank = Pico_mcd->s68k_regs[3]&1;\r
509       if (a >= 0x220000) { // cell arranged\r
510         u32 a1, a2;\r
511         a1 = (a&2) | (cell_map(a >> 2) << 2);\r
512         if (a&2) a2 = cell_map((a+2) >> 2) << 2;\r
513         else     a2 = a1 + 2;\r
514         d  = *(u16 *)(Pico_mcd->word_ram1M[bank]+a1) << 16;\r
515         d |= *(u16 *)(Pico_mcd->word_ram1M[bank]+a2);\r
516       } else {\r
517         u16 *pm=(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe)); d = (pm[0]<<16)|pm[1];\r
518       }\r
519     } else {\r
520       // allow access in any mode, like Gens does\r
521       u16 *pm=(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe)); d = (pm[0]<<16)|pm[1];\r
522     }\r
523     wrdprintf("ret = %08x", d);\r
524     goto end;\r
525   }\r
526 \r
527   if ((a&0xffffc0)==0xa12000)\r
528     rdprintf("m68k_regs r32: [%02x] @%06x", a&0x3f, SekPc);\r
529 \r
530   d = (OtherRead16(a, 32)<<16)|OtherRead16(a+2, 32);\r
531 \r
532   if ((a&0xffffc0)==0xa12000)\r
533     rdprintf("ret = %08x", d);\r
534 \r
535   end:\r
536 #ifdef __debug_io\r
537   dprintf("r32: %06x, %08x @%06x", a&0xffffff, d, SekPc);\r
538 #endif\r
539   return d;\r
540 }\r
541 #endif\r
542 \r
543 \r
544 // -----------------------------------------------------------------\r
545 //                            Write Ram\r
546 \r
547 #ifdef _ASM_CD_MEMORY_C\r
548 void PicoWriteM68k8(u32 a,u8 d);\r
549 #else\r
550 static void PicoWriteM68k8(u32 a,u8 d)\r
551 {\r
552 #ifdef __debug_io\r
553   dprintf("w8 : %06x,   %02x @%06x", a&0xffffff, d, SekPc);\r
554 #endif\r
555   //if ((a&0xe0ffff)==0xe0a9ba+0x69c)\r
556   //  dprintf("w8 : %06x,   %02x @%06x", a&0xffffff, d, SekPc);\r
557 \r
558 \r
559   if ((a&0xe00000)==0xe00000) { // Ram\r
560     *(u8 *)(Pico.ram+((a^1)&0xffff)) = d;\r
561     return;\r
562   }\r
563 \r
564   a&=0xffffff;\r
565 \r
566   // prg RAM\r
567   if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&2)) {\r
568     u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
569     *(u8 *)(prg_bank+((a^1)&0x1ffff))=d;\r
570     return;\r
571   }\r
572 \r
573   // word RAM\r
574   if ((a&0xfc0000)==0x200000) {\r
575     wrdprintf("m68k_wram w8: [%06x] %02x @%06x", a, d, SekPc);\r
576     if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
577       int bank = Pico_mcd->s68k_regs[3]&1;\r
578       if (a >= 0x220000)\r
579            a = (a&3) | (cell_map(a >> 2) << 2); // cell arranged\r
580       else a &= 0x1ffff;\r
581       *(u8 *)(Pico_mcd->word_ram1M[bank]+(a^1))=d;\r
582     } else {\r
583       // allow access in any mode, like Gens does\r
584       *(u8 *)(Pico_mcd->word_ram2M+((a^1)&0x3ffff))=d;\r
585     }\r
586     return;\r
587   }\r
588 \r
589   if ((a&0xffffc0)==0xa12000)\r
590     rdprintf("m68k_regs w8: [%02x] %02x @%06x", a&0x3f, d, SekPc);\r
591 \r
592   OtherWrite8(a,d,8);\r
593 }\r
594 #endif\r
595 \r
596 \r
597 #ifdef _ASM_CD_MEMORY_C\r
598 void PicoWriteM68k16(u32 a,u16 d);\r
599 #else\r
600 static void PicoWriteM68k16(u32 a,u16 d)\r
601 {\r
602 #ifdef __debug_io\r
603   dprintf("w16: %06x, %04x", a&0xffffff, d);\r
604 #endif\r
605   //  dprintf("w16: %06x, %04x  @%06x", a&0xffffff, d, SekPc);\r
606 \r
607   if ((a&0xe00000)==0xe00000) { // Ram\r
608     *(u16 *)(Pico.ram+(a&0xfffe))=d;\r
609     return;\r
610   }\r
611 \r
612   a&=0xfffffe;\r
613 \r
614   // prg RAM\r
615   if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&2)) {\r
616     u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
617     *(u16 *)(prg_bank+(a&0x1fffe))=d;\r
618     return;\r
619   }\r
620 \r
621   // word RAM\r
622   if ((a&0xfc0000)==0x200000) {\r
623     wrdprintf("m68k_wram w16: [%06x] %04x @%06x", a, d, SekPc);\r
624     if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
625       int bank = Pico_mcd->s68k_regs[3]&1;\r
626       if (a >= 0x220000)\r
627            a = (a&2) | (cell_map(a >> 2) << 2); // cell arranged\r
628       else a &= 0x1fffe;\r
629       *(u16 *)(Pico_mcd->word_ram1M[bank]+a)=d;\r
630     } else {\r
631       // allow access in any mode, like Gens does\r
632       *(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe))=d;\r
633     }\r
634     return;\r
635   }\r
636 \r
637   if ((a&0xffffc0)==0xa12000)\r
638     rdprintf("m68k_regs w16: [%02x] %04x @%06x", a&0x3f, d, SekPc);\r
639 \r
640   OtherWrite16(a,d);\r
641 }\r
642 #endif\r
643 \r
644 \r
645 #ifdef _ASM_CD_MEMORY_C\r
646 void PicoWriteM68k32(u32 a,u32 d);\r
647 #else\r
648 static void PicoWriteM68k32(u32 a,u32 d)\r
649 {\r
650 #ifdef __debug_io\r
651   dprintf("w32: %06x, %08x", a&0xffffff, d);\r
652 #endif\r
653 \r
654   if ((a&0xe00000)==0xe00000)\r
655   {\r
656     // Ram:\r
657     u16 *pm=(u16 *)(Pico.ram+(a&0xfffe));\r
658     pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r
659     return;\r
660   }\r
661 \r
662   a&=0xfffffe;\r
663 \r
664   // prg RAM\r
665   if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&2)) {\r
666     u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
667     u16 *pm=(u16 *)(prg_bank+(a&0x1fffe));\r
668     pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r
669     return;\r
670   }\r
671 \r
672   // word RAM\r
673   if ((a&0xfc0000)==0x200000) {\r
674     if (d != 0) // don't log clears\r
675       wrdprintf("m68k_wram w32: [%06x] %08x @%06x", a, d, SekPc);\r
676     if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
677       int bank = Pico_mcd->s68k_regs[3]&1;\r
678       if (a >= 0x220000) { // cell arranged\r
679         u32 a1, a2;\r
680         a1 = (a&2) | (cell_map(a >> 2) << 2);\r
681         if (a&2) a2 = cell_map((a+2) >> 2) << 2;\r
682         else     a2 = a1 + 2;\r
683         *(u16 *)(Pico_mcd->word_ram1M[bank]+a1) = d >> 16;\r
684         *(u16 *)(Pico_mcd->word_ram1M[bank]+a2) = d;\r
685       } else {\r
686         u16 *pm=(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe));\r
687         pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r
688       }\r
689     } else {\r
690       // allow access in any mode, like Gens does\r
691       u16 *pm=(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
692       pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r
693     }\r
694     return;\r
695   }\r
696 \r
697   if ((a&0xffffc0)==0xa12000)\r
698     rdprintf("m68k_regs w32: [%02x] %08x @%06x", a&0x3f, d, SekPc);\r
699 \r
700   OtherWrite16(a,  (u16)(d>>16));\r
701   OtherWrite16(a+2,(u16)d);\r
702 }\r
703 #endif\r
704 \r
705 \r
706 // -----------------------------------------------------------------\r
707 \r
708 #ifdef _ASM_CD_MEMORY_C\r
709 u8 PicoReadS68k8(u32 a);\r
710 #else\r
711 static u8 PicoReadS68k8(u32 a)\r
712 {\r
713   u32 d=0;\r
714 \r
715   a&=0xffffff;\r
716 \r
717   // prg RAM\r
718   if (a < 0x80000) {\r
719     d = *(Pico_mcd->prg_ram+(a^1));\r
720     goto end;\r
721   }\r
722 \r
723   // regs\r
724   if ((a&0xfffe00) == 0xff8000) {\r
725     a &= 0x1ff;\r
726     rdprintf("s68k_regs r8: [%02x] @ %06x", a, SekPcS68k);\r
727     if (a >= 0x58 && a < 0x68)\r
728          d = gfx_cd_read(a&~1);\r
729     else d = s68k_reg_read16(a&~1);\r
730     if ((a&1)==0) d>>=8;\r
731     rdprintf("ret = %02x", (u8)d);\r
732     goto end;\r
733   }\r
734 \r
735   // word RAM (2M area)\r
736   if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
737     // test: batman returns\r
738     wrdprintf("s68k_wram2M r8: [%06x] @%06x", a, SekPcS68k);\r
739     if (Pico_mcd->s68k_regs[3]&4) { // 1M decode mode?\r
740       int bank = !(Pico_mcd->s68k_regs[3]&1);\r
741       d = Pico_mcd->word_ram1M[bank][((a>>1)^1)&0x1ffff];\r
742       if (a&1) d &= 0x0f;\r
743       else d >>= 4;\r
744       dprintf("FIXME: decode");\r
745     } else {\r
746       // allow access in any mode, like Gens does\r
747       d = Pico_mcd->word_ram2M[(a^1)&0x3ffff];\r
748     }\r
749     wrdprintf("ret = %02x", (u8)d);\r
750     goto end;\r
751   }\r
752 \r
753   // word RAM (1M area)\r
754   if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
755     int bank;\r
756     wrdprintf("s68k_wram1M r8: [%06x] @%06x", a, SekPcS68k);\r
757 //    if (!(Pico_mcd->s68k_regs[3]&4))\r
758 //      dprintf("s68k_wram1M FIXME: wrong mode");\r
759     bank = !(Pico_mcd->s68k_regs[3]&1);\r
760     d = Pico_mcd->word_ram1M[bank][(a^1)&0x1ffff];\r
761     wrdprintf("ret = %02x", (u8)d);\r
762     goto end;\r
763   }\r
764 \r
765   // PCM\r
766   if ((a&0xff8000)==0xff0000) {\r
767     dprintf("s68k_pcm r8: [%06x] @%06x", a, SekPcS68k);\r
768     a &= 0x7fff;\r
769     if (a >= 0x2000)\r
770       d = Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a>>1)&0xfff];\r
771     else if (a >= 0x20) {\r
772       a &= 0x1e;\r
773       d = Pico_mcd->pcm.ch[a>>2].addr >> PCM_STEP_SHIFT;\r
774       if (a & 2) d >>= 8;\r
775     }\r
776     dprintf("ret = %02x", (u8)d);\r
777     goto end;\r
778   }\r
779 \r
780   // bram\r
781   if ((a&0xff0000)==0xfe0000) {\r
782     d = Pico_mcd->bram[(a>>1)&0x1fff];\r
783     goto end;\r
784   }\r
785 \r
786   dprintf("s68k r8 : %06x,   %02x @%06x", a&0xffffff, (u8)d, SekPcS68k);\r
787 \r
788   end:\r
789 \r
790 #ifdef __debug_io2\r
791   dprintf("s68k r8 : %06x,   %02x @%06x", a&0xffffff, (u8)d, SekPcS68k);\r
792 #endif\r
793   return (u8)d;\r
794 }\r
795 #endif\r
796 \r
797 \r
798 //u16 PicoReadS68k16_(u32 a);\r
799 #ifdef _ASM_CD_MEMORY_C\r
800 u16 PicoReadS68k16(u32 a);\r
801 #else\r
802 static u16 PicoReadS68k16(u32 a)\r
803 {\r
804   u32 d=0;\r
805 \r
806   a&=0xfffffe;\r
807 \r
808   // prg RAM\r
809   if (a < 0x80000) {\r
810     d = *(u16 *)(Pico_mcd->prg_ram+a);\r
811     goto end;\r
812   }\r
813 \r
814   // regs\r
815   if ((a&0xfffe00) == 0xff8000) {\r
816     a &= 0x1fe;\r
817     rdprintf("s68k_regs r16: [%02x] @ %06x", a, SekPcS68k);\r
818     if (a >= 0x58 && a < 0x68)\r
819          d = gfx_cd_read(a);\r
820     else d = s68k_reg_read16(a);\r
821     rdprintf("ret = %04x", d);\r
822     goto end;\r
823   }\r
824 \r
825   // word RAM (2M area)\r
826   if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
827     wrdprintf("s68k_wram2M r16: [%06x] @%06x", a, SekPcS68k);\r
828     if (Pico_mcd->s68k_regs[3]&4) { // 1M decode mode?\r
829       int bank = !(Pico_mcd->s68k_regs[3]&1);\r
830       d = Pico_mcd->word_ram1M[bank][((a>>1)^1)&0x1ffff];\r
831       d |= d << 4; d &= ~0xf0;\r
832       dprintf("FIXME: decode");\r
833     } else {\r
834       // allow access in any mode, like Gens does\r
835       d = *(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
836     }\r
837     wrdprintf("ret = %04x", d);\r
838     goto end;\r
839   }\r
840 \r
841   // word RAM (1M area)\r
842   if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
843     int bank;\r
844     wrdprintf("s68k_wram1M r16: [%06x] @%06x", a, SekPcS68k);\r
845 //    if (!(Pico_mcd->s68k_regs[3]&4))\r
846 //      dprintf("s68k_wram1M FIXME: wrong mode");\r
847     bank = !(Pico_mcd->s68k_regs[3]&1);\r
848     d = *(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe));\r
849     wrdprintf("ret = %04x", d);\r
850     goto end;\r
851   }\r
852 \r
853   // bram\r
854   if ((a&0xff0000)==0xfe0000) {\r
855     dprintf("FIXME: s68k_bram r16: [%06x] @%06x", a, SekPcS68k);\r
856     a = (a>>1)&0x1fff;\r
857     d = Pico_mcd->bram[a++];            // Gens does little endian here, and so do we..\r
858     d|= Pico_mcd->bram[a++] << 8;       // This is most likely wrong\r
859     dprintf("ret = %04x", d);\r
860     goto end;\r
861   }\r
862 \r
863   // PCM\r
864   if ((a&0xff8000)==0xff0000) {\r
865     dprintf("FIXME: s68k_pcm r16: [%06x] @%06x", a, SekPcS68k);\r
866     a &= 0x7fff;\r
867     if (a >= 0x2000)\r
868       d = Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a>>1)&0xfff];\r
869     else if (a >= 0x20) {\r
870       a &= 0x1e;\r
871       d = Pico_mcd->pcm.ch[a>>2].addr >> PCM_STEP_SHIFT;\r
872       if (a & 2) d >>= 8;\r
873     }\r
874     dprintf("ret = %04x", d);\r
875     goto end;\r
876   }\r
877 \r
878   dprintf("s68k r16: %06x, %04x  @%06x", a&0xffffff, d, SekPcS68k);\r
879 \r
880   end:\r
881 \r
882 #ifdef __debug_io2\r
883   dprintf("s68k r16: %06x, %04x  @%06x", a&0xffffff, d, SekPcS68k);\r
884 #endif\r
885   return d;\r
886 }\r
887 #endif\r
888 \r
889 \r
890 #ifdef _ASM_CD_MEMORY_C\r
891 u32 PicoReadS68k32(u32 a);\r
892 #else\r
893 static u32 PicoReadS68k32(u32 a)\r
894 {\r
895   u32 d=0;\r
896 \r
897   a&=0xfffffe;\r
898 \r
899   // prg RAM\r
900   if (a < 0x80000) {\r
901     u16 *pm=(u16 *)(Pico_mcd->prg_ram+a);\r
902     d = (pm[0]<<16)|pm[1];\r
903     goto end;\r
904   }\r
905 \r
906   // regs\r
907   if ((a&0xfffe00) == 0xff8000) {\r
908     a &= 0x1fe;\r
909     rdprintf("s68k_regs r32: [%02x] @ %06x", a, SekPcS68k);\r
910     if (a >= 0x58 && a < 0x68)\r
911          d = (gfx_cd_read(a)<<16)|gfx_cd_read(a+2);\r
912     else d = (s68k_reg_read16(a)<<16)|s68k_reg_read16(a+2);\r
913     rdprintf("ret = %08x", d);\r
914     goto end;\r
915   }\r
916 \r
917   // word RAM (2M area)\r
918   if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
919     wrdprintf("s68k_wram2M r32: [%06x] @%06x", a, SekPcS68k);\r
920     if (Pico_mcd->s68k_regs[3]&4) { // 1M decode mode?\r
921       int bank = !(Pico_mcd->s68k_regs[3]&1);\r
922       a >>= 1;\r
923       d  = Pico_mcd->word_ram1M[bank][((a+0)^1)&0x1ffff] << 16;\r
924       d |= Pico_mcd->word_ram1M[bank][((a+1)^1)&0x1ffff];\r
925       d |= d << 4; d &= 0x0f0f0f0f;\r
926       dprintf("FIXME: decode");\r
927     } else {\r
928       // allow access in any mode, like Gens does\r
929       u16 *pm=(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe)); d = (pm[0]<<16)|pm[1];\r
930     }\r
931     wrdprintf("ret = %08x", d);\r
932     goto end;\r
933   }\r
934 \r
935   // word RAM (1M area)\r
936   if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
937     int bank;\r
938     wrdprintf("s68k_wram1M r32: [%06x] @%06x", a, SekPcS68k);\r
939 //    if (!(Pico_mcd->s68k_regs[3]&4))\r
940 //      dprintf("s68k_wram1M FIXME: wrong mode");\r
941     bank = !(Pico_mcd->s68k_regs[3]&1);\r
942     u16 *pm=(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe)); d = (pm[0]<<16)|pm[1];\r
943     wrdprintf("ret = %08x", d);\r
944     goto end;\r
945   }\r
946 \r
947   // PCM\r
948   if ((a&0xff8000)==0xff0000) {\r
949     dprintf("FIXME: s68k_pcm r32: [%06x] @%06x", a, SekPcS68k);\r
950     a &= 0x7fff;\r
951     if (a >= 0x2000) {\r
952       a >>= 1;\r
953       d  = Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][a&0xfff] << 16;\r
954       d |= Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a+1)&0xfff];\r
955     } else if (a >= 0x20) {\r
956       a &= 0x1e;\r
957       if (a & 2) {\r
958         a >>= 2;\r
959         d  = (Pico_mcd->pcm.ch[a].addr >> (PCM_STEP_SHIFT-8)) & 0xff0000;\r
960         d |= (Pico_mcd->pcm.ch[(a+1)&7].addr >> PCM_STEP_SHIFT)   & 0xff;\r
961       } else {\r
962         d = Pico_mcd->pcm.ch[a>>2].addr >> PCM_STEP_SHIFT;\r
963         d = ((d<<16)&0xff0000) | ((d>>8)&0xff); // PCM chip is LE\r
964       }\r
965     }\r
966     dprintf("ret = %08x", d);\r
967     goto end;\r
968   }\r
969 \r
970   // bram\r
971   if ((a&0xff0000)==0xfe0000) {\r
972     dprintf("FIXME: s68k_bram r32: [%06x] @%06x", a, SekPcS68k);\r
973     a = (a>>1)&0x1fff;\r
974     d = Pico_mcd->bram[a++] << 16;              // middle endian? TODO: verify against Fusion..\r
975     d|= Pico_mcd->bram[a++] << 24;\r
976     d|= Pico_mcd->bram[a++];\r
977     d|= Pico_mcd->bram[a++] << 8;\r
978     dprintf("ret = %08x", d);\r
979     goto end;\r
980   }\r
981 \r
982   dprintf("s68k r32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r
983 \r
984   end:\r
985 \r
986 #ifdef __debug_io2\r
987   dprintf("s68k r32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r
988 #endif\r
989   return d;\r
990 }\r
991 #endif\r
992 \r
993 \r
994 /* check: jaguar xj 220 (draws entire world using decode) */\r
995 static void decode_write8(u32 a, u8 d, int r3)\r
996 {\r
997   u8 *pd = Pico_mcd->word_ram1M[!(r3 & 1)] + (((a>>1)^1)&0x1ffff);\r
998   u8 oldmask = (a&1) ? 0xf0 : 0x0f;\r
999 \r
1000   r3 &= 0x18;\r
1001   d  &= 0x0f;\r
1002   if (!(a&1)) d <<= 4;\r
1003 \r
1004   //dprintf("FIXME: decode, r3 = %02x", r3);\r
1005 \r
1006   if (r3 == 8) {\r
1007     if ((!(*pd & (~oldmask))) && d) goto do_it;\r
1008   } else if (r3 > 8) {\r
1009     if (d) goto do_it;\r
1010   } else {\r
1011     goto do_it;\r
1012   }\r
1013 \r
1014   return;\r
1015 do_it:\r
1016   *pd = d | (*pd & oldmask);\r
1017 }\r
1018 \r
1019 \r
1020 static void decode_write16(u32 a, u16 d, int r3)\r
1021 {\r
1022   u8 *pd = Pico_mcd->word_ram1M[!(r3 & 1)] + (((a>>1)^1)&0x1ffff);\r
1023 \r
1024   //if ((a & 0x3ffff) < 0x28000) return;\r
1025 \r
1026   r3 &= 0x18;\r
1027   d  &= 0x0f0f;\r
1028   d  |= d >> 4;\r
1029 \r
1030   if (r3 == 8) {\r
1031     u8 dold = *pd;\r
1032     if (!(dold & 0xf0)) dold |= d & 0xf0;\r
1033     if (!(dold & 0x0f)) dold |= d & 0x0f;\r
1034     *pd = dold;\r
1035   } else if (r3 > 8) {\r
1036     u8 dold = *pd;\r
1037     if (!(d & 0xf0)) d |= dold & 0xf0;\r
1038     if (!(d & 0x0f)) d |= dold & 0x0f;\r
1039     *pd = d;\r
1040   } else {\r
1041     *pd = d;\r
1042   }\r
1043 \r
1044   //dprintf("FIXME: decode");\r
1045 }\r
1046 \r
1047 \r
1048 // -----------------------------------------------------------------\r
1049 \r
1050 //void PicoWriteS68k8_(u32 a,u8 d);\r
1051 //void PicoWriteS68k8__(u32 a,u8 d);\r
1052 #ifdef _ASM_CD_MEMORY_C\r
1053 void PicoWriteS68k8(u32 a,u8 d);\r
1054 #else\r
1055 static void PicoWriteS68k8(u32 a,u8 d)\r
1056 {\r
1057 #ifdef __debug_io2\r
1058   dprintf("s68k w8 : %06x,   %02x @%06x", a&0xffffff, d, SekPcS68k);\r
1059 #endif\r
1060 \r
1061   a&=0xffffff;\r
1062 #if 0\r
1063     PicoWriteS68k8_(a, d);\r
1064 /*  if ((a&0xfc0000)!=0x080000) {\r
1065     PicoWriteS68k8_(a, d);\r
1066     return;\r
1067   }\r
1068   printf("r3: %02x\n", Pico_mcd->s68k_regs[3]);\r
1069   PicoWriteS68k8__(a,d);*/\r
1070   return;\r
1071 #endif\r
1072 \r
1073   // prg RAM\r
1074   if (a < 0x80000) {\r
1075     u8 *pm=(u8 *)(Pico_mcd->prg_ram+(a^1));\r
1076     *pm=d;\r
1077     return;\r
1078   }\r
1079 \r
1080   // regs\r
1081   if ((a&0xfffe00) == 0xff8000) {\r
1082     a &= 0x1ff;\r
1083     rdprintf("s68k_regs w8: [%02x] %02x @ %06x", a, d, SekPcS68k);\r
1084     if (a >= 0x58 && a < 0x68)\r
1085          gfx_cd_write16(a&~1, (d<<8)|d);\r
1086     else s68k_reg_write8(a,d);\r
1087     return;\r
1088   }\r
1089 \r
1090   // word RAM (2M area)\r
1091   if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
1092     int r3 = Pico_mcd->s68k_regs[3];\r
1093     wrdprintf("s68k_wram2M w8: [%06x] %02x @%06x", a, d, SekPcS68k);\r
1094     if (r3 & 4) { // 1M decode mode?\r
1095       decode_write8(a, d, r3);\r
1096     } else {\r
1097       // allow access in any mode, like Gens does\r
1098       *(u8 *)(Pico_mcd->word_ram2M+((a^1)&0x3ffff))=d;\r
1099     }\r
1100     return;\r
1101   }\r
1102 \r
1103   // word RAM (1M area)\r
1104   if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
1105     // Wing Commander tries to write here in wrong mode\r
1106     int bank;\r
1107     if (d)\r
1108       wrdprintf("s68k_wram1M w8: [%06x] %02x @%06x", a, d, SekPcS68k);\r
1109 //    if (!(Pico_mcd->s68k_regs[3]&4))\r
1110 //      dprintf("s68k_wram1M FIXME: wrong mode");\r
1111     bank = !(Pico_mcd->s68k_regs[3]&1);\r
1112     *(u8 *)(Pico_mcd->word_ram1M[bank]+((a^1)&0x1ffff))=d;\r
1113     return;\r
1114   }\r
1115 \r
1116   // PCM\r
1117   if ((a&0xff8000)==0xff0000) {\r
1118     a &= 0x7fff;\r
1119     if (a >= 0x2000)\r
1120       Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a>>1)&0xfff] = d;\r
1121     else if (a < 0x12)\r
1122       pcm_write(a>>1, d);\r
1123     return;\r
1124   }\r
1125 \r
1126   // bram\r
1127   if ((a&0xff0000)==0xfe0000) {\r
1128     Pico_mcd->bram[(a>>1)&0x1fff] = d;\r
1129     SRam.changed = 1;\r
1130     return;\r
1131   }\r
1132 \r
1133   dprintf("s68k w8 : %06x,   %02x @%06x", a&0xffffff, d, SekPcS68k);\r
1134 }\r
1135 #endif\r
1136 \r
1137 \r
1138 #ifdef _ASM_CD_MEMORY_C\r
1139 void PicoWriteS68k16(u32 a,u16 d);\r
1140 #else\r
1141 static void PicoWriteS68k16(u32 a,u16 d)\r
1142 {\r
1143 #ifdef __debug_io2\r
1144   dprintf("s68k w16: %06x, %04x @%06x", a&0xffffff, d, SekPcS68k);\r
1145 #endif\r
1146 \r
1147   a&=0xfffffe;\r
1148 \r
1149   // prg RAM\r
1150   if (a < 0x80000) {\r
1151     *(u16 *)(Pico_mcd->prg_ram+a)=d;\r
1152     return;\r
1153   }\r
1154 \r
1155   // regs\r
1156   if ((a&0xfffe00) == 0xff8000) {\r
1157     a &= 0x1fe;\r
1158     rdprintf("s68k_regs w16: [%02x] %04x @ %06x", a, d, SekPcS68k);\r
1159     if (a >= 0x58 && a < 0x68)\r
1160       gfx_cd_write16(a, d);\r
1161     else {\r
1162       if (a == 0xe) { // special case, 2 byte writes would be handled differently\r
1163         Pico_mcd->s68k_regs[0xf] = d;\r
1164         return;\r
1165       }\r
1166       s68k_reg_write8(a,  d>>8);\r
1167       s68k_reg_write8(a+1,d&0xff);\r
1168     }\r
1169     return;\r
1170   }\r
1171 \r
1172   // word RAM (2M area)\r
1173   if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
1174     int r3 = Pico_mcd->s68k_regs[3];\r
1175     wrdprintf("s68k_wram2M w16: [%06x] %04x @%06x", a, d, SekPcS68k);\r
1176     if (r3 & 4) { // 1M decode mode?\r
1177       decode_write16(a, d, r3);\r
1178     } else {\r
1179       // allow access in any mode, like Gens does\r
1180       *(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe))=d;\r
1181     }\r
1182     return;\r
1183   }\r
1184 \r
1185   // word RAM (1M area)\r
1186   if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
1187     int bank;\r
1188     if (d)\r
1189       wrdprintf("s68k_wram1M w16: [%06x] %04x @%06x", a, d, SekPcS68k);\r
1190 //    if (!(Pico_mcd->s68k_regs[3]&4))\r
1191 //      dprintf("s68k_wram1M FIXME: wrong mode");\r
1192     bank = !(Pico_mcd->s68k_regs[3]&1);\r
1193     *(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe))=d;\r
1194     return;\r
1195   }\r
1196 \r
1197   // PCM\r
1198   if ((a&0xff8000)==0xff0000) {\r
1199     a &= 0x7fff;\r
1200     if (a >= 0x2000)\r
1201       Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a>>1)&0xfff] = d;\r
1202     else if (a < 0x12)\r
1203       pcm_write(a>>1, d & 0xff);\r
1204     return;\r
1205   }\r
1206 \r
1207   // bram\r
1208   if ((a&0xff0000)==0xfe0000) {\r
1209     dprintf("s68k_bram w16: [%06x] %04x @%06x", a, d, SekPcS68k);\r
1210     a = (a>>1)&0x1fff;\r
1211     Pico_mcd->bram[a++] = d;            // Gens does little endian here, an so do we..\r
1212     Pico_mcd->bram[a++] = d >> 8;\r
1213     SRam.changed = 1;\r
1214     return;\r
1215   }\r
1216 \r
1217   dprintf("s68k w16: %06x, %04x @%06x", a&0xffffff, d, SekPcS68k);\r
1218 }\r
1219 #endif\r
1220 \r
1221 \r
1222 #ifdef _ASM_CD_MEMORY_C\r
1223 void PicoWriteS68k32(u32 a,u32 d);\r
1224 #else\r
1225 static void PicoWriteS68k32(u32 a,u32 d)\r
1226 {\r
1227 #ifdef __debug_io2\r
1228   dprintf("s68k w32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r
1229 #endif\r
1230 \r
1231   a&=0xfffffe;\r
1232 \r
1233   // prg RAM\r
1234   if (a < 0x80000) {\r
1235     u16 *pm=(u16 *)(Pico_mcd->prg_ram+a);\r
1236     pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r
1237     return;\r
1238   }\r
1239 \r
1240   // regs\r
1241   if ((a&0xfffe00) == 0xff8000) {\r
1242     a &= 0x1fe;\r
1243     rdprintf("s68k_regs w32: [%02x] %08x @ %06x", a, d, SekPcS68k);\r
1244     if (a >= 0x58 && a < 0x68) {\r
1245       gfx_cd_write16(a,   d>>16);\r
1246       gfx_cd_write16(a+2, d&0xffff);\r
1247     } else {\r
1248       s68k_reg_write8(a,   d>>24);\r
1249       s68k_reg_write8(a+1,(d>>16)&0xff);\r
1250       s68k_reg_write8(a+2,(d>>8) &0xff);\r
1251       s68k_reg_write8(a+3, d     &0xff);\r
1252     }\r
1253     return;\r
1254   }\r
1255 \r
1256   // word RAM (2M area)\r
1257   if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
1258     int r3 = Pico_mcd->s68k_regs[3];\r
1259     wrdprintf("s68k_wram2M w32: [%06x] %08x @%06x", a, d, SekPcS68k);\r
1260     if (r3 & 4) { // 1M decode mode?\r
1261       decode_write16(a  , d >> 16, r3);\r
1262       decode_write16(a+2, d      , r3);\r
1263     } else {\r
1264       // allow access in any mode, like Gens does\r
1265       u16 *pm=(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
1266       pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r
1267     }\r
1268     return;\r
1269   }\r
1270 \r
1271   // word RAM (1M area)\r
1272   if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
1273     int bank;\r
1274     u16 *pm;\r
1275     if (d)\r
1276       wrdprintf("s68k_wram1M w32: [%06x] %08x @%06x", a, d, SekPcS68k);\r
1277 //    if (!(Pico_mcd->s68k_regs[3]&4))\r
1278 //      dprintf("s68k_wram1M FIXME: wrong mode");\r
1279     bank = !(Pico_mcd->s68k_regs[3]&1);\r
1280     pm=(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe));\r
1281     pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r
1282     return;\r
1283   }\r
1284 \r
1285   // PCM\r
1286   if ((a&0xff8000)==0xff0000) {\r
1287     a &= 0x7fff;\r
1288     if (a >= 0x2000) {\r
1289       a >>= 1;\r
1290       Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][a&0xfff] = (d >> 16);\r
1291       Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a+1)&0xfff] = d;\r
1292     } else if (a < 0x12) {\r
1293       a >>= 1;\r
1294       pcm_write(a,  (d>>16) & 0xff);\r
1295       pcm_write(a+1, d & 0xff);\r
1296     }\r
1297     return;\r
1298   }\r
1299 \r
1300   // bram\r
1301   if ((a&0xff0000)==0xfe0000) {\r
1302     dprintf("s68k_bram w32: [%06x] %08x @%06x", a, d, SekPcS68k);\r
1303     a = (a>>1)&0x1fff;\r
1304     Pico_mcd->bram[a++] = d >> 16;              // middle endian? verify?\r
1305     Pico_mcd->bram[a++] = d >> 24;\r
1306     Pico_mcd->bram[a++] = d;\r
1307     Pico_mcd->bram[a++] = d >> 8;\r
1308     SRam.changed = 1;\r
1309     return;\r
1310   }\r
1311 \r
1312   dprintf("s68k w32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r
1313 }\r
1314 #endif\r
1315 \r
1316 \r
1317 // -----------------------------------------------------------------\r
1318 \r
1319 \r
1320 #if defined(EMU_C68K)\r
1321 static __inline int PicoMemBaseM68k(u32 pc)\r
1322 {\r
1323   if ((pc&0xe00000)==0xe00000)\r
1324     return (int)Pico.ram-(pc&0xff0000); // Program Counter in Ram\r
1325 \r
1326   if (pc < 0x20000)\r
1327     return (int)Pico_mcd->bios; // Program Counter in BIOS\r
1328 \r
1329   if ((pc&0xfc0000)==0x200000)\r
1330   {\r
1331     if (!(Pico_mcd->s68k_regs[3]&4))\r
1332       return (int)Pico_mcd->word_ram2M - 0x200000; // Program Counter in Word Ram\r
1333     if (pc < 0x220000) {\r
1334       int bank = (Pico_mcd->s68k_regs[3]&1);\r
1335       return (int)Pico_mcd->word_ram1M[bank] - 0x200000;\r
1336     }\r
1337   }\r
1338 \r
1339   // Error - Program Counter is invalid\r
1340   dprintf("m68k FIXME: unhandled jump to %06x", pc);\r
1341 \r
1342   return (int)Pico_mcd->bios;\r
1343 }\r
1344 \r
1345 \r
1346 static u32 PicoCheckPcM68k(u32 pc)\r
1347 {\r
1348   pc-=PicoCpu.membase; // Get real pc\r
1349   pc&=0xfffffe;\r
1350 \r
1351   PicoCpu.membase=PicoMemBaseM68k(pc);\r
1352 \r
1353   return PicoCpu.membase+pc;\r
1354 }\r
1355 \r
1356 \r
1357 static __inline int PicoMemBaseS68k(u32 pc)\r
1358 {\r
1359   if (pc < 0x80000)                     // PRG RAM\r
1360     return (int)Pico_mcd->prg_ram;\r
1361 \r
1362   if ((pc&0xfc0000)==0x080000)          // WORD RAM 2M area (assume we are in the right mode..)\r
1363     return (int)Pico_mcd->word_ram2M - 0x080000;\r
1364 \r
1365   if ((pc&0xfe0000)==0x0c0000) {        // word RAM 1M area\r
1366     int bank = !(Pico_mcd->s68k_regs[3]&1);\r
1367     return (int)Pico_mcd->word_ram1M[bank] - 0x0c0000;\r
1368   }\r
1369 \r
1370   // Error - Program Counter is invalid\r
1371   dprintf("s68k FIXME: unhandled jump to %06x", pc);\r
1372 \r
1373   return (int)Pico_mcd->prg_ram;\r
1374 }\r
1375 \r
1376 \r
1377 static u32 PicoCheckPcS68k(u32 pc)\r
1378 {\r
1379   pc-=PicoCpuS68k.membase; // Get real pc\r
1380   pc&=0xfffffe;\r
1381 \r
1382   PicoCpuS68k.membase=PicoMemBaseS68k(pc);\r
1383 \r
1384   return PicoCpuS68k.membase+pc;\r
1385 }\r
1386 #endif\r
1387 \r
1388 \r
1389 void PicoMemSetupCD()\r
1390 {\r
1391   dprintf("PicoMemSetupCD()");\r
1392 #ifdef EMU_C68K\r
1393   // Setup m68k memory callbacks:\r
1394   PicoCpu.checkpc=PicoCheckPcM68k;\r
1395   PicoCpu.fetch8 =PicoCpu.read8 =PicoReadM68k8;\r
1396   PicoCpu.fetch16=PicoCpu.read16=PicoReadM68k16;\r
1397   PicoCpu.fetch32=PicoCpu.read32=PicoReadM68k32;\r
1398   PicoCpu.write8 =PicoWriteM68k8;\r
1399   PicoCpu.write16=PicoWriteM68k16;\r
1400   PicoCpu.write32=PicoWriteM68k32;\r
1401   // s68k\r
1402   PicoCpuS68k.checkpc=PicoCheckPcS68k;\r
1403   PicoCpuS68k.fetch8 =PicoCpuS68k.read8 =PicoReadS68k8;\r
1404   PicoCpuS68k.fetch16=PicoCpuS68k.read16=PicoReadS68k16;\r
1405   PicoCpuS68k.fetch32=PicoCpuS68k.read32=PicoReadS68k32;\r
1406   PicoCpuS68k.write8 =PicoWriteS68k8;\r
1407   PicoCpuS68k.write16=PicoWriteS68k16;\r
1408   PicoCpuS68k.write32=PicoWriteS68k32;\r
1409 #endif\r
1410 }\r
1411 \r
1412 \r
1413 #ifdef EMU_M68K\r
1414 unsigned char  PicoReadCD8w (unsigned int a) {\r
1415         return m68ki_cpu_p == &PicoS68kCPU ? PicoReadS68k8(a) : PicoReadM68k8(a);\r
1416 }\r
1417 unsigned short PicoReadCD16w(unsigned int a) {\r
1418         return m68ki_cpu_p == &PicoS68kCPU ? PicoReadS68k16(a) : PicoReadM68k16(a);\r
1419 }\r
1420 unsigned int   PicoReadCD32w(unsigned int a) {\r
1421         return m68ki_cpu_p == &PicoS68kCPU ? PicoReadS68k32(a) : PicoReadM68k32(a);\r
1422 }\r
1423 void PicoWriteCD8w (unsigned int a, unsigned char d) {\r
1424         if (m68ki_cpu_p == &PicoS68kCPU) PicoWriteS68k8(a, d); else PicoWriteM68k8(a, d);\r
1425 }\r
1426 void PicoWriteCD16w(unsigned int a, unsigned short d) {\r
1427         if (m68ki_cpu_p == &PicoS68kCPU) PicoWriteS68k16(a, d); else PicoWriteM68k16(a, d);\r
1428 }\r
1429 void PicoWriteCD32w(unsigned int a, unsigned int d) {\r
1430         if (m68ki_cpu_p == &PicoS68kCPU) PicoWriteS68k32(a, d); else PicoWriteM68k32(a, d);\r
1431 }\r
1432 \r
1433 // these are allowed to access RAM\r
1434 unsigned int  m68k_read_pcrelative_CD8 (unsigned int a) {\r
1435   a&=0xffffff;\r
1436   if(m68ki_cpu_p == &PicoS68kCPU) {\r
1437     if (a < 0x80000) return *(u8 *)(Pico_mcd->prg_ram+(a^1)); // PRG Ram\r
1438     if ((a&0xfc0000)==0x080000 && !(Pico_mcd->s68k_regs[3]&4)) // word RAM (2M area: 080000-0bffff)\r
1439       return *(u8 *)(Pico_mcd->word_ram2M+((a^1)&0x3ffff));\r
1440     if ((a&0xfe0000)==0x0c0000 &&  (Pico_mcd->s68k_regs[3]&4)) { // word RAM (1M area: 0c0000-0dffff)\r
1441       int bank = !(Pico_mcd->s68k_regs[3]&1);\r
1442       return *(u8 *)(Pico_mcd->word_ram1M[bank]+((a^1)&0x1ffff));\r
1443     }\r
1444     dprintf("s68k_read_pcrelative_CD8 FIXME: can't handle %06x", a);\r
1445   } else {\r
1446     if((a&0xe00000)==0xe00000) return *(u8 *)(Pico.ram+((a^1)&0xffff)); // Ram\r
1447     if(a<0x20000)              return *(u8 *)(Pico.rom+(a^1)); // Bios\r
1448     if((a&0xfc0000)==0x200000) { // word RAM\r
1449       if(!(Pico_mcd->s68k_regs[3]&4)) // 2M?\r
1450         return *(u8 *)(Pico_mcd->word_ram2M+((a^1)&0x3ffff));\r
1451       else if (a < 0x220000) {\r
1452         int bank = Pico_mcd->s68k_regs[3]&1;\r
1453         return *(u8 *)(Pico_mcd->word_ram1M[bank]+((a^1)&0x1ffff));\r
1454       }\r
1455     }\r
1456     dprintf("m68k_read_pcrelative_CD8 FIXME: can't handle %06x", a);\r
1457   }\r
1458   return 0;//(u8)  lastread_d;\r
1459 }\r
1460 unsigned int  m68k_read_pcrelative_CD16(unsigned int a) {\r
1461   a&=0xffffff;\r
1462   if(m68ki_cpu_p == &PicoS68kCPU) {\r
1463     if (a < 0x80000) return *(u16 *)(Pico_mcd->prg_ram+(a&~1)); // PRG Ram\r
1464     if ((a&0xfc0000)==0x080000 && !(Pico_mcd->s68k_regs[3]&4)) // word RAM (2M area: 080000-0bffff)\r
1465       return *(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
1466     if ((a&0xfe0000)==0x0c0000 &&  (Pico_mcd->s68k_regs[3]&4)) { // word RAM (1M area: 0c0000-0dffff)\r
1467       int bank = !(Pico_mcd->s68k_regs[3]&1);\r
1468       return *(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe));\r
1469     }\r
1470     dprintf("s68k_read_pcrelative_CD16 FIXME: can't handle %06x", a);\r
1471   } else {\r
1472     if((a&0xe00000)==0xe00000) return *(u16 *)(Pico.ram+(a&0xfffe)); // Ram\r
1473     if(a<0x20000)              return *(u16 *)(Pico.rom+(a&~1)); // Bios\r
1474     if((a&0xfc0000)==0x200000) { // word RAM\r
1475       if(!(Pico_mcd->s68k_regs[3]&4)) // 2M?\r
1476         return *(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
1477       else if (a < 0x220000) {\r
1478         int bank = Pico_mcd->s68k_regs[3]&1;\r
1479         return *(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe));\r
1480       }\r
1481     }\r
1482     dprintf("m68k_read_pcrelative_CD16 FIXME: can't handle %06x", a);\r
1483   }\r
1484   return 0;\r
1485 }\r
1486 unsigned int  m68k_read_pcrelative_CD32(unsigned int a) {\r
1487   u16 *pm;\r
1488   a&=0xffffff;\r
1489   if(m68ki_cpu_p == &PicoS68kCPU) {\r
1490     if (a < 0x80000) { u16 *pm=(u16 *)(Pico_mcd->prg_ram+(a&~1)); return (pm[0]<<16)|pm[1]; } // PRG Ram\r
1491     if ((a&0xfc0000)==0x080000 && !(Pico_mcd->s68k_regs[3]&4)) // word RAM (2M area: 080000-0bffff)\r
1492       { pm=(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe)); return (pm[0]<<16)|pm[1]; }\r
1493     if ((a&0xfe0000)==0x0c0000 &&  (Pico_mcd->s68k_regs[3]&4)) { // word RAM (1M area: 0c0000-0dffff)\r
1494       int bank = !(Pico_mcd->s68k_regs[3]&1);\r
1495       pm=(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe));\r
1496       return (pm[0]<<16)|pm[1];\r
1497     }\r
1498     dprintf("s68k_read_pcrelative_CD32 FIXME: can't handle %06x", a);\r
1499   } else {\r
1500     if((a&0xe00000)==0xe00000) { u16 *pm=(u16 *)(Pico.ram+(a&0xfffe)); return (pm[0]<<16)|pm[1]; } // Ram\r
1501     if(a<0x20000)              { u16 *pm=(u16 *)(Pico.rom+(a&~1));     return (pm[0]<<16)|pm[1]; }\r
1502     if((a&0xfc0000)==0x200000) { // word RAM\r
1503       if(!(Pico_mcd->s68k_regs[3]&4)) // 2M?\r
1504         { pm=(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe)); return (pm[0]<<16)|pm[1]; }\r
1505       else if (a < 0x220000) {\r
1506         int bank = Pico_mcd->s68k_regs[3]&1;\r
1507         pm=(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe));\r
1508         return (pm[0]<<16)|pm[1];\r
1509       }\r
1510     }\r
1511     dprintf("m68k_read_pcrelative_CD32 FIXME: can't handle %06x", a);\r
1512   }\r
1513   return 0;\r
1514 }\r
1515 #endif // EMU_M68K\r
1516 \r