0c6935b1b84e55f982eb9ae4bf61b6cebbf07827
[libpicofe.git] / pandora / emu.c
1 // (c) Copyright 2006-2008 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 <stdlib.h>\r
8 #include <sys/time.h>\r
9 #include <sys/stat.h>\r
10 #include <sys/types.h>\r
11 #include <linux/limits.h>\r
12 #include <ctype.h>\r
13 #include <unistd.h>\r
14 \r
15 #include <stdarg.h>\r
16 \r
17 #include "../gp2x/emu.h"\r
18 #include "../gp2x/usbjoy.h"\r
19 #include "../gp2x/menu.h"\r
20 #include "../common/arm_utils.h"\r
21 #include "../common/fonts.h"\r
22 #include "../common/emu.h"\r
23 #include "../common/config.h"\r
24 #include "../common/common.h"\r
25 #include "asm_utils.h"\r
26 \r
27 #include <Pico/PicoInt.h>\r
28 #include <Pico/Patch.h>\r
29 #include <Pico/sound/mix.h>\r
30 #include <zlib/zlib.h>\r
31 \r
32 //#define PFRAMES\r
33 #define BENCHMARK\r
34 //#define USE_320_SCREEN 1\r
35 \r
36 #ifdef BENCHMARK\r
37 #define OSD_FPS_X (800-200)\r
38 #else\r
39 #define OSD_FPS_X (800-120)\r
40 #endif\r
41 \r
42 \r
43 int engineState;\r
44 int select_exits = 0;\r
45 \r
46 char romFileName[PATH_MAX];\r
47 \r
48 static short __attribute__((aligned(4))) sndBuffer[2*44100/50];\r
49 static struct timeval noticeMsgTime = { 0, 0 }; // when started showing\r
50 static int osd_fps_x;\r
51 unsigned char *PicoDraw2FB = NULL;  // temporary buffer for alt renderer\r
52 int reset_timing = 0;\r
53 \r
54 #define PICO_PEN_ADJUST_X 4\r
55 #define PICO_PEN_ADJUST_Y 2\r
56 static int pico_pen_x = SCREEN_WIDTH/2, pico_pen_y = 240/2;\r
57 \r
58 static void emu_msg_cb(const char *msg);\r
59 static void emu_msg_tray_open(void);\r
60 \r
61 \r
62 void emu_noticeMsgUpdated(void)\r
63 {\r
64         gettimeofday(&noticeMsgTime, 0);\r
65 }\r
66 \r
67 int emu_getMainDir(char *dst, int len)\r
68 {\r
69         extern char **g_argv;\r
70         int j;\r
71 \r
72         strncpy(dst, g_argv[0], len);\r
73         len -= 32; // reserve\r
74         if (len < 0) len = 0;\r
75         dst[len] = 0;\r
76         for (j = strlen(dst); j > 0; j--)\r
77                 if (dst[j] == '/') { dst[j+1] = 0; break; }\r
78 \r
79         return j + 1;\r
80 }\r
81 \r
82 void emu_Init(void)\r
83 {\r
84         // make temp buffer for alt renderer\r
85         PicoDraw2FB = malloc((8+320)*(8+240+8));\r
86         if (!PicoDraw2FB)\r
87         {\r
88                 printf("PicoDraw2FB == 0\n");\r
89         }\r
90 \r
91         // make dirs for saves, cfgs, etc.\r
92         mkdir("mds", 0777);\r
93         mkdir("srm", 0777);\r
94         mkdir("brm", 0777);\r
95         mkdir("cfg", 0777);\r
96 \r
97         PicoInit();\r
98         PicoMessage = emu_msg_cb;\r
99         PicoMCDopenTray = emu_msg_tray_open;\r
100         PicoMCDcloseTray = menu_loop_tray;\r
101 }\r
102 \r
103 \r
104 static void scaling_update(void)\r
105 {\r
106         PicoOpt &= ~0x4100;\r
107         switch (currentConfig.scaling) {\r
108                 default: break; // off\r
109                 case 1:  // hw hor\r
110                 case 2:  PicoOpt |=  0x0100; break; // hw hor+vert\r
111                 case 3:  PicoOpt |=  0x4000; break; // sw hor\r
112         }\r
113 }\r
114 \r
115 \r
116 void emu_Deinit(void)\r
117 {\r
118         // save SRAM\r
119         if((currentConfig.EmuOpt & 1) && SRam.changed) {\r
120                 emu_SaveLoadGame(0, 1);\r
121                 SRam.changed = 0;\r
122         }\r
123 \r
124         if (!(currentConfig.EmuOpt & 0x20)) {\r
125                 config_writelrom(PicoConfigFile);\r
126 #ifndef NO_SYNC\r
127                 sync();\r
128 #endif\r
129         }\r
130 \r
131         free(PicoDraw2FB);\r
132 \r
133         PicoExit();\r
134 }\r
135 \r
136 void emu_prepareDefaultConfig(void)\r
137 {\r
138         memset(&defaultConfig, 0, sizeof(defaultConfig));\r
139         defaultConfig.EmuOpt    = 0x8f | 0x00600; // | <- confirm_save, cd_leds\r
140         defaultConfig.s_PicoOpt  = 0x0f | POPT_EXT_FM|POPT_EN_MCD_PCM|POPT_EN_MCD_CDDA|POPT_EN_SVP_DRC;\r
141         defaultConfig.s_PicoOpt |= POPT_ACC_SPRITES|POPT_EN_MCD_GFX;\r
142         defaultConfig.s_PicoOpt &= ~POPT_EN_SVP_DRC; // crashes :(\r
143         defaultConfig.EmuOpt    &= ~8; // no save gzip\r
144         defaultConfig.s_PsndRate = 44100;\r
145         defaultConfig.s_PicoRegion = 0;\r
146         defaultConfig.s_PicoAutoRgnOrder = 0x184; // US, EU, JP\r
147         defaultConfig.s_PicoCDBuffers = 0;\r
148         defaultConfig.Frameskip = 0;\r
149         defaultConfig.CPUclock = 200;\r
150         defaultConfig.volume = 50;\r
151         defaultConfig.scaling = 0;\r
152         defaultConfig.turbo_rate = 15;\r
153 }\r
154 \r
155 static void textOut16(int x, int y, const char *text)\r
156 {\r
157         int i,l,len=strlen(text);\r
158         unsigned int *screen = (unsigned int *)((unsigned short *)SCREEN_BUFFER + (x&~1) + y*SCREEN_WIDTH);\r
159 \r
160         for (i = 0; i < len; i++)\r
161         {\r
162                 for (l=0;l<16;)\r
163                 {\r
164                         unsigned char fd = fontdata8x8[((text[i])*8)+l/2];\r
165                         unsigned int *d = &screen[l*SCREEN_WIDTH/2];\r
166                         if (fd&0x80) d[0]=0xffffffff;\r
167                         if (fd&0x40) d[1]=0xffffffff;\r
168                         if (fd&0x20) d[2]=0xffffffff;\r
169                         if (fd&0x10) d[3]=0xffffffff;\r
170                         if (fd&0x08) d[4]=0xffffffff;\r
171                         if (fd&0x04) d[5]=0xffffffff;\r
172                         if (fd&0x02) d[6]=0xffffffff;\r
173                         if (fd&0x01) d[7]=0xffffffff;\r
174                         l++; d = &screen[l*SCREEN_WIDTH/2];\r
175                         if (fd&0x80) d[0]=0xffffffff;\r
176                         if (fd&0x40) d[1]=0xffffffff;\r
177                         if (fd&0x20) d[2]=0xffffffff;\r
178                         if (fd&0x10) d[3]=0xffffffff;\r
179                         if (fd&0x08) d[4]=0xffffffff;\r
180                         if (fd&0x04) d[5]=0xffffffff;\r
181                         if (fd&0x02) d[6]=0xffffffff;\r
182                         if (fd&0x01) d[7]=0xffffffff;\r
183                         l++;\r
184                 }\r
185                 screen += 8;\r
186         }\r
187 }\r
188 \r
189 \r
190 void osd_text(int x, int y, const char *text)\r
191 {\r
192         int len = strlen(text)*8;\r
193 \r
194         if ((PicoOpt&0x10)||!(currentConfig.EmuOpt&0x80)) {\r
195                 int *p, i, h;\r
196                 x &= ~3; // align x\r
197                 len = (len+3) >> 2;\r
198                 for (h = 0; h < 8; h++) {\r
199                         p = (int *) ((unsigned char *) gp2x_screen+x+SCREEN_WIDTH*(y+h));\r
200                         for (i = len; i; i--, p++) *p = 0xe0e0e0e0;\r
201                 }\r
202                 emu_textOut8(x, y, text);\r
203         } else {\r
204                 int *p, i, h;\r
205                 x &= ~1; // align x\r
206                 len++;\r
207                 for (h = 0; h < 16; h++) {\r
208                         p = (int *) ((unsigned short *) gp2x_screen+x+SCREEN_WIDTH*(y+h));\r
209                         for (i = len; i; i--, p++) *p = 0;//(*p>>2)&0x39e7;\r
210                 }\r
211                 textOut16(x, y, text);\r
212         }\r
213 }\r
214 \r
215 static void draw_cd_leds(void)\r
216 {\r
217 //      static\r
218         int old_reg;\r
219 //      if (!((Pico_mcd->s68k_regs[0] ^ old_reg) & 3)) return; // no change // mmu hack problems?\r
220         old_reg = Pico_mcd->s68k_regs[0];\r
221 \r
222         if ((PicoOpt&0x10)||!(currentConfig.EmuOpt&0x80)) {\r
223                 // 8-bit modes\r
224                 unsigned int col_g = (old_reg & 2) ? 0xc0c0c0c0 : 0xe0e0e0e0;\r
225                 unsigned int col_r = (old_reg & 1) ? 0xd0d0d0d0 : 0xe0e0e0e0;\r
226                 *(unsigned int *)((char *)gp2x_screen + SCREEN_WIDTH*2+ 4) =\r
227                 *(unsigned int *)((char *)gp2x_screen + SCREEN_WIDTH*3+ 4) =\r
228                 *(unsigned int *)((char *)gp2x_screen + SCREEN_WIDTH*4+ 4) = col_g;\r
229                 *(unsigned int *)((char *)gp2x_screen + SCREEN_WIDTH*2+12) =\r
230                 *(unsigned int *)((char *)gp2x_screen + SCREEN_WIDTH*3+12) =\r
231                 *(unsigned int *)((char *)gp2x_screen + SCREEN_WIDTH*4+12) = col_r;\r
232         } else {\r
233                 // 16-bit modes\r
234                 unsigned int *p = (unsigned int *)((short *)gp2x_screen + SCREEN_WIDTH*2+4);\r
235                 unsigned int col_g = (old_reg & 2) ? 0x06000600 : 0;\r
236                 unsigned int col_r = (old_reg & 1) ? 0xc000c000 : 0;\r
237                 *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r; p += SCREEN_WIDTH/2 - 12/2;\r
238                 *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r; p += SCREEN_WIDTH/2 - 12/2;\r
239                 *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r;\r
240         }\r
241 }\r
242 \r
243 static void draw_pico_ptr(void)\r
244 {\r
245         unsigned short *p = (unsigned short *)gp2x_screen;\r
246 \r
247         // only if pen enabled and for 16bit modes\r
248         if (pico_inp_mode == 0 || (PicoOpt&0x10) || !(currentConfig.EmuOpt&0x80)) return;\r
249 \r
250         if (!(Pico.video.reg[12]&1) && !(PicoOpt&POPT_DIS_32C_BORDER))\r
251                 p += 32;\r
252 \r
253         p += SCREEN_WIDTH * (pico_pen_y + PICO_PEN_ADJUST_Y);\r
254         p += pico_pen_x + PICO_PEN_ADJUST_X;\r
255         p[0]   ^= 0xffff;\r
256         p[319] ^= 0xffff;\r
257         p[320] ^= 0xffff;\r
258         p[321] ^= 0xffff;\r
259         p[640] ^= 0xffff;\r
260 }\r
261 \r
262 #ifdef USE_320_SCREEN\r
263 \r
264 static int EmuScanBegin16(unsigned int num)\r
265 {\r
266         if (!(Pico.video.reg[1]&8)) num += 8;\r
267         DrawLineDest = (unsigned short *)gp2x_screen + num*800 + 800/2 - 320/2;\r
268         //int w = (Pico.video.reg[12]&1) ? 320 : 256;\r
269         //DrawLineDest = (unsigned short *)gp2x_screen + num*w;\r
270 \r
271         return 0;\r
272 }\r
273 \r
274 #else // USE_320_SCREEN\r
275 \r
276 static int EmuScanEnd16(unsigned int num)\r
277 {\r
278         unsigned char  *ps=HighCol+8;\r
279         unsigned short *pd;\r
280         unsigned short *pal=HighPal;\r
281         int sh = Pico.video.reg[0xC]&8;\r
282         int len, mask = 0xff;\r
283 \r
284         if (!(Pico.video.reg[1]&8)) num += 8;\r
285         pd=(unsigned short *)gp2x_screen + num*800*2 + 800/2 - 320*2/2;\r
286 \r
287         if (Pico.m.dirtyPal)\r
288                 PicoDoHighPal555(sh);\r
289 \r
290         if (Pico.video.reg[12]&1) {\r
291                 len = 320;\r
292         } else {\r
293                 pd += 32*2;\r
294                 len = 256;\r
295         }\r
296 \r
297         if (!sh && (rendstatus & PDRAW_ACC_SPRITES))\r
298                 mask=0x3f; // accurate sprites, upper bits are priority stuff\r
299 \r
300 #if 1\r
301         clut_line(pd, ps, pal, (mask<<16) | len);\r
302 #else\r
303         for (; len > 0; len--)\r
304         {\r
305                 unsigned int p = pal[*ps++ & mask];\r
306                 p |= p << 16;\r
307                 *(unsigned int *)pd = p;\r
308                 *(unsigned int *)(&pd[800]) = p;\r
309                 pd += 2;\r
310         }\r
311 #endif\r
312 \r
313         return 0;\r
314 }\r
315 \r
316 #endif // USE_320_SCREEN\r
317 \r
318 static int EmuScanBegin8(unsigned int num)\r
319 {\r
320         if (!(Pico.video.reg[1]&8)) num += 8;\r
321         DrawLineDest = (unsigned char *)  gp2x_screen + SCREEN_WIDTH * num;\r
322 \r
323         return 0;\r
324 }\r
325 \r
326 int localPal[0x100];\r
327 static void (*vidCpyM2)(void *dest, void *src) = NULL;\r
328 \r
329 static void blit(const char *fps, const char *notice)\r
330 {\r
331         int emu_opt = currentConfig.EmuOpt;\r
332 \r
333         if (PicoOpt&0x10)\r
334         {\r
335                 // 8bit fast renderer\r
336                 if (Pico.m.dirtyPal) {\r
337                         Pico.m.dirtyPal = 0;\r
338                         vidConvCpyRGB32(localPal, Pico.cram, 0x40);\r
339                         // feed new palette to our device\r
340                         gp2x_video_setpalette(localPal, 0x40);\r
341                 }\r
342                 // a hack for VR\r
343                 if (PicoRead16Hook == PicoSVPRead16)\r
344                         memset32((int *)(PicoDraw2FB+328*8+328*223), 0xe0e0e0e0, 328);\r
345                 // do actual copy\r
346                 vidCpyM2((unsigned char *)gp2x_screen+SCREEN_WIDTH*8, PicoDraw2FB+328*8);\r
347         }\r
348         else if (!(emu_opt&0x80))\r
349         {\r
350                 // 8bit accurate renderer\r
351                 if (Pico.m.dirtyPal)\r
352                 {\r
353                         int pallen = 0xc0;\r
354                         Pico.m.dirtyPal = 0;\r
355                         if (Pico.video.reg[0xC]&8) // shadow/hilight mode\r
356                         {\r
357                                 vidConvCpyRGB32(localPal, Pico.cram, 0x40);\r
358                                 vidConvCpyRGB32sh(localPal+0x40, Pico.cram, 0x40);\r
359                                 vidConvCpyRGB32hi(localPal+0x80, Pico.cram, 0x40);\r
360                                 memcpy32(localPal+0xc0, localPal+0x40, 0x40);\r
361                                 pallen = 0x100;\r
362                         }\r
363                         else if (rendstatus & PDRAW_SONIC_MODE) { // mid-frame palette changes\r
364                                 vidConvCpyRGB32(localPal, Pico.cram, 0x40);\r
365                                 vidConvCpyRGB32(localPal+0x40, HighPal, 0x40);\r
366                                 vidConvCpyRGB32(localPal+0x80, HighPal+0x40, 0x40);\r
367                                 pallen = 0xc0;\r
368                         }\r
369                         else {\r
370                                 vidConvCpyRGB32(localPal, Pico.cram, 0x40);\r
371                                 memcpy32(localPal+0x80, localPal, 0x40);\r
372                         }\r
373                         if (pallen > 0xc0) {\r
374                                 localPal[0xc0] = 0x0000c000;\r
375                                 localPal[0xd0] = 0x00c00000;\r
376                                 localPal[0xe0] = 0x00000000; // reserved pixels for OSD\r
377                                 localPal[0xf0] = 0x00ffffff;\r
378                         }\r
379                         gp2x_video_setpalette(localPal, pallen);\r
380                 }\r
381         }\r
382 \r
383         if (notice || (emu_opt & 2)) {\r
384                 int h = SCREEN_HEIGHT-16;\r
385                 if (currentConfig.scaling == 2 && !(Pico.video.reg[1]&8)) h -= 16;\r
386                 if (notice) osd_text(4, h, notice);\r
387                 if (emu_opt & 2)\r
388                         osd_text(osd_fps_x, h, fps);\r
389         }\r
390         if ((emu_opt & 0x400) && (PicoAHW & PAHW_MCD))\r
391                 draw_cd_leds();\r
392         if (PicoAHW & PAHW_PICO)\r
393                 draw_pico_ptr();\r
394 {\r
395 //static int u=0;\r
396 //memset((char *)gp2x_screen+800*471*2, (u++)>>1, 800*9*2);\r
397 }\r
398 \r
399         //gp2x_video_wait_vsync();\r
400         gp2x_video_flip();\r
401 }\r
402 \r
403 \r
404 // clears whole screen or just the notice area (in all buffers)\r
405 static void clearArea(int full)\r
406 {\r
407         if ((PicoOpt&0x10)||!(currentConfig.EmuOpt&0x80)) {\r
408                 // 8-bit renderers\r
409                 if (full) gp2x_memset_all_buffers(0, 0xe0, SCREEN_WIDTH*240);\r
410                 else      gp2x_memset_all_buffers(SCREEN_WIDTH*232, 0xe0, SCREEN_WIDTH*8);\r
411         } else {\r
412                 // 16bit accurate renderer\r
413                 if (full) gp2x_memset_all_buffers(0, 0, SCREEN_WIDTH*SCREEN_HEIGHT*2);\r
414                 else      gp2x_memset_all_buffers(SCREEN_WIDTH*(SCREEN_HEIGHT-16)*2, 0, SCREEN_WIDTH*16*2);\r
415         }\r
416 }\r
417 \r
418 \r
419 static void vidResetMode(void)\r
420 {\r
421         if (PicoOpt&0x10) {\r
422                 gp2x_video_changemode(8);\r
423         } else if (currentConfig.EmuOpt&0x80) {\r
424                 gp2x_video_changemode(16);\r
425 #ifdef USE_320_SCREEN\r
426                 PicoDrawSetColorFormat(1);\r
427                 PicoScanBegin = EmuScanBegin16;\r
428 #else\r
429                 PicoDrawSetColorFormat(-1);\r
430                 PicoScanEnd = EmuScanEnd16;\r
431 #endif\r
432         } else {\r
433                 gp2x_video_changemode(8);\r
434                 PicoDrawSetColorFormat(2);\r
435                 PicoScanBegin = EmuScanBegin8;\r
436         }\r
437         if ((PicoOpt&0x10)||!(currentConfig.EmuOpt&0x80)) {\r
438                 // setup pal for 8-bit modes\r
439                 localPal[0xc0] = 0x0000c000; // MCD LEDs\r
440                 localPal[0xd0] = 0x00c00000;\r
441                 localPal[0xe0] = 0x00000000; // reserved pixels for OSD\r
442                 localPal[0xf0] = 0x00ffffff;\r
443                 gp2x_video_setpalette(localPal, 0x100);\r
444                 gp2x_memset_all_buffers(0, 0xe0, 320*240);\r
445                 gp2x_video_flip();\r
446         }\r
447         Pico.m.dirtyPal = 1;\r
448         // reset scaling\r
449         if (currentConfig.scaling == 2 && !(Pico.video.reg[1]&8))\r
450              gp2x_video_RGB_setscaling(8, (PicoOpt&0x100)&&!(Pico.video.reg[12]&1) ? 256 : 320, 224);\r
451         else gp2x_video_RGB_setscaling(0, (PicoOpt&0x100)&&!(Pico.video.reg[12]&1) ? 256 : 320, 240);\r
452 }\r
453 \r
454 \r
455 static void emu_msg_cb(const char *msg)\r
456 {\r
457         if ((PicoOpt&0x10)||!(currentConfig.EmuOpt&0x80)) {\r
458                 // 8-bit renderers\r
459                 gp2x_memset_all_buffers(SCREEN_WIDTH*(SCREEN_HEIGHT-16), 0xe0, SCREEN_WIDTH*16);\r
460                 osd_text(4, SCREEN_HEIGHT-16, msg);\r
461                 gp2x_memcpy_all_buffers((char *)gp2x_screen+SCREEN_WIDTH*(SCREEN_HEIGHT-16),\r
462                         SCREEN_WIDTH*(SCREEN_HEIGHT-16), SCREEN_WIDTH*16);\r
463         } else {\r
464                 // 16bit accurate renderer\r
465                 gp2x_memset_all_buffers(SCREEN_WIDTH*(SCREEN_HEIGHT-16)*2, 0, SCREEN_WIDTH*16*2);\r
466                 osd_text(4, SCREEN_HEIGHT-16, msg);\r
467                 gp2x_memcpy_all_buffers((char *)gp2x_screen+SCREEN_WIDTH*(SCREEN_HEIGHT-16)*2,\r
468                         SCREEN_WIDTH*(SCREEN_HEIGHT-16)*2, SCREEN_WIDTH*16*2);\r
469         }\r
470         gettimeofday(&noticeMsgTime, 0);\r
471         noticeMsgTime.tv_sec -= 2;\r
472 \r
473         /* assumption: emu_msg_cb gets called only when something slow is about to happen */\r
474         reset_timing = 1;\r
475 }\r
476 \r
477 static void emu_state_cb(const char *str)\r
478 {\r
479         clearArea(0);\r
480         blit("", str);\r
481 }\r
482 \r
483 static void emu_msg_tray_open(void)\r
484 {\r
485         strcpy(noticeMsg, "CD tray opened");\r
486         gettimeofday(&noticeMsgTime, 0);\r
487 }\r
488 \r
489 static void RunEventsPico(unsigned int events, unsigned int gp2x_keys)\r
490 {\r
491         int ret, px, py, lim_x;\r
492         static int pdown_frames = 0;\r
493 \r
494         emu_RunEventsPico(events);\r
495 \r
496         if (pico_inp_mode == 0) return;\r
497 \r
498         // for F200\r
499         ret = gp2x_touchpad_read(&px, &py);\r
500         if (ret >= 0)\r
501         {\r
502                 if (ret > 35000)\r
503                 {\r
504                         if (pdown_frames++ > 5)\r
505                                 PicoPad[0] |= 0x20;\r
506 \r
507                         pico_pen_x = px;\r
508                         pico_pen_y = py;\r
509                         if (!(Pico.video.reg[12]&1)) {\r
510                                 pico_pen_x -= 32;\r
511                                 if (pico_pen_x <   0) pico_pen_x = 0;\r
512                                 if (pico_pen_x > 248) pico_pen_x = 248;\r
513                         }\r
514                         if (pico_pen_y > 224) pico_pen_y = 224;\r
515                 }\r
516                 else\r
517                         pdown_frames = 0;\r
518 \r
519                 //if (ret == 0)\r
520                 //      PicoPicohw.pen_pos[0] = PicoPicohw.pen_pos[1] = 0x8000;\r
521         }\r
522 \r
523         PicoPad[0] &= ~0x0f; // release UDLR\r
524         if (gp2x_keys & GP2X_UP)    pico_pen_y--;\r
525         if (gp2x_keys & GP2X_DOWN)  pico_pen_y++;\r
526         if (gp2x_keys & GP2X_LEFT)  pico_pen_x--;\r
527         if (gp2x_keys & GP2X_RIGHT) pico_pen_x++;\r
528 \r
529         lim_x = (Pico.video.reg[12]&1) ? 319 : 255;\r
530         if (pico_pen_y < 8) pico_pen_y = 8;\r
531         if (pico_pen_y > 224-PICO_PEN_ADJUST_Y) pico_pen_y = 224-PICO_PEN_ADJUST_Y;\r
532         if (pico_pen_x < 0) pico_pen_x = 0;\r
533         if (pico_pen_x > lim_x-PICO_PEN_ADJUST_X) pico_pen_x = lim_x-PICO_PEN_ADJUST_X;\r
534 \r
535         PicoPicohw.pen_pos[0] = pico_pen_x;\r
536         if (!(Pico.video.reg[12]&1)) PicoPicohw.pen_pos[0] += pico_pen_x/4;\r
537         PicoPicohw.pen_pos[0] += 0x3c;\r
538         PicoPicohw.pen_pos[1] = pico_inp_mode == 1 ? (0x2f8 + pico_pen_y) : (0x1fc + pico_pen_y);\r
539 }\r
540 \r
541 static void update_volume(int has_changed, int is_up)\r
542 {\r
543         static int prev_frame = 0, wait_frames = 0;\r
544         int vol = currentConfig.volume;\r
545 \r
546         if (has_changed)\r
547         {\r
548                 if (vol < 5 && (PicoOpt&8) && prev_frame == Pico.m.frame_count - 1 && wait_frames < 12)\r
549                         wait_frames++;\r
550                 else {\r
551                         if (is_up) {\r
552                                 if (vol < 99) vol++;\r
553                         } else {\r
554                                 if (vol >  0) vol--;\r
555                         }\r
556                         wait_frames = 0;\r
557                         gp2x_sound_volume(vol, vol);\r
558                         currentConfig.volume = vol;\r
559                 }\r
560                 sprintf(noticeMsg, "VOL: %02i", vol);\r
561                 gettimeofday(&noticeMsgTime, 0);\r
562                 prev_frame = Pico.m.frame_count;\r
563         }\r
564 \r
565         // set the right mixer func\r
566         if (!(PicoOpt&8)) return; // just use defaults for mono\r
567         if (vol >= 5)\r
568                 PsndMix_32_to_16l = mix_32_to_16l_stereo;\r
569         else {\r
570                 mix_32_to_16l_level = 5 - vol;\r
571                 PsndMix_32_to_16l = mix_32_to_16l_stereo_lvl;\r
572         }\r
573 }\r
574 \r
575 static void RunEvents(unsigned int which)\r
576 {\r
577         if (which & 0x1800) // save or load (but not both)\r
578         {\r
579                 int do_it = 1;\r
580                 if ( emu_checkSaveFile(state_slot) &&\r
581                                 (( (which & 0x1000) && (currentConfig.EmuOpt & 0x800)) ||   // load\r
582                                  (!(which & 0x1000) && (currentConfig.EmuOpt & 0x200))) ) { // save\r
583                         unsigned long keys;\r
584                         blit("", (which & 0x1000) ? "LOAD STATE? (Y=yes, X=no)" : "OVERWRITE SAVE? (Y=yes, X=no)");\r
585                         while ( !((keys = gp2x_joystick_read(1)) & (GP2X_X|GP2X_Y)) )\r
586                                 usleep(50*1024);\r
587                         if (keys & GP2X_X) do_it = 0;\r
588                         while ( gp2x_joystick_read(1) & (GP2X_X|GP2X_Y) ) // wait for release\r
589                                 usleep(50*1024);\r
590                         clearArea(0);\r
591                 }\r
592                 if (do_it) {\r
593                         osd_text(4, SCREEN_HEIGHT-16, (which & 0x1000) ? "LOADING GAME" : "SAVING GAME");\r
594                         PicoStateProgressCB = emu_state_cb;\r
595                         gp2x_memcpy_all_buffers(gp2x_screen, 0, SCREEN_WIDTH*SCREEN_HEIGHT*2);\r
596                         emu_SaveLoadGame((which & 0x1000) >> 12, 0);\r
597                         PicoStateProgressCB = NULL;\r
598                 }\r
599 \r
600                 reset_timing = 1;\r
601         }\r
602         if (which & 0x0400) // switch renderer\r
603         {\r
604                 if      (  PicoOpt&0x10)             { PicoOpt&=~0x10; currentConfig.EmuOpt |= 0x80; }\r
605                 else if (!(currentConfig.EmuOpt&0x80)) PicoOpt|= 0x10;\r
606                 else   currentConfig.EmuOpt &= ~0x80;\r
607 \r
608                 vidResetMode();\r
609 \r
610                 if (PicoOpt&0x10) {\r
611                         strcpy(noticeMsg, " 8bit fast renderer");\r
612                 } else if (currentConfig.EmuOpt&0x80) {\r
613                         strcpy(noticeMsg, "16bit accurate renderer");\r
614                 } else {\r
615                         strcpy(noticeMsg, " 8bit accurate renderer");\r
616                 }\r
617 \r
618                 gettimeofday(&noticeMsgTime, 0);\r
619         }\r
620         if (which & 0x0300)\r
621         {\r
622                 if(which&0x0200) {\r
623                         state_slot -= 1;\r
624                         if(state_slot < 0) state_slot = 9;\r
625                 } else {\r
626                         state_slot += 1;\r
627                         if(state_slot > 9) state_slot = 0;\r
628                 }\r
629                 sprintf(noticeMsg, "SAVE SLOT %i [%s]", state_slot, emu_checkSaveFile(state_slot) ? "USED" : "FREE");\r
630                 gettimeofday(&noticeMsgTime, 0);\r
631         }\r
632         if (which & 0x0080) {\r
633                 engineState = PGS_Menu;\r
634         }\r
635 }\r
636 \r
637 static void updateKeys(void)\r
638 {\r
639         unsigned int keys, keys2, allActions[2] = { 0, 0 }, events;\r
640         static unsigned int prevEvents = 0;\r
641         int joy, i;\r
642 \r
643         keys = gp2x_joystick_read(0);\r
644         if (keys & GP2X_SELECT) {\r
645                 engineState = select_exits ? PGS_Quit : PGS_Menu;\r
646                 // wait until select is released, so menu would not resume game\r
647                 while (gp2x_joystick_read(1) & GP2X_SELECT) usleep(50*1000);\r
648         }\r
649 \r
650         keys &= CONFIGURABLE_KEYS;\r
651         keys2 = keys;\r
652 \r
653         for (i = 0; i < 32; i++)\r
654         {\r
655                 if (keys2 & (1 << i))\r
656                 {\r
657                         int pl, acts = currentConfig.KeyBinds[i];\r
658                         if (!acts) continue;\r
659                         pl = (acts >> 16) & 1;\r
660                         if (kb_combo_keys & (1 << i))\r
661                         {\r
662                                 int u = i+1, acts_c = acts & kb_combo_acts;\r
663                                 // let's try to find the other one\r
664                                 if (acts_c) {\r
665                                         for (; u < 32; u++)\r
666                                                 if ( (keys2 & (1 << u)) && (currentConfig.KeyBinds[u] & acts_c) ) {\r
667                                                         allActions[pl] |= acts_c & currentConfig.KeyBinds[u];\r
668                                                         keys2 &= ~((1 << i) | (1 << u));\r
669                                                         break;\r
670                                                 }\r
671                                 }\r
672                                 // add non-combo actions if combo ones were not found\r
673                                 if (!acts_c || u == 32)\r
674                                         allActions[pl] |= acts & ~kb_combo_acts;\r
675                         } else {\r
676                                 allActions[pl] |= acts;\r
677                         }\r
678                 }\r
679         }\r
680 \r
681         // add joy inputs\r
682         if (num_of_joys > 0)\r
683         {\r
684                 gp2x_usbjoy_update();\r
685                 for (joy = 0; joy < num_of_joys; joy++) {\r
686                         int btns = gp2x_usbjoy_check2(joy);\r
687                         for (i = 0; i < 32; i++) {\r
688                                 if (btns & (1 << i)) {\r
689                                         int acts = currentConfig.JoyBinds[joy][i];\r
690                                         int pl = (acts >> 16) & 1;\r
691                                         allActions[pl] |= acts;\r
692                                 }\r
693                         }\r
694                 }\r
695         }\r
696 \r
697         PicoPad[0] = allActions[0] & 0xfff;\r
698         PicoPad[1] = allActions[1] & 0xfff;\r
699 \r
700         if (allActions[0] & 0x7000) emu_DoTurbo(&PicoPad[0], allActions[0]);\r
701         if (allActions[1] & 0x7000) emu_DoTurbo(&PicoPad[1], allActions[1]);\r
702 \r
703         events = (allActions[0] | allActions[1]) >> 16;\r
704 \r
705         // volume is treated in special way and triggered every frame\r
706         if (events & 0x6000)\r
707                 update_volume(1, events & 0x2000);\r
708 \r
709         if ((events ^ prevEvents) & 0x40) {\r
710                 emu_changeFastForward(events & 0x40);\r
711                 update_volume(0, 0);\r
712                 reset_timing = 1;\r
713         }\r
714 \r
715         events &= ~prevEvents;\r
716 \r
717         if (PicoAHW == PAHW_PICO)\r
718                 RunEventsPico(events, keys);\r
719         if (events) RunEvents(events);\r
720         if (movie_data) emu_updateMovie();\r
721 \r
722         prevEvents = (allActions[0] | allActions[1]) >> 16;\r
723 }\r
724 \r
725 \r
726 static void updateSound(int len)\r
727 {\r
728         if (PicoOpt&8) len<<=1;\r
729 \r
730         /* avoid writing audio when lagging behind to prevent audio lag */\r
731         if (PicoSkipFrame != 2)\r
732                 gp2x_sound_write(PsndOut, len<<1);\r
733 }\r
734 \r
735 \r
736 static void SkipFrame(int do_audio)\r
737 {\r
738         PicoSkipFrame=do_audio ? 1 : 2;\r
739         PicoFrame();\r
740         PicoSkipFrame=0;\r
741 }\r
742 \r
743 \r
744 void emu_forcedFrame(int opts)\r
745 {\r
746         int po_old = PicoOpt;\r
747         int eo_old = currentConfig.EmuOpt;\r
748 \r
749         PicoOpt &= ~0x10;\r
750         PicoOpt |= opts|POPT_ACC_SPRITES; // acc_sprites\r
751         currentConfig.EmuOpt |= 0x80;\r
752 \r
753         //vidResetMode();\r
754 #ifdef USE_320_SCREEN\r
755         PicoDrawSetColorFormat(1);\r
756         PicoScanBegin = EmuScanBegin16;\r
757 #else\r
758         PicoDrawSetColorFormat(-1);\r
759         PicoScanEnd = EmuScanEnd16;\r
760 #endif\r
761         Pico.m.dirtyPal = 1;\r
762         PicoFrameDrawOnly();\r
763 \r
764 /*\r
765         if (!(Pico.video.reg[12]&1)) {\r
766                 vidCpyM2 = vidCpyM2_32col;\r
767                 clearArea(1);\r
768         } else  vidCpyM2 = vidCpyM2_40col;\r
769 \r
770         vidCpyM2((unsigned char *)gp2x_screen+SCREEN_WIDTH*8, PicoDraw2FB+328*8);\r
771         vidConvCpyRGB32(localPal, Pico.cram, 0x40);\r
772         gp2x_video_setpalette(localPal, 0x40);\r
773 */\r
774         PicoOpt = po_old;\r
775         currentConfig.EmuOpt = eo_old;\r
776 }\r
777 \r
778 static void simpleWait(int thissec, int lim_time)\r
779 {\r
780         struct timeval tval;\r
781 \r
782         spend_cycles(1024);\r
783         gettimeofday(&tval, 0);\r
784         if (thissec != tval.tv_sec) tval.tv_usec+=1000000;\r
785 \r
786         while (tval.tv_usec < lim_time)\r
787         {\r
788                 spend_cycles(1024);\r
789                 gettimeofday(&tval, 0);\r
790                 if (thissec != tval.tv_sec) tval.tv_usec+=1000000;\r
791         }\r
792 }\r
793 \r
794 \r
795 void emu_Loop(void)\r
796 {\r
797         static int PsndRate_old = 0, PicoOpt_old = 0, pal_old = 0;\r
798         char fpsbuff[24]; // fps count c string\r
799         struct timeval tval; // timing\r
800         int pframes_done, pframes_shown, pthissec; // "period" frames, used for sync\r
801         int  frames_done,  frames_shown,  thissec; // actual frames\r
802         int oldmodes = 0, target_fps, target_frametime, lim_time, vsync_offset, i;\r
803         char *notice = 0;\r
804 \r
805         printf("entered emu_Loop()\n");\r
806 \r
807         fpsbuff[0] = 0;\r
808 \r
809         // make sure we are in correct mode\r
810         vidResetMode();\r
811         scaling_update();\r
812         Pico.m.dirtyPal = 1;\r
813         oldmodes = ((Pico.video.reg[12]&1)<<2) ^ 0xc;\r
814         emu_findKeyBindCombos();\r
815 \r
816         // pal/ntsc might have changed, reset related stuff\r
817         target_fps = Pico.m.pal ? 50 : 60;\r
818         target_frametime = 1000000/target_fps;\r
819         reset_timing = 1;\r
820 \r
821         // prepare sound stuff\r
822         if (currentConfig.EmuOpt & 4)\r
823         {\r
824                 int snd_excess_add;\r
825                 if (PsndRate != PsndRate_old || (PicoOpt&0x20b) != (PicoOpt_old&0x20b) || Pico.m.pal != pal_old)\r
826                         PsndRerate(Pico.m.frame_count ? 1 : 0);\r
827 \r
828                 snd_excess_add = ((PsndRate - PsndLen*target_fps)<<16) / target_fps;\r
829                 printf("starting audio: %i len: %i (ex: %04x) stereo: %i, pal: %i\n",\r
830                         PsndRate, PsndLen, snd_excess_add, (PicoOpt&8)>>3, Pico.m.pal);\r
831                 gp2x_start_sound(PsndRate, 16, (PicoOpt&8)>>3);\r
832                 gp2x_sound_volume(currentConfig.volume, currentConfig.volume);\r
833                 PicoWriteSound = updateSound;\r
834                 update_volume(0, 0);\r
835                 memset(sndBuffer, 0, sizeof(sndBuffer));\r
836                 PsndOut = sndBuffer;\r
837                 PsndRate_old = PsndRate;\r
838                 PicoOpt_old  = PicoOpt;\r
839                 pal_old = Pico.m.pal;\r
840         } else {\r
841                 PsndOut = NULL;\r
842         }\r
843 \r
844         // prepare CD buffer\r
845         if (PicoAHW & PAHW_MCD) PicoCDBufferInit();\r
846 \r
847         // calc vsync offset to sync timing code with vsync\r
848         if (currentConfig.EmuOpt&0x2000) {\r
849                 gettimeofday(&tval, 0);\r
850                 gp2x_video_wait_vsync();\r
851                 gettimeofday(&tval, 0);\r
852                 vsync_offset = tval.tv_usec;\r
853                 while (vsync_offset >= target_frametime)\r
854                         vsync_offset -= target_frametime;\r
855                 if (!vsync_offset) vsync_offset++;\r
856                 printf("vsync_offset: %i\n", vsync_offset);\r
857         } else\r
858                 vsync_offset = 0;\r
859 \r
860         frames_done = frames_shown = thissec =\r
861         pframes_done = pframes_shown = pthissec = 0;\r
862 \r
863         // loop\r
864         while (engineState == PGS_Running)\r
865         {\r
866                 int modes;\r
867 \r
868                 gettimeofday(&tval, 0);\r
869                 if (reset_timing) {\r
870                         reset_timing = 0;\r
871                         pthissec = tval.tv_sec;\r
872                         pframes_shown = pframes_done = tval.tv_usec/target_frametime;\r
873                 }\r
874 \r
875                 // show notice message?\r
876                 if (noticeMsgTime.tv_sec)\r
877                 {\r
878                         static int noticeMsgSum;\r
879                         if((tval.tv_sec*1000000+tval.tv_usec) - (noticeMsgTime.tv_sec*1000000+noticeMsgTime.tv_usec) > 2000000) { // > 2.0 sec\r
880                                 noticeMsgTime.tv_sec = noticeMsgTime.tv_usec = 0;\r
881                                 clearArea(0);\r
882                                 notice = 0;\r
883                         } else {\r
884                                 int sum = noticeMsg[0]+noticeMsg[1]+noticeMsg[2];\r
885                                 if (sum != noticeMsgSum) { clearArea(0); noticeMsgSum = sum; }\r
886                                 notice = noticeMsg;\r
887                         }\r
888                 }\r
889 \r
890                 // check for mode changes\r
891                 modes = ((Pico.video.reg[12]&1)<<2)|(Pico.video.reg[1]&8);\r
892                 if (modes != oldmodes)\r
893                 {\r
894                         int scalex = SCREEN_WIDTH;\r
895                         osd_fps_x = OSD_FPS_X;\r
896                         if (modes & 4) {\r
897                                 vidCpyM2 = vidCpyM2_40col;\r
898                         } else {\r
899                                 if (PicoOpt & 0x100) {\r
900                                         vidCpyM2 = vidCpyM2_32col_nobord;\r
901                                         scalex = 256;\r
902                                         osd_fps_x = OSD_FPS_X - 64;\r
903                                 } else {\r
904                                         vidCpyM2 = vidCpyM2_32col;\r
905                                 }\r
906                         }\r
907                         if (currentConfig.scaling == 2 && !(modes&8)) // want vertical scaling and game is not in 240 line mode\r
908                              gp2x_video_RGB_setscaling(8, scalex, 224);\r
909                         else gp2x_video_RGB_setscaling(0, scalex, 240);\r
910                         oldmodes = modes;\r
911                         clearArea(1);\r
912                 }\r
913 \r
914                 // second changed?\r
915                 if (thissec != tval.tv_sec)\r
916                 {\r
917 #ifdef BENCHMARK\r
918                         static int bench = 0, bench_fps = 0, bench_fps_s = 0, bfp = 0, bf[4];\r
919                         if (++bench == 4) {\r
920                                 bench = 0;\r
921                                 bench_fps_s = bench_fps / 4;\r
922                                 bf[bfp++ & 3] = bench_fps / 4;\r
923                                 bench_fps = 0;\r
924                         }\r
925                         bench_fps += frames_shown;\r
926                         sprintf(fpsbuff, "%3i/%3i/%3i", frames_shown, bench_fps_s, (bf[0]+bf[1]+bf[2]+bf[3])>>2);\r
927                         printf("%s\n", fpsbuff);\r
928 #else\r
929                         if (currentConfig.EmuOpt & 2) {\r
930                                 sprintf(fpsbuff, "%3i/%3i", frames_shown, frames_done);\r
931                                 if (fpsbuff[5] == 0) { fpsbuff[5] = fpsbuff[6] = ' '; fpsbuff[7] = 0; }\r
932                         }\r
933 #endif\r
934                         frames_shown = frames_done = 0;\r
935                         thissec = tval.tv_sec;\r
936                 }\r
937 #ifdef PFRAMES\r
938                 sprintf(fpsbuff, "%i", Pico.m.frame_count);\r
939 #endif\r
940 \r
941                 if (pthissec != tval.tv_sec)\r
942                 {\r
943                         if (PsndOut == 0 && currentConfig.Frameskip >= 0) {\r
944                                 pframes_done = pframes_shown = 0;\r
945                         } else {\r
946                                 // it is quite common for this implementation to leave 1 fame unfinished\r
947                                 // when second changes, but we don't want buffer to starve.\r
948                                 if(PsndOut && pframes_done < target_fps && pframes_done > target_fps-5) {\r
949                                         updateKeys();\r
950                                         SkipFrame(1); pframes_done++;\r
951                                 }\r
952 \r
953                                 pframes_done  -= target_fps; if (pframes_done  < 0) pframes_done  = 0;\r
954                                 pframes_shown -= target_fps; if (pframes_shown < 0) pframes_shown = 0;\r
955                                 if (pframes_shown > pframes_done) pframes_shown = pframes_done;\r
956                         }\r
957                         pthissec = tval.tv_sec;\r
958                 }\r
959 \r
960                 lim_time = (pframes_done+1) * target_frametime + vsync_offset;\r
961                 if (currentConfig.Frameskip >= 0) // frameskip enabled\r
962                 {\r
963                         for(i = 0; i < currentConfig.Frameskip; i++) {\r
964                                 updateKeys();\r
965                                 SkipFrame(1); pframes_done++; frames_done++;\r
966                                 if (PsndOut && !reset_timing) { // do framelimitting if sound is enabled\r
967                                         gettimeofday(&tval, 0);\r
968                                         if (pthissec != tval.tv_sec) tval.tv_usec+=1000000;\r
969                                         if (tval.tv_usec < lim_time) { // we are too fast\r
970                                                 simpleWait(pthissec, lim_time);\r
971                                         }\r
972                                 }\r
973                                 lim_time += target_frametime;\r
974                         }\r
975                 }\r
976                 else if (tval.tv_usec > lim_time) // auto frameskip\r
977                 {\r
978                         // no time left for this frame - skip\r
979                         if (tval.tv_usec - lim_time >= 300000) {\r
980                                 /* something caused a slowdown for us (disk access? cache flush?)\r
981                                  * try to recover by resetting timing... */\r
982                                 reset_timing = 1;\r
983                                 continue;\r
984                         }\r
985                         updateKeys();\r
986                         SkipFrame(tval.tv_usec < lim_time+target_frametime*2); pframes_done++; frames_done++;\r
987                         continue;\r
988                 }\r
989 \r
990                 updateKeys();\r
991                 PicoFrame();\r
992 \r
993                 // check time\r
994                 gettimeofday(&tval, 0);\r
995                 if (pthissec != tval.tv_sec) tval.tv_usec+=1000000;\r
996 \r
997                 if (currentConfig.Frameskip < 0 && tval.tv_usec - lim_time >= 300000) // slowdown detection\r
998                         reset_timing = 1;\r
999 /*              else if (PsndOut != NULL || currentConfig.Frameskip < 0)\r
1000                 {\r
1001                         // sleep or vsync if we are still too fast\r
1002                         // usleep sleeps for ~20ms minimum, so it is not a solution here\r
1003                         if (!reset_timing && tval.tv_usec < lim_time)\r
1004                         {\r
1005                                 // we are too fast\r
1006                                 if (vsync_offset) {\r
1007                                         if (lim_time - tval.tv_usec > target_frametime/2)\r
1008                                                 simpleWait(pthissec, lim_time - target_frametime/4);\r
1009                                         gp2x_video_wait_vsync();\r
1010                                 } else {\r
1011                                         simpleWait(pthissec, lim_time);\r
1012                                 }\r
1013                         }\r
1014                 }\r
1015 */\r
1016                 blit(fpsbuff, notice);\r
1017 \r
1018                 pframes_done++; pframes_shown++;\r
1019                  frames_done++;  frames_shown++;\r
1020         }\r
1021 \r
1022         emu_changeFastForward(0);\r
1023 \r
1024         if (PicoAHW & PAHW_MCD) PicoCDBufferFree();\r
1025 \r
1026         // save SRAM\r
1027         if((currentConfig.EmuOpt & 1) && SRam.changed) {\r
1028                 emu_state_cb("Writing SRAM/BRAM..");\r
1029                 emu_SaveLoadGame(0, 1);\r
1030                 SRam.changed = 0;\r
1031         }\r
1032 \r
1033         // if in 8bit mode, generate 16bit image for menu background\r
1034         if ((PicoOpt&0x10) || !(currentConfig.EmuOpt&0x80))\r
1035                 emu_forcedFrame(POPT_EN_SOFTSCALE);\r
1036 }\r
1037 \r
1038 \r
1039 void emu_ResetGame(void)\r
1040 {\r
1041         PicoReset();\r
1042         reset_timing = 1;\r
1043 }\r
1044 \r