[sdl_omap.git] / src / video / omapdss / osdl_video.c

/*
 * (C) Gražvydas "notaz" Ignotas, 2010-2012
 *
 * This work is licensed under the terms of the GNU LGPL, version 2.1 or later.
 * See the COPYING file in the top-level directory.
 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <strings.h>
#include <ctype.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <unistd.h>
#include <linux/fb.h>

#include "omapsdl.h"
#include "omapfb.h"
#include "linux/fbdev.h"
#include "linux/xenv.h"

struct omapfb_saved_layer {
	struct omapfb_plane_info pi;
	struct omapfb_mem_info mi;
};

static const char *get_fb_device(void)
{
	const char *fbname = getenv("SDL_FBDEV");
	if (fbname == NULL)
		fbname = "/dev/fb1";

	return fbname;
}

static int osdl_setup_omapfb(int fd, int enabled, int x, int y, int w, int h,
	int mem, int *buffer_count)
{
	struct omapfb_plane_info pi;
	struct omapfb_mem_info mi;
	int mem_blocks = *buffer_count;
	int ret;

	memset(&pi, 0, sizeof(pi));
	memset(&mi, 0, sizeof(mi));

	ret = ioctl(fd, OMAPFB_QUERY_PLANE, &pi);
	if (ret != 0) {
		err_perror("QUERY_PLANE");
		return -1;
	}

	ret = ioctl(fd, OMAPFB_QUERY_MEM, &mi);
	if (ret != 0) {
		err_perror("QUERY_MEM");
		return -1;
	}

	/* must disable when changing stuff */
	if (pi.enabled) {
		pi.enabled = 0;
		ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);
		if (ret != 0)
			err_perror("SETUP_PLANE");
	}

	if (mi.size < mem * mem_blocks) {
		for (; mem_blocks > 0; mem_blocks--) {
			mi.size = mem * mem_blocks;
			ret = ioctl(fd, OMAPFB_SETUP_MEM, &mi);
			if (ret == 0)
				break;
		}
		if (ret != 0 || mem_blocks <= 0) {
			err("failed to allocate at least %d bytes of vram:\n", mem);
			err_perror("SETUP_MEM");
			return -1;
		}
	}
	*buffer_count = mem_blocks;

	pi.pos_x = x;
	pi.pos_y = y;
	pi.out_width = w;
	pi.out_height = h;
	pi.enabled = enabled;

	ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);
	if (ret != 0) {
		err_perror("SETUP_PLANE");
		err("(%d %d %d %d)\n", x, y, w, h);
		return -1;
	}

	return 0;
}

static int read_sysfs(const char *fname, char *buff, size_t size)
{
	FILE *f;
	int ret;

	f = fopen(fname, "r");
	if (f == NULL) {
		err_perror("open %s: ", fname);
		return -1;
	}

	ret = fread(buff, 1, size - 1, f);
	fclose(f);
	if (ret <= 0) {
		err_perror("read %s: ", fname);
		return -1;
	}

	buff[ret] = 0;
	for (ret--; ret >= 0 && isspace(buff[ret]); ret--)
		buff[ret] = 0;

	return 0;
}

int read_vscreeninfo(const char *fbname, int *w, int *h)
{
	struct fb_var_screeninfo fbvar;
	int ret, fd;

	fd = open(fbname, O_RDWR);
	if (fd == -1) {
		err_perror("open %s", fbname);
		return -1;
	}

	ret = ioctl(fd, FBIOGET_VSCREENINFO, &fbvar);
	close(fd);

	if (ret == -1) {
		err_perror("ioctl %s", fbname);
		return -1;
	}

	if (fbvar.xres == 0 || fbvar.yres == 0)
		return -1;

	*w = fbvar.xres;
	*h = fbvar.yres;
	return 0;
}

