b60f2812 |
1 | /* |
8f892648 |
2 | * (C) notaz, 2010-2011 |
b60f2812 |
3 | * |
4 | * This work is licensed under the terms of the GNU GPLv2 or later. |
5 | * See the COPYING file in the top-level directory. |
6 | */ |
7 | |
8 | #include <stdio.h> |
9 | #include <stdlib.h> |
69af03a2 |
10 | #include <string.h> |
11 | #include <stdarg.h> |
799b0b87 |
12 | #include <stdint.h> |
72228559 |
13 | #include <sys/time.h> |
14 | #include <sys/types.h> |
15 | #include <sys/stat.h> |
16 | #include <fcntl.h> |
17 | #include <unistd.h> |
7c0f51de |
18 | #include <pthread.h> |
b60f2812 |
19 | |
cc56203b |
20 | #include "libpicofe/fonts.h" |
21 | #include "libpicofe/input.h" |
22 | #include "libpicofe/plat.h" |
23 | #include "libpicofe/arm/neon_scale2x.h" |
24 | #include "libpicofe/arm/neon_eagle2x.h" |
72228559 |
25 | #include "plugin_lib.h" |
3c70c47b |
26 | #include "menu.h" |
8f892648 |
27 | #include "main.h" |
47821672 |
28 | #include "plat.h" |
72228559 |
29 | #include "pcnt.h" |
4c08b9e7 |
30 | #include "pl_gun_ts.h" |
69af03a2 |
31 | #include "../libpcsxcore/new_dynarec/new_dynarec.h" |
799b0b87 |
32 | #include "../libpcsxcore/psemu_plugin_defs.h" |
fa56d360 |
33 | #include "../plugins/gpulib/cspace.h" |
b60f2812 |
34 | |
4c08b9e7 |
35 | int in_type1, in_type2; |
36 | int in_a1[2] = { 127, 127 }, in_a2[2] = { 127, 127 }; |
1b0c5139 |
37 | int in_adev[2] = { -1, -1 }, in_adev_axis[2][2] = {{ 0, 1 }, { 0, 1 }}; |
2c5d0a55 |
38 | int in_adev_is_nublike[2]; |
4c08b9e7 |
39 | int in_keystate, in_state_gun; |
b944a30e |
40 | int in_enable_vibration; |
faf2b2aa |
41 | void *tsdev; |
76f7048e |
42 | void *pl_vout_buf; |
6469a8c4 |
43 | int g_layer_x, g_layer_y, g_layer_w, g_layer_h; |
ddc0a02a |
44 | static int pl_vout_w, pl_vout_h, pl_vout_bpp; /* output display/layer */ |
fa56d360 |
45 | static int pl_vout_scale; |
ddc0a02a |
46 | static int psx_w, psx_h, psx_bpp; |
a92f6af1 |
47 | static int vsync_cnt; |
ab423939 |
48 | static int is_pal, frame_interval, frame_interval1024; |
49 | static int vsync_usec_time; |
72228559 |
50 | |
4c08b9e7 |
51 | |
52 | static __attribute__((noinline)) int get_cpu_ticks(void) |
72228559 |
53 | { |
54 | static unsigned long last_utime; |
55 | static int fd; |
56 | unsigned long utime, ret; |
57 | char buf[128]; |
58 | |
59 | if (fd == 0) |
60 | fd = open("/proc/self/stat", O_RDONLY); |
61 | lseek(fd, 0, SEEK_SET); |
62 | buf[0] = 0; |
63 | read(fd, buf, sizeof(buf)); |
64 | buf[sizeof(buf) - 1] = 0; |
65 | |
66 | sscanf(buf, "%*d %*s %*c %*d %*d %*d %*d %*d %*u %*u %*u %*u %*u %lu", &utime); |
67 | ret = utime - last_utime; |
68 | last_utime = utime; |
69 | return ret; |
70 | } |
71 | |
41f55c9f |
72 | static void print_msg(int h, int border) |
8f892648 |
73 | { |
76f7048e |
74 | if (pl_vout_bpp == 16) |
41f55c9f |
75 | pl_text_out16(border + 2, h - 10, "%s", hud_msg); |
8f892648 |
76 | } |
77 | |
41f55c9f |
78 | static void print_fps(int h, int border) |
72228559 |
79 | { |
76f7048e |
80 | if (pl_vout_bpp == 16) |
a92f6af1 |
81 | pl_text_out16(border + 2, h - 10, "%2d %4.1f", |
82 | pl_rearmed_cbs.flips_per_sec, pl_rearmed_cbs.vsps_cur); |
72228559 |
83 | } |
84 | |
41f55c9f |
85 | static void print_cpu_usage(int w, int h, int border) |
72228559 |
86 | { |
76f7048e |
87 | if (pl_vout_bpp == 16) |
a92f6af1 |
88 | pl_text_out16(w - border - 28, h - 10, "%3d", pl_rearmed_cbs.cpu_usage); |
72228559 |
89 | } |
b60f2812 |
90 | |
90f1d26c |
91 | // draw 192x8 status of 24 sound channels |
55b0eeea |
92 | static __attribute__((noinline)) void draw_active_chans(int vout_w, int vout_h) |
90f1d26c |
93 | { |
174c454a |
94 | extern void spu_get_debug_info(int *chans_out, int *run_chans, |
95 | int *fmod_chans_out, int *noise_chans_out); // hack |
96 | int live_chans, run_chans, fmod_chans, noise_chans; |
90f1d26c |
97 | |
98 | static const unsigned short colors[2] = { 0x1fe3, 0x0700 }; |
76f7048e |
99 | unsigned short *dest = (unsigned short *)pl_vout_buf + |
55b0eeea |
100 | vout_w * (vout_h - 10) + vout_w / 2 - 192/2; |
90f1d26c |
101 | unsigned short *d, p; |
102 | int c, x, y; |
103 | |
76f7048e |
104 | if (pl_vout_bpp != 16) |
90f1d26c |
105 | return; |
106 | |
174c454a |
107 | spu_get_debug_info(&live_chans, &run_chans, &fmod_chans, &noise_chans); |
90f1d26c |
108 | |
109 | for (c = 0; c < 24; c++) { |
110 | d = dest + c * 8; |
174c454a |
111 | p = !(live_chans & (1<<c)) ? (run_chans & (1<<c) ? 0x01c0 : 0) : |
90f1d26c |
112 | (fmod_chans & (1<<c)) ? 0xf000 : |
113 | (noise_chans & (1<<c)) ? 0x001f : |
114 | colors[c & 1]; |
55b0eeea |
115 | for (y = 0; y < 8; y++, d += vout_w) |
90f1d26c |
116 | for (x = 0; x < 8; x++) |
117 | d[x] = p; |
118 | } |
119 | } |
120 | |
fa56d360 |
121 | void pl_print_hud(int w, int h, int xborder) |
55b0eeea |
122 | { |
aafcb4dd |
123 | if (h < 16) |
124 | return; |
125 | |
55b0eeea |
126 | if (g_opts & OPT_SHOWSPU) |
127 | draw_active_chans(w, h); |
128 | |
129 | if (hud_msg[0] != 0) |
41f55c9f |
130 | print_msg(h, xborder); |
55b0eeea |
131 | else if (g_opts & OPT_SHOWFPS) |
41f55c9f |
132 | print_fps(h, xborder); |
55b0eeea |
133 | |
134 | if (g_opts & OPT_SHOWCPU) |
41f55c9f |
135 | print_cpu_usage(w, h, xborder); |
55b0eeea |
136 | } |
137 | |
9e5ac38f |
138 | /* update scaler target size according to user settings */ |
139 | static void update_layer_size(int w, int h) |
140 | { |
141 | float mult; |
142 | int imult; |
143 | |
144 | switch (g_scaler) { |
145 | case SCALE_1_1: |
146 | g_layer_w = w; g_layer_h = h; |
147 | break; |
148 | |
149 | case SCALE_4_3v2: |
150 | if (h > g_menuscreen_h || (240 < h && h <= 360)) |
151 | goto fractional_4_3; |
152 | |
153 | // 4:3 that prefers integer scaling |
154 | imult = g_menuscreen_h / h; |
155 | g_layer_w = w * imult; |
156 | g_layer_h = h * imult; |
157 | mult = (float)g_layer_w / (float)g_layer_h; |
158 | if (mult < 1.25f || mult > 1.666f) |
159 | g_layer_w = 4.0f/3.0f * (float)g_layer_h; |
160 | printf(" -> %dx%d %.1f\n", g_layer_w, g_layer_h, mult); |
161 | break; |
162 | |
163 | fractional_4_3: |
164 | case SCALE_4_3: |
165 | mult = 240.0f / (float)h * 4.0f / 3.0f; |
166 | if (h > 256) |
167 | mult *= 2.0f; |
168 | g_layer_w = mult * (float)g_menuscreen_h; |
169 | g_layer_h = g_menuscreen_h; |
170 | printf(" -> %dx%d %.1f\n", g_layer_w, g_layer_h, mult); |
171 | break; |
172 | |
173 | case SCALE_FULLSCREEN: |
174 | g_layer_w = g_menuscreen_w; |
175 | g_layer_h = g_menuscreen_h; |
176 | break; |
177 | |
178 | default: |
179 | break; |
180 | } |
181 | |
182 | g_layer_x = g_menuscreen_w / 2 - g_layer_w / 2; |
183 | g_layer_y = g_menuscreen_h / 2 - g_layer_h / 2; |
184 | if (g_layer_x < 0) g_layer_x = 0; |
185 | if (g_layer_y < 0) g_layer_y = 0; |
186 | if (g_layer_w > g_menuscreen_w) g_layer_w = g_menuscreen_w; |
187 | if (g_layer_h > g_menuscreen_h) g_layer_h = g_menuscreen_h; |
188 | } |
189 | |
fa56d360 |
190 | // XXX: this is platform specific really |
191 | static int resolution_ok(int w, int h) |
69af03a2 |
192 | { |
fa56d360 |
193 | return w <= 1024 && h <= 512; |
194 | } |
195 | |
196 | static void pl_vout_set_mode(int w, int h, int bpp) |
197 | { |
198 | int vout_w, vout_h, vout_bpp; |
199 | |
a185be70 |
200 | // special h handling, Wipeout likes to change it by 1-6 |
321ca84d |
201 | static int vsync_cnt_ms_prev; |
202 | if ((unsigned int)(vsync_cnt - vsync_cnt_ms_prev) < 5*60) |
203 | h = (h + 7) & ~7; |
204 | vsync_cnt_ms_prev = vsync_cnt; |
a185be70 |
205 | |
fa56d360 |
206 | vout_w = psx_w = w; |
207 | vout_h = psx_h = h; |
208 | vout_bpp = psx_bpp = bpp; |
209 | |
210 | pl_vout_scale = 1; |
211 | #ifdef __ARM_NEON__ |
212 | if (soft_filter) { |
213 | if (resolution_ok(w * 2, h * 2) && bpp == 16) { |
214 | vout_w *= 2; |
215 | vout_h *= 2; |
216 | pl_vout_scale = 2; |
217 | } |
218 | else { |
219 | // filter unavailable |
220 | hud_msg[0] = 0; |
221 | } |
222 | } |
223 | #endif |
b60f2812 |
224 | |
fa56d360 |
225 | if (pl_vout_buf != NULL && vout_w == pl_vout_w && vout_h == pl_vout_h |
226 | && vout_bpp == pl_vout_bpp) |
227 | return; |
d352cde2 |
228 | |
fa56d360 |
229 | update_layer_size(vout_w, vout_h); |
9e5ac38f |
230 | |
fa56d360 |
231 | pl_vout_buf = plat_gvideo_set_mode(&vout_w, &vout_h, &vout_bpp); |
232 | if (pl_vout_buf == NULL) |
ddc0a02a |
233 | fprintf(stderr, "failed to set mode %dx%d@%d\n", |
234 | psx_w, psx_h, psx_bpp); |
fa56d360 |
235 | else { |
236 | pl_vout_w = vout_w; |
237 | pl_vout_h = vout_h; |
238 | pl_vout_bpp = vout_bpp; |
239 | } |
a185be70 |
240 | |
ddc0a02a |
241 | menu_notify_mode_change(pl_vout_w, pl_vout_h, pl_vout_bpp); |
69af03a2 |
242 | } |
243 | |
fa56d360 |
244 | static void pl_vout_flip(const void *vram, int stride, int bgr24, int w, int h) |
69af03a2 |
245 | { |
fa56d360 |
246 | static int doffs_old, clear_counter; |
247 | unsigned char *dest = pl_vout_buf; |
248 | const unsigned short *src = vram; |
249 | int dstride = pl_vout_w, h1 = h; |
250 | int doffs; |
251 | |
cc56203b |
252 | pcnt_start(PCNT_BLIT); |
253 | |
fa56d360 |
254 | if (dest == NULL) |
255 | goto out; |
256 | |
257 | if (vram == NULL) { |
258 | // blanking |
259 | memset(pl_vout_buf, 0, dstride * pl_vout_h * pl_vout_bpp / 8); |
260 | goto out; |
261 | } |
262 | |
263 | // borders |
264 | doffs = (dstride - w * pl_vout_scale) / 2 & ~1; |
265 | dest += doffs * 2; |
266 | |
267 | if (doffs > doffs_old) |
268 | clear_counter = 2; |
269 | doffs_old = doffs; |
270 | |
271 | if (clear_counter > 0) { |
272 | memset(pl_vout_buf, 0, dstride * pl_vout_h * pl_vout_bpp / 8); |
273 | clear_counter--; |
274 | } |
275 | |
276 | if (bgr24) |
277 | { |
278 | if (pl_rearmed_cbs.only_16bpp) { |
279 | for (; h1-- > 0; dest += dstride * 2, src += stride) |
280 | { |
281 | bgr888_to_rgb565(dest, src, w * 3); |
282 | } |
283 | } |
284 | else { |
285 | dest -= doffs * 2; |
286 | dest += (doffs / 8) * 24; |
287 | |
288 | for (; h1-- > 0; dest += dstride * 3, src += stride) |
289 | { |
290 | bgr888_to_rgb888(dest, src, w * 3); |
291 | } |
292 | } |
293 | } |
294 | #ifdef __ARM_NEON__ |
295 | else if (soft_filter == SOFT_FILTER_SCALE2X && pl_vout_scale == 2) |
296 | { |
297 | neon_scale2x_16_16(src, (void *)dest, w, |
298 | stride * 2, dstride * 2, h1); |
299 | } |
300 | else if (soft_filter == SOFT_FILTER_EAGLE2X && pl_vout_scale == 2) |
301 | { |
302 | neon_eagle2x_16_16(src, (void *)dest, w, |
303 | stride * 2, dstride * 2, h1); |
304 | } |
305 | #endif |
306 | else |
307 | { |
308 | for (; h1-- > 0; dest += dstride * 2, src += stride) |
309 | { |
310 | bgr555_to_rgb565(dest, src, w * 2); |
311 | } |
312 | } |
8f892648 |
313 | |
fa56d360 |
314 | pl_print_hud(w * pl_vout_scale, h * pl_vout_scale, 0); |
72228559 |
315 | |
fa56d360 |
316 | out: |
cc56203b |
317 | pcnt_end(PCNT_BLIT); |
318 | |
69af03a2 |
319 | // let's flip now |
6469a8c4 |
320 | pl_vout_buf = plat_gvideo_flip(); |
fa56d360 |
321 | pl_rearmed_cbs.flip_cnt++; |
b60f2812 |
322 | } |
323 | |
76f7048e |
324 | static int pl_vout_open(void) |
6d1a1ac2 |
325 | { |
cefe86b7 |
326 | struct timeval now; |
327 | |
fa56d360 |
328 | // force mode update on pl_vout_set_mode() call from gpulib/vout_pl |
329 | pl_vout_buf = NULL; |
cefe86b7 |
330 | |
ab423939 |
331 | plat_gvideo_open(is_pal); |
76f7048e |
332 | |
cefe86b7 |
333 | gettimeofday(&now, 0); |
334 | vsync_usec_time = now.tv_usec; |
76f7048e |
335 | while (vsync_usec_time >= frame_interval) |
336 | vsync_usec_time -= frame_interval; |
cefe86b7 |
337 | |
6d1a1ac2 |
338 | return 0; |
339 | } |
340 | |
76f7048e |
341 | static void pl_vout_close(void) |
b60f2812 |
342 | { |
6469a8c4 |
343 | plat_gvideo_close(); |
b60f2812 |
344 | } |
345 | |
fa56d360 |
346 | static void pl_set_gpu_caps(int caps) |
347 | { |
348 | pl_rearmed_cbs.gpu_caps = caps; |
349 | } |
350 | |
29a8c4f3 |
351 | void *pl_prepare_screenshot(int *w, int *h, int *bpp) |
352 | { |
6469a8c4 |
353 | void *ret = plat_prepare_screenshot(w, h, bpp); |
354 | if (ret != NULL) |
355 | return ret; |
356 | |
76f7048e |
357 | *w = pl_vout_w; |
358 | *h = pl_vout_h; |
359 | *bpp = pl_vout_bpp; |
29a8c4f3 |
360 | |
76f7048e |
361 | return pl_vout_buf; |
29a8c4f3 |
362 | } |
363 | |
fa56d360 |
364 | /* display/redering mode switcher */ |
365 | static int dispmode_default(void) |
366 | { |
367 | pl_rearmed_cbs.gpu_neon.enhancement_enable = 0; |
368 | soft_filter = SOFT_FILTER_NONE; |
369 | snprintf(hud_msg, sizeof(hud_msg), "default mode"); |
370 | return 1; |
371 | } |
372 | |
373 | int dispmode_doubleres(void) |
374 | { |
375 | if (!(pl_rearmed_cbs.gpu_caps & GPU_CAP_SUPPORTS_2X) |
376 | || !resolution_ok(psx_w * 2, psx_h * 2) || psx_bpp != 16) |
377 | return 0; |
378 | |
379 | dispmode_default(); |
380 | pl_rearmed_cbs.gpu_neon.enhancement_enable = 1; |
381 | snprintf(hud_msg, sizeof(hud_msg), "double resolution"); |
382 | return 1; |
383 | } |
384 | |
385 | int dispmode_scale2x(void) |
386 | { |
387 | if (psx_bpp != 16) |
388 | return 0; |
389 | |
390 | dispmode_default(); |
391 | soft_filter = SOFT_FILTER_SCALE2X; |
392 | snprintf(hud_msg, sizeof(hud_msg), "scale2x"); |
393 | return 1; |
394 | } |
395 | |
396 | int dispmode_eagle2x(void) |
397 | { |
398 | if (psx_bpp != 16) |
399 | return 0; |
400 | |
401 | dispmode_default(); |
402 | soft_filter = SOFT_FILTER_EAGLE2X; |
403 | snprintf(hud_msg, sizeof(hud_msg), "eagle2x"); |
404 | return 1; |
405 | } |
406 | |
407 | static int (*dispmode_switchers[])(void) = { |
408 | dispmode_default, |
409 | #ifdef __ARM_NEON__ |
410 | dispmode_doubleres, |
411 | dispmode_scale2x, |
412 | dispmode_eagle2x, |
413 | #endif |
414 | }; |
415 | |
416 | static int dispmode_current; |
417 | |
418 | void pl_switch_dispmode(void) |
419 | { |
420 | if (pl_rearmed_cbs.gpu_caps & GPU_CAP_OWNS_DISPLAY) |
421 | return; |
422 | |
423 | while (1) { |
424 | dispmode_current++; |
425 | if (dispmode_current >= |
426 | sizeof(dispmode_switchers) / sizeof(dispmode_switchers[0])) |
427 | dispmode_current = 0; |
428 | if (dispmode_switchers[dispmode_current]()) |
429 | break; |
430 | } |
431 | } |
432 | |
1b0c5139 |
433 | #ifndef MAEMO |
2c5d0a55 |
434 | /* adjust circle-like analog inputs to better match |
435 | * more square-like analogs in PSX */ |
436 | static void update_analog_nub_adjust(int *x_, int *y_) |
437 | { |
438 | static const int scale[] = { 0, 0, 0, 12, 30, 60, 75, 60, 60 }; |
439 | int x = *x_; |
440 | int y = *y_; |
441 | |
442 | x += x * scale[abs(y) / 16] >> 8; |
443 | y += y * scale[abs(x) / 16] >> 8; |
444 | |
445 | *x_ = x; |
446 | *y_ = y; |
447 | } |
448 | |
1b0c5139 |
449 | static void update_analogs(void) |
450 | { |
451 | int *nubp[2] = { in_a1, in_a2 }; |
2c5d0a55 |
452 | int vals[2]; |
1b0c5139 |
453 | int i, a, v, ret; |
454 | |
455 | for (i = 0; i < 2; i++) |
456 | { |
457 | if (in_adev[i] < 0) |
458 | continue; |
459 | |
460 | for (a = 0; a < 2; a++) { |
2c5d0a55 |
461 | vals[a] = 0; |
1b0c5139 |
462 | |
463 | ret = in_update_analog(in_adev[i], in_adev_axis[i][a], &v); |
2c5d0a55 |
464 | if (ret == 0) |
465 | vals[a] = 128 * v / IN_ABS_RANGE; |
1b0c5139 |
466 | } |
2c5d0a55 |
467 | |
468 | if (in_adev_is_nublike[i]) |
469 | update_analog_nub_adjust(&vals[0], &vals[1]); |
470 | |
471 | for (a = 0; a < 2; a++) { |
472 | v = vals[a] + 127; |
473 | if (v < 0) v = 0; |
474 | else if (v > 255) v = 255; |
475 | nubp[i][a] = v; |
476 | } |
477 | |
1b0c5139 |
478 | } |
479 | //printf("%4d %4d %4d %4d\n", in_a1[0], in_a1[1], in_a2[0], in_a2[1]); |
480 | } |
481 | |
15d46930 |
482 | static void update_input(void) |
483 | { |
484 | int actions[IN_BINDTYPE_COUNT] = { 0, }; |
8f892648 |
485 | unsigned int emu_act; |
15d46930 |
486 | |
487 | in_update(actions); |
4c08b9e7 |
488 | if (in_type1 == PSE_PAD_TYPE_ANALOGPAD) |
1b0c5139 |
489 | update_analogs(); |
8f892648 |
490 | emu_act = actions[IN_BINDTYPE_EMU]; |
4c08b9e7 |
491 | in_state_gun = (emu_act & SACTION_GUN_MASK) >> SACTION_GUN_TRIGGER; |
492 | |
493 | emu_act &= ~SACTION_GUN_MASK; |
8f892648 |
494 | if (emu_act) { |
495 | int which = 0; |
496 | for (; !(emu_act & 1); emu_act >>= 1, which++) |
497 | ; |
498 | emu_act = which; |
499 | } |
500 | emu_set_action(emu_act); |
501 | |
799b0b87 |
502 | in_keystate = actions[IN_BINDTYPE_PLAYER12]; |
15d46930 |
503 | } |
1b0c5139 |
504 | #else /* MAEMO */ |
505 | static void update_input(void) |
506 | { |
507 | } |
508 | #endif |
15d46930 |
509 | |
4c08b9e7 |
510 | void pl_update_gun(int *xn, int *xres, int *y, int *in) |
511 | { |
faf2b2aa |
512 | if (tsdev) |
513 | pl_gun_ts_update(tsdev, xn, y, in); |
4c08b9e7 |
514 | |
76f7048e |
515 | *xres = pl_vout_w; |
516 | *y = *y * pl_vout_h >> 10; |
4c08b9e7 |
517 | } |
518 | |
bce6b056 |
519 | #define MAX_LAG_FRAMES 3 |
520 | |
521 | #define tvdiff(tv, tv_old) \ |
522 | ((tv.tv_sec - tv_old.tv_sec) * 1000000 + tv.tv_usec - tv_old.tv_usec) |
bce6b056 |
523 | |
72228559 |
524 | /* called on every vsync */ |
525 | void pl_frame_limit(void) |
526 | { |
bce6b056 |
527 | static struct timeval tv_old, tv_expect; |
2f546f9a |
528 | static int vsync_cnt_prev, drc_active_vsyncs; |
bce6b056 |
529 | struct timeval now; |
cefe86b7 |
530 | int diff, usadj; |
bce6b056 |
531 | |
532 | vsync_cnt++; |
72228559 |
533 | |
15d46930 |
534 | /* doing input here because the pad is polled |
535 | * thousands of times per frame for some reason */ |
536 | update_input(); |
537 | |
72228559 |
538 | pcnt_end(PCNT_ALL); |
bce6b056 |
539 | gettimeofday(&now, 0); |
72228559 |
540 | |
bce6b056 |
541 | if (now.tv_sec != tv_old.tv_sec) { |
542 | diff = tvdiff(now, tv_old); |
a92f6af1 |
543 | pl_rearmed_cbs.vsps_cur = 0.0f; |
bce6b056 |
544 | if (0 < diff && diff < 2000000) |
a92f6af1 |
545 | pl_rearmed_cbs.vsps_cur = 1000000.0f * (vsync_cnt - vsync_cnt_prev) / diff; |
7c0f51de |
546 | vsync_cnt_prev = vsync_cnt; |
a92f6af1 |
547 | |
548 | if (g_opts & OPT_SHOWFPS) |
549 | pl_rearmed_cbs.flips_per_sec = pl_rearmed_cbs.flip_cnt; |
550 | pl_rearmed_cbs.flip_cnt = 0; |
bd6267e6 |
551 | if (g_opts & OPT_SHOWCPU) |
a92f6af1 |
552 | pl_rearmed_cbs.cpu_usage = get_cpu_ticks(); |
8f892648 |
553 | |
554 | if (hud_new_msg > 0) { |
555 | hud_new_msg--; |
556 | if (hud_new_msg == 0) |
557 | hud_msg[0] = 0; |
558 | } |
a92f6af1 |
559 | tv_old = now; |
72228559 |
560 | } |
561 | #ifdef PCNT |
562 | static int ya_vsync_count; |
563 | if (++ya_vsync_count == PCNT_FRAMES) { |
a92f6af1 |
564 | pcnt_print(pl_rearmed_cbs.vsps_cur); |
72228559 |
565 | ya_vsync_count = 0; |
566 | } |
567 | #endif |
568 | |
76f7048e |
569 | // tv_expect uses usec*1024 units instead of usecs for better accuracy |
570 | tv_expect.tv_usec += frame_interval1024; |
571 | if (tv_expect.tv_usec >= (1000000 << 10)) { |
572 | tv_expect.tv_usec -= (1000000 << 10); |
573 | tv_expect.tv_sec++; |
574 | } |
575 | diff = (tv_expect.tv_sec - now.tv_sec) * 1000000 + (tv_expect.tv_usec >> 10) - now.tv_usec; |
576 | |
577 | if (diff > MAX_LAG_FRAMES * frame_interval || diff < -MAX_LAG_FRAMES * frame_interval) { |
578 | //printf("pl_frame_limit reset, diff=%d, iv %d\n", diff, frame_interval); |
c89cd762 |
579 | tv_expect = now; |
580 | diff = 0; |
cefe86b7 |
581 | // try to align with vsync |
582 | usadj = vsync_usec_time; |
76f7048e |
583 | while (usadj < tv_expect.tv_usec - frame_interval) |
584 | usadj += frame_interval; |
585 | tv_expect.tv_usec = usadj << 10; |
c89cd762 |
586 | } |
587 | |
76f7048e |
588 | if (!(g_opts & OPT_NO_FRAMELIM) && diff > frame_interval) { |
c89cd762 |
589 | // yay for working usleep on pandora! |
76f7048e |
590 | //printf("usleep %d\n", diff - frame_interval / 2); |
47f37583 |
591 | usleep(diff - frame_interval); |
c89cd762 |
592 | } |
593 | |
e64dc4c5 |
594 | if (pl_rearmed_cbs.frameskip) { |
76f7048e |
595 | if (diff < -frame_interval) |
e64dc4c5 |
596 | pl_rearmed_cbs.fskip_advice = 1; |
597 | else if (diff >= 0) |
598 | pl_rearmed_cbs.fskip_advice = 0; |
2f546f9a |
599 | |
600 | // recompilation is not that fast and may cause frame skip on |
601 | // loading screens and such, resulting in flicker or glitches |
602 | if (new_dynarec_did_compile) { |
603 | if (drc_active_vsyncs < 32) |
604 | pl_rearmed_cbs.fskip_advice = 0; |
605 | drc_active_vsyncs++; |
606 | } |
607 | else |
608 | drc_active_vsyncs = 0; |
609 | new_dynarec_did_compile = 0; |
bce6b056 |
610 | } |
72228559 |
611 | |
612 | pcnt_start(PCNT_ALL); |
613 | } |
614 | |
ab423939 |
615 | void pl_timing_prepare(int is_pal_) |
76f7048e |
616 | { |
617 | pl_rearmed_cbs.fskip_advice = 0; |
a92f6af1 |
618 | pl_rearmed_cbs.flips_per_sec = 0; |
619 | pl_rearmed_cbs.cpu_usage = 0; |
76f7048e |
620 | |
ab423939 |
621 | is_pal = is_pal_; |
76f7048e |
622 | frame_interval = is_pal ? 20000 : 16667; |
623 | frame_interval1024 = is_pal ? 20000*1024 : 17066667; |
624 | |
625 | // used by P.E.Op.S. frameskip code |
626 | pl_rearmed_cbs.gpu_peops.fFrameRateHz = is_pal ? 50.0f : 59.94f; |
627 | pl_rearmed_cbs.gpu_peops.dwFrameRateTicks = |
628 | (100000*100 / (unsigned long)(pl_rearmed_cbs.gpu_peops.fFrameRateHz*100)); |
629 | } |
630 | |
69af03a2 |
631 | static void pl_text_out16_(int x, int y, const char *text) |
b60f2812 |
632 | { |
bcb62992 |
633 | int i, l, w = pl_vout_w; |
634 | unsigned short *screen; |
69af03a2 |
635 | unsigned short val = 0xffff; |
636 | |
bcb62992 |
637 | x &= ~1; |
638 | screen = (unsigned short *)pl_vout_buf + x + y * w; |
639 | for (i = 0; ; i++, screen += 8) |
69af03a2 |
640 | { |
bcb62992 |
641 | char c = text[i]; |
642 | if (c == 0) |
643 | break; |
644 | if (c == ' ') |
645 | continue; |
646 | |
69af03a2 |
647 | for (l = 0; l < 8; l++) |
648 | { |
bcb62992 |
649 | unsigned char fd = fontdata8x8[c * 8 + l]; |
69af03a2 |
650 | unsigned short *s = screen + l * w; |
bcb62992 |
651 | unsigned int *s32 = (void *)s; |
652 | |
653 | s32[0] = (s32[0] >> 1) & 0x7bef7bef; |
654 | s32[1] = (s32[1] >> 1) & 0x7bef7bef; |
655 | s32[2] = (s32[2] >> 1) & 0x7bef7bef; |
656 | s32[3] = (s32[3] >> 1) & 0x7bef7bef; |
657 | |
69af03a2 |
658 | if (fd&0x80) s[0] = val; |
659 | if (fd&0x40) s[1] = val; |
660 | if (fd&0x20) s[2] = val; |
661 | if (fd&0x10) s[3] = val; |
662 | if (fd&0x08) s[4] = val; |
663 | if (fd&0x04) s[5] = val; |
664 | if (fd&0x02) s[6] = val; |
665 | if (fd&0x01) s[7] = val; |
666 | } |
667 | } |
b60f2812 |
668 | } |
669 | |
69af03a2 |
670 | void pl_text_out16(int x, int y, const char *texto, ...) |
b60f2812 |
671 | { |
69af03a2 |
672 | va_list args; |
673 | char buffer[256]; |
674 | |
675 | va_start(args, texto); |
676 | vsnprintf(buffer, sizeof(buffer), texto, args); |
677 | va_end(args); |
678 | |
679 | pl_text_out16_(x, y, buffer); |
b60f2812 |
680 | } |
681 | |
201c21e2 |
682 | static void pl_get_layer_pos(int *x, int *y, int *w, int *h) |
683 | { |
684 | *x = g_layer_x; |
685 | *y = g_layer_y; |
686 | *w = g_layer_w; |
687 | *h = g_layer_h; |
688 | } |
689 | |
9ee0fd5b |
690 | static void *pl_mmap(unsigned int size) |
691 | { |
a2ad8cc5 |
692 | return plat_mmap(0, size, 0, 0); |
9ee0fd5b |
693 | } |
694 | |
695 | static void pl_munmap(void *ptr, unsigned int size) |
696 | { |
697 | plat_munmap(ptr, size); |
698 | } |
699 | |
e64dc4c5 |
700 | struct rearmed_cbs pl_rearmed_cbs = { |
201c21e2 |
701 | pl_get_layer_pos, |
76f7048e |
702 | pl_vout_open, |
703 | pl_vout_set_mode, |
704 | pl_vout_flip, |
705 | pl_vout_close, |
fa56d360 |
706 | |
707 | .mmap = pl_mmap, |
708 | .munmap = pl_munmap, |
709 | .pl_set_gpu_caps = pl_set_gpu_caps, |
201c21e2 |
710 | }; |
711 | |
7c0f51de |
712 | /* watchdog */ |
713 | static void *watchdog_thread(void *unused) |
714 | { |
715 | int vsync_cnt_old = 0; |
716 | int seen_dead = 0; |
717 | int sleep_time = 5; |
718 | |
d3f3bf09 |
719 | #if !defined(NDEBUG) || defined(DRC_DBG) |
799b0b87 |
720 | // don't interfere with debug |
721 | return NULL; |
722 | #endif |
7c0f51de |
723 | while (1) |
724 | { |
725 | sleep(sleep_time); |
726 | |
727 | if (stop) { |
728 | seen_dead = 0; |
729 | sleep_time = 5; |
730 | continue; |
731 | } |
732 | if (vsync_cnt != vsync_cnt_old) { |
733 | vsync_cnt_old = vsync_cnt; |
734 | seen_dead = 0; |
735 | sleep_time = 2; |
736 | continue; |
737 | } |
738 | |
739 | seen_dead++; |
740 | sleep_time = 1; |
741 | if (seen_dead > 1) |
742 | fprintf(stderr, "watchdog: seen_dead %d\n", seen_dead); |
743 | if (seen_dead > 4) { |
744 | fprintf(stderr, "watchdog: lockup detected, aborting\n"); |
745 | // we can't do any cleanup here really, the main thread is |
746 | // likely touching resources and would crash anyway |
747 | abort(); |
748 | } |
749 | } |
750 | } |
751 | |
752 | void pl_start_watchdog(void) |
753 | { |
754 | pthread_attr_t attr; |
755 | pthread_t tid; |
756 | int ret; |
757 | |
758 | pthread_attr_init(&attr); |
759 | pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED); |
760 | |
761 | ret = pthread_create(&tid, &attr, watchdog_thread, NULL); |
762 | if (ret != 0) |
763 | fprintf(stderr, "could not start watchdog: %d\n", ret); |
764 | } |
765 | |
4c08b9e7 |
766 | void pl_init(void) |
767 | { |
24de2dd4 |
768 | extern unsigned int hSyncCount; // from psxcounters |
3ece2f0c |
769 | extern unsigned int frame_counter; |
24de2dd4 |
770 | |
ddc0a02a |
771 | psx_w = psx_h = pl_vout_w = pl_vout_h = 256; |
772 | psx_bpp = pl_vout_bpp = 16; |
321ca84d |
773 | |
faf2b2aa |
774 | tsdev = pl_gun_ts_init(); |
24de2dd4 |
775 | |
776 | pl_rearmed_cbs.gpu_hcnt = &hSyncCount; |
3ece2f0c |
777 | pl_rearmed_cbs.gpu_frame_count = &frame_counter; |
4c08b9e7 |
778 | } |