[libpicofe.git] / pandora / plat.c

// (c) Copyright 2006-2009 notaz, All rights reserved.\r
// Free for non-commercial use.\r
\r
// For commercial use, separate licencing terms must be obtained.\r
\r
#include <stdio.h>\r
#include <unistd.h>\r
#include <sys/types.h>\r
#include <sys/stat.h>\r
#include <fcntl.h>\r
#include <sys/ioctl.h>\r
#include <unistd.h>\r
#include <linux/fb.h>\r
#include <linux/omapfb.h>\r
\r
#include "../common/emu.h"\r
#include "../common/menu.h"\r
#include "../common/plat.h"\r
#include "../common/arm_utils.h"\r
#include "../common/input.h"\r
#include "../linux/sndout_oss.h"\r
#include "../linux/fbdev.h"\r
#include "../linux/xenv.h"\r
#include "plat.h"\r
#include "asm_utils.h"\r
#include "version.h"\r
\r
#include <pico/pico_int.h>\r
\r
#include <linux/input.h>\r
\r
static struct vout_fbdev *main_fb, *layer_fb;\r
// g_layer_* - in use, g_layer_c* - configured custom\r
int g_layer_cx, g_layer_cy, g_layer_cw, g_layer_ch;\r
static int g_layer_x, g_layer_y;\r
static int g_layer_w = 320, g_layer_h = 240;\r
static int g_osd_fps_x, g_osd_y, doing_bg_frame;\r
\r
static const char pnd_script_base[] = "sudo -n /usr/pandora/scripts";\r
static short __attribute__((aligned(4))) sndBuffer[2*44100/50];\r
static unsigned char __attribute__((aligned(4))) fb_copy[g_screen_width * g_screen_height * 2];\r
static void *temp_frame;\r
unsigned char *PicoDraw2FB;\r
const char *renderer_names[] = { NULL };\r
const char *renderer_names32x[] = { NULL };\r
\r
static const char * const pandora_gpio_keys[KEY_MAX + 1] = {\r
	[0 ... KEY_MAX] = NULL,\r
	[KEY_UP]	= "Up",\r
	[KEY_LEFT]	= "Left",\r
	[KEY_RIGHT]	= "Right",\r
	[KEY_DOWN]	= "Down",\r
	[KEY_HOME]	= "A",\r
	[KEY_PAGEDOWN]	= "X",\r
	[KEY_END]	= "B",\r
	[KEY_PAGEUP]	= "Y",\r
	[KEY_RIGHTSHIFT]= "L",\r
	[KEY_RIGHTCTRL]	= "R",\r
	[KEY_LEFTALT]	= "Start",\r
	[KEY_LEFTCTRL]	= "Select",\r
	[KEY_MENU]	= "Pandora",\r
};\r
\r
struct in_default_bind in_evdev_defbinds[] =\r
{\r
	/* MXYZ SACB RLDU */\r
	{ KEY_UP,	IN_BINDTYPE_PLAYER12, 0 },\r
	{ KEY_DOWN,	IN_BINDTYPE_PLAYER12, 1 },\r
	{ KEY_LEFT,	IN_BINDTYPE_PLAYER12, 2 },\r
	{ KEY_RIGHT,	IN_BINDTYPE_PLAYER12, 3 },\r
	{ KEY_S,	IN_BINDTYPE_PLAYER12, 4 },	/* B */\r
	{ KEY_D,	IN_BINDTYPE_PLAYER12, 5 },	/* C */\r
	{ KEY_A,	IN_BINDTYPE_PLAYER12, 6 },	/* A */\r
	{ KEY_ENTER,	IN_BINDTYPE_PLAYER12, 7 },\r
	{ KEY_BACKSLASH, IN_BINDTYPE_EMU, PEVB_MENU },\r
	{ KEY_SPACE,	IN_BINDTYPE_EMU, PEVB_MENU },\r
	/* Pandora */\r
	{ KEY_PAGEDOWN,	IN_BINDTYPE_PLAYER12, 4 },\r
	{ KEY_END,	IN_BINDTYPE_PLAYER12, 5 },\r
	{ KEY_HOME,	IN_BINDTYPE_PLAYER12, 6 },\r
	{ KEY_LEFTALT,	IN_BINDTYPE_PLAYER12, 7 },\r
	{ KEY_RIGHTSHIFT,IN_BINDTYPE_EMU, PEVB_STATE_SAVE },\r
	{ KEY_RIGHTCTRL, IN_BINDTYPE_EMU, PEVB_STATE_LOAD },\r
	{ KEY_LEFTCTRL,	 IN_BINDTYPE_EMU, PEVB_MENU },\r
	{ 0, 0, 0 }\r
};\r
\r
static int get_cpu_clock(void)\r
{\r
	FILE *f;\r
	int ret = 0;\r
	f = fopen("/proc/pandora/cpu_mhz_max", "r");\r
	if (f) {\r
		fscanf(f, "%d", &ret);\r
		fclose(f);\r
	}\r
	return ret;\r
}\r
\r
void pemu_prep_defconfig(void)\r
{\r
	defaultConfig.EmuOpt |= EOPT_VSYNC|EOPT_16BPP;\r
	defaultConfig.s_PicoOpt |= POPT_EN_MCD_GFX|POPT_EN_MCD_PSYNC;\r
	defaultConfig.scaling = SCALE_2x2_3x2;\r
}\r
\r
void pemu_validate_config(void)\r
{\r
	currentConfig.CPUclock = get_cpu_clock();\r
}\r
\r
static void osd_text(int x, int y, const char *text)\r
{\r
	int len = strlen(text)*8;\r
	int i, h;\r
\r
	len++;\r
	for (h = 0; h < 8; h++) {\r
		unsigned short *p;\r
		p = (unsigned short *)g_screen_ptr + x + g_screen_width*(y + h);\r
		for (i = len; i; i--, p++)\r
			*p = (*p>>2) & 0x39e7;\r
	}\r
	emu_text_out16(x, y, text);\r
}\r
\r
static void draw_cd_leds(void)\r
{\r
	int old_reg;\r
	old_reg = Pico_mcd->s68k_regs[0];\r
\r
	if (0) {\r
		// 8-bit modes\r
		unsigned int col_g = (old_reg & 2) ? 0xc0c0c0c0 : 0xe0e0e0e0;\r
		unsigned int col_r = (old_reg & 1) ? 0xd0d0d0d0 : 0xe0e0e0e0;\r
		*(unsigned int *)((char *)g_screen_ptr + g_screen_width*2+ 4) =\r
		*(unsigned int *)((char *)g_screen_ptr + g_screen_width*3+ 4) =\r
		*(unsigned int *)((char *)g_screen_ptr + g_screen_width*4+ 4) = col_g;\r
		*(unsigned int *)((char *)g_screen_ptr + g_screen_width*2+12) =\r
		*(unsigned int *)((char *)g_screen_ptr + g_screen_width*3+12) =\r
		*(unsigned int *)((char *)g_screen_ptr + g_screen_width*4+12) = col_r;\r
	} else {\r
		// 16-bit modes\r
		unsigned int *p = (unsigned int *)((short *)g_screen_ptr + g_screen_width*2+4);\r
		unsigned int col_g = (old_reg & 2) ? 0x06000600 : 0;\r
		unsigned int col_r = (old_reg & 1) ? 0xc000c000 : 0;\r
		*p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r; p += g_screen_width/2 - 12/2;\r
		*p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r; p += g_screen_width/2 - 12/2;\r
		*p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r;\r
	}\r
}\r
\r
static int emuscan(unsigned int num)\r
{\r
	DrawLineDest = (unsigned short *)g_screen_ptr + num * g_screen_width;\r
\r
	return 0;\r
}\r
\r
void pemu_finalize_frame(const char *fps, const char *notice)\r
{\r
	if (notice && notice[0])\r
		osd_text(2, g_osd_y, notice);\r
	if (fps && fps[0] && (currentConfig.EmuOpt & EOPT_SHOW_FPS))\r
		osd_text(g_osd_fps_x, g_osd_y, fps);\r
	if ((PicoAHW & PAHW_MCD) && (currentConfig.EmuOpt & EOPT_EN_CD_LEDS))\r
		draw_cd_leds();\r
}\r
\r
void plat_video_flip(void)\r
{\r
	g_screen_ptr = vout_fbdev_flip(layer_fb);\r
\r
	// XXX: drain OS event queue here, maybe we'll actually use it someday..\r
	int dummy;\r
	xenv_update(&dummy);\r
}\r
\r
void plat_video_toggle_renderer(int change, int is_menu)\r
{\r
}\r
\r
void plat_video_menu_enter(int is_rom_loaded)\r
{\r
}\r
\r
void plat_video_menu_begin(void)\r
{\r
}\r
\r
void plat_video_menu_end(void)\r
{\r
	g_menuscreen_ptr = vout_fbdev_flip(main_fb);\r
}\r
\r
void plat_video_wait_vsync(void)\r
{\r
	vout_fbdev_wait_vsync(main_fb);\r
}\r
\r
void plat_status_msg_clear(void)\r
{\r
	vout_fbdev_clear_lines(layer_fb, g_osd_y, 8);\r
}\r
\r
void plat_status_msg_busy_next(const char *msg)\r
{\r
	plat_status_msg_clear();\r
	pemu_finalize_frame("", msg);\r
	plat_video_flip();\r
	emu_status_msg("");\r
	reset_timing = 1;\r
}\r
\r
void plat_status_msg_busy_first(const char *msg)\r
{\r
	plat_status_msg_busy_next(msg);\r
}\r
\r
void plat_update_volume(int has_changed, int is_up)\r
{\r
	static int prev_frame = 0, wait_frames = 0;\r
	int vol = currentConfig.volume;\r
\r
	if (has_changed)\r
	{\r
		if (is_up) {\r
			if (vol < 99) vol++;\r
		} else {\r
			if (vol >  0) vol--;\r
		}\r
		wait_frames = 0;\r
		sndout_oss_setvol(vol, vol);\r
		currentConfig.volume = vol;\r
		emu_status_msg("VOL: %02i", vol);\r
		prev_frame = Pico.m.frame_count;\r
	}\r
}\r
\r
static void make_bg(int no_scale)\r
{\r
	unsigned short *s = (void *)fb_copy;\r
	int x, y;\r
\r
	memset32(g_menubg_src_ptr, 0, g_menuscreen_w * g_menuscreen_h * 2 / 4);\r
\r
	if (!no_scale && g_menuscreen_w >= 640 && g_menuscreen_h >= 480) {\r
		unsigned int t, *d = g_menubg_src_ptr;\r
		d += (g_menuscreen_h / 2 - 480 / 2) * g_menuscreen_w / 2;\r
		d += (g_menuscreen_w / 2 - 640 / 2) / 2;\r
		for (y = 0; y < 240; y++, s += 320, d += g_menuscreen_w*2/2) {\r
			for (x = 0; x < 320; x++) {\r
				t = s[x];\r
				t |= t << 16;\r
				d[x] = d[x + g_menuscreen_w / 2] = t;\r
			}\r
		}\r
		return;\r
	}\r
\r
	if (g_menuscreen_w >= 320 && g_menuscreen_h >= 240) {\r
		unsigned short *d = g_menubg_src_ptr;\r
		d += (g_menuscreen_h / 2 - 240 / 2) * g_menuscreen_w;\r
		d += (g_menuscreen_w / 2 - 320 / 2);\r
		for (y = 0; y < 240; y++, s += 320, d += g_menuscreen_w)\r
			memcpy(d, s, 320*2);\r
		return;\r
	}\r
}\r
\r
void pemu_forced_frame(int no_scale, int do_emu)\r
{\r
	doing_bg_frame = 1;\r
	emu_cmn_forced_frame(no_scale, do_emu);\r
	doing_bg_frame = 0;\r
\r
	// making a copy because enabling the layer clears it's mem\r
	memcpy32((void *)fb_copy, g_screen_ptr, sizeof(fb_copy) / 4);\r
	make_bg(no_scale);\r
}\r
\r
static void oss_write_nonblocking(int len)\r
{\r
	// sndout_oss_can_write() is not reliable, only use with no_frmlimit\r
	if ((currentConfig.EmuOpt & EOPT_NO_FRMLIMIT) && !sndout_oss_can_write(len))\r
		return;\r
\r
	sndout_oss_write_nb(PsndOut, len);\r
}\r
\r
void pemu_sound_start(void)\r
{\r
	PsndOut = NULL;\r
\r
	if (currentConfig.EmuOpt & EOPT_EN_SOUND)\r
	{\r
		int is_stereo = (PicoOpt & POPT_EN_STEREO) ? 1 : 0;\r
\r
		PsndRerate(Pico.m.frame_count ? 1 : 0);\r
\r
		/*\r
		 * for 44k stereo, we do 1470 samples/emu_frame\r
		 * OMAP driver does power of 2 buffers, so we need at least 4K buffer.\r
		 * The most we can lag is 1K samples, size of OMAP's McBSP FIFO,\r
		 * with 2K sample buffer we might sometimes lag more than that,\r
		 * thus causing underflows.\r
		 */\r
		printf("starting audio: %i len: %i stereo: %i, pal: %i\n",\r
			PsndRate, PsndLen, is_stereo, Pico.m.pal);\r
		sndout_oss_start(PsndRate, is_stereo, 2);\r
		//sndout_oss_setvol(currentConfig.volume, currentConfig.volume);\r
		PicoWriteSound = oss_write_nonblocking;\r
		plat_update_volume(0, 0);\r
		memset(sndBuffer, 0, sizeof(sndBuffer));\r
		PsndOut = sndBuffer;\r
	}\r
}\r
\r
void pemu_sound_stop(void)\r
{\r
	sndout_oss_stop();\r
}\r
\r
void pemu_sound_wait(void)\r
{\r
	// don't need to do anything, writes will block by themselves\r
}\r
\r
void plat_debug_cat(char *str)\r
{\r
}\r
\r
static int pnd_setup_layer_(int fd, int enabled, int x, int y, int w, int h)\r
{\r
	struct omapfb_plane_info pi;\r
	struct omapfb_mem_info mi;\r
	int ret;\r
\r
	ret = ioctl(fd, OMAPFB_QUERY_PLANE, &pi);\r
	if (ret != 0) {\r
		perror("QUERY_PLANE");\r
		return -1;\r
	}\r
\r
	ret = ioctl(fd, OMAPFB_QUERY_MEM, &mi);\r
	if (ret != 0) {\r
		perror("QUERY_MEM");\r
		return -1;\r
	}\r
\r
	/* must disable when changing stuff */\r
	if (pi.enabled) {\r
		pi.enabled = 0;\r
		ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);\r
		if (ret != 0)\r
			perror("SETUP_PLANE");\r
	}\r
