platform/psp/emu.c

   1 // (c) Copyright 2007 notaz, All rights reserved.
   2 // Free for non-commercial use.
   3
   4 // For commercial use, separate licencing terms must be obtained.
   5
   6 #include <sys/stat.h>
   7 #include <sys/types.h>
   8 #include <sys/syslimits.h> // PATH_MAX
   9
  10 #include <pspthreadman.h>
  11 #include <pspdisplay.h>
  12 #include <psputils.h>
  13 #include <pspgu.h>
  14 #include <pspaudio.h>
  15
  16 #include "psp.h"
  17 #include "menu.h"
  18 #include "emu.h"
  19 #include "mp3.h"
  20 #include "asm_utils.h"
  21 #include "../common/emu.h"
  22 #include "../common/config.h"
  23 #include "../common/lprintf.h"
  24 #include "../../Pico/PicoInt.h"
  25
  26 #define OSD_FPS_X 432
  27
  28 // additional pspaudio imports, credits to crazyc
  29 int sceAudio_38553111(unsigned short samples, unsigned short freq, char unknown);  // play with conversion?
  30 int sceAudio_5C37C0AE(void);                            // end play?
  31 int sceAudio_E0727056(int volume, void *buffer);        // blocking output
  32 int sceAudioOutput2GetRestSample();
  33
  34
  35 char romFileName[PATH_MAX];
  36 unsigned char *PicoDraw2FB = (unsigned char *)VRAM_CACHED_STUFF + 8; // +8 to be able to skip border with 1 quadword..
  37 int engineState = PGS_Menu;
  38
  39 static unsigned int noticeMsgTime = 0;
  40 int reset_timing = 0; // do we need this?
  41
  42
  43 static void sound_init(void);
  44 static void sound_deinit(void);
  45 static void blit2(const char *fps, const char *notice, int lagging_behind);
  46 static void clearArea(int full);
  47
  48 void emu_noticeMsgUpdated(void)
  49 {
  50         noticeMsgTime = sceKernelGetSystemTimeLow();
  51 }
  52
  53 void emu_getMainDir(char *dst, int len)
  54 {
  55         if (len > 0) *dst = 0;
  56 }
  57
  58 static void osd_text(int x, const char *text, int is_active, int clear_all)
  59 {
  60         unsigned short *screen = is_active ? psp_video_get_active_fb() : psp_screen;
  61         int len = clear_all ? (480 / 2) : (strlen(text) * 8 / 2);
  62         int *p, h;
  63         void *tmp;
  64         for (h = 0; h < 8; h++) {
  65                 p = (int *) (screen+x+512*(264+h));
  66                 p = (int *) ((int)p & ~3); // align
  67                 memset32_uncached(p, 0, len);
  68         }
  69         if (is_active) { tmp = psp_screen; psp_screen = screen; } // nasty pointer tricks
  70         emu_textOut16(x, 264, text);
  71         if (is_active) psp_screen = tmp;
  72 }
  73
  74 void emu_msg_cb(const char *msg)
  75 {
  76         osd_text(4, msg, 1, 1);
  77         noticeMsgTime = sceKernelGetSystemTimeLow() - 2000000;
  78
  79         /* assumption: emu_msg_cb gets called only when something slow is about to happen */
  80         reset_timing = 1;
  81 }
  82
  83 static void emu_msg_tray_open(void)
  84 {
  85         strcpy(noticeMsg, "CD tray opened");
  86         noticeMsgTime = sceKernelGetSystemTimeLow();
  87 }
  88
  89
  90 void emu_Init(void)
  91 {
  92         // make dirs for saves, cfgs, etc.
  93         mkdir("mds", 0777);
  94         mkdir("srm", 0777);
  95         mkdir("brm", 0777);
  96         mkdir("cfg", 0777);
  97
  98         sound_init();
  99
 100         PicoInit();
 101         PicoMessage = emu_msg_cb;
 102         PicoMCDopenTray = emu_msg_tray_open;
 103         PicoMCDcloseTray = menu_loop_tray;
 104 }
 105
 106 void emu_Deinit(void)
 107 {
 108         // save SRAM
 109         if ((currentConfig.EmuOpt & 1) && SRam.changed) {
 110                 emu_SaveLoadGame(0, 1);
 111                 SRam.changed = 0;
 112         }
 113
 114         if (!(currentConfig.EmuOpt & 0x20))
 115                 config_writelrom(PicoConfigFile);
 116
 117         PicoExit();
 118         sound_deinit();
 119 }
 120
 121 void emu_prepareDefaultConfig(void)
 122 {
 123         memset(&defaultConfig, 0, sizeof(defaultConfig));
 124         defaultConfig.EmuOpt    = 0x1d | 0x680; // | <- confirm_save, cd_leds, acc rend
 125         defaultConfig.s_PicoOpt = 0x0f | POPT_EN_MCD_PCM|POPT_EN_MCD_CDDA|POPT_EN_MCD_GFX;
 126         defaultConfig.s_PsndRate = 22050;
 127         defaultConfig.s_PicoRegion = 0; // auto
 128         defaultConfig.s_PicoAutoRgnOrder = 0x184; // US, EU, JP
 129         defaultConfig.s_PicoCDBuffers = 64;
 130         defaultConfig.Frameskip = -1; // auto
 131         defaultConfig.CPUclock = 333;
 132         defaultConfig.KeyBinds[ 4] = 1<<0; // SACB RLDU
 133         defaultConfig.KeyBinds[ 6] = 1<<1;
 134         defaultConfig.KeyBinds[ 7] = 1<<2;
 135         defaultConfig.KeyBinds[ 5] = 1<<3;
 136         defaultConfig.KeyBinds[14] = 1<<4;
 137         defaultConfig.KeyBinds[13] = 1<<5;
 138         defaultConfig.KeyBinds[15] = 1<<6;
 139         defaultConfig.KeyBinds[ 3] = 1<<7;
 140         defaultConfig.KeyBinds[12] = 1<<26; // switch rnd
 141         defaultConfig.KeyBinds[ 8] = 1<<27; // save state
 142         defaultConfig.KeyBinds[ 9] = 1<<28; // load state
 143         defaultConfig.KeyBinds[28] = 1<<0; // num "buttons"
 144         defaultConfig.KeyBinds[30] = 1<<1;
 145         defaultConfig.KeyBinds[31] = 1<<2;
 146         defaultConfig.KeyBinds[29] = 1<<3;
 147         defaultConfig.scaling = 1;     // bilinear filtering for psp
 148         defaultConfig.scale = 1.20;    // fullscreen
 149         defaultConfig.hscale40 = 1.25;
 150         defaultConfig.hscale32 = 1.56;
 151 }
 152
 153 void emu_setDefaultConfig(void)
 154 {
 155         memcpy(&currentConfig, &defaultConfig, sizeof(currentConfig));
 156         PicoOpt = currentConfig.s_PicoOpt;
 157         PsndRate = currentConfig.s_PsndRate;
 158         PicoRegionOverride = currentConfig.s_PicoRegion;
 159         PicoAutoRgnOrder = currentConfig.s_PicoAutoRgnOrder;
 160         PicoCDBuffers = currentConfig.s_PicoCDBuffers;
 161 }
 162
 163
 164 extern void amips_clut(unsigned short *dst, unsigned char *src, unsigned short *pal, int count);
 165 extern void amips_clut_6bit(unsigned short *dst, unsigned char *src, unsigned short *pal, int count);
 166
 167 extern void (*amips_clut_f)(unsigned short *dst, unsigned char *src, unsigned short *pal, int count) = NULL;
 168
 169 struct Vertex
 170 {
 171         short u,v;
 172         short x,y,z;
 173 };
 174
 175 static struct Vertex __attribute__((aligned(4))) g_vertices[2];
 176 static unsigned short __attribute__((aligned(16))) localPal[0x100];
 177 static int dynamic_palette = 0, need_pal_upload = 0, blit_16bit_mode = 0;
 178 static int fbimg_offs = 0;
 179
 180 static void set_scaling_params(void)
 181 {
 182         int src_width, fbimg_width, fbimg_height, fbimg_xoffs, fbimg_yoffs, border_hack = 0;
 183         g_vertices[0].x = g_vertices[0].y =
 184         g_vertices[0].z = g_vertices[1].z = 0;
 185
 186         fbimg_height = (int)(240.0 * currentConfig.scale + 0.5);
 187         if (Pico.video.reg[12] & 1) {
 188                 fbimg_width = (int)(320.0 * currentConfig.scale * currentConfig.hscale40 + 0.5);
 189                 src_width = 320;
 190         } else {
 191                 fbimg_width = (int)(256.0 * currentConfig.scale * currentConfig.hscale32 + 0.5);
 192                 src_width = 256;
 193         }
 194
 195         if (fbimg_width  & 1) fbimg_width++;  // make even
 196         if (fbimg_height & 1) fbimg_height++;
 197
 198         if (fbimg_width >= 480) {
 199                 g_vertices[0].u = (fbimg_width-480)/2;
 200                 g_vertices[1].u = src_width - (fbimg_width-480)/2 - 1;
 201                 fbimg_width = 480;
 202                 fbimg_xoffs = 0;
 203         } else {
 204                 g_vertices[0].u = 0;
 205                 g_vertices[1].u = src_width;
 206                 fbimg_xoffs = 240 - fbimg_width/2;
 207         }
 208         if (fbimg_width > 320 && fbimg_width <= 480) border_hack = 1;
 209
 210         if (fbimg_height >= 272) {
 211                 g_vertices[0].v = (fbimg_height-272)/2;
 212                 g_vertices[1].v = 240 - (fbimg_height-272)/2;
 213                 fbimg_height = 272;
 214                 fbimg_yoffs = 0;
 215         } else {
 216                 g_vertices[0].v = 0;
 217                 g_vertices[1].v = 240;
 218                 fbimg_yoffs = 136 - fbimg_height/2;
 219         }
 220
 221         g_vertices[1].x = fbimg_width;
 222         g_vertices[1].y = fbimg_height;
 223         if (fbimg_xoffs < 0) fbimg_xoffs = 0;
 224         if (fbimg_yoffs < 0) fbimg_yoffs = 0;
 225         if (border_hack) {
 226                 g_vertices[0].u++;
 227                 g_vertices[0].x++;
 228                 g_vertices[1].u--;
 229                 g_vertices[1].x--;
 230         }
 231         fbimg_offs = (fbimg_yoffs*512 + fbimg_xoffs) * 2; // dst is always 16bit
 232
 233         /*
 234         lprintf("set_scaling_params:\n");
 235         lprintf("offs: %i, %i\n", fbimg_xoffs, fbimg_yoffs);
 236         lprintf("xy0, xy1: %i, %i; %i, %i\n", g_vertices[0].x, g_vertices[0].y, g_vertices[1].x, g_vertices[1].y);
 237         lprintf("uv0, uv1: %i, %i; %i, %i\n", g_vertices[0].u, g_vertices[0].v, g_vertices[1].u, g_vertices[1].v);
 238         */
 239 }
 240
 241 static void do_pal_update(int allow_sh, int allow_as)
 242 {
 243         unsigned int *dpal=(void *)localPal;
 244         int i;
 245
 246         //for (i = 0x3f/2; i >= 0; i--)
 247         //      dpal[i] = ((spal[i]&0x000f000f)<< 1)|((spal[i]&0x00f000f0)<<3)|((spal[i]&0x0f000f00)<<4);
 248         do_pal_convert(localPal, Pico.cram, currentConfig.gamma, currentConfig.gamma2);
 249
 250         Pico.m.dirtyPal = 0;
 251         need_pal_upload = 1;
 252
 253         if (allow_sh && (Pico.video.reg[0xC]&8)) // shadow/hilight?
 254         {
 255                 // shadowed pixels
 256                 for (i = 0x3f/2; i >= 0; i--)
 257                         dpal[0x20|i] = dpal[0x60|i] = (dpal[i]>>1)&0x7bcf7bcf;
 258                 // hilighted pixels
 259                 for (i = 0x3f; i >= 0; i--) {
 260                         int t=localPal[i]&0xf79e;t+=0x4208;
 261                         if (t&0x20) t|=0x1e;
 262                         if (t&0x800) t|=0x780;
 263                         if (t&0x10000) t|=0xf000;
 264                         t&=0xf79e;
 265                         localPal[0x80|i]=(unsigned short)t;
 266                 }
 267                 localPal[0xe0] = 0;
 268         }
 269         else if (allow_as && (rendstatus & PDRAW_ACC_SPRITES))
 270         {
 271                 memcpy32(localPal+0x40, localPal, 0x40);
 272                 memcpy32(localPal+0x80, localPal, 0x40);
 273                 memcpy32(localPal+0xc0, localPal, 0x40);
 274         }
 275 }
 276
 277 static void do_slowmode_lines(int line_to)
 278 {
 279         int line = 0, line_len = (Pico.video.reg[12]&1) ? 320 : 256;
 280         unsigned short *dst = (unsigned short *)VRAM_STUFF + 512*240/2;
 281         unsigned char  *src = (unsigned char  *)VRAM_CACHED_STUFF + 16;
 282         if (!(Pico.video.reg[1]&8)) { line = 8; dst += 512*8; src += 512*8; }
 283
 284         for (; line < line_to; line++, dst+=512, src+=512)
 285                 amips_clut_f(dst, src, localPal, line_len);
 286 }
 287
 288 static void EmuScanPrepare(void)
 289 {
 290         HighCol = (unsigned char *)VRAM_CACHED_STUFF + 8;
 291         if (!(Pico.video.reg[1]&8)) HighCol += 8*512;
 292
 293         dynamic_palette = 0;
 294         if (Pico.m.dirtyPal)
 295                 do_pal_update(1, 1);
 296         if ((rendstatus & PDRAW_ACC_SPRITES) && !(Pico.video.reg[0xC]&8))
 297              amips_clut_f = amips_clut_6bit;
 298         else amips_clut_f = amips_clut;
 299 }
 300
 301 static int EmuScanSlowBegin(unsigned int num)
 302 {
 303         if (!(Pico.video.reg[1]&8)) num += 8;
 304
 305         if (!dynamic_palette)
 306                 HighCol = (unsigned char *)VRAM_CACHED_STUFF + num * 512 + 8;
 307
 308         return 0;
 309 }
 310
 311 static int EmuScanSlowEnd(unsigned int num)
 312 {
 313         if (!(Pico.video.reg[1]&8)) num += 8;
 314
 315         if (Pico.m.dirtyPal) {
 316                 if (!dynamic_palette) {
 317                         do_slowmode_lines(num);
 318                         dynamic_palette = 1;
 319                 }
 320                 do_pal_update(1, 0);
 321         }
 322
 323         if (dynamic_palette) {
 324                 int line_len = (Pico.video.reg[12]&1) ? 320 : 256;
 325                 void *dst = (char *)VRAM_STUFF + 512*240 + 512*2*num;
 326                 amips_clut_f(dst, HighCol + 8, localPal, line_len);
 327         }
 328
 329         return 0;
 330 }
 331
 332 static void blitscreen_clut(void)
 333 {
 334         int offs = fbimg_offs;
 335         offs += (psp_screen == VRAM_FB0) ? VRAMOFFS_FB0 : VRAMOFFS_FB1;
 336
 337         sceGuSync(0,0); // sync with prev
 338         sceGuStart(GU_DIRECT, guCmdList);
 339         sceGuDrawBuffer(GU_PSM_5650, (void *)offs, 512); // point to back buffer
 340
 341         if (dynamic_palette)
 342         {
 343                 if (!blit_16bit_mode) {
 344                         sceGuTexMode(GU_PSM_5650, 0, 0, 0);
 345                         sceGuTexImage(0,512,512,512,(char *)VRAM_STUFF + 512*240);
 346
 347                         blit_16bit_mode = 1;
 348                 }
 349         }
 350         else
 351         {
 352                 if (blit_16bit_mode) {
 353                         sceGuClutMode(GU_PSM_5650,0,0xff,0);
 354                         sceGuTexMode(GU_PSM_T8,0,0,0); // 8-bit image
 355                         sceGuTexImage(0,512,512,512,(char *)VRAM_STUFF + 16);
 356                         blit_16bit_mode = 0;
 357                 }
 358
 359                 if ((PicoOpt&0x10) && Pico.m.dirtyPal)
 360                         do_pal_update(0, 0);
 361
 362                 sceKernelDcacheWritebackAll();
 363
 364                 if (need_pal_upload) {
 365                         need_pal_upload = 0;
 366                         sceGuClutLoad((256/8), localPal); // upload 32*8 entries (256)
 367                 }
 368         }
 369
 370 #if 1
 371         if (g_vertices[0].u == 0 && g_vertices[1].u == g_vertices[1].x)
 372         {
 373                 struct Vertex* vertices;
 374                 int x;
 375
 376                 #define SLICE_WIDTH 32
 377                 for (x = 0; x < g_vertices[1].x; x += SLICE_WIDTH)
 378                 {
 379                         // render sprite
 380                         vertices = (struct Vertex*)sceGuGetMemory(2 * sizeof(struct Vertex));
 381                         memcpy(vertices, g_vertices, 2 * sizeof(struct Vertex));
 382                         vertices[0].u = vertices[0].x = x;
 383                         vertices[1].u = vertices[1].x = x + SLICE_WIDTH;
 384                         sceGuDrawArray(GU_SPRITES,GU_TEXTURE_16BIT|GU_VERTEX_16BIT|GU_TRANSFORM_2D,2,0,vertices);
 385                 }
 386                 // lprintf("listlen: %iB\n", sceGuCheckList()); // ~480 only
 387         }
 388         else
 389 #endif
 390                 sceGuDrawArray(GU_SPRITES,GU_TEXTURE_16BIT|GU_VERTEX_16BIT|GU_TRANSFORM_2D,2,0,g_vertices);
 391
 392         sceGuFinish();
 393 }
 394
 395
 396 static void cd_leds(void)
 397 {
 398         unsigned int reg, col_g, col_r, *p;
 399
 400         reg = Pico_mcd->s68k_regs[0];
 401
 402         p = (unsigned int *)((short *)psp_screen + 512*2+4+2);
 403         col_g = (reg & 2) ? 0x06000600 : 0;
 404         col_r = (reg & 1) ? 0x00180018 : 0;
 405         *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r; p += 512/2 - 12/2;
 406         *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r; p += 512/2 - 12/2;
 407         *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r;
 408 }
 409
 410 #if 0
 411 static void dbg_text(void)
 412 {
 413         int *p, h, len;
 414         char text[128];
 415
 416         sprintf(text, "sl: %i, 16b: %i", g_vertices[0].u == 0 && g_vertices[1].u == g_vertices[1].x, blit_16bit_mode);
 417         len = strlen(text) * 8 / 2;
 418         for (h = 0; h < 8; h++) {
 419                 p = (int *) ((unsigned short *) psp_screen+2+512*(256+h));
 420                 p = (int *) ((int)p & ~3); // align
 421                 memset32_uncached(p, 0, len);
 422         }
 423         emu_textOut16(2, 256, text);
 424 }
 425 #endif
 426
 427 /* called after rendering is done, but frame emulation is not finished */
 428 void blit1(void)
 429 {
 430         if (PicoOpt&0x10)
 431         {
 432                 int i;
 433                 unsigned char *pd;
 434                 // clear top and bottom trash
 435                 for (pd = PicoDraw2FB+8, i = 8; i > 0; i--, pd += 512)
 436                         memset32((int *)pd, 0xe0e0e0e0, 320/4);
 437                 for (pd = PicoDraw2FB+512*232+8, i = 8; i > 0; i--, pd += 512)
 438                         memset32((int *)pd, 0xe0e0e0e0, 320/4);
 439         }
 440
 441         blitscreen_clut();
 442 }
 443
 444
 445 static void blit2(const char *fps, const char *notice, int lagging_behind)
 446 {
 447         int vsync = 0, emu_opt = currentConfig.EmuOpt;
 448
 449         if (notice || (emu_opt & 2)) {
 450                 if (notice)      osd_text(4, notice, 0, 0);
 451                 if (emu_opt & 2) osd_text(OSD_FPS_X, fps, 0, 0);
 452         }
 453
 454         //dbg_text();
 455
 456         if ((emu_opt & 0x400) && (PicoAHW & PAHW_MCD))
 457                 cd_leds();
 458
 459         if (currentConfig.EmuOpt & 0x2000) { // want vsync
 460                 if (!(currentConfig.EmuOpt & 0x10000) || !lagging_behind) vsync = 1;
 461         }
 462
 463         psp_video_flip(vsync);
 464 }
 465
 466 // clears whole screen or just the notice area (in all buffers)
 467 static void clearArea(int full)
 468 {
 469         if (full) {
 470                 memset32_uncached(psp_screen, 0, 512*272*2/4);
 471                 psp_video_flip(0);
 472                 memset32_uncached(psp_screen, 0, 512*272*2/4);
 473                 memset32(VRAM_CACHED_STUFF, 0xe0e0e0e0, 512*240/4);
 474                 memset32((int *)VRAM_CACHED_STUFF+512*240/4, 0, 512*240*2/4);
 475         } else {
 476                 void *fb = psp_video_get_active_fb();
 477                 memset32_uncached((int *)((char *)psp_screen + 512*264*2), 0, 512*8*2/4);
 478                 memset32_uncached((int *)((char *)fb         + 512*264*2), 0, 512*8*2/4);
 479         }
 480 }
 481
 482 static void vidResetMode(void)
 483 {
 484         // setup GU
 485         sceGuSync(0,0); // sync with prev
 486         sceGuStart(GU_DIRECT, guCmdList);
 487
 488         sceGuClutMode(GU_PSM_5650,0,0xff,0);
 489         sceGuTexMode(GU_PSM_T8,0,0,0); // 8-bit image
 490         sceGuTexFunc(GU_TFX_REPLACE,GU_TCC_RGB);
 491         if (currentConfig.scaling)
 492              sceGuTexFilter(GU_LINEAR, GU_LINEAR);
 493         else sceGuTexFilter(GU_NEAREST, GU_NEAREST);
 494         sceGuTexScale(1.0f,1.0f);
 495         sceGuTexOffset(0.0f,0.0f);
 496
 497         sceGuTexImage(0,512,512,512,(char *)VRAM_STUFF + 16);
 498
 499         // slow rend.
 500         PicoDrawSetColorFormat(-1);
 501         PicoScanBegin = EmuScanSlowBegin;
 502         PicoScanEnd = EmuScanSlowEnd;
 503
 504         localPal[0xe0] = 0;
 505         Pico.m.dirtyPal = 1;
 506         blit_16bit_mode = dynamic_palette = 0;
 507
 508         sceGuFinish();
 509         set_scaling_params();
 510         sceGuSync(0,0);
 511 }
 512
 513
 514 /* sound stuff */
 515 #define SOUND_BLOCK_SIZE_NTSC (1470*2) // 1024 // 1152
 516 #define SOUND_BLOCK_SIZE_PAL  (1764*2)
 517 #define SOUND_BLOCK_COUNT    8
 518
 519 static short __attribute__((aligned(4))) sndBuffer[SOUND_BLOCK_SIZE_PAL*SOUND_BLOCK_COUNT + 44100/50*2];
 520 static short *snd_playptr = NULL, *sndBuffer_endptr = NULL;
 521 static int samples_made = 0, samples_done = 0, samples_block = 0;
 522 static int sound_thread_exit = 0;
 523 static SceUID sound_sem = -1;
 524
 525 static void writeSound(int len);
 526
 527 static int sound_thread(SceSize args, void *argp)
 528 {
 529         int ret = 0;
 530
 531         lprintf("sthr: started, priority %i\n", sceKernelGetThreadCurrentPriority());
 532
 533         while (!sound_thread_exit)
 534         {
 535                 if (samples_made - samples_done < samples_block) {
 536                         // wait for data (use at least 2 blocks)
 537                         //lprintf("sthr: wait... (%i)\n", samples_made - samples_done);
 538                         while (samples_made - samples_done <= samples_block*2 && !sound_thread_exit)
 539                                 ret = sceKernelWaitSema(sound_sem, 1, 0);
 540                         if (ret < 0) lprintf("sthr: sceKernelWaitSema: %i\n", ret);
 541                         continue;
 542                 }
 543
 544                 // lprintf("sthr: got data: %i\n", samples_made - samples_done);
 545
 546                 ret = sceAudio_E0727056(PSP_AUDIO_VOLUME_MAX, snd_playptr);
 547
 548                 samples_done += samples_block;
 549                 snd_playptr  += samples_block;
 550                 if (snd_playptr >= sndBuffer_endptr)
 551                         snd_playptr = sndBuffer;
 552                 // 1.5 kernel returns 0, newer ones return # of samples queued
 553                 if (ret < 0)
 554                         lprintf("sthr: sceAudio_E0727056: %08x; pos %i/%i\n", ret, samples_done, samples_made);
 555
 556                 // shouln't happen, but just in case
 557                 if (samples_made - samples_done >= samples_block*3) {
 558                         //lprintf("sthr: block skip (%i)\n", samples_made - samples_done);
 559                         samples_done += samples_block; // skip
 560                         snd_playptr  += samples_block;
 561                 }
 562
 563         }
 564
 565         lprintf("sthr: exit\n");
 566         sceKernelExitDeleteThread(0);
 567         return 0;
 568 }
 569
 570 static void sound_init(void)
 571 {
 572         SceUID thid;
 573         int ret;
 574
 575         sound_sem = sceKernelCreateSema("sndsem", 0, 0, 1, NULL);
 576         if (sound_sem < 0) lprintf("sceKernelCreateSema() failed: %i\n", sound_sem);
 577
 578         samples_made = samples_done = 0;
 579         samples_block = SOUND_BLOCK_SIZE_NTSC; // make sure it goes to sema
 580         sound_thread_exit = 0;
 581         thid = sceKernelCreateThread("sndthread", sound_thread, 0x12, 0x10000, 0, NULL);
 582         if (thid >= 0)
 583         {
 584                 ret = sceKernelStartThread(thid, 0, 0);
 585                 if (ret < 0) lprintf("sound_init: sceKernelStartThread returned %08x\n", ret);
 586         }
 587         else
 588                 lprintf("sceKernelCreateThread failed: %i\n", thid);
 589 }
 590
 591 static void sound_prepare(void)
 592 {
 593         static int PsndRate_old = 0, PicoOpt_old = 0, pal_old = 0;
 594         int ret, stereo;
 595
 596         samples_made = samples_done = 0;
 597
 598         if (PsndRate != PsndRate_old || (PicoOpt&0x0b) != (PicoOpt_old&0x0b) || Pico.m.pal != pal_old) {
 599                 PsndRerate(Pico.m.frame_count ? 1 : 0);
 600         }
 601         stereo=(PicoOpt&8)>>3;
 602
 603         samples_block = Pico.m.pal ? SOUND_BLOCK_SIZE_PAL : SOUND_BLOCK_SIZE_NTSC;
 604         if (PsndRate <= 22050) samples_block /= 2;
 605         sndBuffer_endptr = &sndBuffer[samples_block*SOUND_BLOCK_COUNT];
 606
 607         lprintf("starting audio: %i, len: %i, stereo: %i, pal: %i, block samples: %i\n",
 608                         PsndRate, PsndLen, stereo, Pico.m.pal, samples_block);
 609
 610         // while (sceAudioOutput2GetRestSample() > 0) psp_msleep(100);
 611         // sceAudio_5C37C0AE();
 612         ret = sceAudio_38553111(samples_block/2, PsndRate, 2); // seems to not need that stupid 64byte alignment
 613         if (ret < 0) {
 614                 lprintf("sceAudio_38553111() failed: %i\n", ret);
 615                 sprintf(noticeMsg, "sound init failed (%i), snd disabled", ret);
 616                 noticeMsgTime = sceKernelGetSystemTimeLow();
 617                 currentConfig.EmuOpt &= ~4;
 618         } else {
 619                 PicoWriteSound = writeSound;
 620                 memset32((int *)(void *)sndBuffer, 0, sizeof(sndBuffer)/4);
 621                 snd_playptr = sndBuffer_endptr - samples_block;
 622                 samples_made = samples_block; // send 1 empty block first..
 623                 PsndOut = sndBuffer;
 624                 PsndRate_old = PsndRate;
 625                 PicoOpt_old  = PicoOpt;
 626                 pal_old = Pico.m.pal;
 627         }
 628 }
 629
 630 static void sound_end(void)
 631 {
 632         int i;
 633         if (samples_done == 0)
 634         {
 635                 // if no data is written between sceAudio_38553111 and sceAudio_5C37C0AE calls,
 636                 // we get a deadlock on next sceAudio_38553111 call
 637                 // so this is yet another workaround:
 638                 memset32((int *)(void *)sndBuffer, 0, samples_block*4/4);
 639                 samples_made = samples_block * 3;
 640                 sceKernelSignalSema(sound_sem, 1);
 641         }
 642         sceKernelDelayThread(100*1000);
 643         samples_made = samples_done = 0;
 644         for (i = 0; sceAudioOutput2GetRestSample() > 0 && i < 16; i++)
 645                 psp_msleep(100);
 646         sceAudio_5C37C0AE();
 647 }
 648
 649 static void sound_deinit(void)
 650 {
 651         sound_thread_exit = 1;
 652         sceKernelSignalSema(sound_sem, 1);
 653         sceKernelDeleteSema(sound_sem);
 654         sound_sem = -1;
 655 }
 656
 657 static void writeSound(int len)
 658 {
 659         int ret;
 660         if (PicoOpt&8) len<<=1;
 661
 662         PsndOut += len;
 663         /*if (PsndOut > sndBuffer_endptr) {
 664                 memcpy32((int *)(void *)sndBuffer, (int *)endptr, (PsndOut - endptr + 1) / 2);
 665                 PsndOut = &sndBuffer[PsndOut - endptr];
 666                 lprintf("mov\n");
 667         }
 668         else*/
 669         if (PsndOut > sndBuffer_endptr) lprintf("snd oflow %i!\n", PsndOut - sndBuffer_endptr);
 670         if (PsndOut >= sndBuffer_endptr)
 671                 PsndOut = sndBuffer;
 672
 673         // signal the snd thread
 674         samples_made += len;
 675         if (samples_made - samples_done > samples_block*2) {
 676                 // lprintf("signal, %i/%i\n", samples_done, samples_made);
 677                 ret = sceKernelSignalSema(sound_sem, 1);
 678                 //if (ret < 0) lprintf("snd signal ret %08x\n", ret);
 679         }
 680 }
 681
 682
 683 static void SkipFrame(void)
 684 {
 685         PicoSkipFrame=1;
 686         PicoFrame();
 687         PicoSkipFrame=0;
 688 }
 689
 690 void emu_forcedFrame(void)
 691 {
 692         int po_old = PicoOpt;
 693         int eo_old = currentConfig.EmuOpt;
 694
 695         PicoOpt &= ~0x0010;
 696         PicoOpt |=  0x4080; // soft_scale | acc_sprites
 697         currentConfig.EmuOpt |= 0x80;
 698
 699         vidResetMode();
 700         memset32(VRAM_CACHED_STUFF, 0xe0e0e0e0, 512*8/4); // borders
 701         memset32((int *)VRAM_CACHED_STUFF + 512*232/4, 0xe0e0e0e0, 512*8/4);
 702         memset32_uncached((int *)psp_screen + 512*264*2/4, 0, 512*8*2/4);
 703
 704         PicoDrawSetColorFormat(-1);
 705         PicoScanBegin = EmuScanSlowBegin;
 706         PicoScanEnd = EmuScanSlowEnd;
 707         EmuScanPrepare();
 708         PicoFrameDrawOnly();
 709         blit1();
 710         sceGuSync(0,0);
 711
 712         PicoOpt = po_old;
 713         currentConfig.EmuOpt = eo_old;
 714 }
 715
 716
 717 static void RunEvents(unsigned int which)
 718 {
 719         if (which & 0x1800) // save or load (but not both)
 720         {
 721                 int do_it = 1;
 722
 723                 if ( emu_checkSaveFile(state_slot) &&
 724                                 (( (which & 0x1000) && (currentConfig.EmuOpt & 0x800)) || // load
 725                                  (!(which & 0x1000) && (currentConfig.EmuOpt & 0x200))) ) // save
 726                 {
 727                         int keys;
 728                         sceGuSync(0,0);
 729                         blit2("", (which & 0x1000) ? "LOAD STATE? (X=yes, O=no)" : "OVERWRITE SAVE? (X=yes, O=no)", 0);
 730                         while( !((keys = psp_pad_read(1)) & (BTN_X|BTN_CIRCLE)) )
 731                                 psp_msleep(50);
 732                         if (keys & BTN_CIRCLE) do_it = 0;
 733                         while(  ((keys = psp_pad_read(1)) & (BTN_X|BTN_CIRCLE)) ) // wait for release
 734                                 psp_msleep(50);
 735                         clearArea(0);
 736                 }
 737
 738                 if (do_it)
 739                 {
 740                         osd_text(4, (which & 0x1000) ? "LOADING GAME" : "SAVING GAME", 1, 0);
 741                         PicoStateProgressCB = emu_msg_cb;
 742                         emu_SaveLoadGame((which & 0x1000) >> 12, 0);
 743                         PicoStateProgressCB = NULL;
 744                         psp_msleep(0);
 745                 }
 746
 747                 reset_timing = 1;
 748         }
 749         if (which & 0x0400) // switch renderer
 750         {
 751                 if (PicoOpt&0x10) { PicoOpt&=~0x10; currentConfig.EmuOpt |=  0x80; }
 752                 else              { PicoOpt|= 0x10; currentConfig.EmuOpt &= ~0x80; }
 753
 754                 vidResetMode();
 755
 756                 if (PicoOpt&0x10)
 757                         strcpy(noticeMsg, "fast renderer");
 758                 else if (currentConfig.EmuOpt&0x80)
 759                         strcpy(noticeMsg, "accurate renderer");
 760
 761                 noticeMsgTime = sceKernelGetSystemTimeLow();
 762         }
 763         if (which & 0x0300)
 764         {
 765                 if(which&0x0200) {
 766                         state_slot -= 1;
 767                         if(state_slot < 0) state_slot = 9;
 768                 } else {
 769                         state_slot += 1;
 770                         if(state_slot > 9) state_slot = 0;
 771                 }
 772                 sprintf(noticeMsg, "SAVE SLOT %i [%s]", state_slot, emu_checkSaveFile(state_slot) ? "USED" : "FREE");
 773                 noticeMsgTime = sceKernelGetSystemTimeLow();
 774         }
 775 }
 776
 777 static void updateKeys(void)
 778 {
 779         unsigned int keys, allActions[2] = { 0, 0 }, events;
 780         static unsigned int prevEvents = 0;
 781         int i;
 782
 783         keys = psp_pad_read(0);
 784         if (keys & PSP_CTRL_HOME)
 785                 sceDisplayWaitVblankStart();
 786
 787         if (keys & BTN_SELECT)
 788                 engineState = PGS_Menu;
 789
 790         keys &= CONFIGURABLE_KEYS;
 791
 792         for (i = 0; i < 32; i++)
 793         {
 794                 if (keys & (1 << i))
 795                 {
 796                         int pl, acts = currentConfig.KeyBinds[i];
 797                         if (!acts) continue;
 798                         pl = (acts >> 16) & 1;
 799                         if (kb_combo_keys & (1 << i))
 800                         {
 801                                 int u = i+1, acts_c = acts & kb_combo_acts;
 802                                 // let's try to find the other one
 803                                 if (acts_c) {
 804                                         for (; u < 32; u++)
 805                                                 if ( (keys & (1 << u)) && (currentConfig.KeyBinds[u] & acts_c) ) {
 806                                                         allActions[pl] |= acts_c & currentConfig.KeyBinds[u];
 807                                                         keys &= ~((1 << i) | (1 << u));
 808                                                         break;
 809                                                 }
 810                                 }
 811                                 // add non-combo actions if combo ones were not found
 812                                 if (!acts_c || u == 32)
 813                                         allActions[pl] |= acts & ~kb_combo_acts;
 814                         } else {
 815                                 allActions[pl] |= acts;
 816                         }
 817                 }
 818         }
 819
 820         PicoPad[0] = (unsigned short) allActions[0];
 821         PicoPad[1] = (unsigned short) allActions[1];
 822
 823         events = (allActions[0] | allActions[1]) >> 16;
 824
 825         events &= ~prevEvents;
 826         if (events) RunEvents(events);
 827         if (movie_data) emu_updateMovie();
 828
 829         prevEvents = (allActions[0] | allActions[1]) >> 16;
 830 }
 831
 832
 833 static void simpleWait(unsigned int until)
 834 {
 835         unsigned int tval;
 836         int diff;
 837
 838         tval = sceKernelGetSystemTimeLow();
 839         diff = (int)until - (int)tval;
 840         if (diff >= 512 && diff < 100*1024)
 841                 sceKernelDelayThread(diff);
 842 }
 843
 844 void emu_Loop(void)
 845 {
 846         static int mp3_init_done = 0;
 847         char fpsbuff[24]; // fps count c string
 848         unsigned int tval, tval_thissec = 0; // timing
 849         int target_fps, target_frametime, lim_time, tval_diff, i, oldmodes = 0;
 850         int pframes_done, pframes_shown; // "period" frames, used for sync
 851         int  frames_done,  frames_shown, tval_fpsc = 0; // actual frames
 852         char *notice = NULL;
 853
 854         lprintf("entered emu_Loop()\n");
 855
 856         fpsbuff[0] = 0;
 857
 858         if (currentConfig.CPUclock != psp_get_cpu_clock()) {
 859                 lprintf("setting cpu clock to %iMHz... ", currentConfig.CPUclock);
 860                 i = psp_set_cpu_clock(currentConfig.CPUclock);
 861                 lprintf(i ? "failed\n" : "done\n");
 862                 currentConfig.CPUclock = psp_get_cpu_clock();
 863         }
 864
 865         // make sure we are in correct mode
 866         vidResetMode();
 867         clearArea(1);
 868         Pico.m.dirtyPal = 1;
 869         oldmodes = ((Pico.video.reg[12]&1)<<2) ^ 0xc;
 870         emu_findKeyBindCombos();
 871
 872         // pal/ntsc might have changed, reset related stuff
 873         target_fps = Pico.m.pal ? 50 : 60;
 874         target_frametime = Pico.m.pal ? (1000000<<8)/50 : (1000000<<8)/60+1;
 875         reset_timing = 1;
 876
 877         if (PicoAHW & PAHW_MCD) {
 878                 // prepare CD buffer
 879                 PicoCDBufferInit();
 880                 // mp3...
 881                 if (!mp3_init_done) {
 882                         i = mp3_init();
 883                         mp3_init_done = 1;
 884                         if (i) { engineState = PGS_Menu; return; }
 885                 }
 886         }
 887
 888         // prepare sound stuff
 889         PsndOut = NULL;
 890         if (currentConfig.EmuOpt & 4)
 891         {
 892                 sound_prepare();
 893         }
 894
 895         sceDisplayWaitVblankStart();
 896         pframes_shown = pframes_done =
 897          frames_shown =  frames_done = 0;
 898
 899         tval_fpsc = sceKernelGetSystemTimeLow();
 900
 901         // loop?
 902         while (engineState == PGS_Running)
 903         {
 904                 int modes;
 905
 906                 tval = sceKernelGetSystemTimeLow();
 907                 if (reset_timing || tval < tval_fpsc) {
 908                         //stdbg("timing reset");
 909                         reset_timing = 0;
 910                         tval_thissec = tval;
 911                         pframes_shown = pframes_done = 0;
 912                 }
 913
 914                 // show notice message?
 915                 if (noticeMsgTime) {
 916                         static int noticeMsgSum;
 917                         if (tval - noticeMsgTime > 2000000) { // > 2.0 sec
 918                                 noticeMsgTime = 0;
 919                                 clearArea(0);
 920                                 notice = 0;
 921                         } else {
 922                                 int sum = noticeMsg[0]+noticeMsg[1]+noticeMsg[2];
 923                                 if (sum != noticeMsgSum) { clearArea(0); noticeMsgSum = sum; }
 924                                 notice = noticeMsg;
 925                         }
 926                 }
 927
 928                 // check for mode changes
 929                 modes = ((Pico.video.reg[12]&1)<<2)|(Pico.video.reg[1]&8);
 930                 if (modes != oldmodes) {
 931                         oldmodes = modes;
 932                         clearArea(1);
 933                         set_scaling_params();
 934                 }
 935
 936                 // second passed?
 937                 if (tval - tval_fpsc >= 1000000)
 938                 {
 939                         if (currentConfig.EmuOpt & 2)
 940                                 sprintf(fpsbuff, "%02i/%02i  ", frames_shown, frames_done);
 941                         frames_done = frames_shown = 0;
 942                         tval_fpsc += 1000000;
 943                 }
 944
 945                 if (tval - tval_thissec >= 1000000)
 946                 {
 947                         // missing 1 frame?
 948                         if (currentConfig.Frameskip < 0 && pframes_done < target_fps) {
 949                                 SkipFrame(); pframes_done++; frames_done++;
 950                         }
 951
 952                         tval_thissec += 1000000;
 953
 954                         if (currentConfig.Frameskip < 0) {
 955                                 pframes_done  -= target_fps; if (pframes_done  < 0) pframes_done  = 0;
 956                                 pframes_shown -= target_fps; if (pframes_shown < 0) pframes_shown = 0;
 957                                 if (pframes_shown > pframes_done) pframes_shown = pframes_done;
 958                         } else {
 959                                 pframes_done = pframes_shown = 0;
 960                         }
 961                 }
 962 #ifdef PFRAMES
 963                 sprintf(fpsbuff, "%i", Pico.m.frame_count);
 964 #endif
 965
 966                 lim_time = (pframes_done+1) * target_frametime;
 967                 if (currentConfig.Frameskip >= 0) // frameskip enabled
 968                 {
 969                         for (i = 0; i < currentConfig.Frameskip; i++) {
 970                                 updateKeys();
 971                                 SkipFrame(); pframes_done++; frames_done++;
 972                                 if (!(currentConfig.EmuOpt&0x40000)) { // do framelimitting if needed
 973                                         int tval_diff;
 974                                         tval = sceKernelGetSystemTimeLow();
 975                                         tval_diff = (int)(tval - tval_thissec) << 8;
 976                                         if (tval_diff < lim_time) // we are too fast
 977                                                 simpleWait(tval + ((lim_time - tval_diff)>>8));
 978                                 }
 979                                 lim_time += target_frametime;
 980                         }
 981                 }
 982                 else // auto frameskip
 983                 {
 984                         int tval_diff;
 985                         tval = sceKernelGetSystemTimeLow();
 986                         tval_diff = (int)(tval - tval_thissec) << 8;
 987                         if (tval_diff > lim_time && (pframes_done/16 < pframes_shown))
 988                         {
 989                                 // no time left for this frame - skip
 990                                 if (tval_diff - lim_time >= (300000<<8)) {
 991                                         reset_timing = 1;
 992                                         continue;
 993                                 }
 994                                 updateKeys();
 995                                 SkipFrame(); pframes_done++; frames_done++;
 996                                 continue;
 997                         }
 998                 }
 999
1000                 updateKeys();
1001
1002                 if (!(PicoOpt&0x10))
1003                         EmuScanPrepare();
1004
1005                 PicoFrame();
1006
1007                 sceGuSync(0,0);
1008
1009                 // check time
1010                 tval = sceKernelGetSystemTimeLow();
1011                 tval_diff = (int)(tval - tval_thissec) << 8;
1012
1013                 blit2(fpsbuff, notice, tval_diff > lim_time);
1014
1015                 if (currentConfig.Frameskip < 0 && tval_diff - lim_time >= (300000<<8)) { // slowdown detection
1016                         reset_timing = 1;
1017                 }
1018                 else if (!(currentConfig.EmuOpt&0x40000) || currentConfig.Frameskip < 0)
1019                 {
1020                         // sleep if we are still too fast
1021                         if (tval_diff < lim_time)
1022                         {
1023                                 // we are too fast
1024                                 simpleWait(tval + ((lim_time - tval_diff) >> 8));
1025                         }
1026                 }
1027
1028                 pframes_done++; pframes_shown++;
1029                  frames_done++;  frames_shown++;
1030         }
1031
1032
1033         if (PicoAHW & PAHW_MCD) PicoCDBufferFree();
1034
1035         if (PsndOut != NULL) {
1036                 PsndOut = NULL;
1037                 sound_end();
1038         }
1039
1040         // save SRAM
1041         if ((currentConfig.EmuOpt & 1) && SRam.changed) {
1042                 emu_msg_cb("Writing SRAM/BRAM..");
1043                 emu_SaveLoadGame(0, 1);
1044                 SRam.changed = 0;
1045         }
1046
1047         // clear fps counters and stuff
1048         memset32_uncached((int *)psp_video_get_active_fb() + 512*264*2/4, 0, 512*8*2/4);
1049 }
1050
1051
1052 void emu_ResetGame(void)
1053 {
1054         PicoReset();
1055         reset_timing = 1;
1056 }
1057
1058 void emu_HandleResume(void)
1059 {
1060         if (!(PicoAHW & PAHW_MCD)) return;
1061
1062         // reopen files..
1063         if (Pico_mcd->TOC.Tracks[0].F != NULL)
1064         {
1065                 lprintf("emu_HandleResume: reopen %s\n", romFileName);
1066                 pm_close(Pico_mcd->TOC.Tracks[0].F);
1067                 Pico_mcd->TOC.Tracks[0].F = pm_open(romFileName);
1068                 lprintf("reopen %s\n", Pico_mcd->TOC.Tracks[0].F != NULL ? "ok" : "failed");
1069         }
1070
1071         mp3_reopen_file();
1072 }
1073