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