352 lines
9.6 KiB
C
352 lines
9.6 KiB
C
/*
|
|
* Copyright (C) 2015 Red Hat, 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, sublicense, 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 NONINFRINGEMENT.
|
|
* IN NO EVENT SHALL THE COPYRIGHT OWNER(S) 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.
|
|
*/
|
|
|
|
#include <drm/drmP.h>
|
|
#include <drm/drm_fb_helper.h>
|
|
#include "virtgpu_drv.h"
|
|
|
|
#define VIRTIO_GPU_FBCON_POLL_PERIOD (HZ / 60)
|
|
|
|
struct virtio_gpu_fbdev {
|
|
struct drm_fb_helper helper;
|
|
struct virtio_gpu_framebuffer vgfb;
|
|
struct virtio_gpu_device *vgdev;
|
|
struct delayed_work work;
|
|
};
|
|
|
|
static int virtio_gpu_dirty_update(struct virtio_gpu_framebuffer *fb,
|
|
bool store, int x, int y,
|
|
int width, int height)
|
|
{
|
|
struct drm_device *dev = fb->base.dev;
|
|
struct virtio_gpu_device *vgdev = dev->dev_private;
|
|
bool store_for_later = false;
|
|
int bpp = fb->base.format->cpp[0];
|
|
int x2, y2;
|
|
unsigned long flags;
|
|
struct virtio_gpu_object *obj = gem_to_virtio_gpu_obj(fb->obj);
|
|
|
|
if ((width <= 0) ||
|
|
(x + width > fb->base.width) ||
|
|
(y + height > fb->base.height)) {
|
|
DRM_DEBUG("values out of range %dx%d+%d+%d, fb %dx%d\n",
|
|
width, height, x, y,
|
|
fb->base.width, fb->base.height);
|
|
return -EINVAL;
|
|
}
|
|
|
|
/*
|
|
* Can be called with pretty much any context (console output
|
|
* path). If we are in atomic just store the dirty rect info
|
|
* to send out the update later.
|
|
*
|
|
* Can't test inside spin lock.
|
|
*/
|
|
if (in_atomic() || store)
|
|
store_for_later = true;
|
|
|
|
x2 = x + width - 1;
|
|
y2 = y + height - 1;
|
|
|
|
spin_lock_irqsave(&fb->dirty_lock, flags);
|
|
|
|
if (fb->y1 < y)
|
|
y = fb->y1;
|
|
if (fb->y2 > y2)
|
|
y2 = fb->y2;
|
|
if (fb->x1 < x)
|
|
x = fb->x1;
|
|
if (fb->x2 > x2)
|
|
x2 = fb->x2;
|
|
|
|
if (store_for_later) {
|
|
fb->x1 = x;
|
|
fb->x2 = x2;
|
|
fb->y1 = y;
|
|
fb->y2 = y2;
|
|
spin_unlock_irqrestore(&fb->dirty_lock, flags);
|
|
return 0;
|
|
}
|
|
|
|
fb->x1 = fb->y1 = INT_MAX;
|
|
fb->x2 = fb->y2 = 0;
|
|
|
|
spin_unlock_irqrestore(&fb->dirty_lock, flags);
|
|
|
|
{
|
|
uint32_t offset;
|
|
uint32_t w = x2 - x + 1;
|
|
uint32_t h = y2 - y + 1;
|
|
|
|
offset = (y * fb->base.pitches[0]) + x * bpp;
|
|
|
|
virtio_gpu_cmd_transfer_to_host_2d(vgdev, obj->hw_res_handle,
|
|
offset,
|
|
cpu_to_le32(w),
|
|
cpu_to_le32(h),
|
|
cpu_to_le32(x),
|
|
cpu_to_le32(y),
|
|
NULL);
|
|
|
|
}
|
|
virtio_gpu_cmd_resource_flush(vgdev, obj->hw_res_handle,
|
|
x, y, x2 - x + 1, y2 - y + 1);
|
|
return 0;
|
|
}
|
|
|
|
int virtio_gpu_surface_dirty(struct virtio_gpu_framebuffer *vgfb,
|
|
struct drm_clip_rect *clips,
|
|
unsigned num_clips)
|
|
{
|
|
struct virtio_gpu_device *vgdev = vgfb->base.dev->dev_private;
|
|
struct virtio_gpu_object *obj = gem_to_virtio_gpu_obj(vgfb->obj);
|
|
struct drm_clip_rect norect;
|
|
struct drm_clip_rect *clips_ptr;
|
|
int left, right, top, bottom;
|
|
int i;
|
|
int inc = 1;
|
|
if (!num_clips) {
|
|
num_clips = 1;
|
|
clips = &norect;
|
|
norect.x1 = norect.y1 = 0;
|
|
norect.x2 = vgfb->base.width;
|
|
norect.y2 = vgfb->base.height;
|
|
}
|
|
left = clips->x1;
|
|
right = clips->x2;
|
|
top = clips->y1;
|
|
bottom = clips->y2;
|
|
|
|
/* skip the first clip rect */
|
|
for (i = 1, clips_ptr = clips + inc;
|
|
i < num_clips; i++, clips_ptr += inc) {
|
|
left = min_t(int, left, (int)clips_ptr->x1);
|
|
right = max_t(int, right, (int)clips_ptr->x2);
|
|
top = min_t(int, top, (int)clips_ptr->y1);
|
|
bottom = max_t(int, bottom, (int)clips_ptr->y2);
|
|
}
|
|
|
|
if (obj->dumb)
|
|
return virtio_gpu_dirty_update(vgfb, false, left, top,
|
|
right - left, bottom - top);
|
|
|
|
virtio_gpu_cmd_resource_flush(vgdev, obj->hw_res_handle,
|
|
left, top, right - left, bottom - top);
|
|
return 0;
|
|
}
|
|
|
|
static void virtio_gpu_fb_dirty_work(struct work_struct *work)
|
|
{
|
|
struct delayed_work *delayed_work = to_delayed_work(work);
|
|
struct virtio_gpu_fbdev *vfbdev =
|
|
container_of(delayed_work, struct virtio_gpu_fbdev, work);
|
|
struct virtio_gpu_framebuffer *vgfb = &vfbdev->vgfb;
|
|
|
|
virtio_gpu_dirty_update(&vfbdev->vgfb, false, vgfb->x1, vgfb->y1,
|
|
vgfb->x2 - vgfb->x1, vgfb->y2 - vgfb->y1);
|
|
}
|
|
|
|
static void virtio_gpu_3d_fillrect(struct fb_info *info,
|
|
const struct fb_fillrect *rect)
|
|
{
|
|
struct virtio_gpu_fbdev *vfbdev = info->par;
|
|
drm_fb_helper_sys_fillrect(info, rect);
|
|
virtio_gpu_dirty_update(&vfbdev->vgfb, true, rect->dx, rect->dy,
|
|
rect->width, rect->height);
|
|
schedule_delayed_work(&vfbdev->work, VIRTIO_GPU_FBCON_POLL_PERIOD);
|
|
}
|
|
|
|
static void virtio_gpu_3d_copyarea(struct fb_info *info,
|
|
const struct fb_copyarea *area)
|
|
{
|
|
struct virtio_gpu_fbdev *vfbdev = info->par;
|
|
drm_fb_helper_sys_copyarea(info, area);
|
|
virtio_gpu_dirty_update(&vfbdev->vgfb, true, area->dx, area->dy,
|
|
area->width, area->height);
|
|
schedule_delayed_work(&vfbdev->work, VIRTIO_GPU_FBCON_POLL_PERIOD);
|
|
}
|
|
|
|
static void virtio_gpu_3d_imageblit(struct fb_info *info,
|
|
const struct fb_image *image)
|
|
{
|
|
struct virtio_gpu_fbdev *vfbdev = info->par;
|
|
drm_fb_helper_sys_imageblit(info, image);
|
|
virtio_gpu_dirty_update(&vfbdev->vgfb, true, image->dx, image->dy,
|
|
image->width, image->height);
|
|
schedule_delayed_work(&vfbdev->work, VIRTIO_GPU_FBCON_POLL_PERIOD);
|
|
}
|
|
|
|
static struct fb_ops virtio_gpufb_ops = {
|
|
.owner = THIS_MODULE,
|
|
DRM_FB_HELPER_DEFAULT_OPS,
|
|
.fb_fillrect = virtio_gpu_3d_fillrect,
|
|
.fb_copyarea = virtio_gpu_3d_copyarea,
|
|
.fb_imageblit = virtio_gpu_3d_imageblit,
|
|
};
|
|
|
|
static int virtio_gpu_vmap_fb(struct virtio_gpu_device *vgdev,
|
|
struct virtio_gpu_object *obj)
|
|
{
|
|
return virtio_gpu_object_kmap(obj, NULL);
|
|
}
|
|
|
|
static int virtio_gpufb_create(struct drm_fb_helper *helper,
|
|
struct drm_fb_helper_surface_size *sizes)
|
|
{
|
|
struct virtio_gpu_fbdev *vfbdev =
|
|
container_of(helper, struct virtio_gpu_fbdev, helper);
|
|
struct drm_device *dev = helper->dev;
|
|
struct virtio_gpu_device *vgdev = dev->dev_private;
|
|
struct fb_info *info;
|
|
struct drm_framebuffer *fb;
|
|
struct drm_mode_fb_cmd2 mode_cmd = {};
|
|
struct virtio_gpu_object *obj;
|
|
uint32_t resid, format, size;
|
|
int ret;
|
|
|
|
mode_cmd.width = sizes->surface_width;
|
|
mode_cmd.height = sizes->surface_height;
|
|
mode_cmd.pitches[0] = mode_cmd.width * 4;
|
|
mode_cmd.pixel_format = drm_mode_legacy_fb_format(32, 24);
|
|
|
|
format = virtio_gpu_translate_format(mode_cmd.pixel_format);
|
|
if (format == 0)
|
|
return -EINVAL;
|
|
|
|
size = mode_cmd.pitches[0] * mode_cmd.height;
|
|
obj = virtio_gpu_alloc_object(dev, size, false, true);
|
|
if (IS_ERR(obj))
|
|
return PTR_ERR(obj);
|
|
|
|
virtio_gpu_resource_id_get(vgdev, &resid);
|
|
virtio_gpu_cmd_create_resource(vgdev, resid, format,
|
|
mode_cmd.width, mode_cmd.height);
|
|
|
|
ret = virtio_gpu_vmap_fb(vgdev, obj);
|
|
if (ret) {
|
|
DRM_ERROR("failed to vmap fb %d\n", ret);
|
|
goto err_obj_vmap;
|
|
}
|
|
|
|
/* attach the object to the resource */
|
|
ret = virtio_gpu_object_attach(vgdev, obj, resid, NULL);
|
|
if (ret)
|
|
goto err_obj_attach;
|
|
|
|
info = drm_fb_helper_alloc_fbi(helper);
|
|
if (IS_ERR(info)) {
|
|
ret = PTR_ERR(info);
|
|
goto err_fb_alloc;
|
|
}
|
|
|
|
info->par = helper;
|
|
|
|
ret = virtio_gpu_framebuffer_init(dev, &vfbdev->vgfb,
|
|
&mode_cmd, &obj->gem_base);
|
|
if (ret)
|
|
goto err_fb_alloc;
|
|
|
|
fb = &vfbdev->vgfb.base;
|
|
|
|
vfbdev->helper.fb = fb;
|
|
|
|
strcpy(info->fix.id, "virtiodrmfb");
|
|
info->fbops = &virtio_gpufb_ops;
|
|
info->pixmap.flags = FB_PIXMAP_SYSTEM;
|
|
|
|
info->screen_buffer = obj->vmap;
|
|
info->screen_size = obj->gem_base.size;
|
|
drm_fb_helper_fill_fix(info, fb->pitches[0], fb->format->depth);
|
|
drm_fb_helper_fill_var(info, &vfbdev->helper,
|
|
sizes->fb_width, sizes->fb_height);
|
|
|
|
info->fix.mmio_start = 0;
|
|
info->fix.mmio_len = 0;
|
|
return 0;
|
|
|
|
err_fb_alloc:
|
|
virtio_gpu_cmd_resource_inval_backing(vgdev, resid);
|
|
err_obj_attach:
|
|
err_obj_vmap:
|
|
virtio_gpu_gem_free_object(&obj->gem_base);
|
|
return ret;
|
|
}
|
|
|
|
static int virtio_gpu_fbdev_destroy(struct drm_device *dev,
|
|
struct virtio_gpu_fbdev *vgfbdev)
|
|
{
|
|
struct virtio_gpu_framebuffer *vgfb = &vgfbdev->vgfb;
|
|
|
|
drm_fb_helper_unregister_fbi(&vgfbdev->helper);
|
|
|
|
if (vgfb->obj)
|
|
vgfb->obj = NULL;
|
|
drm_fb_helper_fini(&vgfbdev->helper);
|
|
drm_framebuffer_cleanup(&vgfb->base);
|
|
|
|
return 0;
|
|
}
|
|
static const struct drm_fb_helper_funcs virtio_gpu_fb_helper_funcs = {
|
|
.fb_probe = virtio_gpufb_create,
|
|
};
|
|
|
|
int virtio_gpu_fbdev_init(struct virtio_gpu_device *vgdev)
|
|
{
|
|
struct virtio_gpu_fbdev *vgfbdev;
|
|
int bpp_sel = 32; /* TODO: parameter from somewhere? */
|
|
int ret;
|
|
|
|
vgfbdev = kzalloc(sizeof(struct virtio_gpu_fbdev), GFP_KERNEL);
|
|
if (!vgfbdev)
|
|
return -ENOMEM;
|
|
|
|
vgfbdev->vgdev = vgdev;
|
|
vgdev->vgfbdev = vgfbdev;
|
|
INIT_DELAYED_WORK(&vgfbdev->work, virtio_gpu_fb_dirty_work);
|
|
|
|
drm_fb_helper_prepare(vgdev->ddev, &vgfbdev->helper,
|
|
&virtio_gpu_fb_helper_funcs);
|
|
ret = drm_fb_helper_init(vgdev->ddev, &vgfbdev->helper,
|
|
VIRTIO_GPUFB_CONN_LIMIT);
|
|
if (ret) {
|
|
kfree(vgfbdev);
|
|
return ret;
|
|
}
|
|
|
|
drm_fb_helper_single_add_all_connectors(&vgfbdev->helper);
|
|
drm_fb_helper_initial_config(&vgfbdev->helper, bpp_sel);
|
|
return 0;
|
|
}
|
|
|
|
void virtio_gpu_fbdev_fini(struct virtio_gpu_device *vgdev)
|
|
{
|
|
if (!vgdev->vgfbdev)
|
|
return;
|
|
|
|
virtio_gpu_fbdev_destroy(vgdev->ddev, vgdev->vgfbdev);
|
|
kfree(vgdev->vgfbdev);
|
|
vgdev->vgfbdev = NULL;
|
|
}
|