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