2 * (C) GraÅžvydas "notaz" Ignotas, 2010-2012
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.
13 #include <sys/types.h>
16 #include <sys/ioctl.h>
22 #include "linux/fbdev.h"
23 #include "linux/xenv.h"
25 #define MIN(a, b) ( ((a) < (b)) ? (a) : (b) )
28 struct omapfb_plane_info pi;
29 struct omapfb_mem_info mi;
30 struct omapfb_plane_info pi_old;
31 struct omapfb_mem_info mi_old;
34 static const char *get_fb_device(void)
36 const char *fbname = getenv("SDL_FBDEV");
43 static int osdl_setup_omapfb(struct omapfb_state *ostate, int fd, int enabled,
44 int x, int y, int w, int h, int mem, int *buffer_count)
46 struct omapfb_plane_info pi;
47 struct omapfb_mem_info mi;
48 int mem_blocks = *buffer_count;
49 unsigned int size_cur;
52 memset(&pi, 0, sizeof(pi));
53 memset(&mi, 0, sizeof(mi));
55 ret = ioctl(fd, OMAPFB_QUERY_PLANE, &pi);
57 err_perror("QUERY_PLANE");
61 ret = ioctl(fd, OMAPFB_QUERY_MEM, &mi);
63 err_perror("QUERY_MEM");
68 /* must disable when changing stuff */
71 ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);
73 err_perror("SETUP_PLANE");
76 /* allocate more mem, if needed */
77 for (; size_cur < mem * mem_blocks && mem_blocks > 0; mem_blocks--) {
78 mi.size = mem * mem_blocks;
79 ret = ioctl(fd, OMAPFB_SETUP_MEM, &mi);
84 if (mem_blocks <= 0) {
85 err("failed to allocate at least %d bytes of vram:\n", mem);
86 err_perror("SETUP_MEM");
90 *buffer_count = mem_blocks;
98 ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);
100 err_perror("SETUP_PLANE");
101 err("(%d %d %d %d)\n", x, y, w, h);
110 static int read_sysfs(const char *fname, char *buff, size_t size)
115 f = fopen(fname, "r");
117 err_perror("open %s: ", fname);
121 ret = fread(buff, 1, size - 1, f);
124 err_perror("read %s: ", fname);
129 for (ret--; ret >= 0 && isspace(buff[ret]); ret--)
135 int read_vscreeninfo(const char *fbname, int *w, int *h)
137 struct fb_var_screeninfo fbvar;
140 fd = open(fbname, O_RDWR);
142 err_perror("open %s", fbname);
146 ret = ioctl(fd, FBIOGET_VSCREENINFO, &fbvar);
150 err_perror("ioctl %s", fbname);
154 if (fbvar.xres == 0 || fbvar.yres == 0)
162 int osdl_video_detect_screen(struct SDL_PrivateVideoData *pdata)
164 int fb_id, overlay_id = -1, screen_id = -1;
165 char buff[64], screen_name[64];
172 pdata->phys_w = pdata->phys_h = 0;
174 fbname = get_fb_device();
176 /* Figure out screen resolution, we need to know default resolution
177 * to report to SDL and for centering stuff.
178 * The only way to achieve this seems to be walking some sysfs files.. */
179 ret = stat(fbname, &status);
181 err_perror("can't stat %s", fbname);
184 fb_id = minor(status.st_rdev);
186 snprintf(buff, sizeof(buff), "/sys/class/graphics/fb%d/overlays", fb_id);
187 f = fopen(buff, "r");
189 err("can't open %s, skip screen detection", buff);
193 ret = fscanf(f, "%d", &overlay_id);
196 err("can't parse %s, skip screen detection", buff);
200 snprintf(buff, sizeof(buff), "/sys/devices/platform/omapdss/overlay%d/manager", overlay_id);
201 ret = read_sysfs(buff, screen_name, sizeof(screen_name));
203 err("skip screen detection");
208 snprintf(buff, sizeof(buff), "/sys/devices/platform/omapdss/display%d/name", i);
209 ret = read_sysfs(buff, buff, sizeof(buff));
213 if (strcmp(screen_name, buff) == 0) {
220 err("could not find screen");
224 snprintf(buff, sizeof(buff), "/sys/devices/platform/omapdss/display%d/timings", screen_id);
225 f = fopen(buff, "r");
227 err("can't open %s, skip screen detection", buff);
231 ret = fscanf(f, "%*d,%d/%*d/%*d/%*d,%d/%*d/%*d/%*d", &w, &h);
234 err("can't parse %s (%d), skip screen detection", buff, ret);
238 log("detected %dx%d '%s' (%d) screen attached to fb %d and overlay %d",
239 w, h, screen_name, screen_id, fb_id, overlay_id);
246 /* attempt to extract this from FB then */
247 ret = read_vscreeninfo(fbname, &pdata->phys_w, &pdata->phys_h);
248 if (ret != 0 && strcmp(fbname, "/dev/fb0") != 0) {
250 ret = read_vscreeninfo("/dev/fb0", &pdata->phys_w, &pdata->phys_h);
254 err("VSCREENINFO has nothing meaningful");
261 static int osdl_setup_omap_layer(struct SDL_PrivateVideoData *pdata,
262 const char *fbname, int width, int height, int bpp, int *buffer_count)
264 int x = 0, y = 0, w = width, h = height; /* layer size and pos */
265 int screen_w = w, screen_h = h;
271 pdata->layer_x = pdata->layer_y = pdata->layer_w = pdata->layer_h = 0;
273 if (pdata->phys_w != 0)
274 screen_w = pdata->phys_w;
275 if (pdata->phys_h != 0)
276 screen_h = pdata->phys_h;
278 fd = open(fbname, O_RDWR);
280 err_perror("open %s", fbname);
284 /* FIXME: assuming layer doesn't change here */
285 if (pdata->saved_layer == NULL) {
286 struct omapfb_state *slayer;
287 slayer = calloc(1, sizeof(*slayer));
291 ret = ioctl(fd, OMAPFB_QUERY_PLANE, &slayer->pi_old);
293 err_perror("QUERY_PLANE");
297 ret = ioctl(fd, OMAPFB_QUERY_MEM, &slayer->mi_old);
299 err_perror("QUERY_MEM");
303 pdata->saved_layer = slayer;
306 tmp = getenv("SDL_OMAP_LAYER_SIZE");
308 if (strcasecmp(tmp, "fullscreen") == 0) {
309 w = screen_w, h = screen_h;
311 else if (strcasecmp(tmp, "scaled") == 0) {
312 float factor = MIN(((float)screen_w) / width, ((float)screen_h) / height);
313 w = (int)(factor*width), h = (int)(factor*height);
315 else if (strcasecmp(tmp, "pixelperfect") == 0) {
316 float factor = MIN(((float)screen_w) / width, ((float)screen_h) / height);
317 w = ((int)factor) * width, h = ((int)factor) * height;
318 /* factor < 1.f => 0x0 layer, so fall back to 'scaled' */
320 w = (int)(factor * width), h = (int)(factor * height);
323 else if (sscanf(tmp, "%dx%d", &tmp_w, &tmp_h) == 2) {
324 w = tmp_w, h = tmp_h;
327 err("layer size specified incorrectly, "
328 "should be like 800x480");
332 /* the layer can't be set larger than screen */
333 tmp_w = w, tmp_h = h;
338 if (w != tmp_w || h != tmp_h)
339 log("layer resized %dx%d -> %dx%d to fit screen", tmp_w, tmp_h, w, h);
341 x = screen_w / 2 - w / 2;
342 y = screen_h / 2 - h / 2;
343 ret = osdl_setup_omapfb(pdata->saved_layer, fd, 1, x, y, w, h,
344 width * height * ((bpp + 7) / 8), buffer_count);
358 void *osdl_video_set_mode(struct SDL_PrivateVideoData *pdata,
359 int border_l, int border_r, int border_t, int border_b,
360 int width, int height, int bpp, int *doublebuf,
361 const char *wm_title)
363 int buffers_try, buffers_set;
368 fbname = get_fb_device();
370 if (pdata->fbdev != NULL) {
371 vout_fbdev_finish(pdata->fbdev);
375 buffers_try = buffers_set = 1;
377 /* actually try tripple buffering for reduced chance of tearing */
378 buffers_try = buffers_set = 3;
380 ret = osdl_setup_omap_layer(pdata, fbname, width, height, bpp, &buffers_set);
384 pdata->fbdev = vout_fbdev_init(fbname, &width, &height, bpp, buffers_set);
385 if (pdata->fbdev == NULL)
388 if (border_l | border_r | border_t | border_b) {
389 width -= border_l + border_r;
390 height -= border_t + border_b;
391 result = vout_fbdev_resize(pdata->fbdev, width, height, bpp,
392 border_l, border_r, border_t, border_b, buffers_set);
395 result = osdl_video_flip(pdata);
400 if (!pdata->xenv_up) {
401 int xenv_flags = XENV_CAP_KEYS | XENV_CAP_MOUSE;
402 ret = xenv_init(&xenv_flags, wm_title);
405 pdata->xenv_mouse = (xenv_flags & XENV_CAP_MOUSE) ? 1 : 0;
409 if (buffers_try != buffers_set) {
410 log("only %d/%d buffers available, expect tearing\n",
411 buffers_set, buffers_try);
412 *doublebuf = buffers_set > 1;
418 osdl_video_finish(pdata);
422 void *osdl_video_flip(struct SDL_PrivateVideoData *pdata)
426 if (pdata->fbdev == NULL)
429 ret = vout_fbdev_flip(pdata->fbdev);
431 if (pdata->cfg_force_vsync)
432 vout_fbdev_wait_vsync(pdata->fbdev);
437 int osdl_video_pause(struct SDL_PrivateVideoData *pdata, int is_pause)
439 struct omapfb_state *state = pdata->saved_layer;
440 struct omapfb_plane_info pi;
441 struct omapfb_mem_info mi;
446 if (pdata->fbdev != NULL)
447 fd = vout_fbdev_get_fd(pdata->fbdev);
449 err("bad fd %d", fd);
453 err("missing layer state\n");
458 ret = vout_fbdev_save(pdata->fbdev);
463 enabled = pi.enabled;
470 ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);
472 err_perror("SETUP_PLANE");
476 ret = ioctl(fd, OMAPFB_SETUP_MEM, &mi);
478 err_perror("SETUP_MEM");
481 ret = vout_fbdev_restore(pdata->fbdev);
483 err("fbdev_restore failed\n");
490 ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);
492 err_perror("SETUP_PLANE");
500 void osdl_video_finish(struct SDL_PrivateVideoData *pdata)
502 static const char *fbname;
504 fbname = get_fb_device();
505 if (pdata->fbdev != NULL) {
506 vout_fbdev_finish(pdata->fbdev);
510 /* restore the OMAP layer */
511 if (pdata->saved_layer != NULL) {
512 struct omapfb_state *slayer = pdata->saved_layer;
515 fd = open(fbname, O_RDWR);
517 int enabled = slayer->pi_old.enabled;
519 /* be sure to disable while setting up */
520 slayer->pi_old.enabled = 0;
521 ioctl(fd, OMAPFB_SETUP_PLANE, &slayer->pi_old);
522 ioctl(fd, OMAPFB_SETUP_MEM, &slayer->mi_old);
524 slayer->pi_old.enabled = enabled;
525 ioctl(fd, OMAPFB_SETUP_PLANE, &slayer->pi_old);
530 pdata->saved_layer = NULL;
533 if (pdata->xenv_up) {