libvo/vo_fbdev2.c

   1 /*
   2  * video driver for framebuffer device
   3  * copyright (C) 2003 Joey Parrish <joey@nicewarrior.org>
   4  *
   5  * This file is part of MPlayer.
   6  *
   7  * MPlayer is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License as published by
   9  * the Free Software Foundation; either version 2 of the License, or
  10  * (at your option) any later version.
  11  *
  12  * MPlayer is distributed in the hope that it will be useful,
  13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  * GNU General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License along
  18  * with MPlayer; if not, write to the Free Software Foundation, Inc.,
  19  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  20  */
  21
  22 #include <stdio.h>
  23 #include <stdlib.h>
  24 #include <string.h>
  25 #include <fcntl.h>
  26 #include <unistd.h>
  27 #include <errno.h>
  28
  29 #include <sys/mman.h>
  30 #include <sys/ioctl.h>
  31 #include <linux/fb.h>
  32
  33 #include "config.h"
  34 #include "video_out.h"
  35 #include "video_out_internal.h"
  36 #include "fastmemcpy.h"
  37 #include "sub.h"
  38 #include "mp_msg.h"
  39
  40 static const vo_info_t info = {
  41         "Framebuffer Device",
  42         "fbdev2",
  43         "Joey Parrish <joey@nicewarrior.org>",
  44         ""
  45 };
  46
  47 const LIBVO_EXTERN(fbdev2)
  48
  49 static void set_bpp(struct fb_var_screeninfo *p, int bpp)
  50 {
  51         p->bits_per_pixel = (bpp + 1) & ~1;
  52         p->red.msb_right = p->green.msb_right = p->blue.msb_right = p->transp.msb_right = 0;
  53         p->transp.offset = p->transp.length = 0;
  54         p->blue.offset = 0;
  55         switch (bpp) {
  56                 case 32:
  57                         p->transp.offset = 24;
  58                         p->transp.length = 8;
  59                 case 24:
  60                         p->red.offset = 16;
  61                         p->red.length = 8;
  62                         p->green.offset = 8;
  63                         p->green.length = 8;
  64                         p->blue.length = 8;
  65                         break;
  66                 case 16:
  67                         p->red.offset = 11;
  68                         p->green.length = 6;
  69                         p->red.length = 5;
  70                         p->green.offset = 5;
  71                         p->blue.length = 5;
  72                         break;
  73                 case 15:
  74                         p->red.offset = 10;
  75                         p->green.length = 5;
  76                         p->red.length = 5;
  77                         p->green.offset = 5;
  78                         p->blue.length = 5;
  79                         break;
  80         }
  81 }
  82
  83 static char *fb_dev_name = NULL; // such as /dev/fb0
  84 static int fb_dev_fd; // handle for fb_dev_name
  85 static uint8_t *frame_buffer = NULL; // mmap'd access to fbdev
  86 static uint8_t *center = NULL; // where to begin writing our image (centered?)
  87 static struct fb_fix_screeninfo fb_finfo; // fixed info
  88 static struct fb_var_screeninfo fb_vinfo; // variable info
  89 static struct fb_var_screeninfo fb_orig_vinfo; // variable info to restore later
  90 static unsigned short fb_ored[256], fb_ogreen[256], fb_oblue[256];
  91 static struct fb_cmap fb_oldcmap = { 0, 256, fb_ored, fb_ogreen, fb_oblue };
  92 static int fb_cmap_changed = 0; //  to restore map
  93 static int fb_pixel_size;       // 32:  4  24:  3  16:  2  15:  2
  94 static int fb_bpp;              // 32: 32  24: 24  16: 16  15: 15
  95 static size_t fb_size; // size of frame_buffer
  96 static int fb_line_len; // length of one line in bytes
  97 static void (*draw_alpha_p)(int w, int h, unsigned char *src,
  98                 unsigned char *srca, int stride, unsigned char *dst,
  99                 int dstride);
 100
 101 static uint8_t *next_frame = NULL; // for double buffering
 102 static int in_width;
 103 static int in_height;
 104 static int out_width;
 105 static int out_height;
 106
 107 static struct fb_cmap *make_directcolor_cmap(struct fb_var_screeninfo *var)
 108 {
 109   int i, cols, rcols, gcols, bcols;
 110   uint16_t *red, *green, *blue;
 111   struct fb_cmap *cmap;
 112
 113   rcols = 1 << var->red.length;
 114   gcols = 1 << var->green.length;
 115   bcols = 1 << var->blue.length;
 116
 117   /* Make our palette the length of the deepest color */
 118   cols = (rcols > gcols ? rcols : gcols);
 119   cols = (cols > bcols ? cols : bcols);
 120
 121   red = malloc(cols * sizeof(red[0]));
 122   if(!red) {
 123           mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't allocate red palette with %d entries.\n", cols);
 124           return NULL;
 125   }
 126   for(i=0; i< rcols; i++)
 127     red[i] = (65535/(rcols-1)) * i;
 128
 129   green = malloc(cols * sizeof(green[0]));
 130   if(!green) {
 131           mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't allocate green palette with %d entries.\n", cols);
 132           free(red);
 133           return NULL;
 134   }
 135   for(i=0; i< gcols; i++)
 136     green[i] = (65535/(gcols-1)) * i;
 137
 138   blue = malloc(cols * sizeof(blue[0]));
 139   if(!blue) {
 140           mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't allocate blue palette with %d entries.\n", cols);
 141           free(red);
 142           free(green);
 143           return NULL;
 144   }
 145   for(i=0; i< bcols; i++)
 146     blue[i] = (65535/(bcols-1)) * i;
 147
 148   cmap = malloc(sizeof(struct fb_cmap));
 149   if(!cmap) {
 150           mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't allocate color map\n");
 151           free(red);
 152           free(green);
 153           free(blue);
 154           return NULL;
 155   }
 156   cmap->start = 0;
 157   cmap->transp = 0;
 158   cmap->len = cols;
 159   cmap->red = red;
 160   cmap->blue = blue;
 161   cmap->green = green;
 162   cmap->transp = NULL;
 163
 164   return cmap;
 165 }
 166
 167 static int fb_preinit(int reset)
 168 {
 169         static int fb_preinit_done = 0;
 170         static int fb_err = -1;
 171
 172         if (reset) {
 173                 fb_preinit_done = 0;
 174                 return 0;
 175         }
 176
 177         if (fb_preinit_done)
 178                 return fb_err;
 179         fb_preinit_done = 1;
 180
 181         if (!fb_dev_name && !(fb_dev_name = getenv("FRAMEBUFFER")))
 182                 fb_dev_name = strdup("/dev/fb0");
 183
 184         mp_msg(MSGT_VO, MSGL_V, "[fbdev2] Using device %s\n", fb_dev_name);
 185
 186         if ((fb_dev_fd = open(fb_dev_name, O_RDWR)) == -1) {
 187                 mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't open %s: %s\n", fb_dev_name, strerror(errno));
 188                 goto err_out;
 189         }
 190         if (ioctl(fb_dev_fd, FBIOGET_VSCREENINFO, &fb_vinfo)) {
 191                 mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't get VSCREENINFO: %s\n", strerror(errno));
 192                 goto err_out;
 193         }
 194         fb_orig_vinfo = fb_vinfo;
 195
 196         fb_bpp = fb_vinfo.bits_per_pixel;
 197
 198         /* 16 and 15 bpp is reported as 16 bpp */
 199         if (fb_bpp == 16)
 200                 fb_bpp = fb_vinfo.red.length + fb_vinfo.green.length +
 201                         fb_vinfo.blue.length;
 202
 203         fb_err = 0;
 204         return 0;
 205 err_out:
 206         if (fb_dev_fd >= 0) close(fb_dev_fd);
 207         fb_dev_fd = -1;
 208         fb_err = -1;
 209         return -1;
 210 }
 211
 212 static int preinit(const char *subdevice)
 213 {
 214         if (subdevice)
 215         {
 216             if (fb_dev_name) free(fb_dev_name);
 217             fb_dev_name = strdup(subdevice);
 218         }
 219         return fb_preinit(0);
 220 }
 221
 222 static int config(uint32_t width, uint32_t height, uint32_t d_width,
 223                 uint32_t d_height, uint32_t flags, char *title,
 224                 uint32_t format)
 225 {
 226         struct fb_cmap *cmap;
 227         int fs = flags & VOFLAG_FULLSCREEN;
 228
 229         out_width = width;
 230         out_height = height;
 231         in_width = width;
 232         in_height = height;
 233
 234         if (fs) {
 235                 out_width = fb_vinfo.xres;
 236                 out_height = fb_vinfo.yres;
 237         }
 238
 239         if (out_width < in_width || out_height < in_height) {
 240                 mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Screensize is smaller than video size (%dx%d < %dx%d)\n",
 241                     out_width, out_height, in_width, in_height);
 242                 return 1;
 243         }
 244
 245         switch (fb_bpp) {
 246                 case 32: draw_alpha_p = vo_draw_alpha_rgb32; break;
 247                 case 24: draw_alpha_p = vo_draw_alpha_rgb24; break;
 248                 case 16: draw_alpha_p = vo_draw_alpha_rgb16; break;
 249                 case 15: draw_alpha_p = vo_draw_alpha_rgb15; break;
 250                 default: return 1;
 251         }
 252
 253         if (vo_config_count == 0) {
 254                 if (ioctl(fb_dev_fd, FBIOGET_FSCREENINFO, &fb_finfo)) {
 255                         mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't get FSCREENINFO: %s\n", strerror(errno));
 256                         return 1;
 257                 }
 258
 259                 if (fb_finfo.type != FB_TYPE_PACKED_PIXELS) {
 260                         mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] type %d not supported\n", fb_finfo.type);
 261                         return 1;
 262                 }
 263
 264                 switch (fb_finfo.visual) {
 265                         case FB_VISUAL_TRUECOLOR:
 266                                 break;
 267                         case FB_VISUAL_DIRECTCOLOR:
 268                                 mp_msg(MSGT_VO, MSGL_V, "[fbdev2] creating cmap for directcolor\n");
 269                                 if (ioctl(fb_dev_fd, FBIOGETCMAP, &fb_oldcmap)) {
 270                                         mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] can't get cmap: %s\n", strerror(errno));
 271                                         return 1;
 272                                 }
 273                                 if (!(cmap = make_directcolor_cmap(&fb_vinfo)))
 274                                         return 1;
 275                                 if (ioctl(fb_dev_fd, FBIOPUTCMAP, cmap)) {
 276                                         mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] can't put cmap: %s\n", strerror(errno));
 277                                         return 1;
 278                                 }
 279                                 fb_cmap_changed = 1;
 280                                 free(cmap->red);
 281                                 free(cmap->green);
 282                                 free(cmap->blue);
 283                                 free(cmap);
 284                                 break;
 285                         default:
 286                                 mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] visual: %d not yet supported\n", fb_finfo.visual);
 287                                 return 1;
 288                 }
 289
 290                 fb_size = fb_finfo.smem_len;
 291                 fb_line_len = fb_finfo.line_length;
 292                 if ((frame_buffer = (uint8_t *) mmap(0, fb_size, PROT_READ | PROT_WRITE, MAP_SHARED, fb_dev_fd, 0)) == (uint8_t *) -1) {
 293                         mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't mmap %s: %s\n", fb_dev_name, strerror(errno));
 294                         return 1;
 295                 }
 296         }
 297
 298         center = frame_buffer +
 299                  ( (out_width - in_width) / 2 ) * fb_pixel_size +
 300                  ( (out_height - in_height) / 2 ) * fb_line_len;
 301
 302 #ifndef USE_CONVERT2FB
 303         if (!(next_frame = (uint8_t *) realloc(next_frame, in_width * in_height * fb_pixel_size))) {
 304                 mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't malloc next_frame: %s\n", strerror(errno));
 305                 return 1;
 306         }
 307 #endif
 308         if (fs) memset(frame_buffer, '\0', fb_line_len * fb_vinfo.yres);
 309
 310         return 0;
 311 }
 312
 313 static int query_format(uint32_t format)
 314 {
 315         // open the device, etc.
 316         if (fb_preinit(0)) return 0;
 317         if ((format & IMGFMT_BGR_MASK) == IMGFMT_BGR) {
 318                 int fb_target_bpp = format & 0xff;
 319                 set_bpp(&fb_vinfo, fb_target_bpp);
 320                 fb_vinfo.xres_virtual = fb_vinfo.xres;
 321                 fb_vinfo.yres_virtual = fb_vinfo.yres;
 322                 if (ioctl(fb_dev_fd, FBIOPUT_VSCREENINFO, &fb_vinfo)) {
 323                         mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't put VSCREENINFO: %s\n", strerror(errno));
 324                         return 0;
 325                 }
 326                 fb_pixel_size = fb_vinfo.bits_per_pixel / 8;
 327                 fb_bpp = fb_vinfo.red.length + fb_vinfo.green.length +
 328                         fb_vinfo.blue.length + fb_vinfo.transp.length;
 329                 if (fb_bpp == fb_target_bpp)
 330                         return VFCAP_CSP_SUPPORTED|VFCAP_CSP_SUPPORTED_BY_HW|VFCAP_ACCEPT_STRIDE;
 331         }
 332         return 0;
 333 }
 334
 335 static void draw_alpha(int x0, int y0, int w, int h, unsigned char *src,
 336                 unsigned char *srca, int stride)
 337 {
 338         unsigned char *dst;
 339         int dstride;
 340
 341 #ifdef USE_CONVERT2FB
 342         dst = center + (fb_line_len * y0) + (x0 * fb_pixel_size);
 343         dstride = fb_line_len;
 344 #else
 345         dst = next_frame + (in_width * y0 + x0) * fb_pixel_size;
 346         dstride = in_width * fb_pixel_size;
 347 #endif
 348         (*draw_alpha_p)(w, h, src, srca, stride, dst, dstride);
 349 }
 350
 351 static void draw_osd(void)
 352 {
 353         vo_draw_text(in_width, in_height, draw_alpha);
 354 }
 355
 356 // all csp support stride
 357 static int draw_frame(uint8_t *src[]) { return 1; }
 358
 359 static int draw_slice(uint8_t *src[], int stride[], int w, int h, int x, int y)
 360 {
 361         uint8_t *in = src[0];
 362 #ifdef USE_CONVERT2FB
 363         uint8_t *dest = center + (fb_line_len * y) + (x * fb_pixel_size);
 364         int next = fb_line_len;
 365 #else
 366         uint8_t *dest = next_frame + (in_width * y + x) * fb_pixel_size;
 367         int next = in_width * fb_pixel_size;
 368 #endif
 369         int i;
 370
 371         for (i = 0; i < h; i++) {
 372                 fast_memcpy(dest, in, w * fb_pixel_size);
 373                 dest += next;
 374                 in += stride[0];
 375         }
 376         return 0;
 377 }
 378
 379 static void check_events(void)
 380 {
 381 }
 382
 383 static void flip_page(void)
 384 {
 385 #ifndef USE_CONVERT2FB
 386         int i, out_offset = 0, in_offset = 0;
 387
 388         for (i = 0; i < in_height; i++) {
 389                 fast_memcpy(center + out_offset, next_frame + in_offset,
 390                                 in_width * fb_pixel_size);
 391                 out_offset += fb_line_len;
 392                 in_offset += in_width * fb_pixel_size;
 393         }
 394 #endif
 395 }
 396
 397 static void uninit(void)
 398 {
 399         if (fb_cmap_changed) {
 400                 if (ioctl(fb_dev_fd, FBIOPUTCMAP, &fb_oldcmap))
 401                         mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't restore original cmap\n");
 402                 fb_cmap_changed = 0;
 403         }
 404         if(next_frame) free(next_frame);
 405         if (fb_dev_fd >= 0) {
 406                 if (ioctl(fb_dev_fd, FBIOPUT_VSCREENINFO, &fb_orig_vinfo))
 407                         mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't reset original fb_var_screeninfo: %s\n", strerror(errno));
 408                 close(fb_dev_fd);
 409                 fb_dev_fd = -1;
 410         }
 411         if(frame_buffer) munmap(frame_buffer, fb_size);
 412         next_frame = frame_buffer = NULL;
 413         fb_preinit(1); // so that later calls to preinit don't fail
 414 }
 415
 416 static int control(uint32_t request, void *data, ...)
 417 {
 418   switch (request) {
 419   case VOCTRL_QUERY_FORMAT:
 420     return query_format(*((uint32_t*)data));
 421   }
 422   return VO_NOTIMPL;
 423 }