src/video/omapdss/osdl_video.c

   1 /*
   2  * (C) Gražvydas "notaz" Ignotas, 2010-2011
   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"
  23 #include "linux/xenv.h"
  24
  25 struct omapfb_saved_layer {
  26         struct omapfb_plane_info pi;
  27         struct omapfb_mem_info mi;
  28 };
  29
  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
  39 static int osdl_setup_omapfb(int fd, int enabled, int x, int y, int w, int h, int mem)
  40 {
  41         struct omapfb_plane_info pi;
  42         struct omapfb_mem_info mi;
  43         int ret;
  44
  45         ret = ioctl(fd, OMAPFB_QUERY_PLANE, &pi);
  46         if (ret != 0) {
  47                 err_perror("QUERY_PLANE");
  48                 return -1;
  49         }
  50
  51         ret = ioctl(fd, OMAPFB_QUERY_MEM, &mi);
  52         if (ret != 0) {
  53                 err_perror("QUERY_MEM");
  54                 return -1;
  55         }
  56
  57         /* must disable when changing stuff */
  58         if (pi.enabled) {
  59                 pi.enabled = 0;
  60                 ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);
  61                 if (ret != 0)
  62                         err_perror("SETUP_PLANE");
  63         }
  64
  65         if (mi.size < mem) {
  66                 mi.size = mem;
  67                 ret = ioctl(fd, OMAPFB_SETUP_MEM, &mi);
  68                 if (ret != 0) {
  69                         err_perror("SETUP_MEM");
  70                         return -1;
  71                 }
  72         }
  73
  74         pi.pos_x = x;
  75         pi.pos_y = y;
  76         pi.out_width = w;
  77         pi.out_height = h;
  78         pi.enabled = enabled;
  79
  80         ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);
  81         if (ret != 0) {
  82                 err_perror("SETUP_PLANE");
  83                 err("(%d %d %d %d)\n", x, y, w, h);
  84                 return -1;
  85         }
  86
  87         return 0;
  88 }
  89
  90 static int read_sysfs(const char *fname, char *buff, size_t size)
  91 {
  92         FILE *f;
  93         int ret;
  94
  95         f = fopen(fname, "r");
  96         if (f == NULL) {
  97                 err_perror("open %s: ", fname);
  98                 return -1;
  99         }
 100
 101         ret = fread(buff, 1, size - 1, f);
 102         fclose(f);
 103         if (ret <= 0) {
 104                 err_perror("read %s: ", fname);
 105                 return -1;
 106         }
 107
 108         buff[ret] = 0;
 109         for (ret--; ret >= 0 && isspace(buff[ret]); ret--)
 110                 buff[ret] = 0;
 111
 112         return 0;
 113 }
 114
 115 int osdl_video_detect_screen(struct SDL_PrivateVideoData *pdata)
 116 {
 117         int fb_id, overlay_id = -1, screen_id = -1;
 118         struct fb_var_screeninfo fbvar;
 119         char buff[64], screen_name[64];
 120         const char *fbname;
 121         struct stat status;
 122         int fd, i, ret;
 123         int w, h;
 124         FILE *f;
 125
 126         fbname = get_fb_device();
 127
 128         /* Figure out screen resolution, we need to know default resolution
 129          * to report to SDL and for centering stuff.
 130          * The only way to achieve this seems to be walking some sysfs files.. */
 131         ret = stat(fbname, &status);
 132         if (ret != 0) {
 133                 err_perror("can't stat %s", fbname);
 134                 goto skip_screen;
 135         }
 136         fb_id = minor(status.st_rdev);
 137
 138         snprintf(buff, sizeof(buff), "/sys/class/graphics/fb%d/overlays", fb_id);
 139         f = fopen(buff, "r");
 140         if (f == NULL) {
 141                 err("can't open %s, skip screen detection", buff);
 142                 goto skip_screen;
 143         }
 144
 145         ret = fscanf(f, "%d", &overlay_id);
 146         fclose(f);
 147         if (ret != 1) {
 148                 err("can't parse %s, skip screen detection", buff);
 149                 goto skip_screen;
 150         }
 151
 152         snprintf(buff, sizeof(buff), "/sys/devices/platform/omapdss/overlay%d/manager", overlay_id);
 153         ret = read_sysfs(buff, screen_name, sizeof(screen_name));
 154         if (ret < 0) {
 155                 err("skip screen detection");
 156                 goto skip_screen;
 157         }
 158
 159         for (i = 0; ; i++) {
 160                 snprintf(buff, sizeof(buff), "/sys/devices/platform/omapdss/display%d/name", i);
 161                 ret = read_sysfs(buff, buff, sizeof(buff));
 162                 if (ret < 0)
 163                         break;
 164
 165                 if (strcmp(screen_name, buff) == 0) {
 166                         screen_id = i;
 167                         break;
 168                 }
 169         }
 170
 171         if (screen_id < 0) {
 172                 err("could not find screen");
 173                 goto skip_screen;
 174         }
 175
 176         snprintf(buff, sizeof(buff), "/sys/devices/platform/omapdss/display%d/timings", screen_id);
 177         f = fopen(buff, "r");
 178         if (f == NULL) {
 179                 err("can't open %s, skip screen detection", buff);
 180                 goto skip_screen;
 181         }
 182
 183         ret = fscanf(f, "%*d,%d/%*d/%*d/%*d,%d/%*d/%*d/%*d", &w, &h);
 184         fclose(f);
 185         if (ret != 2) {
 186                 err("can't parse %s (%d), skip screen detection", buff, ret);
 187                 goto skip_screen;
 188         }
 189
 190         log("detected %dx%d '%s' (%d) screen attached to fb %d and overlay %d",
 191                 w, h, screen_name, screen_id, fb_id, overlay_id);
 192
 193         pdata->screen_w = w;
 194         pdata->screen_h = h;
 195         return 0;
 196
 197 skip_screen:
 198         /* attempt to extract this from FB then */
 199         fd = open(fbname, O_RDWR);
 200         if (fd == -1) {
 201                 err_perror("open %s", fbname);
 202                 return -1;
 203         }
 204
 205         ret = ioctl(fd, FBIOGET_VSCREENINFO, &fbvar);
 206         close(fd);
 207         if (ret == -1) {
 208                 err_perror("ioctl %s", fbname);
 209                 return -1;
 210         }
 211
 212         if (fbvar.xres == 0 || fbvar.yres == 0) {
 213                 err("VSCREENINFO has nothing meaningful");
 214                 return -1;
 215         }
 216
 217         pdata->screen_w = fbvar.xres;
 218         pdata->screen_h = fbvar.yres;
 219         return 0;
 220 }
 221
 222 static int osdl_setup_omap_layer(struct SDL_PrivateVideoData *pdata,
 223                 const char *fbname, int width, int height, int bpp)
 224 {
 225         int x = 0, y = 0, w = width, h = height; /* layer size and pos */
 226         int screen_w = w, screen_h = h;
 227         int tmp_w, tmp_h;
 228         const char *tmp;
 229         int ret, fd;
 230
 231         if (pdata->screen_w != 0)
 232                 screen_w = pdata->screen_w;
 233         if (pdata->screen_h != 0)
 234                 screen_h = pdata->screen_h;
 235
 236         fd = open(fbname, O_RDWR);
 237         if (fd == -1) {
 238                 err_perror("open %s", fbname);
 239                 return -1;
 240         }
 241
 242         /* FIXME: assuming layer doesn't change here */
 243         if (pdata->saved_layer == NULL) {
 244                 struct omapfb_saved_layer *slayer;
 245                 slayer = calloc(1, sizeof(*slayer));
 246                 if (slayer == NULL)
 247                         return -1;
 248
 249                 ret = ioctl(fd, OMAPFB_QUERY_PLANE, &slayer->pi);
 250                 if (ret != 0) {
 251                         err_perror("QUERY_PLANE");
 252                         return -1;
 253                 }
 254
 255                 ret = ioctl(fd, OMAPFB_QUERY_MEM, &slayer->mi);
 256                 if (ret != 0) {
 257                         err_perror("QUERY_MEM");
 258                         return -1;
 259                 }
 260
 261                 pdata->saved_layer = slayer;
 262         }
 263
 264         tmp = getenv("SDL_OMAP_LAYER_SIZE");
 265         if (tmp != NULL) {
 266                 if (strcasecmp(tmp, "fullscreen") == 0)
 267                         w = screen_w, h = screen_h;
 268                 else if (sscanf(tmp, "%dx%d", &tmp_w, &tmp_h) == 2)
 269                         w = tmp_w, h = tmp_h;
 270                 else
 271                         err("layer size specified incorrectly, "
 272                                 "should be like 800x480");
 273         }
 274         else {
 275                 /* the layer can't be set larger than screen */
 276                 tmp_w = w, tmp_h = h;
 277                 if (w > screen_w)
 278                         w = screen_w;
 279                 if (h > screen_h)
 280                         h = screen_h;
 281                 if (w != tmp_w || h != tmp_h)
 282                         log("layer resized %dx%d -> %dx%d to fit screen", tmp_w, tmp_h, w, h);
 283         }
 284
 285         x = screen_w / 2 - w / 2;
 286         y = screen_h / 2 - h / 2;
 287         ret = osdl_setup_omapfb(fd, 1, x, y, w, h, width * height * ((bpp + 7) / 8) * 2);
 288         close(fd);
 289
 290         return ret;
 291 }
 292
 293 int osdl_video_set_mode(struct SDL_PrivateVideoData *pdata,
 294                         int width, int height, int bpp, int doublebuf)
 295 {
 296         const char *fbname;
 297         int ret;
 298
 299         fbname = get_fb_device();
 300
 301         if (pdata->fbdev != NULL) {
 302                 vout_fbdev_finish(pdata->fbdev);
 303                 pdata->fbdev = NULL;
 304         }
 305
 306         ret = osdl_setup_omap_layer(pdata, fbname, width, height, bpp);
 307         if (ret < 0)
 308                 return -1;
 309
 310         pdata->fbdev = vout_fbdev_init(fbname, &width, &height, bpp, doublebuf ? 2 : 1);
 311         if (pdata->fbdev == NULL)
 312                 return -1;
 313
 314         if (!pdata->xenv_up) {
 315                 ret = xenv_init();
 316                 if (ret == 0)
 317                         pdata->xenv_up = 1;
 318         }
 319
 320         return 0;
 321 }
 322
 323 void *osdl_video_flip(struct SDL_PrivateVideoData *pdata)
 324 {
 325         if (pdata->fbdev == NULL)
 326                 return NULL;
 327
 328         if (gcfg_force_vsync)
 329                 vout_fbdev_wait_vsync(pdata->fbdev);
 330
 331         return vout_fbdev_flip(pdata->fbdev);
 332 }
 333
 334 void osdl_video_finish(struct SDL_PrivateVideoData *pdata)
 335 {
 336         static const char *fbname;
 337
 338         fbname = get_fb_device();
 339         if (pdata->fbdev != NULL) {
 340                 vout_fbdev_finish(pdata->fbdev);
 341                 pdata->fbdev = NULL;
 342         }
 343
 344         /* restore the OMAP layer */
 345         if (pdata->saved_layer != NULL) {
 346                 struct omapfb_saved_layer *slayer = pdata->saved_layer;
 347                 int fd;
 348
 349                 fd = open(fbname, O_RDWR);
 350                 if (fd != -1) {
 351                         int enabled = slayer->pi.enabled;
 352
 353                         /* be sure to disable while setting up */
 354                         slayer->pi.enabled = 0;
 355                         ioctl(fd, OMAPFB_SETUP_PLANE, &slayer->pi);
 356                         ioctl(fd, OMAPFB_SETUP_MEM, &slayer->mi);
 357                         if (enabled) {
 358                                 slayer->pi.enabled = enabled;
 359                                 ioctl(fd, OMAPFB_SETUP_PLANE, &slayer->pi);
 360                         }
 361                         close(fd);
 362                 }
 363                 free(slayer);
 364                 pdata->saved_layer = NULL;
 365         }
 366
 367         if (pdata->xenv_up) {
 368                 xenv_finish();
 369                 pdata->xenv_up = 0;
 370         }
 371 }
 372