\r
	mi.size = 320*240*2*4;\r
	ret = ioctl(fd, OMAPFB_SETUP_MEM, &mi);\r
	if (ret != 0) {\r
		perror("SETUP_MEM");\r
		return -1;\r
	}\r
\r
	pi.pos_x = x;\r
	pi.pos_y = y;\r
	pi.out_width = w;\r
	pi.out_height = h;\r
	pi.enabled = enabled;\r
\r
	ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);\r
	if (ret != 0) {\r
		perror("SETUP_PLANE");\r
		return -1;\r
	}\r
\r
	return 0;\r
}\r
\r
int pnd_setup_layer(int enabled, int x, int y, int w, int h)\r
{\r
	return pnd_setup_layer_(vout_fbdev_get_fd(layer_fb), enabled, x, y, w, h);\r
}\r
\r
void pnd_restore_layer_data(void)\r
{\r
	short *t = (short *)fb_copy + 320*240 / 2 + 160;\r
\r
	// right now this is used by menu, which wants to preview something\r
	// so try to get something on the layer.\r
	if ((t[0] | t[5] | t[13]) == 0)\r
		memset32((void *)fb_copy, 0x07000700, sizeof(fb_copy) / 4);\r
\r
	memcpy32(g_screen_ptr, (void *)fb_copy, 320*240*2 / 4);\r
	plat_video_flip();\r
}\r
\r
static void apply_filter(int which)\r
{\r
	char buf[128];\r
	int i;\r
\r
	if (pnd_filter_list == NULL)\r
		return;\r
\r
	for (i = 0; i < which; i++)\r
		if (pnd_filter_list[i] == NULL)\r
			return;\r
\r
	if (pnd_filter_list[i] == NULL)\r
		return;\r
\r
	snprintf(buf, sizeof(buf), "%s/op_videofir.sh %s", pnd_script_base, pnd_filter_list[i]);\r
	system(buf);\r
}\r
\r
void emu_video_mode_change(int start_line, int line_count, int is_32cols)\r
{\r
	int fb_w = 320, fb_h = 240, fb_left = 0, fb_right = 0, fb_top = 0, fb_bottom = 0;\r
\r
	if (doing_bg_frame)\r
		return;\r
\r
	PicoDrawSetOutFormat(PDF_RGB555, 1);\r
	PicoDrawSetCallbacks(emuscan, NULL);\r
\r
	if (is_32cols) {\r
		fb_w = 256;\r
		fb_left = fb_right = 32;\r
	}\r
\r
	switch (currentConfig.scaling) {\r
	case SCALE_1x1:\r
		g_layer_w = fb_w;\r
		g_layer_h = fb_h;\r
		break;\r
	case SCALE_2x2_3x2:\r
		g_layer_w = fb_w * (is_32cols ? 3 : 2);\r
		g_layer_h = fb_h * 2;\r
		break;\r
	case SCALE_2x2_2x2:\r
		g_layer_w = fb_w * 2;\r
		g_layer_h = fb_h * 2;\r
		break;\r
	case SCALE_FULLSCREEN:\r
		g_layer_w = 800;\r
		g_layer_h = 480;\r
		break;\r
	case SCALE_CUSTOM:\r
		g_layer_x = g_layer_cx;\r
		g_layer_y = g_layer_cy;\r
		g_layer_w = g_layer_cw;\r
		g_layer_h = g_layer_ch;\r
		break;\r
	}\r
\r
	if (currentConfig.scaling != SCALE_CUSTOM) {\r
		// center the layer\r
		g_layer_x = 800 / 2 - g_layer_w / 2;\r
		g_layer_y = 480 / 2 - g_layer_h / 2;\r
	}\r
\r
	switch (currentConfig.scaling) {\r
	case SCALE_FULLSCREEN:\r
	case SCALE_CUSTOM:\r
		fb_top = start_line;\r
		fb_h = line_count;\r
		break;\r
	}\r
	g_osd_fps_x = is_32cols ? 232 : 264;\r
	g_osd_y = fb_top + fb_h - 8;\r
\r
	pnd_setup_layer(1, g_layer_x, g_layer_y, g_layer_w, g_layer_h);\r
	vout_fbdev_clear(layer_fb);\r
	vout_fbdev_resize(layer_fb, fb_w, fb_h, 16, fb_left, fb_right, fb_top, fb_bottom, 3);\r
	plat_video_flip();\r
}\r
\r
void pemu_loop_prep(void)\r
{\r
	static int pal_old = -1;\r
	static int filter_old = -1;\r
	char buf[128];\r
\r
	if (currentConfig.CPUclock != get_cpu_clock()) {\r
		snprintf(buf, sizeof(buf), "unset DISPLAY; echo y | %s/op_cpuspeed.sh %d",\r
			 pnd_script_base, currentConfig.CPUclock);\r
		system(buf);\r
	}\r
\r
	if (Pico.m.pal != pal_old) {\r
		snprintf(buf, sizeof(buf), "%s/op_lcdrate.sh %d",\r
			 pnd_script_base, Pico.m.pal ? 50 : 60);\r
		system(buf);\r
		pal_old = Pico.m.pal;\r
	}\r
\r
	if (currentConfig.filter != filter_old) {\r
		apply_filter(currentConfig.filter);\r
		filter_old = currentConfig.filter;\r
	}\r
\r
	// make sure there is no junk left behind the layer\r
	memset32(g_menuscreen_ptr, 0, g_menuscreen_w * g_menuscreen_h * 2 / 4);\r
	g_menuscreen_ptr = vout_fbdev_flip(main_fb);\r
\r
	// emu_video_mode_change will call pnd_setup_layer()\r
\r
	// dirty buffers better go now than during gameplay\r
	sync();\r
	sleep(0);\r
\r
	pemu_sound_start();\r
}\r
\r
void pemu_loop_end(void)\r
{\r
	pemu_sound_stop();\r
\r
	/* do one more frame for menu bg */\r
	pemu_forced_frame(0, 1);\r
\r
	pnd_setup_layer(0, g_layer_x, g_layer_y, g_layer_w, g_layer_h);\r
}\r
\r
void plat_wait_till_us(unsigned int us_to)\r
{\r
	unsigned int now;\r
	signed int diff;\r
\r
	now = plat_get_ticks_us();\r
\r
	// XXX: need to check NOHZ\r
	diff = (signed int)(us_to - now);\r
	if (diff > 10000) {\r
		//printf("sleep %d\n", us_to - now);\r
		usleep(diff * 15 / 16);\r
		now = plat_get_ticks_us();\r
		//printf(" wake %d\n", (signed)(us_to - now));\r
	}\r
/*\r
	while ((signed int)(us_to - now) > 512) {\r
		spend_cycles(1024);\r
		now = plat_get_ticks_us();\r
	}\r
*/\r
}\r
\r
void plat_early_init(void)\r
{\r
}\r
\r
void plat_init(void)\r
{\r
	const char *main_fb_name, *layer_fb_name;\r
	int fd, ret, w, h;\r
\r
	main_fb_name = getenv("FBDEV_MAIN");\r
	if (main_fb_name == NULL)\r
		main_fb_name = "/dev/fb0";\r
\r
	layer_fb_name = getenv("FBDEV_LAYER");\r
	if (layer_fb_name == NULL)\r
		layer_fb_name = "/dev/fb1";\r
\r
	// must set the layer up first to be able to use it\r
	fd = open(layer_fb_name, O_RDWR);\r
	if (fd == -1) {\r
		fprintf(stderr, "%s: ", layer_fb_name);\r
		perror("open");\r
		exit(1);\r
	}\r
\r
	ret = pnd_setup_layer_(fd, 0, g_layer_x, g_layer_y, g_layer_w, g_layer_h);\r
	close(fd);\r
	if (ret != 0) {\r
		fprintf(stderr, "failed to set up layer, exiting.\n");\r
		exit(1);\r
	}\r
\r
	xenv_init();\r
\r
	w = h = 0;\r
	main_fb = vout_fbdev_init(main_fb_name, &w, &h, 16, 2);\r
	if (main_fb == NULL) {\r
		fprintf(stderr, "couldn't init fb: %s\n", main_fb_name);\r
		exit(1);\r
	}\r
\r
	g_menuscreen_w = w;\r
	g_menuscreen_h = h;\r
	g_menuscreen_ptr = vout_fbdev_flip(main_fb);\r
\r
	w = 320; h = 240;\r
	layer_fb = vout_fbdev_init(layer_fb_name, &w, &h, 16, 3);\r
	if (layer_fb == NULL) {\r
		fprintf(stderr, "couldn't init fb: %s\n", layer_fb_name);\r
		goto fail0;\r
	}\r
\r
	if (w != g_screen_width || h != g_screen_height) {\r
		fprintf(stderr, "%dx%d not supported on %s\n", w, h, layer_fb_name);\r
		goto fail1;\r
	}\r
	g_screen_ptr = vout_fbdev_flip(layer_fb);\r
\r
	temp_frame = calloc(g_menuscreen_w * g_menuscreen_h * 2, 1);\r
	if (temp_frame == NULL) {\r
		fprintf(stderr, "OOM\n");\r
		goto fail1;\r
	}\r
	g_menubg_ptr = temp_frame;\r
	g_menubg_src_ptr = temp_frame;\r
	PicoDraw2FB = temp_frame;\r
\r
	sndout_oss_init();\r
	pnd_menu_init();\r
\r
	in_set_config(in_name_to_id("evdev:gpio-keys"), IN_CFG_KEY_NAMES,\r
		      pandora_gpio_keys, sizeof(pandora_gpio_keys));\r
	return;\r
\r
fail1:\r
	vout_fbdev_finish(layer_fb);\r
fail0:\r
	vout_fbdev_finish(main_fb);\r
	exit(1);\r
}\r
\r
void plat_finish(void)\r
{\r
	sndout_oss_exit();\r
	vout_fbdev_finish(main_fb);\r
	xenv_finish();\r
\r
	printf("all done\n");\r
}\r
\r
Commit	Line	Data
c66f49e6	1	// (c) Copyright 2006-2009 notaz, All rights reserved.\r
	2	// Free for non-commercial use.\r
	3	\r
	4	// For commercial use, separate licencing terms must be obtained.\r
	5	\r
	6	#include <stdio.h>\r
	7	#include <unistd.h>\r
