timers implemented for new z80 mode
[picodrive.git] / Pico / cd / Pico.c
1 // (c) Copyright 2007 notaz, All rights reserved.
2
3
4 #include "../PicoInt.h"
5 #include "../sound/ym2612.h"
6
7 extern unsigned char formatted_bram[4*0x10];
8 extern unsigned int s68k_poll_adclk;
9
10 void (*PicoMCDopenTray)(void) = NULL;
11 int  (*PicoMCDcloseTray)(void) = NULL;
12
13 #define dump_ram(ram,fname) \
14 { \
15   int i, d; \
16   FILE *f; \
17 \
18   for (i = 0; i < sizeof(ram); i+=2) { \
19     d = (ram[i]<<8) | ram[i+1]; \
20     *(unsigned short *)(ram+i) = d; \
21   } \
22   f = fopen(fname, "wb"); \
23   if (f) { \
24     fwrite(ram, 1, sizeof(ram), f); \
25     fclose(f); \
26   } \
27   for (i = 0; i < sizeof(ram); i+=2) { \
28     d = (ram[i]<<8) | ram[i+1]; \
29     *(unsigned short *)(ram+i) = d; \
30   } \
31 }
32
33
34 PICO_INTERNAL int PicoInitMCD(void)
35 {
36   SekInitS68k();
37   Init_CD_Driver();
38
39   return 0;
40 }
41
42
43 PICO_INTERNAL void PicoExitMCD(void)
44 {
45   End_CD_Driver();
46
47   //dump_ram(Pico_mcd->prg_ram, "prg.bin");
48   //dump_ram(Pico.ram, "ram.bin");
49 }
50
51 PICO_INTERNAL void PicoPowerMCD(void)
52 {
53   int fmt_size = sizeof(formatted_bram);
54   memset(Pico_mcd->prg_ram,    0, sizeof(Pico_mcd->prg_ram));
55   memset(Pico_mcd->word_ram2M, 0, sizeof(Pico_mcd->word_ram2M));
56   memset(Pico_mcd->pcm_ram,    0, sizeof(Pico_mcd->pcm_ram));
57   memset(Pico_mcd->bram, 0, sizeof(Pico_mcd->bram));
58   memcpy(Pico_mcd->bram + sizeof(Pico_mcd->bram) - fmt_size, formatted_bram, fmt_size);
59 }
60
61 PICO_INTERNAL int PicoResetMCD(void)
62 {
63   memset(Pico_mcd->s68k_regs, 0, sizeof(Pico_mcd->s68k_regs));
64   memset(&Pico_mcd->pcm, 0, sizeof(Pico_mcd->pcm));
65   memset(&Pico_mcd->m, 0, sizeof(Pico_mcd->m));
66
67   *(unsigned int *)(Pico_mcd->bios + 0x70) = 0xffffffff; // reset hint vector (simplest way to implement reg6)
68   Pico_mcd->m.state_flags |= 1; // s68k reset pending
69   Pico_mcd->s68k_regs[3] = 1; // 2M word RAM mode with m68k access after reset
70
71   Reset_CD();
72   LC89510_Reset();
73   gfx_cd_reset();
74   PicoMemResetCD(1);
75 #ifdef _ASM_CD_MEMORY_C
76   //PicoMemResetCDdecode(1); // don't have to call this in 2M mode
77 #endif
78
79   // use SRam.data for RAM cart
80   if (PicoOpt&POPT_EN_MCD_RAMCART) {
81     if (SRam.data == NULL)
82       SRam.data = calloc(1, 0x12000);
83   }
84   else if (SRam.data != NULL) {
85     free(SRam.data);
86     SRam.data = NULL;
87   }
88   SRam.start = SRam.end = 0; // unused
89
90   return 0;
91 }
92
93 static __inline void SekRunM68k(int cyc)
94 {
95   int cyc_do;
96   SekCycleAim+=cyc;
97   if ((cyc_do=SekCycleAim-SekCycleCnt) <= 0) return;
98 #if defined(EMU_CORE_DEBUG)
99   SekCycleCnt+=CM_compareRun(cyc_do, 0);
100 #elif defined(EMU_C68K)
101   PicoCpuCM68k.cycles=cyc_do;
102   CycloneRun(&PicoCpuCM68k);
103   SekCycleCnt+=cyc_do-PicoCpuCM68k.cycles;
104 #elif defined(EMU_M68K)
105   m68k_set_context(&PicoCpuMM68k);
106   SekCycleCnt+=m68k_execute(cyc_do);
107 #elif defined(EMU_F68K)
108   g_m68kcontext=&PicoCpuFM68k;
109   SekCycleCnt+=fm68k_emulate(cyc_do, 0);
110 #endif
111 }
112
113 static __inline void SekRunS68k(int cyc)
114 {
115   int cyc_do;
116   SekCycleAimS68k+=cyc;
117   if ((cyc_do=SekCycleAimS68k-SekCycleCntS68k) <= 0) return;
118 #if defined(EMU_CORE_DEBUG)
119   SekCycleCntS68k+=CM_compareRun(cyc_do, 1);
120 #elif defined(EMU_C68K)
121   PicoCpuCS68k.cycles=cyc_do;
122   CycloneRun(&PicoCpuCS68k);
123   SekCycleCntS68k+=cyc_do-PicoCpuCS68k.cycles;
124 #elif defined(EMU_M68K)
125   m68k_set_context(&PicoCpuMS68k);
126   SekCycleCntS68k+=m68k_execute(cyc_do);
127 #elif defined(EMU_F68K)
128   g_m68kcontext=&PicoCpuFS68k;
129   SekCycleCntS68k+=fm68k_emulate(cyc_do, 0);
130 #endif
131 }
132
133 #define PS_STEP_M68K ((488<<16)/20) // ~24
134 //#define PS_STEP_S68K 13
135
136 #if defined(_ASM_CD_PICO_C)
137 extern void SekRunPS(int cyc_m68k, int cyc_s68k);
138 #elif defined(EMU_F68K)
139 static __inline void SekRunPS(int cyc_m68k, int cyc_s68k)
140 {
141   SekCycleAim+=cyc_m68k;
142   SekCycleAimS68k+=cyc_s68k;
143   fm68k_emulate(0, 1);
144 }
145 #else
146 static __inline void SekRunPS(int cyc_m68k, int cyc_s68k)
147 {
148   int cycn, cycn_s68k, cyc_do;
149   SekCycleAim+=cyc_m68k;
150   SekCycleAimS68k+=cyc_s68k;
151
152 //  fprintf(stderr, "=== start %3i/%3i [%3i/%3i] {%05i.%i} ===\n", cyc_m68k, cyc_s68k,
153 //              SekCycleAim-SekCycleCnt, SekCycleAimS68k-SekCycleCntS68k, Pico.m.frame_count, Pico.m.scanline);
154
155   /* loop 488 downto 0 in steps of PS_STEP */
156   for (cycn = (488<<16)-PS_STEP_M68K; cycn >= 0; cycn -= PS_STEP_M68K)
157   {
158     cycn_s68k = (cycn + cycn/2 + cycn/8) >> 16;
159     if ((cyc_do = SekCycleAim-SekCycleCnt-(cycn>>16)) > 0) {
160 #if defined(EMU_C68K)
161       PicoCpuCM68k.cycles = cyc_do;
162       CycloneRun(&PicoCpuCM68k);
163       SekCycleCnt += cyc_do - PicoCpuCM68k.cycles;
164 #elif defined(EMU_M68K)
165       m68k_set_context(&PicoCpuMM68k);
166       SekCycleCnt += m68k_execute(cyc_do);
167 #elif defined(EMU_F68K)
168       g_m68kcontext = &PicoCpuFM68k;
169       SekCycleCnt += fm68k_emulate(cyc_do, 0);
170 #endif
171     }
172     if ((cyc_do = SekCycleAimS68k-SekCycleCntS68k-cycn_s68k) > 0) {
173 #if defined(EMU_C68K)
174       PicoCpuCS68k.cycles = cyc_do;
175       CycloneRun(&PicoCpuCS68k);
176       SekCycleCntS68k += cyc_do - PicoCpuCS68k.cycles;
177 #elif defined(EMU_M68K)
178       m68k_set_context(&PicoCpuMS68k);
179       SekCycleCntS68k += m68k_execute(cyc_do);
180 #elif defined(EMU_F68K)
181       g_m68kcontext = &PicoCpuFS68k;
182       SekCycleCntS68k += fm68k_emulate(cyc_do, 0);
183 #endif
184     }
185   }
186 }
187 #endif
188
189
190 static __inline void check_cd_dma(void)
191 {
192         int ddx;
193
194         if (!(Pico_mcd->scd.Status_CDC & 0x08)) return;
195
196         ddx = Pico_mcd->s68k_regs[4] & 7;
197         if (ddx <  2) return; // invalid
198         if (ddx <  4) {
199                 Pico_mcd->s68k_regs[4] |= 0x40; // Data set ready in host port
200                 return;
201         }
202         if (ddx == 6) return; // invalid
203
204         Update_CDC_TRansfer(ddx); // now go and do the actual transfer
205 }
206
207 static __inline void update_chips(void)
208 {
209         int counter_timer, int3_set;
210         int counter75hz_lim = Pico.m.pal ? 2080 : 2096;
211
212         // 75Hz CDC update
213         if ((Pico_mcd->m.counter75hz+=10) >= counter75hz_lim) {
214                 Pico_mcd->m.counter75hz -= counter75hz_lim;
215                 Check_CD_Command();
216         }
217
218         // update timers
219         counter_timer = Pico.m.pal ? 0x21630 : 0x2121c; // 136752 : 135708;
220         Pico_mcd->m.timer_stopwatch += counter_timer;
221         if ((int3_set = Pico_mcd->s68k_regs[0x31])) {
222                 Pico_mcd->m.timer_int3 -= counter_timer;
223                 if (Pico_mcd->m.timer_int3 < 0) {
224                         if (Pico_mcd->s68k_regs[0x33] & (1<<3)) {
225                                 elprintf(EL_INTS, "s68k: timer irq 3");
226                                 SekInterruptS68k(3);
227                                 Pico_mcd->m.timer_int3 += int3_set << 16;
228                         }
229                         // is this really what happens if irq3 is masked out?
230                         Pico_mcd->m.timer_int3 &= 0xffffff;
231                 }
232         }
233
234         // update gfx chip
235         if (Pico_mcd->rot_comp.Reg_58 & 0x8000)
236                 gfx_cd_update();
237
238         // delayed setting of DMNA bit (needed for Silpheed)
239         if (Pico_mcd->m.state_flags & 2) {
240                 Pico_mcd->m.state_flags &= ~2;
241                 if (!(Pico_mcd->s68k_regs[3] & 4)) {
242                         Pico_mcd->s68k_regs[3] |=  2;
243                         Pico_mcd->s68k_regs[3] &= ~1;
244 #ifdef USE_POLL_DETECT
245                         if ((s68k_poll_adclk&0xfe) == 2) {
246                                 SekSetStopS68k(0); s68k_poll_adclk = 0;
247                         }
248 #endif
249                 }
250         }
251 }
252
253
254 static __inline void getSamples(int y)
255 {
256   int len = PsndRender(0, PsndLen);
257   if (PicoWriteSound) PicoWriteSound(len);
258   // clear sound buffer
259   PsndClear();
260 }
261
262
263 #define PICO_CD
264 #include "../PicoFrameHints.c"
265
266
267 PICO_INTERNAL int PicoFrameMCD(void)
268 {
269   if (!(PicoOpt&POPT_ALT_RENDERER))
270     PicoFrameStart();
271
272   PicoFrameHints();
273
274   return 0;
275 }
276
277