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