+ // setup GU
+ sceGuSync(0,0); // sync with prev
+ sceGuStart(GU_DIRECT, guCmdList);
+
+ sceGuClutMode(GU_PSM_5650,0,0xff,0);
+ sceGuTexMode(GU_PSM_T8,0,0,0); // 8-bit image
+ sceGuTexFunc(GU_TFX_REPLACE,GU_TCC_RGB);
+ if (currentConfig.scaling)
+ sceGuTexFilter(GU_LINEAR, GU_LINEAR);
+ else sceGuTexFilter(GU_NEAREST, GU_NEAREST);
+ sceGuTexScale(1.0f,1.0f);
+ sceGuTexOffset(0.0f,0.0f);
+
+ sceGuTexImage(0,512,512,512,(char *)VRAM_STUFF + 16);
+
+ // slow rend.
+ PicoDrawSetColorFormat(-1);
+ PicoScanBegin = EmuScanSlowBegin;
+ PicoScanEnd = EmuScanSlowEnd;
+
+ localPal[0xe0] = 0;
+ localPal[0xf0] = 0x001f;
+ Pico.m.dirtyPal = 1;
+ blit_16bit_mode = dynamic_palette = 0;
+
+ sceGuFinish();
+ set_scaling_params();
+ sceGuSync(0,0);
+}
+
+void plat_debug_cat(char *str)
+{
+ strcat(str, blit_16bit_mode ? "soft clut\n" : "hard clut\n");
+}
+
+
+/* sound stuff */
+#define SOUND_BLOCK_SIZE_NTSC (1470*2) // 1024 // 1152
+#define SOUND_BLOCK_SIZE_PAL (1764*2)
+#define SOUND_BLOCK_COUNT 8
+
+static short __attribute__((aligned(4))) sndBuffer[SOUND_BLOCK_SIZE_PAL*SOUND_BLOCK_COUNT + 44100/50*2];
+static short *snd_playptr = NULL, *sndBuffer_endptr = NULL;
+static int samples_made = 0, samples_done = 0, samples_block = 0;
+static int sound_thread_exit = 0;
+static SceUID sound_sem = -1;
+
+static void writeSound(int len);
+
+static int sound_thread(SceSize args, void *argp)
+{
+ int ret = 0;
+
+ lprintf("sthr: started, priority %i\n", sceKernelGetThreadCurrentPriority());
+
+ while (!sound_thread_exit)
+ {
+ if (samples_made - samples_done < samples_block) {
+ // wait for data (use at least 2 blocks)
+ //lprintf("sthr: wait... (%i)\n", samples_made - samples_done);
+ while (samples_made - samples_done <= samples_block*2 && !sound_thread_exit)
+ ret = sceKernelWaitSema(sound_sem, 1, 0);
+ if (ret < 0) lprintf("sthr: sceKernelWaitSema: %i\n", ret);
+ continue;
+ }
+
+ // lprintf("sthr: got data: %i\n", samples_made - samples_done);
+
+ ret = sceAudio_E0727056(PSP_AUDIO_VOLUME_MAX, snd_playptr);
+
+ samples_done += samples_block;
+ snd_playptr += samples_block;
+ if (snd_playptr >= sndBuffer_endptr)
+ snd_playptr = sndBuffer;
+ // 1.5 kernel returns 0, newer ones return # of samples queued
+ if (ret < 0)
+ lprintf("sthr: sceAudio_E0727056: %08x; pos %i/%i\n", ret, samples_done, samples_made);
+
+ // shouln't happen, but just in case
+ if (samples_made - samples_done >= samples_block*3) {
+ //lprintf("sthr: block skip (%i)\n", samples_made - samples_done);
+ samples_done += samples_block; // skip
+ snd_playptr += samples_block;
+ }
+
+ }
+
+ lprintf("sthr: exit\n");
+ sceKernelExitDeleteThread(0);
+ return 0;
+}
+
+static void sound_init(void)
+{
+ SceUID thid;
+ int ret;
+
+ sound_sem = sceKernelCreateSema("sndsem", 0, 0, 1, NULL);
+ if (sound_sem < 0) lprintf("sceKernelCreateSema() failed: %i\n", sound_sem);
+
+ samples_made = samples_done = 0;
+ samples_block = SOUND_BLOCK_SIZE_NTSC; // make sure it goes to sema
+ sound_thread_exit = 0;
+ thid = sceKernelCreateThread("sndthread", sound_thread, 0x12, 0x10000, 0, NULL);
+ if (thid >= 0)
+ {
+ ret = sceKernelStartThread(thid, 0, 0);
+ if (ret < 0) lprintf("sound_init: sceKernelStartThread returned %08x\n", ret);
+ }
+ else
+ lprintf("sceKernelCreateThread failed: %i\n", thid);
+}
+
+void pemu_sound_start(void)
+{
+ static int PsndRate_old = 0, PicoOpt_old = 0, pal_old = 0;
+ int ret, stereo;
+
+ samples_made = samples_done = 0;
+
+ if (PsndRate != PsndRate_old || (PicoOpt&0x0b) != (PicoOpt_old&0x0b) || Pico.m.pal != pal_old) {
+ PsndRerate(Pico.m.frame_count ? 1 : 0);
+ }
+ stereo=(PicoOpt&8)>>3;
+
+ samples_block = Pico.m.pal ? SOUND_BLOCK_SIZE_PAL : SOUND_BLOCK_SIZE_NTSC;
+ if (PsndRate <= 22050) samples_block /= 2;
+ sndBuffer_endptr = &sndBuffer[samples_block*SOUND_BLOCK_COUNT];
+
+ lprintf("starting audio: %i, len: %i, stereo: %i, pal: %i, block samples: %i\n",
+ PsndRate, PsndLen, stereo, Pico.m.pal, samples_block);
+
+ // while (sceAudioOutput2GetRestSample() > 0) psp_msleep(100);
+ // sceAudio_5C37C0AE();
+ ret = sceAudio_38553111(samples_block/2, PsndRate, 2); // seems to not need that stupid 64byte alignment
+ if (ret < 0) {
+ lprintf("sceAudio_38553111() failed: %i\n", ret);
+ plat_status_msg("sound init failed (%i), snd disabled", ret);
+ currentConfig.EmuOpt &= ~EOPT_EN_SOUND;
+ } else {
+ PicoWriteSound = writeSound;
+ memset32((int *)(void *)sndBuffer, 0, sizeof(sndBuffer)/4);
+ snd_playptr = sndBuffer_endptr - samples_block;
+ samples_made = samples_block; // send 1 empty block first..
+ PsndOut = sndBuffer;
+ PsndRate_old = PsndRate;
+ PicoOpt_old = PicoOpt;
+ pal_old = Pico.m.pal;
+ }
+}
+
+void pemu_sound_stop(void)
+{
+ int i;
+ if (samples_done == 0)
+ {
+ // if no data is written between sceAudio_38553111 and sceAudio_5C37C0AE calls,
+ // we get a deadlock on next sceAudio_38553111 call
+ // so this is yet another workaround:
+ memset32((int *)(void *)sndBuffer, 0, samples_block*4/4);
+ samples_made = samples_block * 3;
+ sceKernelSignalSema(sound_sem, 1);
+ }
+ sceKernelDelayThread(100*1000);
+ samples_made = samples_done = 0;
+ for (i = 0; sceAudioOutput2GetRestSample() > 0 && i < 16; i++)
+ psp_msleep(100);
+ sceAudio_5C37C0AE();
+}
+
+/* wait until we can write more sound */
+void pemu_sound_wait(void)
+{
+ // TODO: test this
+ while (!sound_thread_exit && samples_made - samples_done > samples_block * 4)
+ psp_msleep(10);
+}
+
+static void sound_deinit(void)
+{
+ sound_thread_exit = 1;
+ sceKernelSignalSema(sound_sem, 1);
+ sceKernelDeleteSema(sound_sem);
+ sound_sem = -1;
+}
+
+static void writeSound(int len)
+{
+ int ret;
+ if (PicoOpt&8) len<<=1;
+
+ PsndOut += len;
+ /*if (PsndOut > sndBuffer_endptr) {
+ memcpy32((int *)(void *)sndBuffer, (int *)endptr, (PsndOut - endptr + 1) / 2);
+ PsndOut = &sndBuffer[PsndOut - endptr];
+ lprintf("mov\n");
+ }
+ else*/
+ if (PsndOut > sndBuffer_endptr) lprintf("snd oflow %i!\n", PsndOut - sndBuffer_endptr);
+ if (PsndOut >= sndBuffer_endptr)
+ PsndOut = sndBuffer;
+
+ // signal the snd thread
+ samples_made += len;
+ if (samples_made - samples_done > samples_block*2) {
+ // lprintf("signal, %i/%i\n", samples_done, samples_made);
+ ret = sceKernelSignalSema(sound_sem, 1);
+ //if (ret < 0) lprintf("snd signal ret %08x\n", ret);
+ }
+}
+
+
+static void SkipFrame(void)
+{
+ PicoSkipFrame=1;
+ PicoFrame();
+ PicoSkipFrame=0;
+}
+
+void pemu_forced_frame(int opts)
+{
+ int po_old = PicoOpt;
+ int eo_old = currentConfig.EmuOpt;
+
+ PicoOpt &= ~0x10;
+ PicoOpt |= opts|POPT_ACC_SPRITES;
+ currentConfig.EmuOpt |= 0x80;
+
+ vidResetMode();
+ memset32(VRAM_CACHED_STUFF, 0xe0e0e0e0, 512*8/4); // borders
+ memset32((int *)VRAM_CACHED_STUFF + 512*232/4, 0xe0e0e0e0, 512*8/4);
+ memset32_uncached((int *)psp_screen + 512*264*2/4, 0, 512*8*2/4);
+
+ PicoDrawSetColorFormat(-1);
+ PicoScanBegin = EmuScanSlowBegin;
+ PicoScanEnd = EmuScanSlowEnd;
+ EmuScanPrepare();
+ PicoFrameDrawOnly();
+ blit1();
+ sceGuSync(0,0);
+
+ PicoOpt = po_old;
+ currentConfig.EmuOpt = eo_old;
+}
+
+
+static void RunEventsPico(unsigned int events, unsigned int keys)
+{
+ emu_RunEventsPico(events);
+
+ if (pico_inp_mode != 0)
+ {
+ PicoPad[0] &= ~0x0f; // release UDLR
+ if (keys & PBTN_UP) { pico_pen_y--; if (pico_pen_y < 8) pico_pen_y = 8; }
+ if (keys & PBTN_DOWN) { pico_pen_y++; if (pico_pen_y > 224-PICO_PEN_ADJUST_Y) pico_pen_y = 224-PICO_PEN_ADJUST_Y; }
+ if (keys & PBTN_LEFT) { pico_pen_x--; if (pico_pen_x < 0) pico_pen_x = 0; }
+ if (keys & PBTN_RIGHT) {
+ int lim = (Pico.video.reg[12]&1) ? 319 : 255;
+ pico_pen_x++;
+ if (pico_pen_x > lim-PICO_PEN_ADJUST_X)
+ pico_pen_x = lim-PICO_PEN_ADJUST_X;
+ }
+ PicoPicohw.pen_pos[0] = pico_pen_x;
+ if (!(Pico.video.reg[12]&1)) PicoPicohw.pen_pos[0] += pico_pen_x/4;
+ PicoPicohw.pen_pos[0] += 0x3c;
+ PicoPicohw.pen_pos[1] = pico_inp_mode == 1 ? (0x2f8 + pico_pen_y) : (0x1fc + pico_pen_y);
+ }
+}
+
+static void RunEvents(unsigned int which)
+{
+ if (which & 0x1800) // save or load (but not both)
+ {
+ int do_it = 1;
+
+ if ( emu_check_save_file(state_slot) &&
+ (( (which & 0x1000) && (currentConfig.EmuOpt & 0x800)) || // load
+ (!(which & 0x1000) && (currentConfig.EmuOpt & 0x200))) ) // save
+ {
+ int keys;
+ sceGuSync(0,0);
+ blit2("", (which & 0x1000) ? "LOAD STATE? (X=yes, O=no)" : "OVERWRITE SAVE? (X=yes, O=no)", 0);
+ while( !((keys = psp_pad_read(1)) & (PBTN_X|PBTN_CIRCLE)) )
+ psp_msleep(50);
+ if (keys & PBTN_CIRCLE) do_it = 0;
+ while( ((keys = psp_pad_read(1)) & (PBTN_X|PBTN_CIRCLE)) ) // wait for release
+ psp_msleep(50);
+ clearArea(0);
+ }
+
+ if (do_it)
+ {
+ osd_text(4, (which & 0x1000) ? "LOADING GAME" : "SAVING GAME", 1, 0);
+ PicoStateProgressCB = emu_msg_cb;
+ emu_save_load_game((which & 0x1000) >> 12, 0);
+ PicoStateProgressCB = NULL;
+ psp_msleep(0);
+ }
+
+ reset_timing = 1;
+ }
+ if (which & 0x0400) // switch renderer
+ {
+ if (PicoOpt&0x10) { PicoOpt&=~0x10; currentConfig.EmuOpt |= 0x80; }
+ else { PicoOpt|= 0x10; currentConfig.EmuOpt &= ~0x80; }
+
+ vidResetMode();
+
+ if (PicoOpt & POPT_ALT_RENDERER)
+ plat_status_msg("fast renderer");
+ else if (currentConfig.EmuOpt&0x80)
+ plat_status_msg("accurate renderer");
+ }
+ if (which & 0x0300)
+ {
+ if(which&0x0200) {
+ state_slot -= 1;
+ if(state_slot < 0) state_slot = 9;
+ } else {
+ state_slot += 1;
+ if(state_slot > 9) state_slot = 0;
+ }
+ plat_status_msg("SAVE SLOT %i [%s]", state_slot,
+ emu_check_save_file(state_slot) ? "USED" : "FREE");
+ }
+}
+
+static void updateKeys(void)
+{
+ unsigned int keys, allActions[2] = { 0, 0 }, events;
+ static unsigned int prevEvents = 0;
+ int i;
+
+ /* FIXME: port to input fw, merge with emu.c:emu_update_input() */
+ keys = psp_pad_read(0);
+ if (keys & PSP_CTRL_HOME)
+ sceDisplayWaitVblankStart();
+
+ if (keys & PBTN_SELECT)
+ engineState = PGS_Menu;
+
+ keys &= CONFIGURABLE_KEYS;
+
+ PicoPad[0] = allActions[0] & 0xfff;
+ PicoPad[1] = allActions[1] & 0xfff;
+
+ if (allActions[0] & 0x7000) emu_DoTurbo(&PicoPad[0], allActions[0]);
+ if (allActions[1] & 0x7000) emu_DoTurbo(&PicoPad[1], allActions[1]);
+
+ events = (allActions[0] | allActions[1]) >> 16;
+
+ if ((events ^ prevEvents) & 0x40) {
+ emu_set_fastforward(events & 0x40);
+ reset_timing = 1;
+ }
+
+ events &= ~prevEvents;
+
+ if (PicoAHW == PAHW_PICO)
+ RunEventsPico(events, keys);
+ if (events) RunEvents(events);
+ if (movie_data) emu_updateMovie();
+
+ prevEvents = (allActions[0] | allActions[1]) >> 16;
+}
+
+
+static void simpleWait(unsigned int until)
+{
+ unsigned int tval;
+ int diff;
+
+ tval = sceKernelGetSystemTimeLow();
+ diff = (int)until - (int)tval;
+ if (diff >= 512 && diff < 100*1024)
+ sceKernelDelayThread(diff);
+}
+
+void pemu_loop(void)
+{
+ static int mp3_init_done = 0;
+ char fpsbuff[24]; // fps count c string
+ unsigned int tval, tval_thissec = 0; // timing
+ int target_fps, target_frametime, lim_time, tval_diff, i, oldmodes = 0;
+ int pframes_done, pframes_shown; // "period" frames, used for sync
+ int frames_done, frames_shown, tval_fpsc = 0; // actual frames
+ char *notice = NULL;
+
+ lprintf("entered emu_Loop()\n");
+
+ fpsbuff[0] = 0;
+
+ if (currentConfig.CPUclock != psp_get_cpu_clock()) {
+ lprintf("setting cpu clock to %iMHz... ", currentConfig.CPUclock);
+ i = psp_set_cpu_clock(currentConfig.CPUclock);
+ lprintf(i ? "failed\n" : "done\n");
+ currentConfig.CPUclock = psp_get_cpu_clock();
+ }
+
+ // make sure we are in correct mode
+ vidResetMode();
+ clearArea(1);
+ Pico.m.dirtyPal = 1;
+ oldmodes = ((Pico.video.reg[12]&1)<<2) ^ 0xc;
+
+ // pal/ntsc might have changed, reset related stuff
+ target_fps = Pico.m.pal ? 50 : 60;
+ target_frametime = Pico.m.pal ? (1000000<<8)/50 : (1000000<<8)/60+1;
+ reset_timing = 1;
+
+ if (PicoAHW & PAHW_MCD) {
+ // prepare CD buffer
+ PicoCDBufferInit();
+ // mp3...
+ if (!mp3_init_done) {
+ i = mp3_init();
+ mp3_init_done = 1;
+ if (i) { engineState = PGS_Menu; return; }
+ }
+ }
+
+ // prepare sound stuff
+ PsndOut = NULL;
+ if (currentConfig.EmuOpt & EOPT_EN_SOUND)
+ {
+ pemu_sound_start();
+ }
+
+ sceDisplayWaitVblankStart();
+ pframes_shown = pframes_done =
+ frames_shown = frames_done = 0;
+
+ tval_fpsc = sceKernelGetSystemTimeLow();
+
+ // loop?
+ while (engineState == PGS_Running)
+ {
+ int modes;
+
+ tval = sceKernelGetSystemTimeLow();
+ if (reset_timing || tval < tval_fpsc) {
+ //stdbg("timing reset");
+ reset_timing = 0;
+ tval_thissec = tval;
+ pframes_shown = pframes_done = 0;
+ }
+
+ // show notice message?
+ if (noticeMsgTime) {
+ static int noticeMsgSum;
+ if (tval - noticeMsgTime > 2000000) { // > 2.0 sec
+ noticeMsgTime = 0;
+ clearArea(0);
+ notice = 0;
+ } else {
+ int sum = noticeMsg[0]+noticeMsg[1]+noticeMsg[2];
+ if (sum != noticeMsgSum) { clearArea(0); noticeMsgSum = sum; }
+ notice = noticeMsg;
+ }
+ }
+
+ // check for mode changes
+ modes = ((Pico.video.reg[12]&1)<<2)|(Pico.video.reg[1]&8);
+ if (modes != oldmodes) {
+ oldmodes = modes;
+ clearArea(1);
+ set_scaling_params();
+ }
+
+ // second passed?
+ if (tval - tval_fpsc >= 1000000)
+ {
+ if (currentConfig.EmuOpt & 2)
+ sprintf(fpsbuff, "%02i/%02i ", frames_shown, frames_done);
+ frames_done = frames_shown = 0;
+ tval_fpsc += 1000000;
+ }
+
+ if (tval - tval_thissec >= 1000000)
+ {
+ // missing 1 frame?
+ if (currentConfig.Frameskip < 0 && pframes_done < target_fps) {
+ SkipFrame(); pframes_done++; frames_done++;
+ }
+
+ tval_thissec += 1000000;
+
+ if (currentConfig.Frameskip < 0) {
+ pframes_done -= target_fps; if (pframes_done < 0) pframes_done = 0;
+ pframes_shown -= target_fps; if (pframes_shown < 0) pframes_shown = 0;
+ if (pframes_shown > pframes_done) pframes_shown = pframes_done;
+ } else {
+ pframes_done = pframes_shown = 0;
+ }
+ }
+#ifdef PFRAMES
+ sprintf(fpsbuff, "%i", Pico.m.frame_count);
+#endif
+
+ lim_time = (pframes_done+1) * target_frametime;
+ if (currentConfig.Frameskip >= 0) // frameskip enabled
+ {
+ for (i = 0; i < currentConfig.Frameskip; i++) {
+ updateKeys();
+ SkipFrame(); pframes_done++; frames_done++;
+ if (!(currentConfig.EmuOpt&0x40000)) { // do framelimitting if needed
+ int tval_diff;
+ tval = sceKernelGetSystemTimeLow();
+ tval_diff = (int)(tval - tval_thissec) << 8;
+ if (tval_diff < lim_time) // we are too fast
+ simpleWait(tval + ((lim_time - tval_diff)>>8));
+ }
+ lim_time += target_frametime;
+ }
+ }
+ else // auto frameskip
+ {
+ int tval_diff;
+ tval = sceKernelGetSystemTimeLow();
+ tval_diff = (int)(tval - tval_thissec) << 8;
+ if (tval_diff > lim_time && (pframes_done/16 < pframes_shown))
+ {
+ // no time left for this frame - skip
+ if (tval_diff - lim_time >= (300000<<8)) {
+ reset_timing = 1;
+ continue;
+ }
+ updateKeys();
+ SkipFrame(); pframes_done++; frames_done++;
+ continue;
+ }
+ }
+
+ updateKeys();
+
+ if (!(PicoOpt&0x10))
+ EmuScanPrepare();
+
+ PicoFrame();
+
+ sceGuSync(0,0);
+
+ // check time
+ tval = sceKernelGetSystemTimeLow();
+ tval_diff = (int)(tval - tval_thissec) << 8;
+
+ blit2(fpsbuff, notice, tval_diff > lim_time);
+
+ if (currentConfig.Frameskip < 0 && tval_diff - lim_time >= (300000<<8)) { // slowdown detection
+ reset_timing = 1;
+ }
+ else if (!(currentConfig.EmuOpt&0x40000) || currentConfig.Frameskip < 0)
+ {
+ // sleep if we are still too fast
+ if (tval_diff < lim_time)
+ {
+ // we are too fast
+ simpleWait(tval + ((lim_time - tval_diff) >> 8));
+ }
+ }
+
+ pframes_done++; pframes_shown++;
+ frames_done++; frames_shown++;
+ }
+
+
+ emu_set_fastforward(0);
+
+ if (PicoAHW & PAHW_MCD) PicoCDBufferFree();
+
+ if (PsndOut != NULL) {
+ pemu_sound_stop();
+ PsndOut = NULL;
+ }
+
+ // save SRAM
+ if ((currentConfig.EmuOpt & 1) && SRam.changed) {
+ emu_msg_cb("Writing SRAM/BRAM..");
+ emu_save_load_game(0, 1);
+ SRam.changed = 0;
+ }
+
+ // clear fps counters and stuff
+ memset32_uncached((int *)psp_video_get_active_fb() + 512*264*2/4, 0, 512*8*2/4);
+}
+
+void emu_HandleResume(void)
+{
+ if (!(PicoAHW & PAHW_MCD)) return;
+
+ // reopen first CD track
+ if (Pico_mcd->TOC.Tracks[0].F != NULL)
+ {
+ char *fname = rom_fname_reload;
+ int len = strlen(rom_fname_reload);
+ cue_data_t *cue_data = NULL;
+
+ if (len > 4 && strcasecmp(fname + len - 4, ".cue") == 0)
+ {
+ cue_data = cue_parse(rom_fname_reload);
+ if (cue_data != NULL)
+ fname = cue_data->tracks[1].fname;
+ }
+
+ lprintf("emu_HandleResume: reopen %s\n", fname);
+ pm_close(Pico_mcd->TOC.Tracks[0].F);
+ Pico_mcd->TOC.Tracks[0].F = pm_open(fname);
+ lprintf("reopen %s\n", Pico_mcd->TOC.Tracks[0].F != NULL ? "ok" : "failed");
+
+ if (cue_data != NULL) cue_destroy(cue_data);
+ }
+
+ mp3_reopen_file();
+
+ if (!(Pico_mcd->s68k_regs[0x36] & 1) && (Pico_mcd->scd.Status_CDC & 1))
+ cdda_start_play();