c66f49e6	8	#include <sys/types.h>\r
	9	#include <sys/stat.h>\r
	10	#include <fcntl.h>\r
	11	#include <sys/ioctl.h>\r
	12	#include <unistd.h>\r
	13	#include <linux/fb.h>\r
	14	#include <linux/omapfb.h>\r
	15	\r
	16	#include "../common/emu.h"\r
	17	#include "../common/menu.h"\r
	18	#include "../common/plat.h"\r
	19	#include "../common/arm_utils.h"\r
902972d1	20	#include "../common/input.h"\r
c66f49e6	21	#include "../linux/sndout_oss.h"\r
c66f49e6	22	#include "../linux/fbdev.h"\r
838a76d4	23	#include "../linux/xenv.h"\r
c66f49e6	24	#include "plat.h"\r
	25	#include "asm_utils.h"\r
	26	#include "version.h"\r
	27	\r
	28	#include <pico/pico_int.h>\r
	29	\r
902972d1	30	#include <linux/input.h>\r
c66f49e6	31	\r
c66f49e6	32	static struct vout_fbdev main_fb, layer_fb;\r
c64c8d0e	33	// g_layer_* - in use, g_layer_c* - configured custom\r
c64c8d0e	34	int g_layer_cx, g_layer_cy, g_layer_cw, g_layer_ch;\r
c66f49e6	35	static int g_layer_x, g_layer_y;\r
c66f49e6	36	static int g_layer_w = 320, g_layer_h = 240;\r
b6eccda3	37	static int g_osd_fps_x, g_osd_y, doing_bg_frame;\r
c66f49e6	38	\r
	39	static const char pnd_script_base[] = "sudo -n /usr/pandora/scripts";\r
	40	static short __attribute__((aligned(4))) sndBuffer[2*44100/50];\r
