xenocara/driver/xf86-video-vmware/vmwgfx/vmwgfx_tex_video.c
2014-09-27 17:39:03 +00:00

772 lines
19 KiB
C

/*
* Copyright 2009-2011 VMWare, Inc.
* All Rights Reserved.
*
* Permission is hereby granted, free of charge, to any person obtaining a
* copy of this software and associated documentation files (the
* "Software"), to deal in the Software without restriction, including
* without limitation the rights to use, copy, modify, merge, publish,
* distribute, sub license, and/or sell copies of the Software, and to
* permit persons to whom the Software is furnished to do so, subject to
* the following conditions:
*
* The above copyright notice and this permission notice (including the
* next paragraph) shall be included in all copies or substantial portions
* of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
* OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT.
* IN NO EVENT SHALL TUNGSTEN GRAPHICS AND/OR ITS SUPPLIERS BE LIABLE FOR
* ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
*
* Author: Thomas Hellstrom <thellstrom@vmware.com>
* Author: Zack Rusin <zackr@vmware.com>
*/
#include "vmwgfx_driver.h"
#include "vmwgfx_drmi.h"
#include "vmwgfx_saa.h"
#include <xf86xv.h>
#include <X11/extensions/Xv.h>
#include <fourcc.h>
#include <xa_tracker.h>
#include <xa_context.h>
#include <math.h>
/*XXX get these from pipe's texture limits */
#define IMAGE_MAX_WIDTH 2048
#define IMAGE_MAX_HEIGHT 2048
#define RES_720P_X 1280
#define RES_720P_Y 720
#define MAKE_ATOM(a) MakeAtom(a, sizeof(a) - 1, TRUE)
/*
* ITU-R BT.601, BT.709 transfer matrices.
* [R', G', B'] values are in the range [0, 1], Y' is in the range [0,1]
* and [Pb, Pr] components are in the range [-0.5, 0.5].
*
* The matrices are transposed to fit the xa conversion matrix format.
*/
static const float bt_601[] = {
1.f, 1.f, 1.f, 0.f,
0.f, -0.344136f, 1.772f, 0.f,
1.402f, -0.714136f, 0.f, 0.f
};
static const float bt_709[] = {
1.f, 1.f, 1.f, 0.f,
0.f, -0.187324f, 1.8556f, 0.f,
1.5748f, -0.468124f, 0.f, 0.f
};
static Atom xvBrightness, xvContrast, xvSaturation, xvHue;
#define NUM_TEXTURED_ATTRIBUTES 4
static const XF86AttributeRec TexturedAttributes[NUM_TEXTURED_ATTRIBUTES] = {
{XvSettable | XvGettable, -1000, 1000, "XV_BRIGHTNESS"},
{XvSettable | XvGettable, -1000, 1000, "XV_CONTRAST"},
{XvSettable | XvGettable, -1000, 1000, "XV_SATURATION"},
{XvSettable | XvGettable, -1000, 1000, "XV_HUE"}
};
#define NUM_FORMATS 3
static XF86VideoFormatRec Formats[NUM_FORMATS] = {
{15, TrueColor}, {16, TrueColor}, {24, TrueColor}
};
static XF86VideoEncodingRec DummyEncoding[1] = {
{
0,
"XV_IMAGE",
IMAGE_MAX_WIDTH, IMAGE_MAX_HEIGHT,
{1, 1}
}
};
#define NUM_IMAGES 3
static XF86ImageRec Images[NUM_IMAGES] = {
XVIMAGE_UYVY,
XVIMAGE_YUY2,
XVIMAGE_YV12,
};
struct xorg_xv_port_priv {
struct xa_tracker *xat;
struct xa_context *r;
struct xa_fence *fence;
RegionRec clip;
int brightness;
int contrast;
int saturation;
int hue;
int current_set;
struct xa_surface *yuv[2][3];
int drm_fd;
Bool hdtv;
float uv_offset;
float uv_scale;
float y_offset;
float y_scale;
float rgb_offset;
float rgb_scale;
float sinhue;
float coshue;
float cm[16];
};
/*
* vmwgfx_update_conversion_matrix - Compute the effective color conversion
* matrix.
*
* Applies yuv- and resulting rgb scales and offsets to compute the correct
* color conversion matrix. These scales and offsets are properties of the
* video stream and can be adjusted using XV properties as well.
*/
static void
vmwgfx_update_conversion_matrix(struct xorg_xv_port_priv *priv)
{
int i;
float *cm = priv->cm;
static const float *bt;
bt = (priv->hdtv) ? bt_709 : bt_601;
memcpy(cm, bt, sizeof(bt_601));
/*
* Apply hue rotation
*/
cm[4] = priv->coshue * bt[4] - priv->sinhue * bt[8];
cm[8] = priv->sinhue * bt[4] + priv->coshue * bt[8];
cm[5] = priv->coshue * bt[5] - priv->sinhue * bt[9];
cm[9] = priv->sinhue * bt[5] + priv->coshue * bt[9];
cm[6] = priv->coshue * bt[6] - priv->sinhue * bt[10];
cm[10] = priv->sinhue * bt[6] + priv->coshue * bt[10];
/*
* Adjust for yuv scales in input and rgb scale in the converted output.
*/
for(i = 0; i < 3; ++i) {
cm[i] *= (priv->y_scale*priv->rgb_scale);
cm[i+4] *= (priv->uv_scale*priv->rgb_scale);
cm[i+8] *= (priv->uv_scale*priv->rgb_scale);
}
/*
* Adjust for yuv offsets in input and rgb offset in the converted output.
*/
for (i = 0; i < 3; ++i)
cm[i+12] = -cm[i]*priv->y_offset - (cm[i+4] + cm[i+8])*priv->uv_offset
- priv->rgb_offset*priv->rgb_scale;
/*
* Alpha is 1, unconditionally.
*/
cm[15] = 1.f;
}
static void
stop_video(ScrnInfoPtr pScrn, pointer data, Bool shutdown)
{
struct xorg_xv_port_priv *priv = (struct xorg_xv_port_priv *)data;
int i, j;
REGION_EMPTY(pScrn->pScreen, &priv->clip);
if (shutdown) {
/*
* No need to destroy the xa context or xa tracker since
* they are copied from the screen resources.
*/
xa_fence_destroy(priv->fence);
priv->fence = NULL;
for (i=0; i<3; ++i) {
for (j=0; j<2; ++j) {
if (priv->yuv[i]) {
xa_surface_destroy(priv->yuv[j][i]);
priv->yuv[j][i] = NULL;
}
}
}
}
}
static int
set_port_attribute(ScrnInfoPtr pScrn,
Atom attribute, INT32 value, pointer data)
{
struct xorg_xv_port_priv *priv = (struct xorg_xv_port_priv *)data;
if (attribute == xvBrightness) {
if ((value < -1000) || (value > 1000))
return BadValue;
priv->brightness = value;
priv->y_offset = -((float) value)/1000.f;
} else if (attribute == xvContrast) {
if ((value < -1000) || (value > 1000))
return BadValue;
priv->contrast = value;
priv->rgb_scale = ((float) value + 1000.f)/1000.f;
} else if (attribute == xvSaturation) {
if ((value < -1000) || (value > 1000))
return BadValue;
priv->saturation = value;
priv->uv_scale = ((float) value + 1000.f)/1000.f;
} else if (attribute == xvHue) {
double hue_angle;
if ((value < -1000) || (value > 1000))
return BadValue;
priv->hue = value;
hue_angle = (double) value * M_PI / 1000.;
priv->sinhue = sin(hue_angle);
priv->coshue = cos(hue_angle);
} else
return BadMatch;
vmwgfx_update_conversion_matrix(priv);
return Success;
}
static int
get_port_attribute(ScrnInfoPtr pScrn,
Atom attribute, INT32 * value, pointer data)
{
struct xorg_xv_port_priv *priv = (struct xorg_xv_port_priv *)data;
if (attribute == xvBrightness)
*value = priv->brightness;
else if (attribute == xvContrast)
*value = priv->contrast;
else if (attribute == xvSaturation)
*value = priv->saturation;
else if (attribute == xvHue)
*value = priv->hue;
else
return BadMatch;
return Success;
}
static void
query_best_size(ScrnInfoPtr pScrn,
Bool motion,
short vid_w, short vid_h,
short drw_w, short drw_h,
unsigned int *p_w, unsigned int *p_h, pointer data)
{
if (vid_w > (drw_w << 1))
drw_w = vid_w >> 1;
if (vid_h > (drw_h << 1))
drw_h = vid_h >> 1;
*p_w = drw_w;
*p_h = drw_h;
}
static int
check_yuv_surfaces(struct xorg_xv_port_priv *priv, int id,
int width, int height)
{
struct xa_surface **yuv = priv->yuv[priv->current_set];
int ret = 0;
int i;
for (i=0; i<3; ++i) {
/*
* Adjust u,v texture size and DMA buffer to what's required by
* the format.
*/
if (i == 1) {
switch(id) {
case FOURCC_YV12:
height /= 2;
/* Fall through */
case FOURCC_YUY2:
case FOURCC_UYVY:
width /= 2;
break;
default:
break;
}
}
if (!yuv[i])
yuv[i] = xa_surface_create(priv->xat, width, height, 8,
xa_type_yuv_component,
xa_format_unknown, 0);
else
ret = xa_surface_redefine(yuv[i], width, height, 8,
xa_type_yuv_component,
xa_format_unknown, 0, 0);
if (ret || !yuv[i])
return BadAlloc;
}
return Success;
}
static int
query_image_attributes(ScrnInfoPtr pScrn,
int id,
unsigned short *w, unsigned short *h,
int *pitches, int *offsets)
{
int size, tmp;
if (*w > IMAGE_MAX_WIDTH)
*w = IMAGE_MAX_WIDTH;
if (*h > IMAGE_MAX_HEIGHT)
*h = IMAGE_MAX_HEIGHT;
*w = (*w + 1) & ~1;
if (offsets)
offsets[0] = 0;
switch (id) {
case FOURCC_YV12:
*h = (*h + 1) & ~1;
size = (*w + 3) & ~3;
if (pitches) {
pitches[0] = size;
}
size *= *h;
if (offsets) {
offsets[1] = size;
}
tmp = ((*w >> 1) + 3) & ~3;
if (pitches) {
pitches[1] = pitches[2] = tmp;
}
tmp *= (*h >> 1);
size += tmp;
if (offsets) {
offsets[2] = size;
}
size += tmp;
break;
case FOURCC_UYVY:
case FOURCC_YUY2:
default:
size = *w << 1;
if (pitches)
pitches[0] = size;
size *= *h;
break;
}
return size;
}
static int
copy_packed_data(ScrnInfoPtr pScrn,
struct xorg_xv_port_priv *port,
int id,
unsigned char *buf,
int left,
int top,
unsigned short w, unsigned short h)
{
int i;
struct xa_surface **yuv = port->yuv[port->current_set];
char *ymap, *vmap, *umap;
unsigned char y1, y2, u, v;
int yidx, uidx, vidx;
int y_array_size = w * h;
int ret = BadAlloc;
ymap = xa_surface_map(port->r, yuv[0], XA_MAP_WRITE);
if (!ymap)
return BadAlloc;
umap = xa_surface_map(port->r, yuv[1], XA_MAP_WRITE);
if (!umap)
goto out_no_umap;
vmap = xa_surface_map(port->r, yuv[2], XA_MAP_WRITE);
if (!vmap)
goto out_no_vmap;
yidx = uidx = vidx = 0;
switch (id) {
case FOURCC_YV12: {
int pitches[3], offsets[3];
unsigned char *yp, *up, *vp;
query_image_attributes(pScrn, FOURCC_YV12,
&w, &h, pitches, offsets);
yp = buf + offsets[0];
vp = buf + offsets[1];
up = buf + offsets[2];
memcpy(ymap, yp, w*h);
memcpy(vmap, vp, w*h/4);
memcpy(umap, up, w*h/4);
break;
}
case FOURCC_UYVY:
for (i = 0; i < y_array_size; i +=2 ) {
/* extracting two pixels */
u = buf[0];
y1 = buf[1];
v = buf[2];
y2 = buf[3];
buf += 4;
ymap[yidx++] = y1;
ymap[yidx++] = y2;
umap[uidx++] = u;
vmap[vidx++] = v;
}
break;
case FOURCC_YUY2:
for (i = 0; i < y_array_size; i +=2 ) {
/* extracting two pixels */
y1 = buf[0];
u = buf[1];
y2 = buf[2];
v = buf[3];
buf += 4;
ymap[yidx++] = y1;
ymap[yidx++] = y2;
umap[uidx++] = u;
vmap[vidx++] = v;
}
break;
default:
ret = BadAlloc;
break;
}
ret = Success;
xa_surface_unmap(yuv[2]);
out_no_vmap:
xa_surface_unmap(yuv[1]);
out_no_umap:
xa_surface_unmap(yuv[0]);
return ret;
}
static int
display_video(ScreenPtr pScreen, struct xorg_xv_port_priv *pPriv, int id,
RegionPtr dstRegion,
int src_x, int src_y, int src_w, int src_h,
int dst_x, int dst_y, int dst_w, int dst_h,
PixmapPtr pPixmap)
{
struct vmwgfx_saa_pixmap *vpix = vmwgfx_saa_pixmap(pPixmap);
Bool hdtv;
RegionRec reg;
int ret = BadAlloc;
int blit_ret;
REGION_NULL(pScreen, &reg);
if (!vmwgfx_hw_accel_validate(pPixmap, 0, XA_FLAG_RENDER_TARGET, 0, &reg))
goto out_no_dst;
hdtv = ((src_w >= RES_720P_X) && (src_h >= RES_720P_Y));
if (hdtv != pPriv->hdtv) {
pPriv->hdtv = hdtv;
vmwgfx_update_conversion_matrix(pPriv);
}
#ifdef COMPOSITE
/*
* For redirected windows, we need to fix up the destination coordinates.
*/
REGION_TRANSLATE(pScreen, dstRegion, -pPixmap->screen_x,
-pPixmap->screen_y);
dst_x -= pPixmap->screen_x;
dst_y -= pPixmap->screen_y;
#endif
/*
* Throttle on previous blit.
*/
if (pPriv->fence) {
(void) xa_fence_wait(pPriv->fence, 1000000000ULL);
xa_fence_destroy(pPriv->fence);
pPriv->fence = NULL;
}
DamageRegionAppend(&pPixmap->drawable, dstRegion);
blit_ret = xa_yuv_planar_blit(pPriv->r, src_x, src_y, src_w, src_h,
dst_x, dst_y, dst_w, dst_h,
(struct xa_box *)REGION_RECTS(dstRegion),
REGION_NUM_RECTS(dstRegion),
pPriv->cm,
vpix->hw,
pPriv->yuv[pPriv->current_set ]);
saa_pixmap_dirty(pPixmap, TRUE, dstRegion);
DamageRegionProcessPending(&pPixmap->drawable);
ret = Success;
if (!blit_ret) {
ret = Success;
pPriv->fence = xa_fence_get(pPriv->r);
} else
ret = BadAlloc;
out_no_dst:
REGION_UNINIT(pScreen, &reg);
return ret;
}
static int
put_image(ScrnInfoPtr pScrn,
short src_x, short src_y,
short drw_x, short drw_y,
short src_w, short src_h,
short drw_w, short drw_h,
int id, unsigned char *buf,
short width, short height,
Bool sync, RegionPtr clipBoxes, pointer data,
DrawablePtr pDraw)
{
struct xorg_xv_port_priv *pPriv = (struct xorg_xv_port_priv *) data;
ScreenPtr pScreen = xf86ScrnToScreen(pScrn);
PixmapPtr pPixmap;
INT32 x1, x2, y1, y2;
BoxRec dstBox;
int ret;
/* Clip */
x1 = src_x;
x2 = src_x + src_w;
y1 = src_y;
y2 = src_y + src_h;
dstBox.x1 = drw_x;
dstBox.x2 = drw_x + drw_w;
dstBox.y1 = drw_y;
dstBox.y2 = drw_y + drw_h;
if (!xf86XVClipVideoHelper(&dstBox, &x1, &x2, &y1, &y2, clipBoxes,
width, height))
return Success;
ret = check_yuv_surfaces(pPriv, id, width, height);
if (ret)
return ret;
ret = copy_packed_data(pScrn, pPriv, id, buf,
src_x, src_y, width, height);
if (ret)
return ret;
if (pDraw->type == DRAWABLE_WINDOW) {
pPixmap = (*pScreen->GetWindowPixmap)((WindowPtr)pDraw);
} else {
pPixmap = (PixmapPtr)pDraw;
}
display_video(pScrn->pScreen, pPriv, id, clipBoxes,
src_x, src_y, src_w, src_h,
drw_x, drw_y,
drw_w, drw_h, pPixmap);
pPriv->current_set = (pPriv->current_set + 1) & 1;
return Success;
}
static struct xorg_xv_port_priv *
port_priv_create(struct xa_tracker *xat, struct xa_context *r,
int drm_fd)
{
struct xorg_xv_port_priv *priv = NULL;
priv = calloc(1, sizeof(struct xorg_xv_port_priv));
if (!priv)
return NULL;
priv->r = r;
priv->xat = xat;
priv->drm_fd = drm_fd;
REGION_NULL(pScreen, &priv->clip);
priv->hdtv = FALSE;
priv->uv_offset = 0.5f;
priv->uv_scale = 1.f;
priv->y_offset = 0.f;
priv->y_scale = 1.f;
priv->rgb_offset = 0.f;
priv->rgb_scale = 1.f;
priv->sinhue = 0.f;
priv->coshue = 1.f;
vmwgfx_update_conversion_matrix(priv);
return priv;
}
static void
vmwgfx_free_textured_adaptor(XF86VideoAdaptorPtr adaptor, Bool free_ports)
{
if (free_ports) {
int i;
for(i=0; i<adaptor->nPorts; ++i) {
free(adaptor->pPortPrivates[i].ptr);
}
}
free(adaptor->pAttributes);
free(adaptor->pPortPrivates);
xf86XVFreeVideoAdaptorRec(adaptor);
}
static XF86VideoAdaptorPtr
xorg_setup_textured_adapter(ScreenPtr pScreen)
{
ScrnInfoPtr pScrn = xf86ScreenToScrn(pScreen);
modesettingPtr ms = modesettingPTR(pScrn);
XF86VideoAdaptorPtr adapt;
XF86AttributePtr attrs;
DevUnion *dev_unions;
int nports = 16, i;
int nattributes;
struct xa_context *xar;
/*
* Use the XA default context since we don't expect the X server
* to render from multiple threads.
*/
xar = xa_context_default(ms->xat);
nattributes = NUM_TEXTURED_ATTRIBUTES;
adapt = calloc(1, sizeof(XF86VideoAdaptorRec));
dev_unions = calloc(nports, sizeof(DevUnion));
attrs = calloc(nattributes, sizeof(XF86AttributeRec));
if (adapt == NULL || dev_unions == NULL || attrs == NULL) {
free(adapt);
free(dev_unions);
free(attrs);
return NULL;
}
adapt->type = XvWindowMask | XvInputMask | XvImageMask;
adapt->flags = 0;
adapt->name = "XA G3D Textured Video";
adapt->nEncodings = 1;
adapt->pEncodings = DummyEncoding;
adapt->nFormats = NUM_FORMATS;
adapt->pFormats = Formats;
adapt->nPorts = 0;
adapt->pPortPrivates = dev_unions;
adapt->nAttributes = nattributes;
adapt->pAttributes = attrs;
memcpy(attrs, TexturedAttributes, nattributes * sizeof(XF86AttributeRec));
adapt->nImages = NUM_IMAGES;
adapt->pImages = Images;
adapt->PutVideo = NULL;
adapt->PutStill = NULL;
adapt->GetVideo = NULL;
adapt->GetStill = NULL;
adapt->StopVideo = stop_video;
adapt->SetPortAttribute = set_port_attribute;
adapt->GetPortAttribute = get_port_attribute;
adapt->QueryBestSize = query_best_size;
adapt->PutImage = put_image;
adapt->QueryImageAttributes = query_image_attributes;
for (i = 0; i < nports; i++) {
struct xorg_xv_port_priv *priv =
port_priv_create(ms->xat, xar, ms->fd);
adapt->pPortPrivates[i].ptr = (pointer) (priv);
adapt->nPorts++;
}
return adapt;
}
void
xorg_xv_init(ScreenPtr pScreen)
{
ScrnInfoPtr pScrn = xf86ScreenToScrn(pScreen);
modesettingPtr ms = modesettingPTR(pScrn);
XF86VideoAdaptorPtr *adaptors, *new_adaptors = NULL;
XF86VideoAdaptorPtr textured_adapter = NULL, overlay_adaptor = NULL;
int num_adaptors;
num_adaptors = xf86XVListGenericAdaptors(pScrn, &adaptors);
new_adaptors = malloc((num_adaptors + 2) * sizeof(XF86VideoAdaptorPtr *));
if (new_adaptors == NULL)
return;
memcpy(new_adaptors, adaptors, num_adaptors * sizeof(XF86VideoAdaptorPtr));
adaptors = new_adaptors;
/* Add the adaptors supported by our hardware. First, set up the atoms
* that will be used by both output adaptors.
*/
xvBrightness = MAKE_ATOM("XV_BRIGHTNESS");
xvContrast = MAKE_ATOM("XV_CONTRAST");
xvSaturation = MAKE_ATOM("XV_SATURATION");
xvHue = MAKE_ATOM("XV_HUE");
if (ms->xat) {
textured_adapter = xorg_setup_textured_adapter(pScreen);
if (textured_adapter)
adaptors[num_adaptors++] = textured_adapter;
} else {
xf86DrvMsg(pScrn->scrnIndex, X_INFO,
"No 3D acceleration. Not setting up textured video.\n");
}
overlay_adaptor = vmw_video_init_adaptor(pScrn);
if (overlay_adaptor)
adaptors[num_adaptors++] = overlay_adaptor;
if (num_adaptors) {
Bool ret;
ret = xf86XVScreenInit(pScreen, adaptors, num_adaptors);
if (textured_adapter)
vmwgfx_free_textured_adaptor(textured_adapter, !ret);
if (overlay_adaptor)
vmw_video_free_adaptor(overlay_adaptor, !ret);
if (!ret)
xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
"Failed to initialize Xv.\n");
} else {
xf86DrvMsg(pScrn->scrnIndex, X_WARNING,
"Disabling Xv because no adaptors could be initialized.\n");
}
}