some pandora tweaks
[libpicofe.git] / pandora / emu.c
1 // (c) Copyright 2006-2009 notaz, All rights reserved.\r
2 // Free for non-commercial use.\r
3 \r
4 // For commercial use, separate licencing terms must be obtained.\r
5 \r
6 #include <stdio.h>\r
7 #include <unistd.h>\r
8 \r
9 #include "../common/emu.h"\r
10 #include "../common/menu.h"\r
11 #include "../common/plat.h"\r
12 #include "../common/arm_utils.h"\r
13 #include "../linux/sndout_oss.h"\r
14 #include "../linux/fbdev.h"\r
15 #include "asm_utils.h"\r
16 #include "version.h"\r
17 \r
18 #include <pico/pico_int.h>\r
19 \r
20 \r
21 static short __attribute__((aligned(4))) sndBuffer[2*44100/50];\r
22 static unsigned char temp_frame[g_screen_width * g_screen_height * 2];\r
23 unsigned char *PicoDraw2FB = temp_frame;\r
24 const char *renderer_names[] = { NULL };\r
25 const char *renderer_names32x[] = { NULL };\r
26 char cpu_clk_name[] = "Max CPU clock";\r
27 \r
28 enum {\r
29         SCALE_1x1,\r
30         SCALE_2x2_3x2,\r
31         SCALE_2x2_2x2,\r
32 };\r
33 \r
34 static int get_cpu_clock(void)\r
35 {\r
36         FILE *f;\r
37         int ret = 0;\r
38         f = fopen("/proc/pandora/cpu_mhz_max", "r");\r
39         if (f) {\r
40                 fscanf(f, "%d", &ret);\r
41                 fclose(f);\r
42         }\r
43         return ret;\r
44 }\r
45 \r
46 void pemu_prep_defconfig(void)\r
47 {\r
48         // XXX: move elsewhere\r
49         g_menubg_ptr = temp_frame;\r
50 \r
51         defaultConfig.EmuOpt |= EOPT_VSYNC;\r
52         defaultConfig.s_PicoOpt |= POPT_EN_MCD_GFX|POPT_EN_MCD_PSYNC;\r
53         defaultConfig.scaling = SCALE_2x2_3x2;\r
54 }\r
55 \r
56 void pemu_validate_config(void)\r
57 {\r
58         currentConfig.CPUclock = get_cpu_clock();\r
59 }\r
60 \r
61 // FIXME: cleanup\r
62 static void osd_text(int x, int y, const char *text)\r
63 {\r
64         int len = strlen(text)*8;\r
65 \r
66         if (0) {\r
67                 int *p, i, h;\r
68                 x &= ~3; // align x\r
69                 len = (len+3) >> 2;\r
70                 for (h = 0; h < 8; h++) {\r
71                         p = (int *) ((unsigned char *) g_screen_ptr+x+g_screen_width*(y+h));\r
72                         for (i = len; i; i--, p++) *p = 0xe0e0e0e0;\r
73                 }\r
74                 emu_text_out8(x, y, text);\r
75         } else {\r
76                 int *p, i, h;\r
77                 x &= ~1; // align x\r
78                 len++;\r
79                 for (h = 0; h < 16; h++) {\r
80                         p = (int *) ((unsigned short *) g_screen_ptr+x+g_screen_width*(y+h));\r
81                         for (i = len; i; i--, p++) *p = 0;//(*p>>2)&0x39e7;\r
82                 }\r
83                 text_out16(x, y, text);\r
84         }\r
85 }\r
86 \r
87 static void draw_cd_leds(void)\r
88 {\r
89 //      static\r
90         int old_reg;\r
91 //      if (!((Pico_mcd->s68k_regs[0] ^ old_reg) & 3)) return; // no change // mmu hack problems?\r
92         old_reg = Pico_mcd->s68k_regs[0];\r
93 \r
94         if (0) {\r
95                 // 8-bit modes\r
96                 unsigned int col_g = (old_reg & 2) ? 0xc0c0c0c0 : 0xe0e0e0e0;\r
97                 unsigned int col_r = (old_reg & 1) ? 0xd0d0d0d0 : 0xe0e0e0e0;\r
98                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*2+ 4) =\r
99                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*3+ 4) =\r
100                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*4+ 4) = col_g;\r
101                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*2+12) =\r
102                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*3+12) =\r
103                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*4+12) = col_r;\r
104         } else {\r
105                 // 16-bit modes\r
106                 unsigned int *p = (unsigned int *)((short *)g_screen_ptr + g_screen_width*2+4);\r
107                 unsigned int col_g = (old_reg & 2) ? 0x06000600 : 0;\r
108                 unsigned int col_r = (old_reg & 1) ? 0xc000c000 : 0;\r
109                 *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r; p += g_screen_width/2 - 12/2;\r
110                 *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r; p += g_screen_width/2 - 12/2;\r
111                 *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r;\r
112         }\r
113 }\r
114 \r
115 static int emuscan_1x1(unsigned int num)\r
116 {\r
117         DrawLineDest = (unsigned short *)g_screen_ptr +\r
118                 g_screen_width * g_screen_height / 2 - g_screen_width * 240 / 2 +\r
119                 num*g_screen_width + g_screen_width/2 - 320/2;\r
120 \r
121         return 0;\r
122 }\r
123 \r
124 #define MAKE_EMUSCAN(name_, clut_name_, offs_, len_)            \\r
125 static int name_(unsigned int num)                              \\r
126 {                                                               \\r
127         unsigned char  *ps = HighCol+8;                         \\r
128         unsigned short *pd, *pal = HighPal;                     \\r
129         int sh = Pico.video.reg[0xC] & 8;                       \\r
130         int mask = 0xff;                                        \\r
131                                                                 \\r
132         pd = (unsigned short *)g_screen_ptr + num*800*2 + offs_;\\r
133                                                                 \\r
134         if (Pico.m.dirtyPal)                                    \\r
135                 PicoDoHighPal555(sh);                           \\r
136                                                                 \\r
137         if (!sh && (rendstatus & PDRAW_SPR_LO_ON_HI))           \\r
138                 mask = 0x3f; /* upper bits are priority stuff */\\r
139                                                                 \\r
140         clut_line##clut_name_(pd, ps, pal, (mask<<16) | len_);  \\r
141                                                                 \\r
142         return 0;                                               \\r
143 }\r
144 \r
145 MAKE_EMUSCAN(emuscan_2x2_40, 2x2, 800/2 - 320*2/2, 320)\r
146 MAKE_EMUSCAN(emuscan_2x2_32, 2x2, 800/2 - 256*2/2, 256)\r
147 MAKE_EMUSCAN(emuscan_3x2_32, 3x2, 800/2 - 256*3/2, 256)\r
148 \r
149 #if 0 /* FIXME */\r
150 static int EmuScanEnd16_32x(unsigned int num)\r
151 {\r
152         unsigned int *ps;\r
153         unsigned int *pd;\r
154         int len;\r
155 \r
156         ps = (unsigned int *)temp_frame;\r
157         pd = (unsigned int *)g_screen_ptr + (num*800*2 + 800/2 - 320*2/2) / 2;\r
158 \r
159         for (len = 320/2; len > 0; len--, ps++) {\r
160                 unsigned int p, p1;\r
161                 p1 = *ps;\r
162                 p = p1 << 16;\r
163                 p |= p >> 16;\r
164                 *pd = pd[800/2] = p;\r
165                 pd++;\r
166 \r
167                 p = p1 >> 16;\r
168                 p |= p << 16;\r
169                 *pd = pd[800/2] = p;\r
170                 pd++;\r
171         }\r
172 \r
173         return 0;\r
174 }\r
175 #endif\r
176 \r
177 void pemu_finalize_frame(const char *fps, const char *notice)\r
178 {\r
179         if (notice || (currentConfig.EmuOpt & EOPT_SHOW_FPS)) {\r
180                 if (notice)\r
181                         osd_text(4, 464, notice);\r
182                 if (currentConfig.EmuOpt & EOPT_SHOW_FPS)\r
183                         osd_text(640, 464, fps);\r
184         }\r
185         if ((PicoAHW & PAHW_MCD) && (currentConfig.EmuOpt & EOPT_EN_CD_LEDS))\r
186                 draw_cd_leds();\r
187 }\r
188 \r
189 void plat_video_toggle_renderer(int change, int is_menu)\r
190 {\r
191         // this will auto-select SMS/32X renderers\r
192         PicoDrawSetOutFormat(PDF_RGB555, 1);\r
193 }\r
194 \r
195 void plat_video_menu_enter(int is_rom_loaded)\r
196 {\r
197 }\r
198 \r
199 void plat_video_menu_begin(void)\r
200 {\r
201         memcpy32(g_screen_ptr, g_menubg_ptr, g_screen_width * g_screen_height * 2 / 4);\r
202 }\r
203 \r
204 void plat_video_menu_end(void)\r
205 {\r
206         plat_video_flip();\r
207 }\r
208 \r
209 void plat_status_msg_clear(void)\r
210 {\r
211         int s = g_screen_width * g_screen_height * 2;\r
212         int l = g_screen_width * 16 * 2;\r
213         int i;\r
214 \r
215         for (i = 0; i < fbdev_buffer_count; i++)\r
216                 memset32((int *)((char *)fbdev_buffers[i] + s - l), 0, l / 4);\r
217 }\r
218 \r
219 void plat_status_msg_busy_next(const char *msg)\r
220 {\r
221         plat_status_msg_clear();\r
222         pemu_finalize_frame("", msg);\r
223         plat_video_flip();\r
224         emu_status_msg("");\r
225         reset_timing = 1;\r
226 }\r
227 \r
228 void plat_status_msg_busy_first(const char *msg)\r
229 {\r
230 //      memset32(g_screen_ptr, 0, g_screen_width * g_screen_height * 2 / 4);\r
231         plat_status_msg_busy_next(msg);\r
232 }\r
233 \r
234 void plat_update_volume(int has_changed, int is_up)\r
235 {\r
236         static int prev_frame = 0, wait_frames = 0;\r
237         int vol = currentConfig.volume;\r
238 \r
239         if (has_changed)\r
240         {\r
241                 if (is_up) {\r
242                         if (vol < 99) vol++;\r
243                 } else {\r
244                         if (vol >  0) vol--;\r
245                 }\r
246                 wait_frames = 0;\r
247                 sndout_oss_setvol(vol, vol);\r
248                 currentConfig.volume = vol;\r
249                 emu_status_msg("VOL: %02i", vol);\r
250                 prev_frame = Pico.m.frame_count;\r
251         }\r
252 }\r
253 \r
254 void pemu_forced_frame(int opts, int no_scale)\r
255 {\r
256         int oldscale = currentConfig.scaling;\r
257         int po_old = PicoOpt;\r
258 \r
259         if (no_scale) {\r
260                 currentConfig.scaling = SCALE_1x1;\r
261                 emu_video_mode_change(0, 0, 0);\r
262         }\r
263 \r
264         PicoOpt &= ~POPT_ALT_RENDERER;\r
265         PicoOpt |= opts|POPT_ACC_SPRITES; // acc_sprites\r
266 \r
267         Pico.m.dirtyPal = 1;\r
268         PicoFrameDrawOnly();\r
269 \r
270         PicoOpt = po_old;\r
271         currentConfig.scaling = oldscale;\r
272 }\r
273 \r
274 static void updateSound(int len)\r
275 {\r
276         unsigned int t;\r
277 \r
278         len <<= 1;\r
279         if (PicoOpt & POPT_EN_STEREO)\r
280                 len <<= 1;\r
281 \r
282         // sndout_oss_can_write() not reliable..\r
283         if ((currentConfig.EmuOpt & EOPT_NO_FRMLIMIT) && !sndout_oss_can_write(len))\r
284                 return;\r
285 \r
286         /* avoid writing audio when lagging behind to prevent audio lag */\r
287         if (PicoSkipFrame == 2)\r
288                 return;\r
289 \r
290         t = plat_get_ticks_ms();\r
291         sndout_oss_write(PsndOut, len);\r
292         t = plat_get_ticks_ms() - t;\r
293         if (t > 1)\r
294                 printf("audio lag %u\n", t);\r
295 }\r
296 \r
297 void pemu_sound_start(void)\r
298 {\r
299         int target_fps = Pico.m.pal ? 50 : 60;\r
300 \r
301         PsndOut = NULL;\r
302 \r
303         if (currentConfig.EmuOpt & EOPT_EN_SOUND)\r
304         {\r
305                 int snd_excess_add, frame_samples;\r
306                 int is_stereo = (PicoOpt & POPT_EN_STEREO) ? 1 : 0;\r
307 \r
308                 PsndRerate(Pico.m.frame_count ? 1 : 0);\r
309 \r
310                 frame_samples = PsndLen;\r
311                 snd_excess_add = ((PsndRate - PsndLen * target_fps)<<16) / target_fps;\r
312                 if (snd_excess_add != 0)\r
313                         frame_samples++;\r
314 \r
315                 printf("starting audio: %i len: %i (ex: %04x) stereo: %i, pal: %i\n",\r
316                         PsndRate, PsndLen, snd_excess_add, is_stereo, Pico.m.pal);\r
317                 sndout_oss_start(PsndRate, frame_samples * 2, is_stereo);\r
318                 //sndout_oss_setvol(currentConfig.volume, currentConfig.volume);\r
319                 PicoWriteSound = updateSound;\r
320                 plat_update_volume(0, 0);\r
321                 memset(sndBuffer, 0, sizeof(sndBuffer));\r
322                 PsndOut = sndBuffer;\r
323         }\r
324 }\r
325 \r
326 void pemu_sound_stop(void)\r
327 {\r
328         sndout_oss_stop();\r
329 }\r
330 \r
331 void pemu_sound_wait(void)\r
332 {\r
333         // don't need to do anything, writes will block by themselves\r
334 }\r
335 \r
336 void plat_debug_cat(char *str)\r
337 {\r
338 }\r
339 \r
340 void emu_video_mode_change(int start_line, int line_count, int is_32cols)\r
341 {\r
342         int i;\r
343 \r
344         // clear whole screen in all buffers\r
345         for (i = 0; i < fbdev_buffer_count; i++)\r
346                 memset32(fbdev_buffers[i], 0, g_screen_width * g_screen_height * 2 / 4);\r
347 \r
348         PicoScanBegin = NULL;\r
349         PicoScanEnd = NULL;\r
350 \r
351 #if 0\r
352         if (PicoAHW & PAHW_32X) {\r
353                 /* FIXME */\r
354                 DrawLineDest = (unsigned short *)temp_frame;\r
355                 PicoDrawSetOutFormat(PDF_RGB555, 1);\r
356                 PicoScanEnd = EmuScanEnd16_32x;\r
357         } else\r
358 #endif\r
359         {\r
360                 switch (currentConfig.scaling) {\r
361                 case SCALE_1x1:\r
362                         PicoDrawSetOutFormat(PDF_RGB555, 1);\r
363                         PicoScanBegin = emuscan_1x1;\r
364                         break;\r
365                 case SCALE_2x2_3x2:\r
366                         PicoDrawSetOutFormat(PDF_NONE, 0);\r
367                         PicoScanEnd = is_32cols ? emuscan_3x2_32 : emuscan_2x2_40;\r
368                         break;\r
369                 case SCALE_2x2_2x2:\r
370                         PicoDrawSetOutFormat(PDF_NONE, 0);\r
371                         PicoScanEnd = is_32cols ? emuscan_2x2_32 : emuscan_2x2_40;\r
372                         break;\r
373                 }\r
374         }\r
375 }\r
376 \r
377 void pemu_loop_prep(void)\r
378 {\r
379         if (currentConfig.CPUclock != get_cpu_clock()) {\r
380                 char buf[64];\r
381                 snprintf(buf, sizeof(buf), "sudo /usr/pandora/scripts/op_cpuspeed.sh %d",\r
382                         currentConfig.CPUclock);\r
383                 system(buf);\r
384         }\r
385 \r
386         pemu_sound_start();\r
387 }\r
388 \r
389 void pemu_loop_end(void)\r
390 {\r
391         int po_old = PicoOpt;\r
392         int eo_old = currentConfig.EmuOpt;\r
393 \r
394         pemu_sound_stop();\r
395         memset32(g_screen_ptr, 0, g_screen_width * g_screen_height * 2 / 4);\r
396 \r
397         /* do one more frame for menu bg */\r
398         PicoOpt &= ~POPT_ALT_RENDERER;\r
399         PicoOpt |= POPT_EN_SOFTSCALE|POPT_ACC_SPRITES;\r
400         currentConfig.EmuOpt |= EOPT_16BPP;\r
401 \r
402         PicoDrawSetOutFormat(PDF_RGB555, 1);\r
403         Pico.m.dirtyPal = 1;\r
404         PicoFrame();\r
405 \r
406         PicoOpt = po_old;\r
407         currentConfig.EmuOpt = eo_old;\r
408 }\r
409 \r
410 void plat_wait_till_us(unsigned int us_to)\r
411 {\r
412         unsigned int now;\r
413         signed int diff;\r
414 \r
415         now = plat_get_ticks_us();\r
416 \r
417         // XXX: need to check NOHZ\r
418         diff = (signed int)(us_to - now);\r
419         if (diff > 10000) {\r
420                 //printf("sleep %d\n", us_to - now);\r
421                 usleep(diff * 15 / 16);\r
422                 now = plat_get_ticks_us();\r
423                 //printf(" wake %d\n", (signed)(us_to - now));\r
424         }\r
425 /*\r
426         while ((signed int)(us_to - now) > 512) {\r
427                 spend_cycles(1024);\r
428                 now = plat_get_ticks_us();\r
429         }\r
430 */\r
431 }\r
432 \r
433 const char *plat_get_credits(void)\r
434 {\r
435         return "PicoDrive v" VERSION " (c) notaz, 2006-2010\n\n\n"\r
436                 "Credits:\n"\r
437                 "fDave: Cyclone 68000 core,\n"\r
438                 "      base code of PicoDrive\n"\r
439                 "Reesy & FluBBa: DrZ80 core\n"\r
440                 "MAME devs: YM2612 and SN76496 cores\n"\r
441                 "Pandora team: Pandora\n"\r
442                 "Inder, ketchupgun: graphics\n"\r
443                 "\n"\r
444                 "special thanks (for docs, ideas):\n"\r
445                 " Charles MacDonald, Haze,\n"\r
446                 " Stephane Dallongeville,\n"\r
447                 " Lordus, Exophase, Rokas,\n"\r
448                 " Nemesis, Tasco Deluxe";\r
449 }\r