c66f49e6	41	static unsigned char __attribute__((aligned(4))) fb_copy[g_screen_width * g_screen_height * 2];\r
b6eccda3	42	static void *temp_frame;\r
b6eccda3	43	unsigned char *PicoDraw2FB;\r
c66f49e6	44	const char *renderer_names[] = { NULL };\r
c66f49e6	45	const char *renderer_names32x[] = { NULL };\r
c66f49e6	46	\r
902972d1	47	static const char * const pandora_gpio_keys[KEY_MAX + 1] = {\r
	48	[0 ... KEY_MAX] = NULL,\r
	49	[KEY_UP] = "Up",\r
	50	[KEY_LEFT] = "Left",\r
	51	[KEY_RIGHT] = "Right",\r
	52	[KEY_DOWN] = "Down",\r
	53	[KEY_HOME] = "A",\r
	54	[KEY_PAGEDOWN] = "X",\r
	55	[KEY_END] = "B",\r
	56	[KEY_PAGEUP] = "Y",\r
	57	[KEY_RIGHTSHIFT]= "L",\r
	58	[KEY_RIGHTCTRL] = "R",\r
	59	[KEY_LEFTALT] = "Start",\r
	60	[KEY_LEFTCTRL] = "Select",\r
	61	[KEY_MENU] = "Pandora",\r
	62	};\r
	63	\r
