platform/gp2x/emu.c

   1 /*\r
   2  * (c) Copyright 2006-2010 notaz, All rights reserved.\r
   3  *\r
   4  * For performance reasons 3 renderers are exported for both MD and 32x modes:\r
   5  * - 16bpp line renderer\r
   6  * - 8bpp line renderer (slightly faster)\r
   7  * - 8bpp tile renderer\r
   8  * In 32x mode:\r
   9  * - 32x layer is overlayed on top of 16bpp one\r
  10  * - line internal one done on PicoDraw2FB, then mixed with 32x\r
  11  * - tile internal one done on PicoDraw2FB, then mixed with 32x\r
  12  */\r
  13 \r
  14 #include <stdio.h>\r
  15 #include <stdlib.h>\r
  16 #include <unistd.h>\r
  17 \r
  18 #include "../libpicofe/gp2x/plat_gp2x.h"\r
  19 #include "../libpicofe/gp2x/soc.h"\r
  20 #include "../libpicofe/input.h"\r
  21 #include "../libpicofe/plat.h"\r
  22 #include "../libpicofe/gp2x/soc_pollux.h"\r
  23 #include "../common/menu_pico.h"\r
  24 #include "../common/arm_utils.h"\r
  25 #include "../common/emu.h"\r
  26 #include "../common/config_file.h"\r
  27 #include "../common/version.h"\r
  28 #include "plat.h"\r
  29 \r
  30 #include <pico/pico_int.h>\r
  31 #include <pico/patch.h>\r
  32 #include <pico/sound/mix.h>\r
  33 #include <zlib/zlib.h>\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 //extern int crashed_940;\r
  43 \r
  44 static int osd_fps_x, osd_y, doing_bg_frame;\r
  45 const char *renderer_names[] = { "16bit accurate", " 8bit accurate", " 8bit fast", NULL };\r
  46 const char *renderer_names32x[] = { "accurate", "faster", "fastest", NULL };\r
  47 enum renderer_types { RT_16BIT, RT_8BIT_ACC, RT_8BIT_FAST, RT_COUNT };\r
  48 \r
  49 static int (*emu_scan_begin)(unsigned int num) = NULL;\r
  50 static int (*emu_scan_end)(unsigned int num) = NULL;\r
  51 \r
  52 \r
  53 void pemu_prep_defconfig(void)\r
  54 {\r
  55         gp2x_soc_t soc;\r
  56 \r
  57         defaultConfig.CPUclock = default_cpu_clock;\r
  58         defaultConfig.renderer32x = RT_8BIT_FAST;\r
  59         defaultConfig.analog_deadzone = 50;\r
  60 \r
  61         soc = soc_detect();\r
  62         if (soc == SOCID_MMSP2)\r
  63                 defaultConfig.s_PicoOpt |= POPT_EXT_FM;\r
  64         else if (soc == SOCID_POLLUX) {\r
  65                 defaultConfig.EmuOpt |= EOPT_WIZ_TEAR_FIX|EOPT_SHOW_RTC;\r
  66                 defaultConfig.s_PicoOpt |= POPT_EN_MCD_GFX;\r
  67         }\r
  68 }\r
  69 \r
  70 void pemu_validate_config(void)\r
  71 {\r
  72         if (gp2x_dev_id != GP2X_DEV_GP2X)\r
  73                 PicoOpt &= ~POPT_EXT_FM;\r
  74         if (gp2x_dev_id != GP2X_DEV_WIZ)\r
  75                 currentConfig.EmuOpt &= ~EOPT_WIZ_TEAR_FIX;\r
  76 \r
  77         if (currentConfig.gamma < 10 || currentConfig.gamma > 300)\r
  78                 currentConfig.gamma = 100;\r
  79 \r
  80         if (currentConfig.CPUclock < 10 || currentConfig.CPUclock > 1024)\r
  81                 currentConfig.CPUclock = default_cpu_clock;\r
  82 }\r
  83 \r
  84 static int get_renderer(void)\r
  85 {\r
  86         if (PicoAHW & PAHW_32X)\r
  87                 return currentConfig.renderer32x;\r
  88         else\r
  89                 return currentConfig.renderer;\r
  90 }\r
  91 \r
  92 static void change_renderer(int diff)\r
  93 {\r
  94         int *r;\r
  95         if (PicoAHW & PAHW_32X)\r
  96                 r = &currentConfig.renderer32x;\r
  97         else\r
  98                 r = &currentConfig.renderer;\r
  99         *r += diff;\r
 100 \r
 101         // 8bpp fast is not there (yet?)\r
 102         if ((PicoAHW & PAHW_SMS) && *r == RT_8BIT_FAST)\r
 103                 (*r)++;\r
 104 \r
 105         if      (*r >= RT_COUNT)\r
 106                 *r = 0;\r
 107         else if (*r < 0)\r
 108                 *r = RT_COUNT - 1;\r
 109 }\r
 110 \r
 111 #define is_16bit_mode() \\r
 112         (get_renderer() == RT_16BIT || (PicoAHW & PAHW_32X))\r
 113 \r
 114 static void (*osd_text)(int x, int y, const char *text);\r
 115 \r
 116 static void osd_text8(int x, int y, const char *text)\r
 117 {\r
 118         int len = strlen(text)*8;\r
 119         int *p, i, h, offs;\r
 120 \r
 121         len = (len+3) >> 2;\r
 122         for (h = 0; h < 8; h++) {\r
 123                 offs = (x + g_screen_width * (y+h)) & ~3;\r
 124                 p = (int *) ((char *)g_screen_ptr + offs);\r
 125                 for (i = len; i; i--, p++)\r
 126                         *p = 0xe0e0e0e0;\r
 127         }\r
 128         emu_text_out8(x, y, text);\r
 129 }\r
 130 \r
 131 static void osd_text16(int x, int y, const char *text)\r
 132 {\r
 133         int len = strlen(text)*8;\r
 134         int *p, i, h, offs;\r
 135 \r
 136         len = (len+1) >> 1;\r
 137         for (h = 0; h < 8; h++) {\r
 138                 offs = (x + g_screen_width * (y+h)) & ~1;\r
 139                 p = (int *) ((short *)g_screen_ptr + offs);\r
 140                 for (i = len; i; i--, p++)\r
 141                         *p = (*p >> 2) & 0x39e7;\r
 142         }\r
 143         emu_text_out16(x, y, text);\r
 144 }\r
 145 \r
 146 static void osd_text8_rot(int x, int y, const char *text)\r
 147 {\r
 148         int len = strlen(text) * 8;\r
 149         char *p = (char *)g_screen_ptr + 240*(320-x) + y;\r
 150 \r
 151         while (len--) {\r
 152                 memset(p, 0xe0, 8);\r
 153                 p -= 240;\r
 154         }\r
 155 \r
 156         emu_text_out8_rot(x, y, text);\r
 157 }\r
 158 \r
 159 static void osd_text16_rot(int x, int y, const char *text)\r
 160 {\r
 161         int len = strlen(text) * 8;\r
 162         short *p = (short *)g_screen_ptr + 240*(320-x) + y;\r
 163 \r
 164         while (len--) {\r
 165                 memset(p, 0, 8*2);\r
 166                 p -= 240;\r
 167         }\r
 168 \r
 169         emu_text_out16_rot(x, y, text);\r
 170 }\r
 171 \r
 172 static void draw_cd_leds(void)\r
 173 {\r
 174         int led_reg, pitch, scr_offs, led_offs;\r
 175         led_reg = Pico_mcd->s68k_regs[0];\r
 176 \r
 177         if (currentConfig.EmuOpt & EOPT_WIZ_TEAR_FIX) {\r
 178                 pitch = 240;\r
 179                 led_offs = -pitch * 6;\r
 180                 scr_offs = pitch * (320 - 4);\r
 181         } else {\r
 182                 pitch = 320;\r
 183                 led_offs = 4;\r
 184                 scr_offs = pitch * 2 + 4;\r
 185         }\r
 186 \r
 187         if (!is_16bit_mode()) {\r
 188         #define p(x) px[(x) >> 2]\r
 189                 // 8-bit modes\r
 190                 unsigned int *px = (unsigned int *)((char *)g_screen_ptr + scr_offs);\r
 191                 unsigned int col_g = (led_reg & 2) ? 0xc0c0c0c0 : 0xe0e0e0e0;\r
 192                 unsigned int col_r = (led_reg & 1) ? 0xd0d0d0d0 : 0xe0e0e0e0;\r
 193                 p(pitch*0) = p(pitch*1) = p(pitch*2) = col_g;\r
 194                 p(pitch*0 + led_offs) = p(pitch*1 + led_offs) = p(pitch*2 + led_offs) = col_r;\r
 195         #undef p\r
 196         } else {\r
 197         #define p(x) px[(x)*2 >> 2] = px[((x)*2 >> 2) + 1]\r
 198                 // 16-bit modes\r
 199                 unsigned int *px = (unsigned int *)((short *)g_screen_ptr + scr_offs);\r
 200                 unsigned int col_g = (led_reg & 2) ? 0x06000600 : 0;\r
 201                 unsigned int col_r = (led_reg & 1) ? 0xc000c000 : 0;\r
 202                 p(pitch*0) = p(pitch*1) = p(pitch*2) = col_g;\r
 203                 p(pitch*0 + led_offs) = p(pitch*1 + led_offs) = p(pitch*2 + led_offs) = col_r;\r
 204         #undef p\r
 205         }\r
 206 }\r
 207 \r
 208 static void draw_pico_ptr(void)\r
 209 {\r
 210         unsigned short *p = (unsigned short *)g_screen_ptr;\r
 211         int x, y, pitch = 320;\r
 212 \r
 213         // only if pen enabled and for 16bit modes\r
 214         if (pico_inp_mode == 0 || currentConfig.EmuOpt != RT_16BIT)\r
 215                 return;\r
 216 \r
 217         x = pico_pen_x + PICO_PEN_ADJUST_X;\r
 218         y = pico_pen_y + PICO_PEN_ADJUST_Y;\r
 219         if (!(Pico.video.reg[12]&1) && !(PicoOpt & POPT_DIS_32C_BORDER))\r
 220                 x += 32;\r
 221 \r
 222         if (currentConfig.EmuOpt & EOPT_WIZ_TEAR_FIX) {\r
 223                 pitch = 240;\r
 224                 p += (319 - x) * pitch + y;\r
 225         } else\r
 226                 p += x + y * pitch;\r
 227 \r
 228         p[0]       ^= 0xffff;\r
 229         p[pitch-1] ^= 0xffff;\r
 230         p[pitch]   ^= 0xffff;\r
 231         p[pitch+1] ^= 0xffff;\r
 232         p[pitch*2] ^= 0xffff;\r
 233 }\r
 234 \r
 235 /* rot thing for Wiz */\r
 236 static unsigned char __attribute__((aligned(4))) rot_buff[320*4*2];\r
 237 \r
 238 static int EmuScanBegin16_rot(unsigned int num)\r
 239 {\r
 240         DrawLineDest = rot_buff + (num & 3) * 320 * 2;\r
 241         return 0;\r
 242 }\r
 243 \r
 244 static int EmuScanEnd16_rot(unsigned int num)\r
 245 {\r
 246         if ((num & 3) != 3)\r
 247                 return 0;\r
 248         rotated_blit16(g_screen_ptr, rot_buff, num + 1,\r
 249                 !(Pico.video.reg[12] & 1) && !(PicoOpt & POPT_EN_SOFTSCALE));\r
 250         return 0;\r
 251 }\r
 252 \r
 253 static int EmuScanBegin8_rot(unsigned int num)\r
 254 {\r
 255         DrawLineDest = rot_buff + (num & 3) * 320;\r
 256         return 0;\r
 257 }\r
 258 \r
 259 static int EmuScanEnd8_rot(unsigned int num)\r
 260 {\r
 261         if ((num & 3) != 3)\r
 262                 return 0;\r
 263         rotated_blit8(g_screen_ptr, rot_buff, num + 1,\r
 264                 !(Pico.video.reg[12] & 1));\r
 265         return 0;\r
 266 }\r
 267 \r
 268 /* line doublers */\r
 269 static unsigned int ld_counter;\r
 270 static int ld_left, ld_lines;\r
 271 \r
 272 static int EmuScanBegin16_ld(unsigned int num)\r
 273 {\r
 274         if ((signed int)(ld_counter - num) > 100)\r
 275                 ld_counter = 0;\r
 276 \r
 277         if (emu_scan_begin)\r
 278                 return emu_scan_begin(ld_counter);\r
 279         else\r
 280                 DrawLineDest = (char *)g_screen_ptr + 320 * ld_counter * gp2x_current_bpp / 8;\r
 281 \r
 282         return 0;\r
 283 }\r
 284 \r
 285 static int EmuScanEnd16_ld(unsigned int num)\r
 286 {\r
 287         void *oldline = DrawLineDest;\r
 288 \r
 289         if (emu_scan_end)\r
 290                 emu_scan_end(ld_counter);\r
 291 \r
 292         ld_counter++;\r
 293         ld_left--;\r
 294         if (ld_left <= 0) {\r
 295                 ld_left = ld_lines;\r
 296 \r
 297                 EmuScanBegin16_ld(num);\r
 298                 memcpy32(DrawLineDest, oldline, 320 * gp2x_current_bpp / 8 / 4);\r
 299                 if (emu_scan_end)\r
 300                         emu_scan_end(ld_counter);\r
 301 \r
 302                 ld_counter++;\r
 303         }\r
 304 \r
 305         return 0;\r
 306 }\r
 307 \r
 308 static int localPal[0x100];\r
 309 static void (*vidcpyM2)(void *dest, void *src, int m32col, int with_32c_border);\r
 310 static int (*make_local_pal)(int fast_mode);\r
 311 \r
 312 static int make_local_pal_md(int fast_mode)\r
 313 {\r
 314         int pallen = 0xc0;\r
 315 \r
 316         bgr444_to_rgb32(localPal, Pico.cram);\r
 317         if (fast_mode)\r
 318                 return 0x40;\r
 319 \r
 320         if (Pico.video.reg[0xC] & 8) { // shadow/hilight mode\r
 321                 bgr444_to_rgb32_sh(localPal, Pico.cram);\r
 322                 localPal[0xc0] = 0x0000c000;\r
 323                 localPal[0xd0] = 0x00c00000;\r
 324                 localPal[0xe0] = 0x00000000; // reserved pixels for OSD\r
 325                 localPal[0xf0] = 0x00ffffff;\r
 326                 pallen = 0x100;\r
 327         }\r
 328         else if (rendstatus & PDRAW_SONIC_MODE) { // mid-frame palette changes\r
 329                 bgr444_to_rgb32(localPal+0x40, HighPal);\r
 330                 bgr444_to_rgb32(localPal+0x80, HighPal+0x40);\r
 331         }\r
 332         else\r
 333                 memcpy32(localPal+0x80, localPal, 0x40); // for spr prio mess\r
 334 \r
 335         return pallen;\r
 336 }\r
 337 \r
 338 static int make_local_pal_sms(int fast_mode)\r
 339 {\r
 340         unsigned short *spal = Pico.cram;\r
 341         unsigned int *dpal = (void *)localPal;\r
 342         unsigned int i, t;\r
 343 \r
 344         for (i = 0x40; i > 0; i--) {\r
 345                 t = *spal++;\r
 346                 t = ((t & 0x0003) << 22) | ((t & 0x000c) << 12) | ((t & 0x0030) << 2);\r
 347                 t |= t >> 2;\r
 348                 t |= t >> 4;\r
 349                 *dpal++ = t;\r
 350         }\r
 351 \r
 352         return 0x40;\r
 353 }\r
 354 \r
 355 void pemu_finalize_frame(const char *fps, const char *notice)\r
 356 {\r
 357         int emu_opt = currentConfig.EmuOpt;\r
 358         int ret;\r
 359 \r
 360         if (PicoAHW & PAHW_32X)\r
 361                 ; // nothing to do\r
 362         else if (get_renderer() == RT_8BIT_FAST)\r
 363         {\r
 364                 // 8bit fast renderer\r
 365                 if (Pico.m.dirtyPal) {\r
 366                         Pico.m.dirtyPal = 0;\r
 367                         ret = make_local_pal(1);\r
 368                         // feed new palette to our device\r
 369                         gp2x_video_setpalette(localPal, ret);\r
 370                 }\r
 371                 // a hack for VR\r
 372                 if (PicoAHW & PAHW_SVP)\r
 373                         memset32((int *)(PicoDraw2FB+328*8+328*223), 0xe0e0e0e0, 328);\r
 374                 // do actual copy\r
 375                 vidcpyM2(g_screen_ptr, PicoDraw2FB+328*8,\r
 376                         !(Pico.video.reg[12] & 1), !(PicoOpt & POPT_DIS_32C_BORDER));\r
 377         }\r
 378         else if (get_renderer() == RT_8BIT_ACC)\r
 379         {\r
 380                 // 8bit accurate renderer\r
 381                 if (Pico.m.dirtyPal)\r
 382                 {\r
 383                         Pico.m.dirtyPal = 0;\r
 384                         ret = make_local_pal(0);\r
 385                         gp2x_video_setpalette(localPal, ret);\r
 386                 }\r
 387         }\r
 388 \r
 389         if (notice)\r
 390                 osd_text(4, osd_y, notice);\r
 391         if (emu_opt & EOPT_SHOW_FPS)\r
 392                 osd_text(osd_fps_x, osd_y, fps);\r
 393         if ((PicoAHW & PAHW_MCD) && (emu_opt & EOPT_EN_CD_LEDS))\r
 394                 draw_cd_leds();\r
 395         if (PicoAHW & PAHW_PICO)\r
 396                 draw_pico_ptr();\r
 397 }\r
 398 \r
 399 void plat_video_flip(void)\r
 400 {\r
 401         int stride = g_screen_width;\r
 402         gp2x_video_flip();\r
 403 \r
 404         if (is_16bit_mode())\r
 405                 stride *= 2;\r
 406         PicoDrawSetOutBuf(g_screen_ptr, stride);\r
 407 }\r
 408 \r
 409 /* XXX */\r
 410 unsigned int plat_get_ticks_ms(void)\r
 411 {\r
 412         return gp2x_get_ticks_ms();\r
 413 }\r
 414 \r
 415 unsigned int plat_get_ticks_us(void)\r
 416 {\r
 417         return gp2x_get_ticks_us();\r
 418 }\r
 419 \r
 420 void plat_wait_till_us(unsigned int us_to)\r
 421 {\r
 422         unsigned int now;\r
 423 \r
 424         spend_cycles(1024);\r
 425         now = plat_get_ticks_us();\r
 426 \r
 427         while ((signed int)(us_to - now) > 512)\r
 428         {\r
 429                 spend_cycles(1024);\r
 430                 now = plat_get_ticks_us();\r
 431         }\r
 432 }\r
 433 \r
 434 void plat_video_wait_vsync(void)\r
 435 {\r
 436         gp2x_video_wait_vsync();\r
 437 }\r
 438 \r
 439 void plat_status_msg_clear(void)\r
 440 {\r
 441         int is_8bit = !is_16bit_mode();\r
 442         if (currentConfig.EmuOpt & EOPT_WIZ_TEAR_FIX) {\r
 443                 /* ugh.. */\r
 444                 int i, u, *p;\r
 445                 if (is_8bit) {\r
 446                         for (i = 0; i < 4; i++) {\r
 447                                 p = (int *)gp2x_screens[i] + (240-8) / 4;\r
 448                                 for (u = 320; u > 0; u--, p += 240/4)\r
 449                                         p[0] = p[1] = 0xe0e0e0e0;\r
 450                         }\r
 451                 } else {\r
 452                         for (i = 0; i < 4; i++) {\r
 453                                 p = (int *)gp2x_screens[i] + (240-8)*2 / 4;\r
 454                                 for (u = 320; u > 0; u--, p += 240*2/4)\r
 455                                         p[0] = p[1] = p[2] = p[3] = 0;\r
 456                         }\r
 457                 }\r
 458                 return;\r
 459         }\r
 460 \r
 461         if (is_8bit)\r
 462                 gp2x_memset_all_buffers(320*232, 0xe0, 320*8);\r
 463         else\r
 464                 gp2x_memset_all_buffers(320*232*2, 0, 320*8*2);\r
 465 }\r
 466 \r
 467 void plat_status_msg_busy_next(const char *msg)\r
 468 {\r
 469         plat_status_msg_clear();\r
 470         pemu_finalize_frame("", msg);\r
 471         plat_video_flip();\r
 472         emu_status_msg("");\r
 473 \r
 474         /* assumption: msg_busy_next gets called only when\r
 475          * something slow is about to happen */\r
 476         reset_timing = 1;\r
 477 }\r
 478 \r
 479 void plat_status_msg_busy_first(const char *msg)\r
 480 {\r
 481         gp2x_memcpy_all_buffers(g_screen_ptr, 0, 320*240*2);\r
 482         plat_status_msg_busy_next(msg);\r
 483 }\r
 484 \r
 485 static void vid_reset_mode(void)\r
 486 {\r
 487         int gp2x_mode = 16;\r
 488         int renderer = get_renderer();\r
 489 \r
 490         PicoOpt &= ~POPT_ALT_RENDERER;\r
 491         emu_scan_begin = NULL;\r
 492         emu_scan_end = NULL;\r
 493 \r
 494         switch (renderer) {\r
 495         case RT_16BIT:\r
 496                 PicoDrawSetOutFormat(PDF_RGB555, 0);\r
 497                 PicoDrawSetOutBuf(g_screen_ptr, g_screen_width * 2);\r
 498                 break;\r
 499         case RT_8BIT_ACC:\r
 500                 PicoDrawSetOutFormat(PDF_8BIT, 0);\r
 501                 PicoDrawSetOutBuf(g_screen_ptr, g_screen_width);\r
 502                 gp2x_mode = 8;\r
 503                 break;\r
 504         case RT_8BIT_FAST:\r
 505                 PicoOpt |= POPT_ALT_RENDERER;\r
 506                 PicoDrawSetOutFormat(PDF_NONE, 0);\r
 507                 vidcpyM2 = vidcpy_m2;\r
 508                 gp2x_mode = 8;\r
 509                 break;\r
 510         default:\r
 511                 printf("bad renderer\n");\r
 512                 break;\r
 513         }\r
 514 \r
 515         if (PicoAHW & PAHW_32X) {\r
 516                 // Wiz 16bit is an exception, uses line rendering due to rotation mess\r
 517                 if (renderer == RT_16BIT && (currentConfig.EmuOpt & EOPT_WIZ_TEAR_FIX)) {\r
 518                         PicoDrawSetOutFormat(PDF_RGB555, 1);\r
 519                 }\r
 520                 else {\r
 521                         PicoDrawSetOutFormat(PDF_NONE, 0);\r
 522                 }\r
 523                 PicoDrawSetOutBuf(g_screen_ptr, g_screen_width * 2);\r
 524                 gp2x_mode = 16;\r
 525         }\r
 526 \r
 527         if (currentConfig.EmuOpt & EOPT_WIZ_TEAR_FIX) {\r
 528                 if ((PicoAHW & PAHW_32X) || renderer == RT_16BIT) {\r
 529                         emu_scan_begin = EmuScanBegin16_rot;\r
 530                         emu_scan_end = EmuScanEnd16_rot;\r
 531                 }\r
 532                 else if (renderer == RT_8BIT_ACC) {\r
 533                         emu_scan_begin = EmuScanBegin8_rot;\r
 534                         emu_scan_end = EmuScanEnd8_rot;\r
 535                 }\r
 536                 else if (renderer == RT_8BIT_FAST)\r
 537                         vidcpyM2 = vidcpy_m2_rot;\r
 538         }\r
 539 \r
 540         PicoDrawSetCallbacks(emu_scan_begin, emu_scan_end);\r
 541 \r
 542         if (is_16bit_mode())\r
 543                 osd_text = (currentConfig.EmuOpt & EOPT_WIZ_TEAR_FIX) ? osd_text16_rot : osd_text16;\r
 544         else\r
 545                 osd_text = (currentConfig.EmuOpt & EOPT_WIZ_TEAR_FIX) ? osd_text8_rot : osd_text8;\r
 546 \r
 547         gp2x_video_wait_vsync();\r
 548         if (!is_16bit_mode()) {\r
 549                 // setup pal for 8-bit modes\r
 550                 localPal[0xc0] = 0x0000c000; // MCD LEDs\r
 551                 localPal[0xd0] = 0x00c00000;\r
 552                 localPal[0xe0] = 0x00000000; // reserved pixels for OSD\r
 553                 localPal[0xf0] = 0x00ffffff;\r
 554                 gp2x_video_setpalette(localPal, 0x100);\r
 555                 gp2x_memset_all_buffers(0, 0xe0, 320*240);\r
 556         }\r
 557         else\r
 558                 gp2x_memset_all_buffers(0, 0, 320*240*2);\r
 559 \r
 560         if (currentConfig.EmuOpt & EOPT_WIZ_TEAR_FIX)\r
 561                 gp2x_mode = -gp2x_mode;\r
 562 \r
 563         gp2x_video_changemode(gp2x_mode, Pico.m.pal);\r
 564 \r
 565         Pico.m.dirtyPal = 1;\r
 566 \r
 567         PicoOpt &= ~POPT_EN_SOFTSCALE;\r
 568         if (currentConfig.scaling == EOPT_SCALE_SW)\r
 569                 PicoOpt |= POPT_EN_SOFTSCALE;\r
 570 \r
 571         // palette converters for 8bit modes\r
 572         make_local_pal = (PicoAHW & PAHW_SMS) ? make_local_pal_sms : make_local_pal_md;\r
 573 }\r
 574 \r
 575 void emu_video_mode_change(int start_line, int line_count, int is_32cols)\r
 576 {\r
 577         int scalex = 320, scaley = 240;\r
 578         int ln_offs = 0;\r
 579 \r
 580         if (doing_bg_frame)\r
 581                 return;\r
 582 \r
 583         osd_fps_x = OSD_FPS_X;\r
 584         osd_y = 232;\r
 585 \r
 586         /* set up hwscaling here */\r
 587         PicoOpt &= ~POPT_DIS_32C_BORDER;\r
 588         if (is_32cols && currentConfig.scaling == EOPT_SCALE_HW) {\r
 589                 scalex = 256;\r
 590                 PicoOpt |= POPT_DIS_32C_BORDER;\r
 591                 osd_fps_x = OSD_FPS_X - 64;\r
 592         }\r
 593 \r
 594         if (currentConfig.vscaling == EOPT_SCALE_HW) {\r
 595                 ln_offs = start_line;\r
 596                 scaley = line_count;\r
 597                 osd_y = start_line + line_count - 8;\r
 598         }\r
 599 \r
 600         gp2x_video_RGB_setscaling(ln_offs, scalex, scaley);\r
 601 \r
 602         /* line doubling */\r
 603         if (currentConfig.vscaling == EOPT_SCALE_SW && line_count < 240) {\r
 604                 ld_lines = ld_left = line_count / (240 - line_count);\r
 605                 PicoDrawSetCallbacks(EmuScanBegin16_ld, EmuScanEnd16_ld);\r
 606         }\r
 607 \r
 608         // clear whole screen in all buffers\r
 609         if (!is_16bit_mode())\r
 610                 gp2x_memset_all_buffers(0, 0xe0, 320*240);\r
 611         else\r
 612                 gp2x_memset_all_buffers(0, 0, 320*240*2);\r
 613 }\r
 614 \r
 615 void plat_video_toggle_renderer(int change, int is_menu_call)\r
 616 {\r
 617         change_renderer(change);\r
 618 \r
 619         if (is_menu_call)\r
 620                 return;\r
 621 \r
 622         vid_reset_mode();\r
 623         rendstatus_old = -1;\r
 624 \r
 625         if (PicoAHW & PAHW_32X)\r
 626                 emu_status_msg(renderer_names32x[get_renderer()]);\r
 627         else\r
 628                 emu_status_msg(renderer_names[get_renderer()]);\r
 629 }\r
 630 \r
 631 #if 0 // TODO\r
 632 static void RunEventsPico(unsigned int events)\r
 633 {\r
 634         int ret, px, py, lim_x;\r
 635         static int pdown_frames = 0;\r
 636 \r
 637         // for F200\r
 638         ret = gp2x_touchpad_read(&px, &py);\r
 639         if (ret >= 0)\r
 640         {\r
 641                 if (ret > 35000)\r
 642                 {\r
 643                         if (pdown_frames++ > 5)\r
 644                                 PicoPad[0] |= 0x20;\r
 645 \r
 646                         pico_pen_x = px;\r
 647                         pico_pen_y = py;\r
 648                         if (!(Pico.video.reg[12]&1)) {\r
 649                                 pico_pen_x -= 32;\r
 650                                 if (pico_pen_x <   0) pico_pen_x = 0;\r
 651                                 if (pico_pen_x > 248) pico_pen_x = 248;\r
 652                         }\r
 653                         if (pico_pen_y > 224) pico_pen_y = 224;\r
 654                 }\r
 655                 else\r
 656                         pdown_frames = 0;\r
 657 \r
 658                 //if (ret == 0)\r
 659                 //      PicoPicohw.pen_pos[0] = PicoPicohw.pen_pos[1] = 0x8000;\r
 660         }\r
 661 }\r
 662 #endif\r
 663 \r
 664 void plat_update_volume(int has_changed, int is_up)\r
 665 {\r
 666         static int prev_frame = 0, wait_frames = 0;\r
 667         int need_low_volume = 0;\r
 668         int vol = currentConfig.volume;\r
 669         gp2x_soc_t soc;\r
 670 \r
 671         soc = soc_detect();\r
 672         if ((PicoOpt & POPT_EN_STEREO) && soc == SOCID_MMSP2)\r
 673                 need_low_volume = 1;\r
 674 \r
 675         if (has_changed)\r
 676         {\r
 677                 if (need_low_volume && vol < 5 && prev_frame == Pico.m.frame_count - 1 && wait_frames < 12)\r
 678                         wait_frames++;\r
 679                 else {\r
 680                         wait_frames = 0;\r
 681                         plat_target_step_volume(&currentConfig.volume, is_up ? 1 : -1);\r
 682                         vol = currentConfig.volume;\r
 683                 }\r
 684                 emu_status_msg("VOL: %02i", vol);\r
 685                 prev_frame = Pico.m.frame_count;\r
 686         }\r
 687 \r
 688         if (!need_low_volume)\r
 689                 return;\r
 690 \r
 691         /* set the right mixer func */\r
 692         if (vol >= 5)\r
 693                 PsndMix_32_to_16l = mix_32_to_16l_stereo;\r
 694         else {\r
 695                 mix_32_to_16l_level = 5 - vol;\r
 696                 PsndMix_32_to_16l = mix_32_to_16l_stereo_lvl;\r
 697         }\r
 698 }\r
 699 \r
 700 void pemu_sound_start(void)\r
 701 {\r
 702         gp2x_soc_t soc;\r
 703 \r
 704         emu_sound_start();\r
 705 \r
 706         if (currentConfig.EmuOpt & EOPT_EN_SOUND)\r
 707         {\r
 708                 soc = soc_detect();\r
 709                 if (soc == SOCID_POLLUX) {\r
 710                         PsndRate = pollux_get_real_snd_rate(PsndRate);\r
 711                         PsndRerate(Pico.m.frame_count ? 1 : 0);\r
 712                 }\r
 713 \r
 714                 plat_target_step_volume(&currentConfig.volume, 0);\r
 715         }\r
 716 }\r
 717 \r
 718 static const int sound_rates[] = { 44100, 32000, 22050, 16000, 11025, 8000 };\r
 719 \r
 720 void pemu_sound_stop(void)\r
 721 {\r
 722         int i;\r
 723 \r
 724         /* get back from Pollux pain */\r
 725         PsndRate += 1000;\r
 726         for (i = 0; i < ARRAY_SIZE(sound_rates); i++) {\r
 727                 if (PsndRate >= sound_rates[i]) {\r
 728                         PsndRate = sound_rates[i];\r
 729                         break;\r
 730                 }\r
 731         }\r
 732 }\r
 733 \r
 734 void pemu_forced_frame(int no_scale, int do_emu)\r
 735 {\r
 736         doing_bg_frame = 1;\r
 737         PicoDrawSetOutBuf(g_screen_ptr, g_screen_width * 2);\r
 738         PicoDrawSetCallbacks(NULL, NULL);\r
 739         Pico.m.dirtyPal = 1;\r
 740 \r
 741         emu_cmn_forced_frame(no_scale, do_emu);\r
 742 \r
 743         g_menubg_src_ptr = g_screen_ptr;\r
 744         doing_bg_frame = 0;\r
 745 }\r
 746 \r
 747 void plat_debug_cat(char *str)\r
 748 {\r
 749 }\r
 750 \r
 751 void plat_video_loop_prepare(void) \r
 752 {\r
 753         // make sure we are in correct mode\r
 754         change_renderer(0);\r
 755         vid_reset_mode();\r
 756 }\r
 757 \r
 758 void pemu_loop_prep(void)\r
 759 {\r
 760         if (gp2x_dev_id == GP2X_DEV_CAANOO)\r
 761                 in_set_config_int(in_name_to_id("evdev:pollux-analog"),\r
 762                         IN_CFG_ABS_DEAD_ZONE,\r
 763                         currentConfig.analog_deadzone);\r
 764 \r
 765         // dirty buffers better go now than during gameplay\r
 766         sync();\r
 767         sleep(0);\r
 768 }\r
 769 \r
 770 void pemu_loop_end(void)\r
 771 {\r
 772         pemu_sound_stop();\r
 773 \r
 774         /* do one more frame for menu bg */\r
 775         pemu_forced_frame(0, 1);\r
 776 }\r
 777 \r