forked from Minki/linux
3bacf4361c
I've broken this by removing the backoff handling from the
set_config2atomic helper in
commit 38b6441e4e
Author: Daniel Vetter <daniel.vetter@ffwll.ch>
Date: Wed Mar 22 22:50:58 2017 +0100
drm/atomic-helper: Remove the backoff hack from set_config
Fixing this properly would mean we get to wire the acquire_ctx all the
way through vmwgfx fbdev code, and doing the same was tricky for the
shared fbdev layer. Probably much better to look into refactoring the
entire code to use the helpers, but since that's not a viable
long-term solution fix the issue by open-coding a vmwgfx version of
set_config, that does the legacy backoff dance internally.
Note: Just compile-tested. The idea is to take
drm_mode_set_config_internal(), remove the "is this a legacy driver"
check, and whack the drm_atomic_legacy_backoff trickery at the end.
Since drm_atomic_legacy_backoff is for atomic commits only we need to
open-code it.
Cc: Thomas Hellstrom <thellstrom@vmware.com>
Signed-off-by: Daniel Vetter <daniel.vetter@intel.com>
Reviewed-by: Thomas Hellstrom <thellstrom@vmware.com>
Signed-off-by: Sean Paul <seanpaul@chromium.org>
Link: http://patchwork.freedesktop.org/patch/msgid/20170406200256.26040-1-daniel.vetter@ffwll.ch
915 lines
21 KiB
C
915 lines
21 KiB
C
/**************************************************************************
|
|
*
|
|
* Copyright © 2007 David Airlie
|
|
* Copyright © 2009-2015 VMware, Inc., Palo Alto, CA., USA
|
|
* 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
|
|
* THE COPYRIGHT HOLDERS, AUTHORS 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 <linux/export.h>
|
|
|
|
#include <drm/drmP.h>
|
|
#include "vmwgfx_drv.h"
|
|
#include "vmwgfx_kms.h"
|
|
|
|
#include <drm/ttm/ttm_placement.h>
|
|
|
|
#define VMW_DIRTY_DELAY (HZ / 30)
|
|
|
|
struct vmw_fb_par {
|
|
struct vmw_private *vmw_priv;
|
|
|
|
void *vmalloc;
|
|
|
|
struct mutex bo_mutex;
|
|
struct vmw_dma_buffer *vmw_bo;
|
|
struct ttm_bo_kmap_obj map;
|
|
void *bo_ptr;
|
|
unsigned bo_size;
|
|
struct drm_framebuffer *set_fb;
|
|
struct drm_display_mode *set_mode;
|
|
u32 fb_x;
|
|
u32 fb_y;
|
|
bool bo_iowrite;
|
|
|
|
u32 pseudo_palette[17];
|
|
|
|
unsigned max_width;
|
|
unsigned max_height;
|
|
|
|
struct {
|
|
spinlock_t lock;
|
|
bool active;
|
|
unsigned x1;
|
|
unsigned y1;
|
|
unsigned x2;
|
|
unsigned y2;
|
|
} dirty;
|
|
|
|
struct drm_crtc *crtc;
|
|
struct drm_connector *con;
|
|
struct delayed_work local_work;
|
|
};
|
|
|
|
static int vmw_fb_setcolreg(unsigned regno, unsigned red, unsigned green,
|
|
unsigned blue, unsigned transp,
|
|
struct fb_info *info)
|
|
{
|
|
struct vmw_fb_par *par = info->par;
|
|
u32 *pal = par->pseudo_palette;
|
|
|
|
if (regno > 15) {
|
|
DRM_ERROR("Bad regno %u.\n", regno);
|
|
return 1;
|
|
}
|
|
|
|
switch (par->set_fb->format->depth) {
|
|
case 24:
|
|
case 32:
|
|
pal[regno] = ((red & 0xff00) << 8) |
|
|
(green & 0xff00) |
|
|
((blue & 0xff00) >> 8);
|
|
break;
|
|
default:
|
|
DRM_ERROR("Bad depth %u, bpp %u.\n",
|
|
par->set_fb->format->depth,
|
|
par->set_fb->format->cpp[0] * 8);
|
|
return 1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int vmw_fb_check_var(struct fb_var_screeninfo *var,
|
|
struct fb_info *info)
|
|
{
|
|
int depth = var->bits_per_pixel;
|
|
struct vmw_fb_par *par = info->par;
|
|
struct vmw_private *vmw_priv = par->vmw_priv;
|
|
|
|
switch (var->bits_per_pixel) {
|
|
case 32:
|
|
depth = (var->transp.length > 0) ? 32 : 24;
|
|
break;
|
|
default:
|
|
DRM_ERROR("Bad bpp %u.\n", var->bits_per_pixel);
|
|
return -EINVAL;
|
|
}
|
|
|
|
switch (depth) {
|
|
case 24:
|
|
var->red.offset = 16;
|
|
var->green.offset = 8;
|
|
var->blue.offset = 0;
|
|
var->red.length = 8;
|
|
var->green.length = 8;
|
|
var->blue.length = 8;
|
|
var->transp.length = 0;
|
|
var->transp.offset = 0;
|
|
break;
|
|
case 32:
|
|
var->red.offset = 16;
|
|
var->green.offset = 8;
|
|
var->blue.offset = 0;
|
|
var->red.length = 8;
|
|
var->green.length = 8;
|
|
var->blue.length = 8;
|
|
var->transp.length = 8;
|
|
var->transp.offset = 24;
|
|
break;
|
|
default:
|
|
DRM_ERROR("Bad depth %u.\n", depth);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if ((var->xoffset + var->xres) > par->max_width ||
|
|
(var->yoffset + var->yres) > par->max_height) {
|
|
DRM_ERROR("Requested geom can not fit in framebuffer\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (!vmw_kms_validate_mode_vram(vmw_priv,
|
|
var->xres * var->bits_per_pixel/8,
|
|
var->yoffset + var->yres)) {
|
|
DRM_ERROR("Requested geom can not fit in framebuffer\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int vmw_fb_blank(int blank, struct fb_info *info)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Dirty code
|
|
*/
|
|
|
|
static void vmw_fb_dirty_flush(struct work_struct *work)
|
|
{
|
|
struct vmw_fb_par *par = container_of(work, struct vmw_fb_par,
|
|
local_work.work);
|
|
struct vmw_private *vmw_priv = par->vmw_priv;
|
|
struct fb_info *info = vmw_priv->fb_info;
|
|
unsigned long irq_flags;
|
|
s32 dst_x1, dst_x2, dst_y1, dst_y2, w, h;
|
|
u32 cpp, max_x, max_y;
|
|
struct drm_clip_rect clip;
|
|
struct drm_framebuffer *cur_fb;
|
|
u8 *src_ptr, *dst_ptr;
|
|
|
|
if (vmw_priv->suspended)
|
|
return;
|
|
|
|
mutex_lock(&par->bo_mutex);
|
|
cur_fb = par->set_fb;
|
|
if (!cur_fb)
|
|
goto out_unlock;
|
|
|
|
spin_lock_irqsave(&par->dirty.lock, irq_flags);
|
|
if (!par->dirty.active) {
|
|
spin_unlock_irqrestore(&par->dirty.lock, irq_flags);
|
|
goto out_unlock;
|
|
}
|
|
|
|
/*
|
|
* Handle panning when copying from vmalloc to framebuffer.
|
|
* Clip dirty area to framebuffer.
|
|
*/
|
|
cpp = cur_fb->format->cpp[0];
|
|
max_x = par->fb_x + cur_fb->width;
|
|
max_y = par->fb_y + cur_fb->height;
|
|
|
|
dst_x1 = par->dirty.x1 - par->fb_x;
|
|
dst_y1 = par->dirty.y1 - par->fb_y;
|
|
dst_x1 = max_t(s32, dst_x1, 0);
|
|
dst_y1 = max_t(s32, dst_y1, 0);
|
|
|
|
dst_x2 = par->dirty.x2 - par->fb_x;
|
|
dst_y2 = par->dirty.y2 - par->fb_y;
|
|
dst_x2 = min_t(s32, dst_x2, max_x);
|
|
dst_y2 = min_t(s32, dst_y2, max_y);
|
|
w = dst_x2 - dst_x1;
|
|
h = dst_y2 - dst_y1;
|
|
w = max_t(s32, 0, w);
|
|
h = max_t(s32, 0, h);
|
|
|
|
par->dirty.x1 = par->dirty.x2 = 0;
|
|
par->dirty.y1 = par->dirty.y2 = 0;
|
|
spin_unlock_irqrestore(&par->dirty.lock, irq_flags);
|
|
|
|
if (w && h) {
|
|
dst_ptr = (u8 *)par->bo_ptr +
|
|
(dst_y1 * par->set_fb->pitches[0] + dst_x1 * cpp);
|
|
src_ptr = (u8 *)par->vmalloc +
|
|
((dst_y1 + par->fb_y) * info->fix.line_length +
|
|
(dst_x1 + par->fb_x) * cpp);
|
|
|
|
while (h-- > 0) {
|
|
memcpy(dst_ptr, src_ptr, w*cpp);
|
|
dst_ptr += par->set_fb->pitches[0];
|
|
src_ptr += info->fix.line_length;
|
|
}
|
|
|
|
clip.x1 = dst_x1;
|
|
clip.x2 = dst_x2;
|
|
clip.y1 = dst_y1;
|
|
clip.y2 = dst_y2;
|
|
|
|
WARN_ON_ONCE(par->set_fb->funcs->dirty(cur_fb, NULL, 0, 0,
|
|
&clip, 1));
|
|
vmw_fifo_flush(vmw_priv, false);
|
|
}
|
|
out_unlock:
|
|
mutex_unlock(&par->bo_mutex);
|
|
}
|
|
|
|
static void vmw_fb_dirty_mark(struct vmw_fb_par *par,
|
|
unsigned x1, unsigned y1,
|
|
unsigned width, unsigned height)
|
|
{
|
|
unsigned long flags;
|
|
unsigned x2 = x1 + width;
|
|
unsigned y2 = y1 + height;
|
|
|
|
spin_lock_irqsave(&par->dirty.lock, flags);
|
|
if (par->dirty.x1 == par->dirty.x2) {
|
|
par->dirty.x1 = x1;
|
|
par->dirty.y1 = y1;
|
|
par->dirty.x2 = x2;
|
|
par->dirty.y2 = y2;
|
|
/* if we are active start the dirty work
|
|
* we share the work with the defio system */
|
|
if (par->dirty.active)
|
|
schedule_delayed_work(&par->local_work,
|
|
VMW_DIRTY_DELAY);
|
|
} else {
|
|
if (x1 < par->dirty.x1)
|
|
par->dirty.x1 = x1;
|
|
if (y1 < par->dirty.y1)
|
|
par->dirty.y1 = y1;
|
|
if (x2 > par->dirty.x2)
|
|
par->dirty.x2 = x2;
|
|
if (y2 > par->dirty.y2)
|
|
par->dirty.y2 = y2;
|
|
}
|
|
spin_unlock_irqrestore(&par->dirty.lock, flags);
|
|
}
|
|
|
|
static int vmw_fb_pan_display(struct fb_var_screeninfo *var,
|
|
struct fb_info *info)
|
|
{
|
|
struct vmw_fb_par *par = info->par;
|
|
|
|
if ((var->xoffset + var->xres) > var->xres_virtual ||
|
|
(var->yoffset + var->yres) > var->yres_virtual) {
|
|
DRM_ERROR("Requested panning can not fit in framebuffer\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
mutex_lock(&par->bo_mutex);
|
|
par->fb_x = var->xoffset;
|
|
par->fb_y = var->yoffset;
|
|
if (par->set_fb)
|
|
vmw_fb_dirty_mark(par, par->fb_x, par->fb_y, par->set_fb->width,
|
|
par->set_fb->height);
|
|
mutex_unlock(&par->bo_mutex);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void vmw_deferred_io(struct fb_info *info,
|
|
struct list_head *pagelist)
|
|
{
|
|
struct vmw_fb_par *par = info->par;
|
|
unsigned long start, end, min, max;
|
|
unsigned long flags;
|
|
struct page *page;
|
|
int y1, y2;
|
|
|
|
min = ULONG_MAX;
|
|
max = 0;
|
|
list_for_each_entry(page, pagelist, lru) {
|
|
start = page->index << PAGE_SHIFT;
|
|
end = start + PAGE_SIZE - 1;
|
|
min = min(min, start);
|
|
max = max(max, end);
|
|
}
|
|
|
|
if (min < max) {
|
|
y1 = min / info->fix.line_length;
|
|
y2 = (max / info->fix.line_length) + 1;
|
|
|
|
spin_lock_irqsave(&par->dirty.lock, flags);
|
|
par->dirty.x1 = 0;
|
|
par->dirty.y1 = y1;
|
|
par->dirty.x2 = info->var.xres;
|
|
par->dirty.y2 = y2;
|
|
spin_unlock_irqrestore(&par->dirty.lock, flags);
|
|
|
|
/*
|
|
* Since we've already waited on this work once, try to
|
|
* execute asap.
|
|
*/
|
|
cancel_delayed_work(&par->local_work);
|
|
schedule_delayed_work(&par->local_work, 0);
|
|
}
|
|
};
|
|
|
|
static struct fb_deferred_io vmw_defio = {
|
|
.delay = VMW_DIRTY_DELAY,
|
|
.deferred_io = vmw_deferred_io,
|
|
};
|
|
|
|
/*
|
|
* Draw code
|
|
*/
|
|
|
|
static void vmw_fb_fillrect(struct fb_info *info, const struct fb_fillrect *rect)
|
|
{
|
|
cfb_fillrect(info, rect);
|
|
vmw_fb_dirty_mark(info->par, rect->dx, rect->dy,
|
|
rect->width, rect->height);
|
|
}
|
|
|
|
static void vmw_fb_copyarea(struct fb_info *info, const struct fb_copyarea *region)
|
|
{
|
|
cfb_copyarea(info, region);
|
|
vmw_fb_dirty_mark(info->par, region->dx, region->dy,
|
|
region->width, region->height);
|
|
}
|
|
|
|
static void vmw_fb_imageblit(struct fb_info *info, const struct fb_image *image)
|
|
{
|
|
cfb_imageblit(info, image);
|
|
vmw_fb_dirty_mark(info->par, image->dx, image->dy,
|
|
image->width, image->height);
|
|
}
|
|
|
|
/*
|
|
* Bring up code
|
|
*/
|
|
|
|
static int vmw_fb_create_bo(struct vmw_private *vmw_priv,
|
|
size_t size, struct vmw_dma_buffer **out)
|
|
{
|
|
struct vmw_dma_buffer *vmw_bo;
|
|
int ret;
|
|
|
|
(void) ttm_write_lock(&vmw_priv->reservation_sem, false);
|
|
|
|
vmw_bo = kmalloc(sizeof(*vmw_bo), GFP_KERNEL);
|
|
if (!vmw_bo) {
|
|
ret = -ENOMEM;
|
|
goto err_unlock;
|
|
}
|
|
|
|
ret = vmw_dmabuf_init(vmw_priv, vmw_bo, size,
|
|
&vmw_sys_placement,
|
|
false,
|
|
&vmw_dmabuf_bo_free);
|
|
if (unlikely(ret != 0))
|
|
goto err_unlock; /* init frees the buffer on failure */
|
|
|
|
*out = vmw_bo;
|
|
ttm_write_unlock(&vmw_priv->reservation_sem);
|
|
|
|
return 0;
|
|
|
|
err_unlock:
|
|
ttm_write_unlock(&vmw_priv->reservation_sem);
|
|
return ret;
|
|
}
|
|
|
|
static int vmw_fb_compute_depth(struct fb_var_screeninfo *var,
|
|
int *depth)
|
|
{
|
|
switch (var->bits_per_pixel) {
|
|
case 32:
|
|
*depth = (var->transp.length > 0) ? 32 : 24;
|
|
break;
|
|
default:
|
|
DRM_ERROR("Bad bpp %u.\n", var->bits_per_pixel);
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int vmwgfx_set_config_internal(struct drm_mode_set *set)
|
|
{
|
|
struct drm_crtc *crtc = set->crtc;
|
|
struct drm_framebuffer *fb;
|
|
struct drm_crtc *tmp;
|
|
struct drm_modeset_acquire_ctx *ctx;
|
|
struct drm_device *dev = set->crtc->dev;
|
|
int ret;
|
|
|
|
ctx = dev->mode_config.acquire_ctx;
|
|
|
|
restart:
|
|
/*
|
|
* NOTE: ->set_config can also disable other crtcs (if we steal all
|
|
* connectors from it), hence we need to refcount the fbs across all
|
|
* crtcs. Atomic modeset will have saner semantics ...
|
|
*/
|
|
drm_for_each_crtc(tmp, dev)
|
|
tmp->primary->old_fb = tmp->primary->fb;
|
|
|
|
fb = set->fb;
|
|
|
|
ret = crtc->funcs->set_config(set, ctx);
|
|
if (ret == 0) {
|
|
crtc->primary->crtc = crtc;
|
|
crtc->primary->fb = fb;
|
|
}
|
|
|
|
drm_for_each_crtc(tmp, dev) {
|
|
if (tmp->primary->fb)
|
|
drm_framebuffer_get(tmp->primary->fb);
|
|
if (tmp->primary->old_fb)
|
|
drm_framebuffer_put(tmp->primary->old_fb);
|
|
tmp->primary->old_fb = NULL;
|
|
}
|
|
|
|
if (ret == -EDEADLK) {
|
|
dev->mode_config.acquire_ctx = NULL;
|
|
|
|
retry_locking:
|
|
drm_modeset_backoff(ctx);
|
|
|
|
ret = drm_modeset_lock_all_ctx(dev, ctx);
|
|
if (ret)
|
|
goto retry_locking;
|
|
|
|
dev->mode_config.acquire_ctx = ctx;
|
|
|
|
goto restart;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int vmw_fb_kms_detach(struct vmw_fb_par *par,
|
|
bool detach_bo,
|
|
bool unref_bo)
|
|
{
|
|
struct drm_framebuffer *cur_fb = par->set_fb;
|
|
int ret;
|
|
|
|
/* Detach the KMS framebuffer from crtcs */
|
|
if (par->set_mode) {
|
|
struct drm_mode_set set;
|
|
|
|
set.crtc = par->crtc;
|
|
set.x = 0;
|
|
set.y = 0;
|
|
set.mode = NULL;
|
|
set.fb = NULL;
|
|
set.num_connectors = 0;
|
|
set.connectors = &par->con;
|
|
ret = vmwgfx_set_config_internal(&set);
|
|
if (ret) {
|
|
DRM_ERROR("Could not unset a mode.\n");
|
|
return ret;
|
|
}
|
|
drm_mode_destroy(par->vmw_priv->dev, par->set_mode);
|
|
par->set_mode = NULL;
|
|
}
|
|
|
|
if (cur_fb) {
|
|
drm_framebuffer_unreference(cur_fb);
|
|
par->set_fb = NULL;
|
|
}
|
|
|
|
if (par->vmw_bo && detach_bo) {
|
|
struct vmw_private *vmw_priv = par->vmw_priv;
|
|
|
|
if (par->bo_ptr) {
|
|
ttm_bo_kunmap(&par->map);
|
|
par->bo_ptr = NULL;
|
|
}
|
|
if (unref_bo)
|
|
vmw_dmabuf_unreference(&par->vmw_bo);
|
|
else if (vmw_priv->active_display_unit != vmw_du_legacy)
|
|
vmw_dmabuf_unpin(par->vmw_priv, par->vmw_bo, false);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int vmw_fb_kms_framebuffer(struct fb_info *info)
|
|
{
|
|
struct drm_mode_fb_cmd2 mode_cmd;
|
|
struct vmw_fb_par *par = info->par;
|
|
struct fb_var_screeninfo *var = &info->var;
|
|
struct drm_framebuffer *cur_fb;
|
|
struct vmw_framebuffer *vfb;
|
|
int ret = 0, depth;
|
|
size_t new_bo_size;
|
|
|
|
ret = vmw_fb_compute_depth(var, &depth);
|
|
if (ret)
|
|
return ret;
|
|
|
|
mode_cmd.width = var->xres;
|
|
mode_cmd.height = var->yres;
|
|
mode_cmd.pitches[0] = ((var->bits_per_pixel + 7) / 8) * mode_cmd.width;
|
|
mode_cmd.pixel_format =
|
|
drm_mode_legacy_fb_format(var->bits_per_pixel, depth);
|
|
|
|
cur_fb = par->set_fb;
|
|
if (cur_fb && cur_fb->width == mode_cmd.width &&
|
|
cur_fb->height == mode_cmd.height &&
|
|
cur_fb->format->format == mode_cmd.pixel_format &&
|
|
cur_fb->pitches[0] == mode_cmd.pitches[0])
|
|
return 0;
|
|
|
|
/* Need new buffer object ? */
|
|
new_bo_size = (size_t) mode_cmd.pitches[0] * (size_t) mode_cmd.height;
|
|
ret = vmw_fb_kms_detach(par,
|
|
par->bo_size < new_bo_size ||
|
|
par->bo_size > 2*new_bo_size,
|
|
true);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (!par->vmw_bo) {
|
|
ret = vmw_fb_create_bo(par->vmw_priv, new_bo_size,
|
|
&par->vmw_bo);
|
|
if (ret) {
|
|
DRM_ERROR("Failed creating a buffer object for "
|
|
"fbdev.\n");
|
|
return ret;
|
|
}
|
|
par->bo_size = new_bo_size;
|
|
}
|
|
|
|
vfb = vmw_kms_new_framebuffer(par->vmw_priv, par->vmw_bo, NULL,
|
|
true, &mode_cmd);
|
|
if (IS_ERR(vfb))
|
|
return PTR_ERR(vfb);
|
|
|
|
par->set_fb = &vfb->base;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int vmw_fb_set_par(struct fb_info *info)
|
|
{
|
|
struct vmw_fb_par *par = info->par;
|
|
struct vmw_private *vmw_priv = par->vmw_priv;
|
|
struct drm_mode_set set;
|
|
struct fb_var_screeninfo *var = &info->var;
|
|
struct drm_display_mode new_mode = { DRM_MODE("fb_mode",
|
|
DRM_MODE_TYPE_DRIVER,
|
|
0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
|
|
DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC)
|
|
};
|
|
struct drm_display_mode *old_mode;
|
|
struct drm_display_mode *mode;
|
|
int ret;
|
|
|
|
old_mode = par->set_mode;
|
|
mode = drm_mode_duplicate(vmw_priv->dev, &new_mode);
|
|
if (!mode) {
|
|
DRM_ERROR("Could not create new fb mode.\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
mode->hdisplay = var->xres;
|
|
mode->vdisplay = var->yres;
|
|
vmw_guess_mode_timing(mode);
|
|
|
|
if (old_mode && drm_mode_equal(old_mode, mode)) {
|
|
drm_mode_destroy(vmw_priv->dev, mode);
|
|
mode = old_mode;
|
|
old_mode = NULL;
|
|
} else if (!vmw_kms_validate_mode_vram(vmw_priv,
|
|
mode->hdisplay *
|
|
DIV_ROUND_UP(var->bits_per_pixel, 8),
|
|
mode->vdisplay)) {
|
|
drm_mode_destroy(vmw_priv->dev, mode);
|
|
return -EINVAL;
|
|
}
|
|
|
|
mutex_lock(&par->bo_mutex);
|
|
drm_modeset_lock_all(vmw_priv->dev);
|
|
ret = vmw_fb_kms_framebuffer(info);
|
|
if (ret)
|
|
goto out_unlock;
|
|
|
|
par->fb_x = var->xoffset;
|
|
par->fb_y = var->yoffset;
|
|
|
|
set.crtc = par->crtc;
|
|
set.x = 0;
|
|
set.y = 0;
|
|
set.mode = mode;
|
|
set.fb = par->set_fb;
|
|
set.num_connectors = 1;
|
|
set.connectors = &par->con;
|
|
|
|
ret = vmwgfx_set_config_internal(&set);
|
|
if (ret)
|
|
goto out_unlock;
|
|
|
|
if (!par->bo_ptr) {
|
|
struct vmw_framebuffer *vfb = vmw_framebuffer_to_vfb(set.fb);
|
|
|
|
/*
|
|
* Pin before mapping. Since we don't know in what placement
|
|
* to pin, call into KMS to do it for us. LDU doesn't require
|
|
* additional pinning because set_config() would've pinned
|
|
* it already
|
|
*/
|
|
if (vmw_priv->active_display_unit != vmw_du_legacy) {
|
|
ret = vfb->pin(vfb);
|
|
if (ret) {
|
|
DRM_ERROR("Could not pin the fbdev "
|
|
"framebuffer.\n");
|
|
goto out_unlock;
|
|
}
|
|
}
|
|
|
|
ret = ttm_bo_kmap(&par->vmw_bo->base, 0,
|
|
par->vmw_bo->base.num_pages, &par->map);
|
|
if (ret) {
|
|
if (vmw_priv->active_display_unit != vmw_du_legacy)
|
|
vfb->unpin(vfb);
|
|
|
|
DRM_ERROR("Could not map the fbdev framebuffer.\n");
|
|
goto out_unlock;
|
|
}
|
|
|
|
par->bo_ptr = ttm_kmap_obj_virtual(&par->map, &par->bo_iowrite);
|
|
}
|
|
|
|
|
|
vmw_fb_dirty_mark(par, par->fb_x, par->fb_y,
|
|
par->set_fb->width, par->set_fb->height);
|
|
|
|
/* If there already was stuff dirty we wont
|
|
* schedule a new work, so lets do it now */
|
|
|
|
schedule_delayed_work(&par->local_work, 0);
|
|
|
|
out_unlock:
|
|
if (old_mode)
|
|
drm_mode_destroy(vmw_priv->dev, old_mode);
|
|
par->set_mode = mode;
|
|
|
|
drm_modeset_unlock_all(vmw_priv->dev);
|
|
mutex_unlock(&par->bo_mutex);
|
|
|
|
return ret;
|
|
}
|
|
|
|
|
|
static struct fb_ops vmw_fb_ops = {
|
|
.owner = THIS_MODULE,
|
|
.fb_check_var = vmw_fb_check_var,
|
|
.fb_set_par = vmw_fb_set_par,
|
|
.fb_setcolreg = vmw_fb_setcolreg,
|
|
.fb_fillrect = vmw_fb_fillrect,
|
|
.fb_copyarea = vmw_fb_copyarea,
|
|
.fb_imageblit = vmw_fb_imageblit,
|
|
.fb_pan_display = vmw_fb_pan_display,
|
|
.fb_blank = vmw_fb_blank,
|
|
};
|
|
|
|
int vmw_fb_init(struct vmw_private *vmw_priv)
|
|
{
|
|
struct device *device = &vmw_priv->dev->pdev->dev;
|
|
struct vmw_fb_par *par;
|
|
struct fb_info *info;
|
|
unsigned fb_width, fb_height;
|
|
unsigned fb_bpp, fb_depth, fb_offset, fb_pitch, fb_size;
|
|
struct drm_display_mode *init_mode;
|
|
int ret;
|
|
|
|
fb_bpp = 32;
|
|
fb_depth = 24;
|
|
|
|
/* XXX As shouldn't these be as well. */
|
|
fb_width = min(vmw_priv->fb_max_width, (unsigned)2048);
|
|
fb_height = min(vmw_priv->fb_max_height, (unsigned)2048);
|
|
|
|
fb_pitch = fb_width * fb_bpp / 8;
|
|
fb_size = fb_pitch * fb_height;
|
|
fb_offset = vmw_read(vmw_priv, SVGA_REG_FB_OFFSET);
|
|
|
|
info = framebuffer_alloc(sizeof(*par), device);
|
|
if (!info)
|
|
return -ENOMEM;
|
|
|
|
/*
|
|
* Par
|
|
*/
|
|
vmw_priv->fb_info = info;
|
|
par = info->par;
|
|
memset(par, 0, sizeof(*par));
|
|
INIT_DELAYED_WORK(&par->local_work, &vmw_fb_dirty_flush);
|
|
par->vmw_priv = vmw_priv;
|
|
par->vmalloc = NULL;
|
|
par->max_width = fb_width;
|
|
par->max_height = fb_height;
|
|
|
|
drm_modeset_lock_all(vmw_priv->dev);
|
|
ret = vmw_kms_fbdev_init_data(vmw_priv, 0, par->max_width,
|
|
par->max_height, &par->con,
|
|
&par->crtc, &init_mode);
|
|
if (ret) {
|
|
drm_modeset_unlock_all(vmw_priv->dev);
|
|
goto err_kms;
|
|
}
|
|
|
|
info->var.xres = init_mode->hdisplay;
|
|
info->var.yres = init_mode->vdisplay;
|
|
drm_modeset_unlock_all(vmw_priv->dev);
|
|
|
|
/*
|
|
* Create buffers and alloc memory
|
|
*/
|
|
par->vmalloc = vzalloc(fb_size);
|
|
if (unlikely(par->vmalloc == NULL)) {
|
|
ret = -ENOMEM;
|
|
goto err_free;
|
|
}
|
|
|
|
/*
|
|
* Fixed and var
|
|
*/
|
|
strcpy(info->fix.id, "svgadrmfb");
|
|
info->fix.type = FB_TYPE_PACKED_PIXELS;
|
|
info->fix.visual = FB_VISUAL_TRUECOLOR;
|
|
info->fix.type_aux = 0;
|
|
info->fix.xpanstep = 1; /* doing it in hw */
|
|
info->fix.ypanstep = 1; /* doing it in hw */
|
|
info->fix.ywrapstep = 0;
|
|
info->fix.accel = FB_ACCEL_NONE;
|
|
info->fix.line_length = fb_pitch;
|
|
|
|
info->fix.smem_start = 0;
|
|
info->fix.smem_len = fb_size;
|
|
|
|
info->pseudo_palette = par->pseudo_palette;
|
|
info->screen_base = (char __iomem *)par->vmalloc;
|
|
info->screen_size = fb_size;
|
|
|
|
info->flags = FBINFO_DEFAULT;
|
|
info->fbops = &vmw_fb_ops;
|
|
|
|
/* 24 depth per default */
|
|
info->var.red.offset = 16;
|
|
info->var.green.offset = 8;
|
|
info->var.blue.offset = 0;
|
|
info->var.red.length = 8;
|
|
info->var.green.length = 8;
|
|
info->var.blue.length = 8;
|
|
info->var.transp.offset = 0;
|
|
info->var.transp.length = 0;
|
|
|
|
info->var.xres_virtual = fb_width;
|
|
info->var.yres_virtual = fb_height;
|
|
info->var.bits_per_pixel = fb_bpp;
|
|
info->var.xoffset = 0;
|
|
info->var.yoffset = 0;
|
|
info->var.activate = FB_ACTIVATE_NOW;
|
|
info->var.height = -1;
|
|
info->var.width = -1;
|
|
|
|
/* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */
|
|
info->apertures = alloc_apertures(1);
|
|
if (!info->apertures) {
|
|
ret = -ENOMEM;
|
|
goto err_aper;
|
|
}
|
|
info->apertures->ranges[0].base = vmw_priv->vram_start;
|
|
info->apertures->ranges[0].size = vmw_priv->vram_size;
|
|
|
|
/*
|
|
* Dirty & Deferred IO
|
|
*/
|
|
par->dirty.x1 = par->dirty.x2 = 0;
|
|
par->dirty.y1 = par->dirty.y2 = 0;
|
|
par->dirty.active = true;
|
|
spin_lock_init(&par->dirty.lock);
|
|
mutex_init(&par->bo_mutex);
|
|
info->fbdefio = &vmw_defio;
|
|
fb_deferred_io_init(info);
|
|
|
|
ret = register_framebuffer(info);
|
|
if (unlikely(ret != 0))
|
|
goto err_defio;
|
|
|
|
vmw_fb_set_par(info);
|
|
|
|
return 0;
|
|
|
|
err_defio:
|
|
fb_deferred_io_cleanup(info);
|
|
err_aper:
|
|
err_free:
|
|
vfree(par->vmalloc);
|
|
err_kms:
|
|
framebuffer_release(info);
|
|
vmw_priv->fb_info = NULL;
|
|
|
|
return ret;
|
|
}
|
|
|
|
int vmw_fb_close(struct vmw_private *vmw_priv)
|
|
{
|
|
struct fb_info *info;
|
|
struct vmw_fb_par *par;
|
|
|
|
if (!vmw_priv->fb_info)
|
|
return 0;
|
|
|
|
info = vmw_priv->fb_info;
|
|
par = info->par;
|
|
|
|
/* ??? order */
|
|
fb_deferred_io_cleanup(info);
|
|
cancel_delayed_work_sync(&par->local_work);
|
|
unregister_framebuffer(info);
|
|
|
|
(void) vmw_fb_kms_detach(par, true, true);
|
|
|
|
vfree(par->vmalloc);
|
|
framebuffer_release(info);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int vmw_fb_off(struct vmw_private *vmw_priv)
|
|
{
|
|
struct fb_info *info;
|
|
struct vmw_fb_par *par;
|
|
unsigned long flags;
|
|
|
|
if (!vmw_priv->fb_info)
|
|
return -EINVAL;
|
|
|
|
info = vmw_priv->fb_info;
|
|
par = info->par;
|
|
|
|
spin_lock_irqsave(&par->dirty.lock, flags);
|
|
par->dirty.active = false;
|
|
spin_unlock_irqrestore(&par->dirty.lock, flags);
|
|
|
|
flush_delayed_work(&info->deferred_work);
|
|
flush_delayed_work(&par->local_work);
|
|
|
|
mutex_lock(&par->bo_mutex);
|
|
drm_modeset_lock_all(vmw_priv->dev);
|
|
(void) vmw_fb_kms_detach(par, true, false);
|
|
drm_modeset_unlock_all(vmw_priv->dev);
|
|
mutex_unlock(&par->bo_mutex);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int vmw_fb_on(struct vmw_private *vmw_priv)
|
|
{
|
|
struct fb_info *info;
|
|
struct vmw_fb_par *par;
|
|
unsigned long flags;
|
|
|
|
if (!vmw_priv->fb_info)
|
|
return -EINVAL;
|
|
|
|
info = vmw_priv->fb_info;
|
|
par = info->par;
|
|
|
|
vmw_fb_set_par(info);
|
|
spin_lock_irqsave(&par->dirty.lock, flags);
|
|
par->dirty.active = true;
|
|
spin_unlock_irqrestore(&par->dirty.lock, flags);
|
|
|
|
return 0;
|
|
}
|