c64c8d0e	64	struct in_default_bind in_evdev_defbinds[] =\r
	65	{\r
	66	/* MXYZ SACB RLDU */\r
	67	{ KEY_UP, IN_BINDTYPE_PLAYER12, 0 },\r
	68	{ KEY_DOWN, IN_BINDTYPE_PLAYER12, 1 },\r
	69	{ KEY_LEFT, IN_BINDTYPE_PLAYER12, 2 },\r
	70	{ KEY_RIGHT, IN_BINDTYPE_PLAYER12, 3 },\r
	71	{ KEY_S, IN_BINDTYPE_PLAYER12, 4 }, /* B */\r
	72	{ KEY_D, IN_BINDTYPE_PLAYER12, 5 }, /* C */\r
	73	{ KEY_A, IN_BINDTYPE_PLAYER12, 6 }, /* A */\r
	74	{ KEY_ENTER, IN_BINDTYPE_PLAYER12, 7 },\r
	75	{ KEY_BACKSLASH, IN_BINDTYPE_EMU, PEVB_MENU },\r
	76	{ KEY_SPACE, IN_BINDTYPE_EMU, PEVB_MENU },\r
	77	/* Pandora */\r
	78	{ KEY_PAGEDOWN, IN_BINDTYPE_PLAYER12, 4 },\r
	79	{ KEY_END, IN_BINDTYPE_PLAYER12, 5 },\r
	80	{ KEY_HOME, IN_BINDTYPE_PLAYER12, 6 },\r
	81	{ KEY_LEFTALT, IN_BINDTYPE_PLAYER12, 7 },\r
	82	{ KEY_RIGHTSHIFT,IN_BINDTYPE_EMU, PEVB_STATE_SAVE },\r
	83	{ KEY_RIGHTCTRL, IN_BINDTYPE_EMU, PEVB_STATE_LOAD },\r
	84	{ KEY_LEFTCTRL, IN_BINDTYPE_EMU, PEVB_MENU },\r
	85	{ 0, 0, 0 }\r
	86	};\r
	87	\r
c66f49e6	88	static int get_cpu_clock(void)\r
	89	{\r
	90	FILE *f;\r
	91	int ret = 0;\r
	92	f = fopen("/proc/pandora/cpu_mhz_max", "r");\r
	93	if (f) {\r
	94	fscanf(f, "%d", &ret);\r
	95	fclose(f);\r
	96	}\r
	97	return ret;\r
	98	}\r
	99	\r
	100	void pemu_prep_defconfig(void)\r
	101	{\r
	102	defaultConfig.EmuOpt \|= EOPT_VSYNC\|EOPT_16BPP;\r
	103	defaultConfig.s_PicoOpt \|= POPT_EN_MCD_GFX\|POPT_EN_MCD_PSYNC;\r
	104	defaultConfig.scaling = SCALE_2x2_3x2;\r
	105	}\r
	106	\r
	107	void pemu_validate_config(void)\r
	108	{\r
	109	currentConfig.CPUclock = get_cpu_clock();\r
	110	}\r
	111	\r
	112	static void osd_text(int x, int y, const char *text)\r
	113	{\r
	114	int len = strlen(text)*8;\r
	115	int i, h;\r
	116	\r
	117	len++;\r
	118	for (h = 0; h < 8; h++) {\r
	119	unsigned short *p;\r
	120	p = (unsigned short )g_screen_ptr + x + g_screen_width(y + h);\r
	121	for (i = len; i; i--, p++)\r
	122	p = (p>>2) & 0x39e7;\r
	123	}\r
	124	emu_text_out16(x, y, text);\r
	125	}\r
	126	\r
	127	static void draw_cd_leds(void)\r
	128	{\r
	129	int old_reg;\r
	130	old_reg = Pico_mcd->s68k_regs[0];\r
	131	\r
	132	if (0) {\r
	133	// 8-bit modes\r
	134	unsigned int col_g = (old_reg & 2) ? 0xc0c0c0c0 : 0xe0e0e0e0;\r
	135	unsigned int col_r = (old_reg & 1) ? 0xd0d0d0d0 : 0xe0e0e0e0;\r
	136	(unsigned int )((char )g_screen_ptr + g_screen_width2+ 4) =\r
	137	(unsigned int )((char )g_screen_ptr + g_screen_width3+ 4) =\r
	138	(unsigned int )((char )g_screen_ptr + g_screen_width4+ 4) = col_g;\r
	139	(unsigned int )((char )g_screen_ptr + g_screen_width2+12) =\r
	140	(unsigned int )((char )g_screen_ptr + g_screen_width3+12) =\r
	141	(unsigned int )((char )g_screen_ptr + g_screen_width4+12) = col_r;\r
	142	} else {\r
	143	// 16-bit modes\r
	144	unsigned int p = (unsigned int )((short )g_screen_ptr + g_screen_width2+4);\r
	145	unsigned int col_g = (old_reg & 2) ? 0x06000600 : 0;\r
	146	unsigned int col_r = (old_reg & 1) ? 0xc000c000 : 0;\r
	147	p++ = col_g; p++ = col_g; p+=2; p++ = col_r; p++ = col_r; p += g_screen_width/2 - 12/2;\r
	148	p++ = col_g; p++ = col_g; p+=2; p++ = col_r; p++ = col_r; p += g_screen_width/2 - 12/2;\r
	149	p++ = col_g; p++ = col_g; p+=2; p++ = col_r; p++ = col_r;\r
	150	}\r
	151	}\r
