mirror of https://github.com/mpv-player/mpv
405 lines
10 KiB
C
405 lines
10 KiB
C
/*
|
|
* Video driver for Framebuffer device
|
|
* by Joey Parrish <joey@nicewarrior.org>
|
|
* (C) 2003
|
|
*/
|
|
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <fcntl.h>
|
|
#include <unistd.h>
|
|
#include <errno.h>
|
|
|
|
#include <sys/mman.h>
|
|
#include <sys/ioctl.h>
|
|
#include <linux/fb.h>
|
|
|
|
#include "config.h"
|
|
#include "video_out.h"
|
|
#include "video_out_internal.h"
|
|
#include "fastmemcpy.h"
|
|
#include "mp_msg.h"
|
|
|
|
static vo_info_t info = {
|
|
"Framebuffer Device",
|
|
"fbdev2",
|
|
"Joey Parrish <joey@nicewarrior.org>",
|
|
""
|
|
};
|
|
|
|
LIBVO_EXTERN(fbdev2)
|
|
|
|
static void set_bpp(struct fb_var_screeninfo *p, int bpp)
|
|
{
|
|
p->bits_per_pixel = (bpp + 1) & ~1;
|
|
p->red.msb_right = p->green.msb_right = p->blue.msb_right = p->transp.msb_right = 0;
|
|
p->transp.offset = p->transp.length = 0;
|
|
p->blue.offset = 0;
|
|
switch (bpp) {
|
|
case 32:
|
|
p->transp.offset = 24;
|
|
p->transp.length = 8;
|
|
case 24:
|
|
p->red.offset = 16;
|
|
p->red.length = 8;
|
|
p->green.offset = 8;
|
|
p->green.length = 8;
|
|
p->blue.length = 8;
|
|
break;
|
|
case 16:
|
|
p->red.offset = 11;
|
|
p->green.length = 6;
|
|
p->red.length = 5;
|
|
p->green.offset = 5;
|
|
p->blue.length = 5;
|
|
break;
|
|
case 15:
|
|
p->red.offset = 10;
|
|
p->green.length = 5;
|
|
p->red.length = 5;
|
|
p->green.offset = 5;
|
|
p->blue.length = 5;
|
|
break;
|
|
}
|
|
}
|
|
|
|
static char *fb_dev_name = NULL; // such as /dev/fb0
|
|
static int fb_dev_fd; // handle for fb_dev_name
|
|
static uint8_t *frame_buffer = NULL; // mmap'd access to fbdev
|
|
static uint8_t *center = NULL; // where to begin writing our image (centered?)
|
|
static struct fb_fix_screeninfo fb_finfo; // fixed info
|
|
static struct fb_var_screeninfo fb_vinfo; // variable info
|
|
static struct fb_var_screeninfo fb_orig_vinfo; // variable info to restore later
|
|
static struct fb_cmap fb_oldcmap; // cmap to restore later
|
|
static int fb_cmap_changed = 0; // to restore map
|
|
static int fb_pixel_size; // 32: 4 24: 3 16: 2 15: 2
|
|
static int fb_bpp; // 32: 32 24: 24 16: 16 15: 15
|
|
static size_t fb_size; // size of frame_buffer
|
|
static int fb_line_len; // length of one line in bytes
|
|
static void (*draw_alpha_p)(int w, int h, unsigned char *src,
|
|
unsigned char *srca, int stride, unsigned char *dst,
|
|
int dstride);
|
|
|
|
static uint8_t *next_frame = NULL; // for double buffering
|
|
static int in_width;
|
|
static int in_height;
|
|
static int out_width;
|
|
static int out_height;
|
|
|
|
static struct fb_cmap *make_directcolor_cmap(struct fb_var_screeninfo *var)
|
|
{
|
|
int i, cols, rcols, gcols, bcols;
|
|
uint16_t *red, *green, *blue;
|
|
struct fb_cmap *cmap;
|
|
|
|
rcols = 1 << var->red.length;
|
|
gcols = 1 << var->green.length;
|
|
bcols = 1 << var->blue.length;
|
|
|
|
/* Make our palette the length of the deepest color */
|
|
cols = (rcols > gcols ? rcols : gcols);
|
|
cols = (cols > bcols ? cols : bcols);
|
|
|
|
red = malloc(cols * sizeof(red[0]));
|
|
if(!red) {
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't allocate red palette with %d entries.\n", cols);
|
|
return NULL;
|
|
}
|
|
for(i=0; i< rcols; i++)
|
|
red[i] = (65535/(rcols-1)) * i;
|
|
|
|
green = malloc(cols * sizeof(green[0]));
|
|
if(!green) {
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't allocate green palette with %d entries.\n", cols);
|
|
free(red);
|
|
return NULL;
|
|
}
|
|
for(i=0; i< gcols; i++)
|
|
green[i] = (65535/(gcols-1)) * i;
|
|
|
|
blue = malloc(cols * sizeof(blue[0]));
|
|
if(!blue) {
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't allocate blue palette with %d entries.\n", cols);
|
|
free(red);
|
|
free(green);
|
|
return NULL;
|
|
}
|
|
for(i=0; i< bcols; i++)
|
|
blue[i] = (65535/(bcols-1)) * i;
|
|
|
|
cmap = malloc(sizeof(struct fb_cmap));
|
|
if(!cmap) {
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't allocate color map\n");
|
|
free(red);
|
|
free(green);
|
|
free(blue);
|
|
return NULL;
|
|
}
|
|
cmap->start = 0;
|
|
cmap->transp = 0;
|
|
cmap->len = cols;
|
|
cmap->red = red;
|
|
cmap->blue = blue;
|
|
cmap->green = green;
|
|
cmap->transp = NULL;
|
|
|
|
return cmap;
|
|
}
|
|
|
|
static int fb_preinit(int reset)
|
|
{
|
|
static int fb_preinit_done = 0;
|
|
static int fb_err = -1;
|
|
|
|
if (reset) {
|
|
fb_preinit_done = 0;
|
|
return 0;
|
|
}
|
|
|
|
if (fb_preinit_done)
|
|
return fb_err;
|
|
fb_preinit_done = 1;
|
|
|
|
if (!fb_dev_name && !(fb_dev_name = getenv("FRAMEBUFFER")))
|
|
fb_dev_name = strdup("/dev/fb0");
|
|
|
|
mp_msg(MSGT_VO, MSGL_V, "[fbdev2] Using device %s\n", fb_dev_name);
|
|
|
|
if ((fb_dev_fd = open(fb_dev_name, O_RDWR)) == -1) {
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't open %s: %s\n", fb_dev_name, strerror(errno));
|
|
goto err_out;
|
|
}
|
|
if (ioctl(fb_dev_fd, FBIOGET_VSCREENINFO, &fb_vinfo)) {
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't get VSCREENINFO: %s\n", strerror(errno));
|
|
goto err_out;
|
|
}
|
|
fb_orig_vinfo = fb_vinfo;
|
|
|
|
fb_bpp = fb_vinfo.bits_per_pixel;
|
|
|
|
/* 16 and 15 bpp is reported as 16 bpp */
|
|
if (fb_bpp == 16)
|
|
fb_bpp = fb_vinfo.red.length + fb_vinfo.green.length +
|
|
fb_vinfo.blue.length;
|
|
|
|
fb_err = 0;
|
|
return 0;
|
|
err_out:
|
|
if (fb_dev_fd >= 0) close(fb_dev_fd);
|
|
fb_dev_fd = -1;
|
|
fb_err = -1;
|
|
return -1;
|
|
}
|
|
|
|
static uint32_t preinit(const char *subdevice)
|
|
{
|
|
if (subdevice)
|
|
{
|
|
if (fb_dev_name) free(fb_dev_name);
|
|
fb_dev_name = strdup(subdevice);
|
|
}
|
|
return fb_preinit(0);
|
|
}
|
|
|
|
static uint32_t config(uint32_t width, uint32_t height, uint32_t d_width,
|
|
uint32_t d_height, uint32_t flags, char *title,
|
|
uint32_t format)
|
|
{
|
|
struct fb_cmap *cmap;
|
|
int fs = flags & 0x01;
|
|
|
|
out_width = width;
|
|
out_height = height;
|
|
in_width = width;
|
|
in_height = height;
|
|
|
|
if (fs) {
|
|
out_width = fb_vinfo.xres;
|
|
out_height = fb_vinfo.yres;
|
|
}
|
|
|
|
if (out_width < in_width || out_height < in_height) {
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Screensize is smaller than video size (%dx%d < %dx%d)\n",
|
|
out_width, out_height, in_width, in_height);
|
|
return 1;
|
|
}
|
|
|
|
switch (fb_bpp) {
|
|
case 32: draw_alpha_p = vo_draw_alpha_rgb32; break;
|
|
case 24: draw_alpha_p = vo_draw_alpha_rgb24; break;
|
|
case 16: draw_alpha_p = vo_draw_alpha_rgb16; break;
|
|
case 15: draw_alpha_p = vo_draw_alpha_rgb15; break;
|
|
default: return 1;
|
|
}
|
|
|
|
if (vo_config_count == 0) {
|
|
if (ioctl(fb_dev_fd, FBIOGET_FSCREENINFO, &fb_finfo)) {
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't get FSCREENINFO: %s\n", strerror(errno));
|
|
return 1;
|
|
}
|
|
|
|
if (fb_finfo.type != FB_TYPE_PACKED_PIXELS) {
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] type %d not supported\n", fb_finfo.type);
|
|
return 1;
|
|
}
|
|
|
|
switch (fb_finfo.visual) {
|
|
case FB_VISUAL_TRUECOLOR:
|
|
break;
|
|
case FB_VISUAL_DIRECTCOLOR:
|
|
mp_msg(MSGT_VO, MSGL_V, "[fbdev2] creating cmap for directcolor\n");
|
|
if (ioctl(fb_dev_fd, FBIOGETCMAP, &fb_oldcmap)) {
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] can't get cmap: %s\n", strerror(errno));
|
|
return 1;
|
|
}
|
|
if (!(cmap = make_directcolor_cmap(&fb_vinfo)))
|
|
return 1;
|
|
if (ioctl(fb_dev_fd, FBIOPUTCMAP, cmap)) {
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] can't put cmap: %s\n", strerror(errno));
|
|
return 1;
|
|
}
|
|
fb_cmap_changed = 1;
|
|
free(cmap->red);
|
|
free(cmap->green);
|
|
free(cmap->blue);
|
|
free(cmap);
|
|
break;
|
|
default:
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] visual: %d not yet supported\n", fb_finfo.visual);
|
|
return 1;
|
|
}
|
|
|
|
fb_size = fb_finfo.smem_len;
|
|
fb_line_len = fb_finfo.line_length;
|
|
if ((frame_buffer = (uint8_t *) mmap(0, fb_size, PROT_READ | PROT_WRITE, MAP_SHARED, fb_dev_fd, 0)) == (uint8_t *) -1) {
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't mmap %s: %s\n", fb_dev_name, strerror(errno));
|
|
return 1;
|
|
}
|
|
}
|
|
|
|
center = frame_buffer + (out_width - in_width) * fb_pixel_size /
|
|
2 + ( (out_height - in_height) / 2 ) * fb_line_len;
|
|
|
|
#ifndef USE_CONVERT2FB
|
|
if (!(next_frame = (uint8_t *) realloc(next_frame, in_width * in_height * fb_pixel_size))) {
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't malloc next_frame: %s\n", strerror(errno));
|
|
return 1;
|
|
}
|
|
#endif
|
|
if (fs) memset(frame_buffer, '\0', fb_line_len * fb_vinfo.yres);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static uint32_t query_format(uint32_t format)
|
|
{
|
|
// open the device, etc.
|
|
if (fb_preinit(0)) return 0;
|
|
if ((format & IMGFMT_BGR_MASK) == IMGFMT_BGR) {
|
|
int fb_target_bpp = format & 0xff;
|
|
set_bpp(&fb_vinfo, fb_target_bpp);
|
|
fb_vinfo.xres_virtual = fb_vinfo.xres;
|
|
fb_vinfo.yres_virtual = fb_vinfo.yres;
|
|
if (ioctl(fb_dev_fd, FBIOPUT_VSCREENINFO, &fb_vinfo)) {
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't put VSCREENINFO: %s\n", strerror(errno));
|
|
return 0;
|
|
}
|
|
fb_pixel_size = fb_vinfo.bits_per_pixel / 8;
|
|
fb_bpp = fb_vinfo.red.length + fb_vinfo.green.length +
|
|
fb_vinfo.blue.length + fb_vinfo.transp.length;
|
|
if (fb_bpp == fb_target_bpp)
|
|
return VFCAP_CSP_SUPPORTED|VFCAP_CSP_SUPPORTED_BY_HW|VFCAP_ACCEPT_STRIDE;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static void draw_alpha(int x0, int y0, int w, int h, unsigned char *src,
|
|
unsigned char *srca, int stride)
|
|
{
|
|
unsigned char *dst;
|
|
int dstride;
|
|
|
|
#ifdef USE_CONVERT2FB
|
|
dst = center + (fb_line_len * y0) + (x0 * fb_pixel_size);
|
|
dstride = fb_line_len;
|
|
#else
|
|
dst = next_frame + (in_width * y0 + x0) * fb_pixel_size;
|
|
dstride = in_width * fb_pixel_size;
|
|
#endif
|
|
(*draw_alpha_p)(w, h, src, srca, stride, dst, dstride);
|
|
}
|
|
|
|
static void draw_osd(void)
|
|
{
|
|
vo_draw_text(in_width, in_height, draw_alpha);
|
|
}
|
|
|
|
// all csp support stride
|
|
static uint32_t draw_frame(uint8_t *src[]) { return 1; }
|
|
|
|
static uint32_t draw_slice(uint8_t *src[], int stride[], int w, int h, int x, int y)
|
|
{
|
|
uint8_t *in = src[0];
|
|
#ifdef USE_CONVERT2FB
|
|
uint8_t *dest = center + (fb_line_len * y) + (x * fb_pixel_size);
|
|
int next = fb_line_len;
|
|
#else
|
|
uint8_t *dest = next_frame + (in_width * y + x) * fb_pixel_size;
|
|
int next = in_width * fb_pixel_size;
|
|
#endif
|
|
int i;
|
|
|
|
for (i = 0; i < h; i++) {
|
|
memcpy(dest, in, w * fb_pixel_size);
|
|
dest += next;
|
|
in += stride[0];
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static void check_events(void)
|
|
{
|
|
}
|
|
|
|
static void flip_page(void)
|
|
{
|
|
#ifndef USE_CONVERT2FB
|
|
int i, out_offset = 0, in_offset = 0;
|
|
|
|
for (i = 0; i < in_height; i++) {
|
|
memcpy(center + out_offset, next_frame + in_offset,
|
|
in_width * fb_pixel_size);
|
|
out_offset += fb_line_len;
|
|
in_offset += in_width * fb_pixel_size;
|
|
}
|
|
#endif
|
|
}
|
|
|
|
static void uninit(void)
|
|
{
|
|
if (fb_cmap_changed) {
|
|
if (ioctl(fb_dev_fd, FBIOPUTCMAP, &fb_oldcmap))
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't restore original cmap\n");
|
|
fb_cmap_changed = 0;
|
|
}
|
|
if(next_frame) free(next_frame);
|
|
if (fb_dev_fd >= 0) {
|
|
if (ioctl(fb_dev_fd, FBIOPUT_VSCREENINFO, &fb_orig_vinfo))
|
|
mp_msg(MSGT_VO, MSGL_ERR, "[fbdev2] Can't reset original fb_var_screeninfo: %s\n", strerror(errno));
|
|
close(fb_dev_fd);
|
|
fb_dev_fd = -1;
|
|
}
|
|
if(frame_buffer) munmap(frame_buffer, fb_size);
|
|
next_frame = frame_buffer = NULL;
|
|
fb_preinit(1); // so that later calls to preinit don't fail
|
|
}
|
|
|
|
static uint32_t control(uint32_t request, void *data, ...)
|
|
{
|
|
switch (request) {
|
|
case VOCTRL_QUERY_FORMAT:
|
|
return query_format(*((uint32_t*)data));
|
|
}
|
|
return VO_NOTIMPL;
|
|
}
|