int osdl_video_detect_screen(struct SDL_PrivateVideoData *pdata)
{
	int fb_id, overlay_id = -1, screen_id = -1;
	char buff[64], screen_name[64];
	const char *fbname;
	struct stat status;
	int fd, i, ret;
	int w, h;
	FILE *f;

	pdata->phys_w = pdata->phys_h = 0;

	fbname = get_fb_device();

	/* Figure out screen resolution, we need to know default resolution
	 * to report to SDL and for centering stuff.
	 * The only way to achieve this seems to be walking some sysfs files.. */
	ret = stat(fbname, &status);
	if (ret != 0) {
		err_perror("can't stat %s", fbname);
		goto skip_screen;
	}
	fb_id = minor(status.st_rdev);

	snprintf(buff, sizeof(buff), "/sys/class/graphics/fb%d/overlays", fb_id);
	f = fopen(buff, "r");
	if (f == NULL) {
		err("can't open %s, skip screen detection", buff);
		goto skip_screen;
	}

	ret = fscanf(f, "%d", &overlay_id);
	fclose(f);
	if (ret != 1) {
		err("can't parse %s, skip screen detection", buff);
		goto skip_screen;
	}

	snprintf(buff, sizeof(buff), "/sys/devices/platform/omapdss/overlay%d/manager", overlay_id);
	ret = read_sysfs(buff, screen_name, sizeof(screen_name));
	if (ret < 0) {
		err("skip screen detection");
		goto skip_screen;
	}

	for (i = 0; ; i++) {
		snprintf(buff, sizeof(buff), "/sys/devices/platform/omapdss/display%d/name", i);
		ret = read_sysfs(buff, buff, sizeof(buff));
		if (ret < 0)
			break;

		if (strcmp(screen_name, buff) == 0) {
			screen_id = i;
			break;
		}
	}

	if (screen_id < 0) {
		err("could not find screen");
		goto skip_screen;
	}

	snprintf(buff, sizeof(buff), "/sys/devices/platform/omapdss/display%d/timings", screen_id);
	f = fopen(buff, "r");
	if (f == NULL) {
		err("can't open %s, skip screen detection", buff);
		goto skip_screen;
	}

	ret = fscanf(f, "%*d,%d/%*d/%*d/%*d,%d/%*d/%*d/%*d", &w, &h);
	fclose(f);
	if (ret != 2) {
		err("can't parse %s (%d), skip screen detection", buff, ret);
		goto skip_screen;
	}

	log("detected %dx%d '%s' (%d) screen attached to fb %d and overlay %d",
		w, h, screen_name, screen_id, fb_id, overlay_id);

	pdata->phys_w = w;
	pdata->phys_h = h;
	return 0;

skip_screen:
	/* attempt to extract this from FB then */
	ret = read_vscreeninfo(fbname, &pdata->phys_w, &pdata->phys_h);
	if (ret != 0 && strcmp(fbname, "/dev/fb0") != 0) {
		/* last resort */
		ret = read_vscreeninfo("/dev/fb0", &pdata->phys_w, &pdata->phys_h);
	}

	if (ret != 0) {
		err("VSCREENINFO has nothing meaningful");
		return -1;
	}

	return 0;
}

static int osdl_setup_omap_layer(struct SDL_PrivateVideoData *pdata,
		const char *fbname, int width, int height, int bpp, int *buffer_count)
{
	int x = 0, y = 0, w = width, h = height; /* layer size and pos */
	int screen_w = w, screen_h = h;
	int tmp_w, tmp_h;
	const char *tmp;
	int retval = -1;
	int ret, fd;

	pdata->layer_x = pdata->layer_y = pdata->layer_w = pdata->layer_h = 0;

	if (pdata->phys_w != 0)
		screen_w = pdata->phys_w;
	if (pdata->phys_h != 0)
		screen_h = pdata->phys_h;

	fd = open(fbname, O_RDWR);
	if (fd == -1) {
		err_perror("open %s", fbname);
		return -1;
	}

	/* FIXME: assuming layer doesn't change here */
	if (pdata->saved_layer == NULL) {
		struct omapfb_saved_layer *slayer;
		slayer = calloc(1, sizeof(*slayer));
		if (slayer == NULL)
			goto out;

		ret = ioctl(fd, OMAPFB_QUERY_PLANE, &slayer->pi);
		if (ret != 0) {
			err_perror("QUERY_PLANE");
			goto out;
		}

		ret = ioctl(fd, OMAPFB_QUERY_MEM, &slayer->mi);
		if (ret != 0) {
			err_perror("QUERY_MEM");
			goto out;
		}

		pdata->saved_layer = slayer;
	}

	tmp = getenv("SDL_OMAP_LAYER_SIZE");
	if (tmp != NULL) {
		if (strcasecmp(tmp, "fullscreen") == 0)
			w = screen_w, h = screen_h;
		else if (sscanf(tmp, "%dx%d", &tmp_w, &tmp_h) == 2)
			w = tmp_w, h = tmp_h;
		else
			err("layer size specified incorrectly, "
				"should be like 800x480");
	}

	/* the layer can't be set larger than screen */
	tmp_w = w, tmp_h = h;
	if (w > screen_w)
		w = screen_w;
	if (h > screen_h)
		h = screen_h;
	if (w != tmp_w || h != tmp_h)
		log("layer resized %dx%d -> %dx%d to fit screen", tmp_w, tmp_h, w, h);

	x = screen_w / 2 - w / 2;
	y = screen_h / 2 - h / 2;
	ret = osdl_setup_omapfb(fd, 1, x, y, w, h,
				width * height * ((bpp + 7) / 8), buffer_count);
	if (ret == 0) {
		pdata->layer_x = x;
		pdata->layer_y = y;
		pdata->layer_w = w;
		pdata->layer_h = h;
	}

	retval = ret;
out:
	close(fd);
	return retval;
}