152	\r
153	static int emuscan(unsigned int num)\r
154	{\r
155	DrawLineDest = (unsigned short )g_screen_ptr + num g_screen_width;\r
156	\r
157	return 0;\r
158	}\r
159	\r
160	void pemu_finalize_frame(const char fps, const char notice)\r
161	{\r
c4046e6e	162	if (notice && notice[0])\r
	163	osd_text(2, g_osd_y, notice);\r
	164	if (fps && fps[0] && (currentConfig.EmuOpt & EOPT_SHOW_FPS))\r
	165	osd_text(g_osd_fps_x, g_osd_y, fps);\r
c66f49e6	166	if ((PicoAHW & PAHW_MCD) && (currentConfig.EmuOpt & EOPT_EN_CD_LEDS))\r
	167	draw_cd_leds();\r
	168	}\r
	169	\r
	170	void plat_video_flip(void)\r
	171	{\r
	172	g_screen_ptr = vout_fbdev_flip(layer_fb);\r
838a76d4	173	\r
	174	// XXX: drain OS event queue here, maybe we'll actually use it someday..\r
	175	int dummy;\r
	176	xenv_update(&dummy);\r
c66f49e6	177	}\r
	178	\r
	179	void plat_video_toggle_renderer(int change, int is_menu)\r
	180	{\r
	181	}\r
	182	\r
	183	void plat_video_menu_enter(int is_rom_loaded)\r
	184	{\r
	185	}\r
	186	\r
	187	void plat_video_menu_begin(void)\r
	188	{\r
c66f49e6	189	}\r
	190	\r
	191	void plat_video_menu_end(void)\r
	192	{\r
	193	g_menuscreen_ptr = vout_fbdev_flip(main_fb);\r
	194	}\r
	195	\r
	196	void plat_video_wait_vsync(void)\r
	197	{\r
	198	vout_fbdev_wait_vsync(main_fb);\r
	199	}\r
	200	\r
	201	void plat_status_msg_clear(void)\r
	202	{\r
69dfeea1	203	vout_fbdev_clear_lines(layer_fb, g_osd_y, 8);\r
c66f49e6	204	}\r
	205	\r
	206	void plat_status_msg_busy_next(const char *msg)\r
	207	{\r
	208	plat_status_msg_clear();\r
	209	pemu_finalize_frame("", msg);\r
	210	plat_video_flip();\r
	211	emu_status_msg("");\r
	212	reset_timing = 1;\r
	213	}\r
	214	\r
	215	void plat_status_msg_busy_first(const char *msg)\r
	216	{\r
	217	plat_status_msg_busy_next(msg);\r
	218	}\r
	219	\r
	220	void plat_update_volume(int has_changed, int is_up)\r
	221	{\r
	222	static int prev_frame = 0, wait_frames = 0;\r
	223	int vol = currentConfig.volume;\r
	224	\r
	225	if (has_changed)\r
	226	{\r
	227	if (is_up) {\r
	228	if (vol < 99) vol++;\r
	229	} else {\r
	230	if (vol > 0) vol--;\r
	231	}\r
	232	wait_frames = 0;\r
	233	sndout_oss_setvol(vol, vol);\r
	234	currentConfig.volume = vol;\r
	235	emu_status_msg("VOL: %02i", vol);\r
	236	prev_frame = Pico.m.frame_count;\r
	237	}\r
	238	}\r
	239	\r
b6eccda3	240	static void make_bg(int no_scale)\r
c66f49e6	241	{\r
902972d1	242	unsigned short s = (void )fb_copy;\r
902972d1	243	int x, y;\r
902972d1	244	\r
b6eccda3	245	memset32(g_menubg_src_ptr, 0, g_menuscreen_w * g_menuscreen_h * 2 / 4);\r
	246	\r
	247	if (!no_scale && g_menuscreen_w >= 640 && g_menuscreen_h >= 480) {\r
	248	unsigned int t, *d = g_menubg_src_ptr;\r
	249	d += (g_menuscreen_h / 2 - 480 / 2) * g_menuscreen_w / 2;\r
	250	d += (g_menuscreen_w / 2 - 640 / 2) / 2;\r
	251	for (y = 0; y < 240; y++, s += 320, d += g_menuscreen_w*2/2) {\r
	252	for (x = 0; x < 320; x++) {\r
	253	t = s[x];\r
	254	t \|= t << 16;\r
	255	d[x] = d[x + g_menuscreen_w / 2] = t;\r
	256	}\r
902972d1	257	}\r
b6eccda3	258	return;\r
	259	}\r
	260	\r
	261	if (g_menuscreen_w >= 320 && g_menuscreen_h >= 240) {\r
	262	unsigned short *d = g_menubg_src_ptr;\r
	263	d += (g_menuscreen_h / 2 - 240 / 2) * g_menuscreen_w;\r
	264	d += (g_menuscreen_w / 2 - 320 / 2);\r
	265	for (y = 0; y < 240; y++, s += 320, d += g_menuscreen_w)\r
	266	memcpy(d, s, 320*2);\r
	267	return;\r
c66f49e6	268	}\r
902972d1	269	}\r
c66f49e6	270	\r
902972d1	271	void pemu_forced_frame(int no_scale, int do_emu)\r
902972d1	272	{\r
b6eccda3	273	doing_bg_frame = 1;\r
a33164ff	274	emu_cmn_forced_frame(no_scale, do_emu);\r
b6eccda3	275	doing_bg_frame = 0;\r
902972d1	276	\r
	277	// making a copy because enabling the layer clears it's mem\r
	278	memcpy32((void *)fb_copy, g_screen_ptr, sizeof(fb_copy) / 4);\r
b6eccda3	279	make_bg(no_scale);\r
c66f49e6	280	}\r
c66f49e6	281	\r
a33164ff	282	static void oss_write_nonblocking(int len)\r
c66f49e6	283	{\r
a33164ff	284	// sndout_oss_can_write() is not reliable, only use with no_frmlimit\r
c66f49e6	285	if ((currentConfig.EmuOpt & EOPT_NO_FRMLIMIT) && !sndout_oss_can_write(len))\r
	286	return;\r
	287	\r
a33164ff	288	sndout_oss_write_nb(PsndOut, len);\r
c66f49e6	289	}\r
	290	\r
	291	void pemu_sound_start(void)\r
	292	{\r
c66f49e6	293	PsndOut = NULL;\r
	294	\r
	295	if (currentConfig.EmuOpt & EOPT_EN_SOUND)\r
	296	{\r
c66f49e6	297	int is_stereo = (PicoOpt & POPT_EN_STEREO) ? 1 : 0;\r
	298	\r
	299	PsndRerate(Pico.m.frame_count ? 1 : 0);\r
	300	\r
c66f49e6	301	/*\r
b6eccda3	302	* for 44k stereo, we do 1470 samples/emu_frame\r
c66f49e6	303	* OMAP driver does power of 2 buffers, so we need at least 4K buffer.\r
	304	* The most we can lag is 1K samples, size of OMAP's McBSP FIFO,\r
	305	* with 2K sample buffer we might sometimes lag more than that,\r
	306	* thus causing underflows.\r
	307	*/\r
b6eccda3	308	printf("starting audio: %i len: %i stereo: %i, pal: %i\n",\r
	309	PsndRate, PsndLen, is_stereo, Pico.m.pal);\r
	310	sndout_oss_start(PsndRate, is_stereo, 2);\r
c66f49e6	311	//sndout_oss_setvol(currentConfig.volume, currentConfig.volume);\r
a33164ff	312	PicoWriteSound = oss_write_nonblocking;\r
c66f49e6	313	plat_update_volume(0, 0);\r
	314	memset(sndBuffer, 0, sizeof(sndBuffer));\r
	315	PsndOut = sndBuffer;\r
	316	}\r
	317	}\r
	318	\r
	319	void pemu_sound_stop(void)\r
	320	{\r
	321	sndout_oss_stop();\r
	322	}\r
	323	\r
	324	void pemu_sound_wait(void)\r
	325	{\r
	326	// don't need to do anything, writes will block by themselves\r
	327	}\r
	328	\r
	329	void plat_debug_cat(char *str)\r
	330	{\r
	331	}\r
	332	\r
	333	static int pnd_setup_layer_(int fd, int enabled, int x, int y, int w, int h)\r
	334	{\r
	335	struct omapfb_plane_info pi;\r
	336	struct omapfb_mem_info mi;\r
	337	int ret;\r
	338	\r
	339	ret = ioctl(fd, OMAPFB_QUERY_PLANE, &pi);\r
	340	if (ret != 0) {\r
	341	perror("QUERY_PLANE");\r
	342	return -1;\r
	343	}\r
	344	\r
	345	ret = ioctl(fd, OMAPFB_QUERY_MEM, &mi);\r
	346	if (ret != 0) {\r
	347	perror("QUERY_MEM");\r
	348	return -1;\r
	349	}\r
	350	\r
	351	/* must disable when changing stuff */\r
	352	if (pi.enabled) {\r
	353	pi.enabled = 0;\r
	354	ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);\r
	355	if (ret != 0)\r
	356	perror("SETUP_PLANE");\r
	357	}\r
	358	\r
	359	mi.size = 3202402*4;\r
	360	ret = ioctl(fd, OMAPFB_SETUP_MEM, &mi);\r
	361	if (ret != 0) {\r
	362	perror("SETUP_MEM");\r
	363	return -1;\r
	364	}\r
	365	\r
	366	pi.pos_x = x;\r
	367	pi.pos_y = y;\r
	368	pi.out_width = w;\r
	369	pi.out_height = h;\r
	370	pi.enabled = enabled;\r
	371	\r
	372	ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);\r
	373	if (ret != 0) {\r
	374	perror("SETUP_PLANE");\r
	375	return -1;\r
	376	}\r
