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