void *osdl_video_set_mode(struct SDL_PrivateVideoData *pdata,
			  int border_l, int border_r, int border_t, int border_b,
			  int width, int height, int bpp, int *doublebuf)
{
	int buffers_try, buffers_set;
	const char *fbname;
	void *result;
	int ret;

	fbname = get_fb_device();

	if (pdata->fbdev != NULL) {
		vout_fbdev_finish(pdata->fbdev);
		pdata->fbdev = NULL;
	}

	buffers_try = buffers_set = 1;
	if (*doublebuf)
		/* actually try tripple buffering for reduced chance of tearing */
		buffers_try = buffers_set = 3;

	ret = osdl_setup_omap_layer(pdata, fbname, width, height, bpp, &buffers_set);
	if (ret < 0)
		goto fail;

	pdata->fbdev = vout_fbdev_init(fbname, &width, &height, bpp, buffers_set);
	if (pdata->fbdev == NULL)
		goto fail;

	if (border_l | border_r | border_t | border_b) {
		width -= border_l + border_r;
		height -= border_t + border_b;
		result = vout_fbdev_resize(pdata->fbdev, width, height, bpp,
				border_l, border_r, border_t, border_b, buffers_set);
	}
	else {
		result = osdl_video_flip(pdata);
	}
	if (result == NULL)
		goto fail;

	if (!pdata->xenv_up) {
		ret = xenv_init();
		if (ret == 0)
			pdata->xenv_up = 1;
	}

	if (buffers_try != buffers_set) {
		log("only %d/%d buffers available, expect tearing\n",
			buffers_set, buffers_try);
		*doublebuf = buffers_set > 1;
	}

	return result;

fail:
	osdl_video_finish(pdata);
	return NULL;
}

void *osdl_video_flip(struct SDL_PrivateVideoData *pdata)
{
	void *ret;

	if (pdata->fbdev == NULL)
		return NULL;

	ret = vout_fbdev_flip(pdata->fbdev);

	if (pdata->cfg_force_vsync)
		vout_fbdev_wait_vsync(pdata->fbdev);

	return ret;
}

void osdl_video_finish(struct SDL_PrivateVideoData *pdata)
{
	static const char *fbname;

	fbname = get_fb_device();
	if (pdata->fbdev != NULL) {
		vout_fbdev_finish(pdata->fbdev);
		pdata->fbdev = NULL;
	}

	/* restore the OMAP layer */
	if (pdata->saved_layer != NULL) {
		struct omapfb_saved_layer *slayer = pdata->saved_layer;
		int fd;

		fd = open(fbname, O_RDWR);
		if (fd != -1) {
			int enabled = slayer->pi.enabled;

			/* be sure to disable while setting up */
			slayer->pi.enabled = 0;
			ioctl(fd, OMAPFB_SETUP_PLANE, &slayer->pi);
			ioctl(fd, OMAPFB_SETUP_MEM, &slayer->mi);
			if (enabled) {
				slayer->pi.enabled = enabled;
				ioctl(fd, OMAPFB_SETUP_PLANE, &slayer->pi);
			}
			close(fd);
		}
		free(slayer);
		pdata->saved_layer = NULL;
	}

	if (pdata->xenv_up) {
		xenv_finish();
		pdata->xenv_up = 0;
	}
}
Commit	Line	Data
f641fccb	1	/*
0c7caf2b	2	* (C) Gražvydas "notaz" Ignotas, 2010-2012
f641fccb	3	*
	4	* This work is licensed under the terms of the GNU LGPL, version 2.1 or later.
	5	* See the COPYING file in the top-level directory.
	6	*/
	7
	8	#include <stdio.h>
	9	#include <stdlib.h>
	10	#include <string.h>
	11	#include <strings.h>
	12	#include <ctype.h>
	13	#include <sys/types.h>
	14	#include <sys/stat.h>
	15	#include <fcntl.h>
	16	#include <sys/ioctl.h>
	17	#include <unistd.h>
	18	#include <linux/fb.h>
	19
	20	#include "omapsdl.h"
	21	#include "omapfb.h"
	22	#include "linux/fbdev.h"