377	\r
378	return 0;\r
379	}\r
380	\r
381	int pnd_setup_layer(int enabled, int x, int y, int w, int h)\r
382	{\r
383	return pnd_setup_layer_(vout_fbdev_get_fd(layer_fb), enabled, x, y, w, h);\r
384	}\r
385	\r
386	void pnd_restore_layer_data(void)\r
387	{\r
24cf9d99	388	short t = (short )fb_copy + 320*240 / 2 + 160;\r
c66f49e6	389	\r
	390	// right now this is used by menu, which wants to preview something\r
	391	// so try to get something on the layer.\r
	392	if ((t[0] \| t[5] \| t[13]) == 0)\r
	393	memset32((void *)fb_copy, 0x07000700, sizeof(fb_copy) / 4);\r
	394	\r
	395	memcpy32(g_screen_ptr, (void )fb_copy, 320240*2 / 4);\r
	396	plat_video_flip();\r
	397	}\r
	398	\r
	399	static void apply_filter(int which)\r
	400	{\r
	401	char buf[128];\r
	402	int i;\r
	403	\r
	404	if (pnd_filter_list == NULL)\r
	405	return;\r
	406	\r
	407	for (i = 0; i < which; i++)\r
	408	if (pnd_filter_list[i] == NULL)\r
	409	return;\r
	410	\r
	411	if (pnd_filter_list[i] == NULL)\r
	412	return;\r
	413	\r
	414	snprintf(buf, sizeof(buf), "%s/op_videofir.sh %s", pnd_script_base, pnd_filter_list[i]);\r
	415	system(buf);\r
	416	}\r
	417	\r
	418	void emu_video_mode_change(int start_line, int line_count, int is_32cols)\r
	419	{\r
	420	int fb_w = 320, fb_h = 240, fb_left = 0, fb_right = 0, fb_top = 0, fb_bottom = 0;\r
	421	\r
b6eccda3	422	if (doing_bg_frame)\r
	423	return;\r
	424	\r
c66f49e6	425	PicoDrawSetOutFormat(PDF_RGB555, 1);\r
b6072c17	426	PicoDrawSetCallbacks(emuscan, NULL);\r
c66f49e6	427	\r
	428	if (is_32cols) {\r
	429	fb_w = 256;\r
	430	fb_left = fb_right = 32;\r
	431	}\r
	432	\r
	433	switch (currentConfig.scaling) {\r
	434	case SCALE_1x1:\r
	435	g_layer_w = fb_w;\r
	436	g_layer_h = fb_h;\r
	437	break;\r
	438	case SCALE_2x2_3x2:\r
	439	g_layer_w = fb_w * (is_32cols ? 3 : 2);\r
	440	g_layer_h = fb_h * 2;\r
	441	break;\r
	442	case SCALE_2x2_2x2:\r
	443	g_layer_w = fb_w * 2;\r
	444	g_layer_h = fb_h * 2;\r
	445	break;\r
	446	case SCALE_FULLSCREEN:\r
	447	g_layer_w = 800;\r
	448	g_layer_h = 480;\r
	449	break;\r
	450	case SCALE_CUSTOM:\r
	451	g_layer_x = g_layer_cx;\r
	452	g_layer_y = g_layer_cy;\r
	453	g_layer_w = g_layer_cw;\r
	454	g_layer_h = g_layer_ch;\r
	455	break;\r
	456	}\r
	457	\r
	458	if (currentConfig.scaling != SCALE_CUSTOM) {\r
	459	// center the layer\r
	460	g_layer_x = 800 / 2 - g_layer_w / 2;\r
	461	g_layer_y = 480 / 2 - g_layer_h / 2;\r
	462	}\r
	463	\r
	464	switch (currentConfig.scaling) {\r
	465	case SCALE_FULLSCREEN:\r
	466	case SCALE_CUSTOM:\r
	467	fb_top = start_line;\r
	468	fb_h = line_count;\r
	469	break;\r
	470	}\r
	471	g_osd_fps_x = is_32cols ? 232 : 264;\r
	472	g_osd_y = fb_top + fb_h - 8;\r
	473	\r
	474	pnd_setup_layer(1, g_layer_x, g_layer_y, g_layer_w, g_layer_h);\r
c66f49e6	475	vout_fbdev_clear(layer_fb);\r
c64c8d0e	476	vout_fbdev_resize(layer_fb, fb_w, fb_h, 16, fb_left, fb_right, fb_top, fb_bottom, 3);\r
c4046e6e	477	plat_video_flip();\r
c66f49e6	478	}\r
c66f49e6	479	\r
c66f49e6	480	void pemu_loop_prep(void)\r
	481	{\r
	482	static int pal_old = -1;\r
	483	static int filter_old = -1;\r
	484	char buf[128];\r
	485	\r
	486	if (currentConfig.CPUclock != get_cpu_clock()) {\r
	487	snprintf(buf, sizeof(buf), "unset DISPLAY; echo y \| %s/op_cpuspeed.sh %d",\r
	488	pnd_script_base, currentConfig.CPUclock);\r
	489	system(buf);\r
	490	}\r
	491	\r
	492	if (Pico.m.pal != pal_old) {\r
	493	snprintf(buf, sizeof(buf), "%s/op_lcdrate.sh %d",\r
	494	pnd_script_base, Pico.m.pal ? 50 : 60);\r
	495	system(buf);\r
	496	pal_old = Pico.m.pal;\r
	497	}\r
	498	\r
	499	if (currentConfig.filter != filter_old) {\r
	500	apply_filter(currentConfig.filter);\r
	501	filter_old = currentConfig.filter;\r
	502	}\r
	503	\r
	504	// make sure there is no junk left behind the layer\r
b6eccda3	505	memset32(g_menuscreen_ptr, 0, g_menuscreen_w * g_menuscreen_h * 2 / 4);\r
c66f49e6	506	g_menuscreen_ptr = vout_fbdev_flip(main_fb);\r
	507	\r
	508	// emu_video_mode_change will call pnd_setup_layer()\r
	509	\r
	510	// dirty buffers better go now than during gameplay\r
	511	sync();\r
	512	sleep(0);\r
	513	\r
	514	pemu_sound_start();\r
	515	}\r
	516	\r
	517	void pemu_loop_end(void)\r
	518	{\r
c66f49e6	519	pemu_sound_stop();\r
c66f49e6	520	\r
c66f49e6	521	/* do one more frame for menu bg */\r
902972d1	522	pemu_forced_frame(0, 1);\r
c66f49e6	523	\r
c66f49e6	524	pnd_setup_layer(0, g_layer_x, g_layer_y, g_layer_w, g_layer_h);\r
c66f49e6	525	}\r
	526	\r
	527	void plat_wait_till_us(unsigned int us_to)\r
	528	{\r
	529	unsigned int now;\r
	530	signed int diff;\r
	531	\r
	532	now = plat_get_ticks_us();\r
	533	\r
	534	// XXX: need to check NOHZ\r
	535	diff = (signed int)(us_to - now);\r
	536	if (diff > 10000) {\r
	537	//printf("sleep %d\n", us_to - now);\r
	538	usleep(diff * 15 / 16);\r
	539	now = plat_get_ticks_us();\r
	540	//printf(" wake %d\n", (signed)(us_to - now));\r
	541	}\r
	542	/*\r
	543	while ((signed int)(us_to - now) > 512) {\r
	544	spend_cycles(1024);\r
	545	now = plat_get_ticks_us();\r
	546	}\r
	547	*/\r
	548	}\r
	549	\r
