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