f9b3f440	23	#include "linux/xenv.h"
f641fccb	24
	25	struct omapfb_saved_layer {
	26	struct omapfb_plane_info pi;
	27	struct omapfb_mem_info mi;
	28	};
	29
b9a19b44	30	static const char *get_fb_device(void)
	31	{
	32	const char *fbname = getenv("SDL_FBDEV");
	33	if (fbname == NULL)
	34	fbname = "/dev/fb1";
	35
	36	return fbname;
	37	}
	38
0c7caf2b	39	static int osdl_setup_omapfb(int fd, int enabled, int x, int y, int w, int h,
0c7caf2b	40	int mem, int *buffer_count)
f641fccb	41	{
	42	struct omapfb_plane_info pi;
	43	struct omapfb_mem_info mi;
0c7caf2b	44	int mem_blocks = *buffer_count;
f641fccb	45	int ret;
f641fccb	46
5f4b1fd3	47	memset(&pi, 0, sizeof(pi));
	48	memset(&mi, 0, sizeof(mi));
	49
f641fccb	50	ret = ioctl(fd, OMAPFB_QUERY_PLANE, &pi);
f641fccb	51	if (ret != 0) {
7b66578c	52	err_perror("QUERY_PLANE");
f641fccb	53	return -1;
	54	}
	55
	56	ret = ioctl(fd, OMAPFB_QUERY_MEM, &mi);
	57	if (ret != 0) {
7b66578c	58	err_perror("QUERY_MEM");
f641fccb	59	return -1;
	60	}
	61
	62	/* must disable when changing stuff */
	63	if (pi.enabled) {
	64	pi.enabled = 0;
	65	ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);
	66	if (ret != 0)
7b66578c	67	err_perror("SETUP_PLANE");
f641fccb	68	}
f641fccb	69
0c7caf2b	70	if (mi.size < mem * mem_blocks) {
	71	for (; mem_blocks > 0; mem_blocks--) {
	72	mi.size = mem * mem_blocks;
	73	ret = ioctl(fd, OMAPFB_SETUP_MEM, &mi);
	74	if (ret == 0)
	75	break;
	76	}
	77	if (ret != 0 \|\| mem_blocks <= 0) {
	78	err("failed to allocate at least %d bytes of vram:\n", mem);
13f953aa	79	err_perror("SETUP_MEM");
	80	return -1;
	81	}
f641fccb	82	}
0c7caf2b	83	*buffer_count = mem_blocks;
f641fccb	84
	85	pi.pos_x = x;
	86	pi.pos_y = y;
	87	pi.out_width = w;
	88	pi.out_height = h;
	89	pi.enabled = enabled;
	90
	91	ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);
	92	if (ret != 0) {
7b66578c	93	err_perror("SETUP_PLANE");
6f13ad97	94	err("(%d %d %d %d)\n", x, y, w, h);
f641fccb	95	return -1;
	96	}
	97
	98	return 0;
	99	}
	100
	101	static int read_sysfs(const char fname, char buff, size_t size)
	102	{
	103	FILE *f;
	104	int ret;
	105
	106	f = fopen(fname, "r");
	107	if (f == NULL) {
7b66578c	108	err_perror("open %s: ", fname);
f641fccb	109	return -1;
	110	}
	111
	112	ret = fread(buff, 1, size - 1, f);
	113	fclose(f);
	114	if (ret <= 0) {
7b66578c	115	err_perror("read %s: ", fname);
f641fccb	116	return -1;
	117	}
	118
	119	buff[ret] = 0;
	120	for (ret--; ret >= 0 && isspace(buff[ret]); ret--)
	121	buff[ret] = 0;
	122
	123	return 0;
	124	}
	125