c66f49e6	550	void plat_early_init(void)\r
	551	{\r
	552	}\r
	553	\r
	554	void plat_init(void)\r
	555	{\r
	556	const char main_fb_name, layer_fb_name;\r
	557	int fd, ret, w, h;\r
	558	\r
	559	main_fb_name = getenv("FBDEV_MAIN");\r
	560	if (main_fb_name == NULL)\r
	561	main_fb_name = "/dev/fb0";\r
	562	\r
	563	layer_fb_name = getenv("FBDEV_LAYER");\r
	564	if (layer_fb_name == NULL)\r
	565	layer_fb_name = "/dev/fb1";\r
	566	\r
	567	// must set the layer up first to be able to use it\r
	568	fd = open(layer_fb_name, O_RDWR);\r
	569	if (fd == -1) {\r
	570	fprintf(stderr, "%s: ", layer_fb_name);\r
	571	perror("open");\r
	572	exit(1);\r
	573	}\r
	574	\r
	575	ret = pnd_setup_layer_(fd, 0, g_layer_x, g_layer_y, g_layer_w, g_layer_h);\r
	576	close(fd);\r
	577	if (ret != 0) {\r
	578	fprintf(stderr, "failed to set up layer, exiting.\n");\r
	579	exit(1);\r
	580	}\r
	581	\r
838a76d4	582	xenv_init();\r
c66f49e6	583	\r
c66f49e6	584	w = h = 0;\r
c64c8d0e	585	main_fb = vout_fbdev_init(main_fb_name, &w, &h, 16, 2);\r
c66f49e6	586	if (main_fb == NULL) {\r
	587	fprintf(stderr, "couldn't init fb: %s\n", main_fb_name);\r
	588	exit(1);\r
	589	}\r
	590	\r
b6eccda3	591	g_menuscreen_w = w;\r
b6eccda3	592	g_menuscreen_h = h;\r
c66f49e6	593	g_menuscreen_ptr = vout_fbdev_flip(main_fb);\r
	594	\r
	595	w = 320; h = 240;\r
c64c8d0e	596	layer_fb = vout_fbdev_init(layer_fb_name, &w, &h, 16, 3);\r
c66f49e6	597	if (layer_fb == NULL) {\r
	598	fprintf(stderr, "couldn't init fb: %s\n", layer_fb_name);\r
	599	goto fail0;\r
	600	}\r
	601	\r
	602	if (w != g_screen_width \|\| h != g_screen_height) {\r
	603	fprintf(stderr, "%dx%d not supported on %s\n", w, h, layer_fb_name);\r
	604	goto fail1;\r
	605	}\r
	606	g_screen_ptr = vout_fbdev_flip(layer_fb);\r
	607	\r
b6eccda3	608	temp_frame = calloc(g_menuscreen_w * g_menuscreen_h * 2, 1);\r
	609	if (temp_frame == NULL) {\r
	610	fprintf(stderr, "OOM\n");\r
	611	goto fail1;\r
	612	}\r
c66f49e6	613	g_menubg_ptr = temp_frame;\r
c66f49e6	614	g_menubg_src_ptr = temp_frame;\r
b6eccda3	615	PicoDraw2FB = temp_frame;\r
c66f49e6	616	\r
	617	sndout_oss_init();\r
	618	pnd_menu_init();\r
902972d1	619	\r
	620	in_set_config(in_name_to_id("evdev:gpio-keys"), IN_CFG_KEY_NAMES,\r
	621	pandora_gpio_keys, sizeof(pandora_gpio_keys));\r
c66f49e6	622	return;\r
	623	\r
	624	fail1:\r
	625	vout_fbdev_finish(layer_fb);\r
	626	fail0:\r
	627	vout_fbdev_finish(main_fb);\r
	628	exit(1);\r
	629	}\r
	630	\r
	631	void plat_finish(void)\r
	632	{\r
	633	sndout_oss_exit();\r
	634	vout_fbdev_finish(main_fb);\r
838a76d4	635	xenv_finish();\r
c66f49e6	636	\r
	637	printf("all done\n");\r
	638	}\r
	639	\r