[picodrive.git] / platform / pandora / plat.c

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