platform/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 <stdlib.h>\r
   8 #include <sys/time.h>\r
   9 #include <stdarg.h>\r
  10 \r
  11 #include "../common/arm_utils.h"\r
  12 #include "../common/fonts.h"\r
  13 #include "../common/emu.h"\r
  14 #include "../common/menu.h"\r
  15 #include "../common/config.h"\r
  16 #include "../common/input.h"\r
  17 #include "../linux/sndout_oss.h"\r
  18 #include "asm_utils.h"\r
  19 \r
  20 #include <pico/pico_int.h>\r
  21 #include <pico/patch.h>\r
  22 #include <pico/sound/mix.h>\r
  23 #include <zlib/zlib.h>\r
  24 \r
  25 //#define PFRAMES\r
  26 #define BENCHMARK\r
  27 //#define USE_320_SCREEN 1\r
  28 \r
  29 #ifdef BENCHMARK\r
  30 #define OSD_FPS_X (800-200)\r
  31 #else\r
  32 #define OSD_FPS_X (800-120)\r
  33 #endif\r
  34 \r
  35 \r
  36 static short __attribute__((aligned(4))) sndBuffer[2*44100/50];\r
  37 static int osd_fps_x;\r
  38 unsigned char *PicoDraw2FB = NULL;  // temporary buffer for alt renderer\r
  39 \r
  40 #define PICO_PEN_ADJUST_X 4\r
  41 #define PICO_PEN_ADJUST_Y 2\r
  42 static int pico_pen_x = 0, pico_pen_y = 240/2;\r
  43 \r
  44 \r
  45 int plat_get_root_dir(char *dst, int len)\r
  46 {\r
  47         extern char **g_argv;\r
  48         int j;\r
  49 \r
  50         strncpy(dst, g_argv[0], len);\r
  51         len -= 32; // reserve\r
  52         if (len < 0) len = 0;\r
  53         dst[len] = 0;\r
  54         for (j = strlen(dst); j > 0; j--)\r
  55                 if (dst[j] == '/') { dst[j+1] = 0; break; }\r
  56 \r
  57         return j + 1;\r
  58 }\r
  59 \r
  60 void pemu_prep_defconfig(void)\r
  61 {\r
  62         memset(&defaultConfig, 0, sizeof(defaultConfig));\r
  63         defaultConfig.EmuOpt    = 0x8f | 0x00600; // | <- confirm_save, cd_leds\r
  64         defaultConfig.s_PicoOpt  = 0x0f | POPT_EXT_FM|POPT_EN_MCD_PCM|POPT_EN_MCD_CDDA|POPT_EN_SVP_DRC;\r
  65         defaultConfig.s_PicoOpt |= POPT_ACC_SPRITES|POPT_EN_MCD_GFX;\r
  66         defaultConfig.EmuOpt    &= ~8; // no save gzip\r
  67         defaultConfig.s_PsndRate = 44100;\r
  68         defaultConfig.s_PicoRegion = 0;\r
  69         defaultConfig.s_PicoAutoRgnOrder = 0x184; // US, EU, JP\r
  70         defaultConfig.s_PicoCDBuffers = 0;\r
  71         defaultConfig.Frameskip = 0;\r
  72         defaultConfig.CPUclock = 200;\r
  73         defaultConfig.volume = 50;\r
  74         defaultConfig.scaling = 0;\r
  75         defaultConfig.turbo_rate = 15;\r
  76 }\r
  77 \r
  78 static void textOut16(int x, int y, const char *text)\r
  79 {\r
  80         int i,l,len=strlen(text);\r
  81         unsigned int *screen = (unsigned int *)((unsigned short *)g_screen_ptr + (x&~1) + y*g_screen_width);\r
  82 \r
  83         for (i = 0; i < len; i++)\r
  84         {\r
  85                 for (l=0;l<16;)\r
  86                 {\r
  87                         unsigned char fd = fontdata8x8[((text[i])*8)+l/2];\r
  88                         unsigned int *d = &screen[l*g_screen_width/2];\r
  89                         if (fd&0x80) d[0]=0xffffffff;\r
  90                         if (fd&0x40) d[1]=0xffffffff;\r
  91                         if (fd&0x20) d[2]=0xffffffff;\r
  92                         if (fd&0x10) d[3]=0xffffffff;\r
  93                         if (fd&0x08) d[4]=0xffffffff;\r
  94                         if (fd&0x04) d[5]=0xffffffff;\r
  95                         if (fd&0x02) d[6]=0xffffffff;\r
  96                         if (fd&0x01) d[7]=0xffffffff;\r
  97                         l++; d = &screen[l*g_screen_width/2];\r
  98                         if (fd&0x80) d[0]=0xffffffff;\r
  99                         if (fd&0x40) d[1]=0xffffffff;\r
 100                         if (fd&0x20) d[2]=0xffffffff;\r
 101                         if (fd&0x10) d[3]=0xffffffff;\r
 102                         if (fd&0x08) d[4]=0xffffffff;\r
 103                         if (fd&0x04) d[5]=0xffffffff;\r
 104                         if (fd&0x02) d[6]=0xffffffff;\r
 105                         if (fd&0x01) d[7]=0xffffffff;\r
 106                         l++;\r
 107                 }\r
 108                 screen += 8;\r
 109         }\r
 110 }\r
 111 \r
 112 \r
 113 static void osd_text(int x, int y, const char *text)\r
 114 {\r
 115         int len = strlen(text)*8;\r
 116 \r
 117         if ((PicoOpt&0x10)||!(currentConfig.EmuOpt&0x80)) {\r
 118                 int *p, i, h;\r
 119                 x &= ~3; // align x\r
 120                 len = (len+3) >> 2;\r
 121                 for (h = 0; h < 8; h++) {\r
 122                         p = (int *) ((unsigned char *) g_screen_ptr+x+g_screen_width*(y+h));\r
 123                         for (i = len; i; i--, p++) *p = 0xe0e0e0e0;\r
 124                 }\r
 125                 emu_text_out8(x, y, text);\r
 126         } else {\r
 127                 int *p, i, h;\r
 128                 x &= ~1; // align x\r
 129                 len++;\r
 130                 for (h = 0; h < 16; h++) {\r
 131                         p = (int *) ((unsigned short *) g_screen_ptr+x+g_screen_width*(y+h));\r
 132                         for (i = len; i; i--, p++) *p = 0;//(*p>>2)&0x39e7;\r
 133                 }\r
 134                 text_out16(x, y, text);\r
 135         }\r
 136 }\r
 137 \r
 138 static void draw_cd_leds(void)\r
 139 {\r
 140 //      static\r
 141         int old_reg;\r
 142 //      if (!((Pico_mcd->s68k_regs[0] ^ old_reg) & 3)) return; // no change // mmu hack problems?\r
 143         old_reg = Pico_mcd->s68k_regs[0];\r
 144 \r
 145         if ((PicoOpt&0x10)||!(currentConfig.EmuOpt&0x80)) {\r
 146                 // 8-bit modes\r
 147                 unsigned int col_g = (old_reg & 2) ? 0xc0c0c0c0 : 0xe0e0e0e0;\r
 148                 unsigned int col_r = (old_reg & 1) ? 0xd0d0d0d0 : 0xe0e0e0e0;\r
 149                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*2+ 4) =\r
 150                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*3+ 4) =\r
 151                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*4+ 4) = col_g;\r
 152                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*2+12) =\r
 153                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*3+12) =\r
 154                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*4+12) = col_r;\r
 155         } else {\r
 156                 // 16-bit modes\r
 157                 unsigned int *p = (unsigned int *)((short *)g_screen_ptr + g_screen_width*2+4);\r
 158                 unsigned int col_g = (old_reg & 2) ? 0x06000600 : 0;\r
 159                 unsigned int col_r = (old_reg & 1) ? 0xc000c000 : 0;\r
 160                 *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r; p += g_screen_width/2 - 12/2;\r
 161                 *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r; p += g_screen_width/2 - 12/2;\r
 162                 *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r;\r
 163         }\r
 164 }\r
 165 \r
 166 static void draw_pico_ptr(void)\r
 167 {\r
 168         unsigned short *p = (unsigned short *)g_screen_ptr;\r
 169 \r
 170         // only if pen enabled and for 16bit modes\r
 171         if (pico_inp_mode == 0 || (PicoOpt&0x10) || !(currentConfig.EmuOpt&0x80)) return;\r
 172 \r
 173         if (!(Pico.video.reg[12]&1) && !(PicoOpt&POPT_DIS_32C_BORDER))\r
 174                 p += 32;\r
 175 \r
 176         p += g_screen_width * (pico_pen_y + PICO_PEN_ADJUST_Y);\r
 177         p += pico_pen_x + PICO_PEN_ADJUST_X;\r
 178         p[0]   ^= 0xffff;\r
 179         p[319] ^= 0xffff;\r
 180         p[320] ^= 0xffff;\r
 181         p[321] ^= 0xffff;\r
 182         p[640] ^= 0xffff;\r
 183 }\r
 184 \r
 185 #ifdef USE_320_SCREEN\r
 186 \r
 187 static int EmuScanBegin16(unsigned int num)\r
 188 {\r
 189         DrawLineDest = (unsigned short *)g_screen_ptr + num*800 + 800/2 - 320/2;\r
 190         //int w = (Pico.video.reg[12]&1) ? 320 : 256;\r
 191         //DrawLineDest = (unsigned short *)g_screen_ptr + num*w;\r
 192 \r
 193         return 0;\r
 194 }\r
 195 \r
 196 #else // USE_320_SCREEN\r
 197 \r
 198 static int EmuScanEnd16(unsigned int num)\r
 199 {\r
 200         unsigned char  *ps=HighCol+8;\r
 201         unsigned short *pd;\r
 202         unsigned short *pal=HighPal;\r
 203         int sh = Pico.video.reg[0xC]&8;\r
 204         int len, mask = 0xff;\r
 205 \r
 206         pd=(unsigned short *)g_screen_ptr + num*800*2 + 800/2 - 320*2/2;\r
 207 \r
 208         if (Pico.m.dirtyPal)\r
 209                 PicoDoHighPal555(sh);\r
 210 \r
 211         if (Pico.video.reg[12]&1) {\r
 212                 len = 320;\r
 213         } else {\r
 214                 pd += 32*2;\r
 215                 len = 256;\r
 216         }\r
 217 \r
 218         if (!sh && (rendstatus & PDRAW_SPR_LO_ON_HI))\r
 219                 mask=0x3f; // messed sprites, upper bits are priority stuff\r
 220 \r
 221 #if 1\r
 222         clut_line(pd, ps, pal, (mask<<16) | len);\r
 223 #else\r
 224         for (; len > 0; len--)\r
 225         {\r
 226                 unsigned int p = pal[*ps++ & mask];\r
 227                 p |= p << 16;\r
 228                 *(unsigned int *)pd = p;\r
 229                 *(unsigned int *)(&pd[800]) = p;\r
 230                 pd += 2;\r
 231         }\r
 232 #endif\r
 233 \r
 234         return 0;\r
 235 }\r
 236 \r
 237 #endif // USE_320_SCREEN\r
 238 \r
 239 int localPal[0x100];\r
 240 static void (*vidCpyM2)(void *dest, void *src) = NULL;\r
 241 \r
 242 static void blit(const char *fps, const char *notice)\r
 243 {\r
 244         int emu_opt = currentConfig.EmuOpt;\r
 245 \r
 246         if (PicoOpt&0x10)\r
 247         {\r
 248                 // 8bit fast renderer\r
 249                 if (Pico.m.dirtyPal) {\r
 250                         Pico.m.dirtyPal = 0;\r
 251                         vidConvCpyRGB32(localPal, Pico.cram, 0x40);\r
 252                         // feed new palette to our device\r
 253                         // gp2x_video_setpalette(localPal, 0x40);\r
 254                 }\r
 255                 // a hack for VR\r
 256                 if (PicoAHW & PAHW_SVP)\r
 257                         memset32((int *)(PicoDraw2FB+328*8+328*223), 0xe0e0e0e0, 328);\r
 258                 // do actual copy\r
 259                 vidCpyM2((unsigned char *)g_screen_ptr+g_screen_width*8, PicoDraw2FB+328*8);\r
 260         }\r
 261         else if (!(emu_opt&0x80))\r
 262         {\r
 263                 // 8bit accurate renderer\r
 264                 if (Pico.m.dirtyPal)\r
 265                 {\r
 266                         int pallen = 0xc0;\r
 267                         Pico.m.dirtyPal = 0;\r
 268                         if (Pico.video.reg[0xC]&8) // shadow/hilight mode\r
 269                         {\r
 270                                 vidConvCpyRGB32(localPal, Pico.cram, 0x40);\r
 271                                 vidConvCpyRGB32sh(localPal+0x40, Pico.cram, 0x40);\r
 272                                 vidConvCpyRGB32hi(localPal+0x80, Pico.cram, 0x40);\r
 273                                 memcpy32(localPal+0xc0, localPal+0x40, 0x40);\r
 274                                 pallen = 0x100;\r
 275                         }\r
 276                         else if (rendstatus & PDRAW_SONIC_MODE) { // mid-frame palette changes\r
 277                                 vidConvCpyRGB32(localPal, Pico.cram, 0x40);\r
 278                                 vidConvCpyRGB32(localPal+0x40, HighPal, 0x40);\r
 279                                 vidConvCpyRGB32(localPal+0x80, HighPal+0x40, 0x40);\r
 280                                 pallen = 0xc0;\r
 281                         }\r
 282                         else {\r
 283                                 vidConvCpyRGB32(localPal, Pico.cram, 0x40);\r
 284                                 memcpy32(localPal+0x80, localPal, 0x40);\r
 285                         }\r
 286                         if (pallen > 0xc0) {\r
 287                                 localPal[0xc0] = 0x0000c000;\r
 288                                 localPal[0xd0] = 0x00c00000;\r
 289                                 localPal[0xe0] = 0x00000000; // reserved pixels for OSD\r
 290                                 localPal[0xf0] = 0x00ffffff;\r
 291                         }\r
 292                         // gp2x_video_setpalette(localPal, pallen);\r
 293                 }\r
 294         }\r
 295 \r
 296         if (notice || (emu_opt & 2)) {\r
 297                 int h = g_screen_height-16;\r
 298                 if (currentConfig.scaling == 2 && !(Pico.video.reg[1]&8)) h -= 16;\r
 299                 if (notice) osd_text(4, h, notice);\r
 300                 if (emu_opt & 2)\r
 301                         osd_text(osd_fps_x, h, fps);\r
 302         }\r
 303         if ((emu_opt & 0x400) && (PicoAHW & PAHW_MCD))\r
 304                 draw_cd_leds();\r
 305         if (PicoAHW & PAHW_PICO)\r
 306                 draw_pico_ptr();\r
 307 \r
 308         //gp2x_video_wait_vsync();\r
 309         // gp2x_video_flip();\r
 310 }\r
 311 \r
 312 \r
 313 // clears whole screen or just the notice area (in all buffers)\r
 314 static void clearArea(int full)\r
 315 {\r
 316         if (full) memset(g_screen_ptr, 0, g_screen_width*g_screen_height*2);\r
 317         else      memset((short *)g_screen_ptr + g_screen_width * (g_screen_height - 16), 0,\r
 318                         g_screen_width * 16 * 2);\r
 319 }\r
 320 \r
 321 \r
 322 static void vidResetMode(void)\r
 323 {\r
 324 #if 0\r
 325         if (PicoOpt&0x10) {\r
 326                 gp2x_video_changemode(8);\r
 327         } else if (currentConfig.EmuOpt&0x80) {\r
 328                 gp2x_video_changemode(16);\r
 329 #ifdef USE_320_SCREEN\r
 330                 PicoDrawSetColorFormat(1);\r
 331                 PicoScanBegin = EmuScanBegin16;\r
 332 #else\r
 333                 PicoDrawSetColorFormat(-1);\r
 334                 PicoScanEnd = EmuScanEnd16;\r
 335 #endif\r
 336         } else {\r
 337                 gp2x_video_changemode(8);\r
 338                 PicoDrawSetColorFormat(2);\r
 339                 PicoScanBegin = EmuScanBegin8;\r
 340         }\r
 341         if ((PicoOpt&0x10)||!(currentConfig.EmuOpt&0x80)) {\r
 342                 // setup pal for 8-bit modes\r
 343                 localPal[0xc0] = 0x0000c000; // MCD LEDs\r
 344                 localPal[0xd0] = 0x00c00000;\r
 345                 localPal[0xe0] = 0x00000000; // reserved pixels for OSD\r
 346                 localPal[0xf0] = 0x00ffffff;\r
 347                 gp2x_video_setpalette(localPal, 0x100);\r
 348                 gp2x_memset_all_buffers(0, 0xe0, 320*240);\r
 349                 gp2x_video_flip();\r
 350         }\r
 351         Pico.m.dirtyPal = 1;\r
 352         // reset scaling\r
 353         if (currentConfig.scaling == 2 && !(Pico.video.reg[1]&8))\r
 354              gp2x_video_RGB_setscaling(8, (PicoOpt&0x100)&&!(Pico.video.reg[12]&1) ? 256 : 320, 224);\r
 355         else gp2x_video_RGB_setscaling(0, (PicoOpt&0x100)&&!(Pico.video.reg[12]&1) ? 256 : 320, 240);\r
 356 #else\r
 357 #ifdef USE_320_SCREEN\r
 358         PicoDrawSetColorFormat(1);\r
 359         PicoScanBegin = EmuScanBegin16;\r
 360 #else\r
 361         PicoDrawSetColorFormat(-1);\r
 362         PicoScanEnd = EmuScanEnd16;\r
 363 #endif\r
 364 #endif\r
 365 }\r
 366 \r
 367 \r
 368 static void update_volume(int has_changed, int is_up)\r
 369 {\r
 370         static int prev_frame = 0, wait_frames = 0;\r
 371         int vol = currentConfig.volume;\r
 372 \r
 373         if (has_changed)\r
 374         {\r
 375                 if (vol < 5 && (PicoOpt&8) && prev_frame == Pico.m.frame_count - 1 && wait_frames < 12)\r
 376                         wait_frames++;\r
 377                 else {\r
 378                         if (is_up) {\r
 379                                 if (vol < 99) vol++;\r
 380                         } else {\r
 381                                 if (vol >  0) vol--;\r
 382                         }\r
 383                         wait_frames = 0;\r
 384                         sndout_oss_setvol(vol, vol);\r
 385                         currentConfig.volume = vol;\r
 386                 }\r
 387                 sprintf(noticeMsg, "VOL: %02i", vol);\r
 388                 gettimeofday(&noticeMsgTime, 0);\r
 389                 prev_frame = Pico.m.frame_count;\r
 390         }\r
 391 \r
 392         // set the right mixer func\r
 393         if (!(PicoOpt&8)) return; // just use defaults for mono\r
 394         if (vol >= 5)\r
 395                 PsndMix_32_to_16l = mix_32_to_16l_stereo;\r
 396         else {\r
 397                 mix_32_to_16l_level = 5 - vol;\r
 398                 PsndMix_32_to_16l = mix_32_to_16l_stereo_lvl;\r
 399         }\r
 400 }\r
 401 \r
 402 \r
 403 static void updateSound(int len)\r
 404 {\r
 405         if (PicoOpt&8) len<<=1;\r
 406 \r
 407         /* avoid writing audio when lagging behind to prevent audio lag */\r
 408         if (PicoSkipFrame != 2)\r
 409                 sndout_oss_write(PsndOut, len<<1);\r
 410 }\r
 411 \r
 412 \r
 413 static void SkipFrame(int do_audio)\r
 414 {\r
 415         PicoSkipFrame=do_audio ? 1 : 2;\r
 416         PicoFrame();\r
 417         PicoSkipFrame=0;\r
 418 }\r
 419 \r
 420 \r
 421 void pemu_forced_frame(int opts)\r
 422 {\r
 423         int po_old = PicoOpt;\r
 424         int eo_old = currentConfig.EmuOpt;\r
 425 \r
 426         PicoOpt &= ~0x10;\r
 427         PicoOpt |= opts|POPT_ACC_SPRITES; // acc_sprites\r
 428         currentConfig.EmuOpt |= 0x80;\r
 429 \r
 430         //vidResetMode();\r
 431 #ifdef USE_320_SCREEN\r
 432         PicoDrawSetColorFormat(1);\r
 433         PicoScanBegin = EmuScanBegin16;\r
 434 #else\r
 435         PicoDrawSetColorFormat(-1);\r
 436         PicoScanEnd = EmuScanEnd16;\r
 437 #endif\r
 438         Pico.m.dirtyPal = 1;\r
 439         PicoFrameDrawOnly();\r
 440 \r
 441 /*\r
 442         if (!(Pico.video.reg[12]&1)) {\r
 443                 vidCpyM2 = vidCpyM2_32col;\r
 444                 clearArea(1);\r
 445         } else  vidCpyM2 = vidCpyM2_40col;\r
 446 \r
 447         vidCpyM2((unsigned char *)g_screen_ptr+g_screen_width*8, PicoDraw2FB+328*8);\r
 448         vidConvCpyRGB32(localPal, Pico.cram, 0x40);\r
 449         gp2x_video_setpalette(localPal, 0x40);\r
 450 */\r
 451         PicoOpt = po_old;\r
 452         currentConfig.EmuOpt = eo_old;\r
 453 }\r
 454 \r
 455 void plat_debug_cat(char *str)\r
 456 {\r
 457 }\r
 458 \r
 459 static void simpleWait(int thissec, int lim_time)\r
 460 {\r
 461         struct timeval tval;\r
 462 \r
 463         spend_cycles(1024);\r
 464         gettimeofday(&tval, 0);\r
 465         if (thissec != tval.tv_sec) tval.tv_usec+=1000000;\r
 466 \r
 467         while (tval.tv_usec < lim_time)\r
 468         {\r
 469                 spend_cycles(1024);\r
 470                 gettimeofday(&tval, 0);\r
 471                 if (thissec != tval.tv_sec) tval.tv_usec+=1000000;\r
 472         }\r
 473 }\r
 474 \r
 475 void pemu_sound_start(void)\r
 476 {\r
 477         static int PsndRate_old = 0, PicoOpt_old = 0, pal_old = 0;\r
 478         int target_fps = Pico.m.pal ? 50 : 60;\r
 479 \r
 480         PsndOut = NULL;\r
 481 \r
 482         if (currentConfig.EmuOpt & 4)\r
 483         {\r
 484                 int snd_excess_add;\r
 485                 if (PsndRate != PsndRate_old || (PicoOpt&0x20b) != (PicoOpt_old&0x20b) || Pico.m.pal != pal_old)\r
 486                         PsndRerate(Pico.m.frame_count ? 1 : 0);\r
 487 \r
 488                 snd_excess_add = ((PsndRate - PsndLen*target_fps)<<16) / target_fps;\r
 489                 printf("starting audio: %i len: %i (ex: %04x) stereo: %i, pal: %i\n",\r
 490                         PsndRate, PsndLen, snd_excess_add, (PicoOpt&8)>>3, Pico.m.pal);\r
 491                 sndout_oss_start(PsndRate, 16, (PicoOpt&8)>>3);\r
 492                 sndout_oss_setvol(currentConfig.volume, currentConfig.volume);\r
 493                 PicoWriteSound = updateSound;\r
 494                 update_volume(0, 0);\r
 495                 memset(sndBuffer, 0, sizeof(sndBuffer));\r
 496                 PsndOut = sndBuffer;\r
 497                 PsndRate_old = PsndRate;\r
 498                 PicoOpt_old  = PicoOpt;\r
 499                 pal_old = Pico.m.pal;\r
 500         }\r
 501 }\r
 502 \r
 503 void pemu_sound_stop(void)\r
 504 {\r
 505 }\r
 506 \r
 507 void pemu_sound_wait(void)\r
 508 {\r
 509         // don't need to do anything, writes will block by themselves\r
 510 }\r
 511 \r
 512 void pemu_loop(void)\r
 513 {\r
 514         char fpsbuff[24]; // fps count c string\r
 515         struct timeval tval; // timing\r
 516         int pframes_done, pframes_shown, pthissec; // "period" frames, used for sync\r
 517         int  frames_done,  frames_shown,  thissec; // actual frames\r
 518         int oldmodes = 0, target_fps, target_frametime, lim_time, vsync_offset, i;\r
 519         char *notice = 0;\r
 520 \r
 521         printf("entered emu_Loop()\n");\r
 522 \r
 523         fpsbuff[0] = 0;\r
 524 \r
 525         // make sure we are in correct mode\r
 526         vidResetMode();\r
 527         Pico.m.dirtyPal = 1;\r
 528         oldmodes = ((Pico.video.reg[12]&1)<<2) ^ 0xc;\r
 529 \r
 530         // pal/ntsc might have changed, reset related stuff\r
 531         target_fps = Pico.m.pal ? 50 : 60;\r
 532         target_frametime = 1000000/target_fps;\r
 533         reset_timing = 1;\r
 534 \r
 535         pemu_sound_start();\r
 536 \r
 537         // prepare CD buffer\r
 538         if (PicoAHW & PAHW_MCD) PicoCDBufferInit();\r
 539 \r
 540         // calc vsync offset to sync timing code with vsync\r
 541         if (currentConfig.EmuOpt&0x2000) {\r
 542                 gettimeofday(&tval, 0);\r
 543                 //gp2x_video_wait_vsync();\r
 544                 gettimeofday(&tval, 0);\r
 545                 vsync_offset = tval.tv_usec;\r
 546                 while (vsync_offset >= target_frametime)\r
 547                         vsync_offset -= target_frametime;\r
 548                 if (!vsync_offset) vsync_offset++;\r
 549                 printf("vsync_offset: %i\n", vsync_offset);\r
 550         } else\r
 551                 vsync_offset = 0;\r
 552 \r
 553         frames_done = frames_shown = thissec =\r
 554         pframes_done = pframes_shown = pthissec = 0;\r
 555 \r
 556         // loop\r
 557         while (engineState == PGS_Running)\r
 558         {\r
 559                 int modes;\r
 560 \r
 561                 gettimeofday(&tval, 0);\r
 562                 if (reset_timing) {\r
 563                         reset_timing = 0;\r
 564                         pthissec = tval.tv_sec;\r
 565                         pframes_shown = pframes_done = tval.tv_usec/target_frametime;\r
 566                 }\r
 567 \r
 568                 // show notice message?\r
 569                 if (noticeMsgTime.tv_sec)\r
 570                 {\r
 571                         static int noticeMsgSum;\r
 572                         if((tval.tv_sec*1000000+tval.tv_usec) - (noticeMsgTime.tv_sec*1000000+noticeMsgTime.tv_usec) > 2000000) { // > 2.0 sec\r
 573                                 noticeMsgTime.tv_sec = noticeMsgTime.tv_usec = 0;\r
 574                                 clearArea(0);\r
 575                                 notice = 0;\r
 576                         } else {\r
 577                                 int sum = noticeMsg[0]+noticeMsg[1]+noticeMsg[2];\r
 578                                 if (sum != noticeMsgSum) { clearArea(0); noticeMsgSum = sum; }\r
 579                                 notice = noticeMsg;\r
 580                         }\r
 581                 }\r
 582 \r
 583                 // check for mode changes\r
 584                 modes = ((Pico.video.reg[12]&1)<<2)|(Pico.video.reg[1]&8);\r
 585                 if (modes != oldmodes)\r
 586                 {\r
 587                         int scalex = g_screen_width;\r
 588                         osd_fps_x = OSD_FPS_X;\r
 589                         if (modes & 4) {\r
 590                                 vidCpyM2 = vidCpyM2_40col;\r
 591                         } else {\r
 592                                 if (PicoOpt & 0x100) {\r
 593                                         vidCpyM2 = vidCpyM2_32col_nobord;\r
 594                                         scalex = 256;\r
 595                                         osd_fps_x = OSD_FPS_X - 64;\r
 596                                 } else {\r
 597                                         vidCpyM2 = vidCpyM2_32col;\r
 598                                 }\r
 599                         }\r
 600                         //if (currentConfig.scaling == 2 && !(modes&8)) // want vertical scaling and game is not in 240 line mode\r
 601                         //      gp2x_video_RGB_setscaling(8, scalex, 224);\r
 602                         // else gp2x_video_RGB_setscaling(0, scalex, 240);\r
 603                         oldmodes = modes;\r
 604                         clearArea(1);\r
 605                 }\r
 606 \r
 607                 // second changed?\r
 608                 if (thissec != tval.tv_sec)\r
 609                 {\r
 610 #ifdef BENCHMARK\r
 611                         static int bench = 0, bench_fps = 0, bench_fps_s = 0, bfp = 0, bf[4];\r
 612                         if (++bench == 4) {\r
 613                                 bench = 0;\r
 614                                 bench_fps_s = bench_fps / 4;\r
 615                                 bf[bfp++ & 3] = bench_fps / 4;\r
 616                                 bench_fps = 0;\r
 617                         }\r
 618                         bench_fps += frames_shown;\r
 619                         sprintf(fpsbuff, "%3i/%3i/%3i", frames_shown, bench_fps_s, (bf[0]+bf[1]+bf[2]+bf[3])>>2);\r
 620                         printf("%s\n", fpsbuff);\r
 621 #else\r
 622                         if (currentConfig.EmuOpt & 2) {\r
 623                                 sprintf(fpsbuff, "%3i/%3i", frames_shown, frames_done);\r
 624                                 if (fpsbuff[5] == 0) { fpsbuff[5] = fpsbuff[6] = ' '; fpsbuff[7] = 0; }\r
 625                         }\r
 626 #endif\r
 627                         frames_shown = frames_done = 0;\r
 628                         thissec = tval.tv_sec;\r
 629                 }\r
 630 #ifdef PFRAMES\r
 631                 sprintf(fpsbuff, "%i", Pico.m.frame_count);\r
 632 #endif\r
 633 \r
 634                 if (pthissec != tval.tv_sec)\r
 635                 {\r
 636                         if (PsndOut == 0 && currentConfig.Frameskip >= 0) {\r
 637                                 pframes_done = pframes_shown = 0;\r
 638                         } else {\r
 639                                 // it is quite common for this implementation to leave 1 fame unfinished\r
 640                                 // when second changes, but we don't want buffer to starve.\r
 641                                 if(PsndOut && pframes_done < target_fps && pframes_done > target_fps-5) {\r
 642                                         emu_update_input();\r
 643                                         SkipFrame(1); pframes_done++;\r
 644                                 }\r
 645 \r
 646                                 pframes_done  -= target_fps; if (pframes_done  < 0) pframes_done  = 0;\r
 647                                 pframes_shown -= target_fps; if (pframes_shown < 0) pframes_shown = 0;\r
 648                                 if (pframes_shown > pframes_done) pframes_shown = pframes_done;\r
 649                         }\r
 650                         pthissec = tval.tv_sec;\r
 651                 }\r
 652 \r
 653                 lim_time = (pframes_done+1) * target_frametime + vsync_offset;\r
 654                 if (currentConfig.Frameskip >= 0) // frameskip enabled\r
 655                 {\r
 656                         for(i = 0; i < currentConfig.Frameskip; i++) {\r
 657                                 emu_update_input();\r
 658                                 SkipFrame(1); pframes_done++; frames_done++;\r
 659                                 if (PsndOut && !reset_timing) { // do framelimitting if sound is enabled\r
 660                                         gettimeofday(&tval, 0);\r
 661                                         if (pthissec != tval.tv_sec) tval.tv_usec+=1000000;\r
 662                                         if (tval.tv_usec < lim_time) { // we are too fast\r
 663                                                 simpleWait(pthissec, lim_time);\r
 664                                         }\r
 665                                 }\r
 666                                 lim_time += target_frametime;\r
 667                         }\r
 668                 }\r
 669                 else if (tval.tv_usec > lim_time) // auto frameskip\r
 670                 {\r
 671                         // no time left for this frame - skip\r
 672                         if (tval.tv_usec - lim_time >= 300000) {\r
 673                                 /* something caused a slowdown for us (disk access? cache flush?)\r
 674                                  * try to recover by resetting timing... */\r
 675                                 reset_timing = 1;\r
 676                                 continue;\r
 677                         }\r
 678                         emu_update_input();\r
 679                         SkipFrame(tval.tv_usec < lim_time+target_frametime*2); pframes_done++; frames_done++;\r
 680                         continue;\r
 681                 }\r
 682 \r
 683                 emu_update_input();\r
 684                 PicoFrame();\r
 685 \r
 686                 // check time\r
 687                 gettimeofday(&tval, 0);\r
 688                 if (pthissec != tval.tv_sec) tval.tv_usec+=1000000;\r
 689 \r
 690                 if (currentConfig.Frameskip < 0 && tval.tv_usec - lim_time >= 300000) // slowdown detection\r
 691                         reset_timing = 1;\r
 692 #if 1\r
 693                 else if (PsndOut != NULL || currentConfig.Frameskip < 0)\r
 694                 {\r
 695                         // sleep or vsync if we are still too fast\r
 696                         // usleep sleeps for ~20ms minimum, so it is not a solution here\r
 697                         if (!reset_timing && tval.tv_usec < lim_time)\r
 698                         {\r
 699                                 // we are too fast\r
 700                                 if (vsync_offset) {\r
 701                                         if (lim_time - tval.tv_usec > target_frametime/2)\r
 702                                                 simpleWait(pthissec, lim_time - target_frametime/4);\r
 703                                         // gp2x_video_wait_vsync();\r
 704                                 } else {\r
 705                                         simpleWait(pthissec, lim_time);\r
 706                                 }\r
 707                         }\r
 708                 }\r
 709 #endif\r
 710                 blit(fpsbuff, notice);\r
 711 \r
 712                 pframes_done++; pframes_shown++;\r
 713                  frames_done++;  frames_shown++;\r
 714         }\r
 715 \r
 716         emu_set_fastforward(0);\r
 717 \r
 718         if (PicoAHW & PAHW_MCD) PicoCDBufferFree();\r
 719 \r
 720         // save SRAM\r
 721         if ((currentConfig.EmuOpt & EOPT_EN_SRAM) && SRam.changed) {\r
 722                 /* FIXME: plat_status_msg_busy_first */\r
 723                 emu_state_cb("Writing SRAM/BRAM..");\r
 724                 emu_save_load_game(0, 1);\r
 725                 SRam.changed = 0;\r
 726         }\r
 727 \r
 728         // if in 8bit mode, generate 16bit image for menu background\r
 729         if ((PicoOpt&0x10) || !(currentConfig.EmuOpt&0x80))\r
 730                 pemu_forced_frame(POPT_EN_SOFTSCALE);\r
 731 }\r
 732 \r