34edc246	126	int read_vscreeninfo(const char fbname, int w, int *h)
	127	{
	128	struct fb_var_screeninfo fbvar;
	129	int ret, fd;
	130
	131	fd = open(fbname, O_RDWR);
	132	if (fd == -1) {
	133	err_perror("open %s", fbname);
	134	return -1;
	135	}
	136
	137	ret = ioctl(fd, FBIOGET_VSCREENINFO, &fbvar);
	138	close(fd);
	139
	140	if (ret == -1) {
	141	err_perror("ioctl %s", fbname);
	142	return -1;
	143	}
	144
	145	if (fbvar.xres == 0 \|\| fbvar.yres == 0)
	146	return -1;
	147
	148	*w = fbvar.xres;
	149	*h = fbvar.yres;
	150	return 0;
	151	}
	152
b9a19b44	153	int osdl_video_detect_screen(struct SDL_PrivateVideoData *pdata)
f641fccb	154	{
f641fccb	155	int fb_id, overlay_id = -1, screen_id = -1;
f641fccb	156	char buff[64], screen_name[64];
b9a19b44	157	const char *fbname;
f641fccb	158	struct stat status;
b9a19b44	159	int fd, i, ret;
b9a19b44	160	int w, h;
f641fccb	161	FILE *f;
f641fccb	162
5f4b1fd3	163	pdata->phys_w = pdata->phys_h = 0;
5f4b1fd3	164
b9a19b44	165	fbname = get_fb_device();
f641fccb	166
b9a19b44	167	/* Figure out screen resolution, we need to know default resolution
b9a19b44	168	* to report to SDL and for centering stuff.
f641fccb	169	* The only way to achieve this seems to be walking some sysfs files.. */
	170	ret = stat(fbname, &status);
	171	if (ret != 0) {
7b66578c	172	err_perror("can't stat %s", fbname);
b9a19b44	173	goto skip_screen;
f641fccb	174	}
	175	fb_id = minor(status.st_rdev);
	176
	177	snprintf(buff, sizeof(buff), "/sys/class/graphics/fb%d/overlays", fb_id);
	178	f = fopen(buff, "r");
	179	if (f == NULL) {
7b66578c	180	err("can't open %s, skip screen detection", buff);
f641fccb	181	goto skip_screen;
	182	}
	183
	184	ret = fscanf(f, "%d", &overlay_id);
	185	fclose(f);
	186	if (ret != 1) {
7b66578c	187	err("can't parse %s, skip screen detection", buff);
f641fccb	188	goto skip_screen;
	189	}
	190
	191	snprintf(buff, sizeof(buff), "/sys/devices/platform/omapdss/overlay%d/manager", overlay_id);
	192	ret = read_sysfs(buff, screen_name, sizeof(screen_name));
	193	if (ret < 0) {
7b66578c	194	err("skip screen detection");
f641fccb	195	goto skip_screen;
	196	}
	197
	198	for (i = 0; ; i++) {
	199	snprintf(buff, sizeof(buff), "/sys/devices/platform/omapdss/display%d/name", i);
	200	ret = read_sysfs(buff, buff, sizeof(buff));
	201	if (ret < 0)
	202	break;
	203
	204	if (strcmp(screen_name, buff) == 0) {
	205	screen_id = i;
	206	break;
	207	}
	208	}
	209
	210	if (screen_id < 0) {
7b66578c	211	err("could not find screen");
f641fccb	212	goto skip_screen;
	213	}
	214
	215	snprintf(buff, sizeof(buff), "/sys/devices/platform/omapdss/display%d/timings", screen_id);
	216	f = fopen(buff, "r");
	217	if (f == NULL) {
7b66578c	218	err("can't open %s, skip screen detection", buff);
f641fccb	219	goto skip_screen;
	220	}
	221
b9a19b44	222	ret = fscanf(f, "%d,%d/%d/%d/%d,%d/%d/%d/%*d", &w, &h);
f641fccb	223	fclose(f);
f641fccb	224	if (ret != 2) {
7b66578c	225	err("can't parse %s (%d), skip screen detection", buff, ret);
f641fccb	226	goto skip_screen;
	227	}
	228
7b66578c	229	log("detected %dx%d '%s' (%d) screen attached to fb %d and overlay %d",
b9a19b44	230	w, h, screen_name, screen_id, fb_id, overlay_id);
b9a19b44	231
5f4b1fd3	232	pdata->phys_w = w;
5f4b1fd3	233	pdata->phys_h = h;
b9a19b44	234	return 0;
f641fccb	235
f641fccb	236	skip_screen:
b9a19b44	237	/* attempt to extract this from FB then */
34edc246	238	ret = read_vscreeninfo(fbname, &pdata->phys_w, &pdata->phys_h);
	239	if (ret != 0 && strcmp(fbname, "/dev/fb0") != 0) {
	240	/* last resort */
	241	ret = read_vscreeninfo("/dev/fb0", &pdata->phys_w, &pdata->phys_h);
b9a19b44	242	}
b9a19b44	243
34edc246	244	if (ret != 0) {
b9a19b44	245	err("VSCREENINFO has nothing meaningful");
	246	return -1;
	247	}
	248
b9a19b44	249	return 0;
	250	}
	251
	252	static int osdl_setup_omap_layer(struct SDL_PrivateVideoData *pdata,
0c7caf2b	253	const char fbname, int width, int height, int bpp, int buffer_count)
b9a19b44	254	{
	255	int x = 0, y = 0, w = width, h = height; /* layer size and pos */
	256	int screen_w = w, screen_h = h;
f151701d	257	int tmp_w, tmp_h;
b9a19b44	258	const char *tmp;
f11c56a6	259	int retval = -1;
b9a19b44	260	int ret, fd;
b9a19b44	261
5f4b1fd3	262	pdata->layer_x = pdata->layer_y = pdata->layer_w = pdata->layer_h = 0;
	263
	264	if (pdata->phys_w != 0)
	265	screen_w = pdata->phys_w;
	266	if (pdata->phys_h != 0)
	267	screen_h = pdata->phys_h;
b9a19b44	268
	269	fd = open(fbname, O_RDWR);
	270	if (fd == -1) {
	271	err_perror("open %s", fbname);
	272	return -1;
	273	}
	274
	275	/* FIXME: assuming layer doesn't change here */
	276	if (pdata->saved_layer == NULL) {
	277	struct omapfb_saved_layer *slayer;
	278	slayer = calloc(1, sizeof(*slayer));
	279	if (slayer == NULL)
f11c56a6	280	goto out;
b9a19b44	281
	282	ret = ioctl(fd, OMAPFB_QUERY_PLANE, &slayer->pi);
	283	if (ret != 0) {
	284	err_perror("QUERY_PLANE");
f11c56a6	285	goto out;
b9a19b44	286	}
	287
	288	ret = ioctl(fd, OMAPFB_QUERY_MEM, &slayer->mi);
	289	if (ret != 0) {
	290	err_perror("QUERY_MEM");
f11c56a6	291	goto out;
b9a19b44	292	}
	293
	294	pdata->saved_layer = slayer;
	295	}
	296
f641fccb	297	tmp = getenv("SDL_OMAP_LAYER_SIZE");
f641fccb	298	if (tmp != NULL) {
f641fccb	299	if (strcasecmp(tmp, "fullscreen") == 0)
f641fccb	300	w = screen_w, h = screen_h;
f151701d	301	else if (sscanf(tmp, "%dx%d", &tmp_w, &tmp_h) == 2)
f151701d	302	w = tmp_w, h = tmp_h;
f641fccb	303	else
7b66578c	304	err("layer size specified incorrectly, "
7b66578c	305	"should be like 800x480");
f641fccb	306	}
f11c56a6	307
	308	/* the layer can't be set larger than screen */
	309	tmp_w = w, tmp_h = h;
	310	if (w > screen_w)
	311	w = screen_w;
	312	if (h > screen_h)
	313	h = screen_h;
	314	if (w != tmp_w \|\| h != tmp_h)
	315	log("layer resized %dx%d -> %dx%d to fit screen", tmp_w, tmp_h, w, h);
f641fccb	316
	317	x = screen_w / 2 - w / 2;
	318	y = screen_h / 2 - h / 2;
0c7caf2b	319	ret = osdl_setup_omapfb(fd, 1, x, y, w, h,
0c7caf2b	320	width * height * ((bpp + 7) / 8), buffer_count);
5f4b1fd3	321	if (ret == 0) {
	322	pdata->layer_x = x;
	323	pdata->layer_y = y;
	324	pdata->layer_w = w;
	325	pdata->layer_h = h;
	326	}
f641fccb	327
f11c56a6	328	retval = ret;
	329	out:
	330	close(fd);
	331	return retval;
f641fccb	332	}
f641fccb	333
455c8c43	334	void osdl_video_set_mode(struct SDL_PrivateVideoData pdata,
455c8c43	335	int border_l, int border_r, int border_t, int border_b,
0c7caf2b	336	int width, int height, int bpp, int *doublebuf)
f641fccb	337	{
0c7caf2b	338	int buffers_try, buffers_set;
f641fccb	339	const char *fbname;
455c8c43	340	void *result;
f641fccb	341	int ret;
f641fccb	342
b9a19b44	343	fbname = get_fb_device();
f641fccb	344
	345	if (pdata->fbdev != NULL) {
	346	vout_fbdev_finish(pdata->fbdev);
	347	pdata->fbdev = NULL;
	348	}
	349
0c7caf2b	350	buffers_try = buffers_set = 1;
	351	if (*doublebuf)
	352	/* actually try tripple buffering for reduced chance of tearing */
	353	buffers_try = buffers_set = 3;
	354
	355	ret = osdl_setup_omap_layer(pdata, fbname, width, height, bpp, &buffers_set);
f641fccb	356	if (ret < 0)
0c7caf2b	357	goto fail;
f641fccb	358
0c7caf2b	359	pdata->fbdev = vout_fbdev_init(fbname, &width, &height, bpp, buffers_set);
f641fccb	360	if (pdata->fbdev == NULL)
0c7caf2b	361	goto fail;
455c8c43	362
	363	if (border_l \| border_r \| border_t \| border_b) {
	364	width -= border_l + border_r;
	365	height -= border_t + border_b;
	366	result = vout_fbdev_resize(pdata->fbdev, width, height, bpp,
0c7caf2b	367	border_l, border_r, border_t, border_b, buffers_set);
455c8c43	368	}
	369	else {
	370	result = osdl_video_flip(pdata);
	371	}
0c7caf2b	372	if (result == NULL)
0c7caf2b	373	goto fail;
f641fccb	374
f9b3f440	375	if (!pdata->xenv_up) {
	376	ret = xenv_init();
	377	if (ret == 0)
	378	pdata->xenv_up = 1;
f641fccb	379	}
f641fccb	380
0c7caf2b	381	if (buffers_try != buffers_set) {
	382	log("only %d/%d buffers available, expect tearing\n",
	383	buffers_set, buffers_try);
	384	*doublebuf = buffers_set > 1;
	385	}
	386
455c8c43	387	return result;
0c7caf2b	388
	389	fail:
	390	osdl_video_finish(pdata);
	391	return NULL;
f641fccb	392	}
	393
	394	void osdl_video_flip(struct SDL_PrivateVideoData pdata)
	395	{
52a1749b	396	void *ret;
52a1749b	397
f641fccb	398	if (pdata->fbdev == NULL)
	399	return NULL;
	400
52a1749b	401	ret = vout_fbdev_flip(pdata->fbdev);
52a1749b	402
5f4b1fd3	403	if (pdata->cfg_force_vsync)
f641fccb	404	vout_fbdev_wait_vsync(pdata->fbdev);
f641fccb	405
52a1749b	406	return ret;
f641fccb	407	}
	408
	409	void osdl_video_finish(struct SDL_PrivateVideoData *pdata)
	410	{
	411	static const char *fbname;
	412
b9a19b44	413	fbname = get_fb_device();
f641fccb	414	if (pdata->fbdev != NULL) {
	415	vout_fbdev_finish(pdata->fbdev);
	416	pdata->fbdev = NULL;
	417	}
	418
	419	/* restore the OMAP layer */
	420	if (pdata->saved_layer != NULL) {
	421	struct omapfb_saved_layer *slayer = pdata->saved_layer;
	422	int fd;
	423
	424	fd = open(fbname, O_RDWR);
	425	if (fd != -1) {
	426	int enabled = slayer->pi.enabled;
	427
	428	/* be sure to disable while setting up */
	429	slayer->pi.enabled = 0;
	430	ioctl(fd, OMAPFB_SETUP_PLANE, &slayer->pi);
	431	ioctl(fd, OMAPFB_SETUP_MEM, &slayer->mi);
	432	if (enabled) {
	433	slayer->pi.enabled = enabled;
	434	ioctl(fd, OMAPFB_SETUP_PLANE, &slayer->pi);
	435	}
	436	close(fd);
	437	}
	438	free(slayer);
	439	pdata->saved_layer = NULL;
	440	}
	441
f9b3f440	442	if (pdata->xenv_up) {
	443	xenv_finish();
	444	pdata->xenv_up = 0;
f641fccb	445	}
	446	}
	447