[net-next-2.6.git] / drivers / gpu / drm / vmwgfx / vmwgfx_fb.c

/**************************************************************************
 *
 * Copyright © 2007 David Airlie
 * Copyright © 2009 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 "drmP.h"
#include "vmwgfx_drv.h"

#include "ttm/ttm_placement.h"

#define VMW_DIRTY_DELAY (HZ / 30)

struct vmw_fb_par {
	struct vmw_private *vmw_priv;

	void *vmalloc;

	struct vmw_dma_buffer *vmw_bo;
	struct ttm_bo_kmap_obj map;

	u32 pseudo_palette[17];

	unsigned depth;
	unsigned bpp;

	unsigned max_width;
	unsigned max_height;

	void *bo_ptr;
	unsigned bo_size;
	bool bo_iowrite;

	struct {
		spinlock_t lock;
		bool active;
		unsigned x1;
		unsigned y1;
		unsigned x2;
		unsigned y2;
	} dirty;
};

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->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->depth, par->bpp);
		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 (!(vmw_priv->capabilities & SVGA_CAP_DISPLAY_TOPOLOGY) &&
	    (var->xoffset != 0 || var->yoffset != 0)) {
		DRM_ERROR("Can not handle panning without display topology\n");
		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;
	}

	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;

	vmw_kms_write_svga(vmw_priv, info->var.xres, info->var.yres,
			   info->fix.line_length,
			   par->bpp, par->depth);
	if (vmw_priv->capabilities & SVGA_CAP_DISPLAY_TOPOLOGY) {
		/* TODO check if pitch and offset changes */
		vmw_write(vmw_priv, SVGA_REG_NUM_GUEST_DISPLAYS, 1);
		vmw_write(vmw_priv, SVGA_REG_DISPLAY_ID, 0);
		vmw_write(vmw_priv, SVGA_REG_DISPLAY_IS_PRIMARY, true);
		vmw_write(vmw_priv, SVGA_REG_DISPLAY_POSITION_X, info->var.xoffset);
		vmw_write(vmw_priv, SVGA_REG_DISPLAY_POSITION_Y, info->var.yoffset);
		vmw_write(vmw_priv, SVGA_REG_DISPLAY_WIDTH, info->var.xres);
		vmw_write(vmw_priv, SVGA_REG_DISPLAY_HEIGHT, info->var.yres);
		vmw_write(vmw_priv, SVGA_REG_DISPLAY_ID, SVGA_ID_INVALID);
	}

	/* This is really helpful since if this fails the user
	 * can probably not see anything on the screen.
	 */
	WARN_ON(vmw_read(vmw_priv, SVGA_REG_FB_OFFSET) != 0);

	return 0;
}

static int vmw_fb_pan_display(struct fb_var_screeninfo *var,
			      struct fb_info *info)
{
	return 0;
}

static int vmw_fb_blank(int blank, struct fb_info *info)
{
	return 0;
}

/*
 * Dirty code
 */

static void vmw_fb_dirty_flush(struct vmw_fb_par *par)
{
	struct vmw_private *vmw_priv = par->vmw_priv;
	struct fb_info *info = vmw_priv->fb_info;
	int stride = (info->fix.line_length / 4);
	int *src = (int *)info->screen_base;
	__le32 __iomem *vram_mem = par->bo_ptr;
	unsigned long flags;
	unsigned x, y, w, h;
	int i, k;
	struct {
		uint32_t header;
		SVGAFifoCmdUpdate body;
	} *cmd;

	spin_lock_irqsave(&par->dirty.lock, flags);
	if (!par->dirty.active) {
		spin_unlock_irqrestore(&par->dirty.lock, flags);
		return;
	}
	x = par->dirty.x1;
	y = par->dirty.y1;
	w = min(par->dirty.x2, info->var.xres) - x;
	h = min(par->dirty.y2, info->var.yres) - y;
	par->dirty.x1 = par->dirty.x2 = 0;
	par->dirty.y1 = par->dirty.y2 = 0;
	spin_unlock_irqrestore(&par->dirty.lock, flags);

	for (i = y * stride; i < info->fix.smem_len / 4; i += stride) {
		for (k = i+x; k < i+x+w && k < info->fix.smem_len / 4; k++)
			iowrite32(src[k], vram_mem + k);
	}

#if 0
	DRM_INFO("%s, (%u, %u) (%ux%u)\n", __func__, x, y, w, h);
#endif

	cmd = vmw_fifo_reserve(vmw_priv, sizeof(*cmd));
	if (unlikely(cmd == NULL)) {
		DRM_ERROR("Fifo reserve failed.\n");
		return;
	}

	cmd->header = cpu_to_le32(SVGA_CMD_UPDATE);
	cmd->body.x = cpu_to_le32(x);
	cmd->body.y = cpu_to_le32(y);
	cmd->body.width = cpu_to_le32(w);
	cmd->body.height = cpu_to_le32(h);
	vmw_fifo_commit(vmw_priv, sizeof(*cmd));
}

static void vmw_fb_dirty_mark(struct vmw_fb_par *par,
			      unsigned x1, unsigned y1,
			      unsigned width, unsigned height)
{
	struct fb_info *info = par->vmw_priv->fb_info;
	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(&info->deferred_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 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);
	}

	vmw_fb_dirty_flush(par);
};

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 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,
};

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;
	struct ttm_placement ne_placement = vmw_vram_ne_placement;
	int ret;

	ne_placement.lpfn = (size + PAGE_SIZE - 1) >> PAGE_SHIFT;

	/* interuptable? */
	ret = ttm_write_lock(&vmw_priv->fbdev_master.lock, false);
	if (unlikely(ret != 0))
		return ret;

	vmw_bo = kmalloc(sizeof(*vmw_bo), GFP_KERNEL);
	if (!vmw_bo)
		goto err_unlock;

	ret = vmw_dmabuf_init(vmw_priv, vmw_bo, size,
			      &ne_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->fbdev_master.lock);

	return 0;

err_unlock:
	ttm_write_unlock(&vmw_priv->fbdev_master.lock);
	return ret;
}

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 initial_width, initial_height;
	unsigned fb_width, fb_height;
	unsigned fb_bbp, fb_depth, fb_offset, fb_pitch, fb_size;
	int ret;

	/* XXX These shouldn't be hardcoded. */
	initial_width = 800;
	initial_height = 600;

	fb_bbp = 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);

	initial_width = min(fb_width, initial_width);
	initial_height = min(fb_height, initial_height);

	fb_pitch = fb_width * fb_bbp / 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;
	par->vmw_priv = vmw_priv;
	par->depth = fb_depth;
	par->bpp = fb_bbp;
	par->vmalloc = NULL;
	par->max_width = fb_width;
	par->max_height = fb_height;

	/*
	 * Create buffers and alloc memory
	 */
	par->vmalloc = vmalloc(fb_size);
	if (unlikely(par->vmalloc == NULL)) {
		ret = -ENOMEM;
		goto err_free;
	}

	ret = vmw_fb_create_bo(vmw_priv, fb_size, &par->vmw_bo);
	if (unlikely(ret != 0))
		goto err_free;

	ret = ttm_bo_kmap(&par->vmw_bo->base,
			  0,
			  par->vmw_bo->base.num_pages,
			  &par->map);
	if (unlikely(ret != 0))
		goto err_unref;
	par->bo_ptr = ttm_kmap_obj_virtual(&par->map, &par->bo_iowrite);
	par->bo_size = fb_size;

	/*
	 * 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->fix.mmio_start = 0;
	info->fix.mmio_len = 0;

	info->pseudo_palette = par->pseudo_palette;
	info->screen_base = 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 = par->bpp;
	info->var.xoffset = 0;
	info->var.yoffset = 0;
	info->var.activate = FB_ACTIVATE_NOW;
	info->var.height = -1;
	info->var.width = -1;

	info->var.xres = initial_width;
	info->var.yres = initial_height;

#if 0
	info->pixmap.size = 64*1024;
	info->pixmap.buf_align = 8;
	info->pixmap.access_align = 32;
	info->pixmap.flags = FB_PIXMAP_SYSTEM;
	info->pixmap.scan_align = 1;
#else
	info->pixmap.size = 0;
	info->pixmap.buf_align = 8;
	info->pixmap.access_align = 32;
	info->pixmap.flags = FB_PIXMAP_SYSTEM;
	info->pixmap.scan_align = 1;
#endif

	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);
	info->fbdefio = &vmw_defio;
	fb_deferred_io_init(info);

	ret = register_framebuffer(info);
	if (unlikely(ret != 0))
		goto err_defio;

	return 0;

err_defio:
	fb_deferred_io_cleanup(info);
err_aper:
	ttm_bo_kunmap(&par->map);
err_unref:
	ttm_bo_unref((struct ttm_buffer_object **)&par->vmw_bo);
err_free:
	vfree(par->vmalloc);
	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;
	struct ttm_buffer_object *bo;

	if (!vmw_priv->fb_info)
		return 0;

	info = vmw_priv->fb_info;
	par = info->par;
	bo = &par->vmw_bo->base;
	par->vmw_bo = NULL;

	/* ??? order */
	fb_deferred_io_cleanup(info);
	unregister_framebuffer(info);

	ttm_bo_kunmap(&par->map);
	ttm_bo_unref(&bo);

	vfree(par->vmalloc);
	framebuffer_release(info);

	return 0;
}

int vmw_dmabuf_from_vram(struct vmw_private *vmw_priv,
			 struct vmw_dma_buffer *vmw_bo)
{
	struct ttm_buffer_object *bo = &vmw_bo->base;
	int ret = 0;

	ret = ttm_bo_reserve(bo, false, false, false, 0);
	if (unlikely(ret != 0))
		return ret;

	ret = ttm_bo_validate(bo, &vmw_sys_placement, false, false, false);
	ttm_bo_unreserve(bo);

	return ret;
}

int vmw_dmabuf_to_start_of_vram(struct vmw_private *vmw_priv,
				struct vmw_dma_buffer *vmw_bo)
{
	struct ttm_buffer_object *bo = &vmw_bo->base;
	struct ttm_placement ne_placement = vmw_vram_ne_placement;
	int ret = 0;

	ne_placement.lpfn = bo->num_pages;

	/* interuptable? */
	ret = ttm_write_lock(&vmw_priv->active_master->lock, false);
	if (unlikely(ret != 0))
		return ret;

	ret = ttm_bo_reserve(bo, false, false, false, 0);
	if (unlikely(ret != 0))
		goto err_unlock;

	if (bo->mem.mem_type == TTM_PL_VRAM &&
	    bo->mem.mm_node->start < bo->num_pages)
		(void) ttm_bo_validate(bo, &vmw_sys_placement, false,
				       false, false);

	ret = ttm_bo_validate(bo, &ne_placement, false, false, false);

	/* Could probably bug on */
	WARN_ON(bo->offset != 0);

	ttm_bo_unreserve(bo);
err_unlock:
	ttm_write_unlock(&vmw_priv->active_master->lock);

	return ret;
}

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_scheduled_work();

	par->bo_ptr = NULL;
	ttm_bo_kunmap(&par->map);

	vmw_dmabuf_from_vram(vmw_priv, par->vmw_bo);

	return 0;
}

int vmw_fb_on(struct vmw_private *vmw_priv)
{
	struct fb_info *info;
	struct vmw_fb_par *par;
	unsigned long flags;
	bool dummy;
	int ret;

	if (!vmw_priv->fb_info)
		return -EINVAL;

	info = vmw_priv->fb_info;
	par = info->par;

	/* we are already active */
	if (par->bo_ptr != NULL)
		return 0;

	/* Make sure that all overlays are stoped when we take over */
	vmw_overlay_stop_all(vmw_priv);

	ret = vmw_dmabuf_to_start_of_vram(vmw_priv, par->vmw_bo);
	if (unlikely(ret != 0)) {
		DRM_ERROR("could not move buffer to start of VRAM\n");
		goto err_no_buffer;
	}

	ret = ttm_bo_kmap(&par->vmw_bo->base,
			  0,
			  par->vmw_bo->base.num_pages,
			  &par->map);
	BUG_ON(ret != 0);
	par->bo_ptr = ttm_kmap_obj_virtual(&par->map, &dummy);

	spin_lock_irqsave(&par->dirty.lock, flags);
	par->dirty.active = true;
	spin_unlock_irqrestore(&par->dirty.lock, flags);

err_no_buffer:
	vmw_fb_set_par(info);

	vmw_fb_dirty_mark(par, 0, 0, info->var.xres, info->var.yres);

	/* If there already was stuff dirty we wont
	 * schedule a new work, so lets do it now */
	schedule_delayed_work(&info->deferred_work, 0);

	return 0;
}
Commit	Line	Data
fb1d9738 JB	1	/**************************************************************************
	2	*
	3	* Copyright © 2007 David Airlie
	4	* Copyright © 2009 VMware, Inc., Palo Alto, CA., USA
	5	* All Rights Reserved.
	6	*
	7	* Permission is hereby granted, free of charge, to any person obtaining a
	8	* copy of this software and associated documentation files (the
	9	* "Software"), to deal in the Software without restriction, including
	10	* without limitation the rights to use, copy, modify, merge, publish,
	11	* distribute, sub license, and/or sell copies of the Software, and to
	12	* permit persons to whom the Software is furnished to do so, subject to
	13	* the following conditions:
	14	*
	15	* The above copyright notice and this permission notice (including the
	16	* next paragraph) shall be included in all copies or substantial portions
	17	* of the Software.
	18	*
	19	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	20	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	21	* FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
	22	* THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
	23	* DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
	24	* OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
	25	* USE OR OTHER DEALINGS IN THE SOFTWARE.
	26	*
	27	**************************************************************************/
	28
	29	#include "drmP.h"
	30	#include "vmwgfx_drv.h"
	31
	32	#include "ttm/ttm_placement.h"
	33
	34	#define VMW_DIRTY_DELAY (HZ / 30)
	35
	36	struct vmw_fb_par {
	37	struct vmw_private *vmw_priv;
	38
	39	void *vmalloc;
	40
	41	struct vmw_dma_buffer *vmw_bo;
	42	struct ttm_bo_kmap_obj map;
	43
	44	u32 pseudo_palette[17];
	45
	46	unsigned depth;
	47	unsigned bpp;
	48
	49	unsigned max_width;
	50	unsigned max_height;
	51
	52	void *bo_ptr;
	53	unsigned bo_size;
	54	bool bo_iowrite;
	55
	56	struct {
	57	spinlock_t lock;
	58	bool active;
	59	unsigned x1;
	60	unsigned y1;
	61	unsigned x2;
	62	unsigned y2;
	63	} dirty;
	64	};
65
66	static int vmw_fb_setcolreg(unsigned regno, unsigned red, unsigned green,
67	unsigned blue, unsigned transp,
68	struct fb_info *info)
69	{
70	struct vmw_fb_par *par = info->par;
71	u32 *pal = par->pseudo_palette;
72
73	if (regno > 15) {
74	DRM_ERROR("Bad regno %u.\n", regno);
75	return 1;
76	}
77
78	switch (par->depth) {
79	case 24:
80	case 32:
81	pal[regno] = ((red & 0xff00) << 8) \|
82	(green & 0xff00) \|
83	((blue & 0xff00) >> 8);
84	break;
85	default:
86	DRM_ERROR("Bad depth %u, bpp %u.\n", par->depth, par->bpp);
87	return 1;
88	}
89
90	return 0;
91	}
92
93	static int vmw_fb_check_var(struct fb_var_screeninfo *var,
94	struct fb_info *info)
95	{
96	int depth = var->bits_per_pixel;
97	struct vmw_fb_par *par = info->par;
98	struct vmw_private *vmw_priv = par->vmw_priv;
99
100	switch (var->bits_per_pixel) {
101	case 32:
102	depth = (var->transp.length > 0) ? 32 : 24;
103	break;
104	default:
105	DRM_ERROR("Bad bpp %u.\n", var->bits_per_pixel);
106	return -EINVAL;
107	}
108
109	switch (depth) {
110	case 24:
111	var->red.offset = 16;
112	var->green.offset = 8;
113	var->blue.offset = 0;
114	var->red.length = 8;
115	var->green.length = 8;
116	var->blue.length = 8;
117	var->transp.length = 0;
118	var->transp.offset = 0;
119	break;
120	case 32:
121	var->red.offset = 16;
122	var->green.offset = 8;
123	var->blue.offset = 0;
124	var->red.length = 8;
125	var->green.length = 8;
126	var->blue.length = 8;
127	var->transp.length = 8;
128	var->transp.offset = 24;
129	break;
130	default:
131	DRM_ERROR("Bad depth %u.\n", depth);
132	return -EINVAL;
133	}
134
d7e1958d JB	135	if (!(vmw_priv->capabilities & SVGA_CAP_DISPLAY_TOPOLOGY) &&
	136	(var->xoffset != 0 \|\| var->yoffset != 0)) {
	137	DRM_ERROR("Can not handle panning without display topology\n");
fb1d9738 JB	138	return -EINVAL;
	139	}
	140
d7e1958d JB	141	if ((var->xoffset + var->xres) > par->max_width \|\|
d7e1958d JB	142	(var->yoffset + var->yres) > par->max_height) {
fb1d9738 JB	143	DRM_ERROR("Requested geom can not fit in framebuffer\n");
	144	return -EINVAL;
	145	}
	146
	147	return 0;
	148	}
	149
	150	static int vmw_fb_set_par(struct fb_info *info)
	151	{
	152	struct vmw_fb_par *par = info->par;
	153	struct vmw_private *vmw_priv = par->vmw_priv;
	154
991b7b44 JB	155	vmw_kms_write_svga(vmw_priv, info->var.xres, info->var.yres,
	156	info->fix.line_length,
	157	par->bpp, par->depth);
d7e1958d	158	if (vmw_priv->capabilities & SVGA_CAP_DISPLAY_TOPOLOGY) {
fb1d9738	159	/* TODO check if pitch and offset changes */
991b7b44	160	vmw_write(vmw_priv, SVGA_REG_NUM_GUEST_DISPLAYS, 1);
fb1d9738 JB	161	vmw_write(vmw_priv, SVGA_REG_DISPLAY_ID, 0);
	162	vmw_write(vmw_priv, SVGA_REG_DISPLAY_IS_PRIMARY, true);
	163	vmw_write(vmw_priv, SVGA_REG_DISPLAY_POSITION_X, info->var.xoffset);
	164	vmw_write(vmw_priv, SVGA_REG_DISPLAY_POSITION_Y, info->var.yoffset);
	165	vmw_write(vmw_priv, SVGA_REG_DISPLAY_WIDTH, info->var.xres);
	166	vmw_write(vmw_priv, SVGA_REG_DISPLAY_HEIGHT, info->var.yres);
	167	vmw_write(vmw_priv, SVGA_REG_DISPLAY_ID, SVGA_ID_INVALID);
fb1d9738 JB	168	}
fb1d9738 JB	169
d7e1958d JB	170	/* This is really helpful since if this fails the user
	171	* can probably not see anything on the screen.
	172	*/
	173	WARN_ON(vmw_read(vmw_priv, SVGA_REG_FB_OFFSET) != 0);
	174
fb1d9738 JB	175	return 0;
	176	}
	177
	178	static int vmw_fb_pan_display(struct fb_var_screeninfo *var,
	179	struct fb_info *info)
	180	{
	181	return 0;
	182	}
	183
	184	static int vmw_fb_blank(int blank, struct fb_info *info)
	185	{
	186	return 0;
	187	}
	188
	189	/*
	190	* Dirty code
	191	*/
	192
	193	static void vmw_fb_dirty_flush(struct vmw_fb_par *par)
	194	{
	195	struct vmw_private *vmw_priv = par->vmw_priv;
	196	struct fb_info *info = vmw_priv->fb_info;
	197	int stride = (info->fix.line_length / 4);
	198	int src = (int )info->screen_base;
	199	__le32 __iomem *vram_mem = par->bo_ptr;
	200	unsigned long flags;
	201	unsigned x, y, w, h;
	202	int i, k;
	203	struct {
	204	uint32_t header;
	205	SVGAFifoCmdUpdate body;
	206	} *cmd;
	207
	208	spin_lock_irqsave(&par->dirty.lock, flags);
	209	if (!par->dirty.active) {
	210	spin_unlock_irqrestore(&par->dirty.lock, flags);
	211	return;
	212	}
	213	x = par->dirty.x1;
	214	y = par->dirty.y1;
	215	w = min(par->dirty.x2, info->var.xres) - x;
	216	h = min(par->dirty.y2, info->var.yres) - y;
	217	par->dirty.x1 = par->dirty.x2 = 0;
	218	par->dirty.y1 = par->dirty.y2 = 0;
	219	spin_unlock_irqrestore(&par->dirty.lock, flags);
	220
	221	for (i = y * stride; i < info->fix.smem_len / 4; i += stride) {
	222	for (k = i+x; k < i+x+w && k < info->fix.smem_len / 4; k++)
	223	iowrite32(src[k], vram_mem + k);
	224	}
	225
	226	#if 0
	227	DRM_INFO("%s, (%u, %u) (%ux%u)\n", __func__, x, y, w, h);
	228	#endif
	229
	230	cmd = vmw_fifo_reserve(vmw_priv, sizeof(*cmd));
	231	if (unlikely(cmd == NULL)) {
	232	DRM_ERROR("Fifo reserve failed.\n");
	233	return;
	234	}
	235
	236	cmd->header = cpu_to_le32(SVGA_CMD_UPDATE);
	237	cmd->body.x = cpu_to_le32(x);
	238	cmd->body.y = cpu_to_le32(y);
239	cmd->body.width = cpu_to_le32(w);
240	cmd->body.height = cpu_to_le32(h);
241	vmw_fifo_commit(vmw_priv, sizeof(*cmd));
242	}
243
244	static void vmw_fb_dirty_mark(struct vmw_fb_par *par,
245	unsigned x1, unsigned y1,
246	unsigned width, unsigned height)
247	{
248	struct fb_info *info = par->vmw_priv->fb_info;
249	unsigned long flags;
250	unsigned x2 = x1 + width;
251	unsigned y2 = y1 + height;
252
253	spin_lock_irqsave(&par->dirty.lock, flags);
254	if (par->dirty.x1 == par->dirty.x2) {
255	par->dirty.x1 = x1;
256	par->dirty.y1 = y1;
257	par->dirty.x2 = x2;
258	par->dirty.y2 = y2;
259	/* if we are active start the dirty work
260	* we share the work with the defio system */
261	if (par->dirty.active)
262	schedule_delayed_work(&info->deferred_work, VMW_DIRTY_DELAY);
263	} else {
264	if (x1 < par->dirty.x1)
265	par->dirty.x1 = x1;
266	if (y1 < par->dirty.y1)
267	par->dirty.y1 = y1;
268	if (x2 > par->dirty.x2)
269	par->dirty.x2 = x2;
270	if (y2 > par->dirty.y2)
271	par->dirty.y2 = y2;
272	}
273	spin_unlock_irqrestore(&par->dirty.lock, flags);
274	}
275
276	static void vmw_deferred_io(struct fb_info *info,
277	struct list_head *pagelist)
278	{
279	struct vmw_fb_par *par = info->par;
280	unsigned long start, end, min, max;
281	unsigned long flags;
282	struct page *page;
283	int y1, y2;
284
285	min = ULONG_MAX;
286	max = 0;
287	list_for_each_entry(page, pagelist, lru) {
288	start = page->index << PAGE_SHIFT;
289	end = start + PAGE_SIZE - 1;
290	min = min(min, start);
291	max = max(max, end);
292	}
293
294	if (min < max) {
295	y1 = min / info->fix.line_length;
296	y2 = (max / info->fix.line_length) + 1;
297
298	spin_lock_irqsave(&par->dirty.lock, flags);
299	par->dirty.x1 = 0;
300	par->dirty.y1 = y1;
301	par->dirty.x2 = info->var.xres;
302	par->dirty.y2 = y2;
303	spin_unlock_irqrestore(&par->dirty.lock, flags);
304	}
305
306	vmw_fb_dirty_flush(par);
307	};
308
309	struct fb_deferred_io vmw_defio = {
310	.delay = VMW_DIRTY_DELAY,
311	.deferred_io = vmw_deferred_io,
312	};
313
314	/*
315	* Draw code
316	*/
317
318	static void vmw_fb_fillrect(struct fb_info info, const struct fb_fillrect rect)
319	{
320	cfb_fillrect(info, rect);
321	vmw_fb_dirty_mark(info->par, rect->dx, rect->dy,
322	rect->width, rect->height);
323	}
324
325	static void vmw_fb_copyarea(struct fb_info info, const struct fb_copyarea region)
326	{
327	cfb_copyarea(info, region);
328	vmw_fb_dirty_mark(info->par, region->dx, region->dy,
329	region->width, region->height);
330	}
331
332	static void vmw_fb_imageblit(struct fb_info info, const struct fb_image image)
333	{
334	cfb_imageblit(info, image);
335	vmw_fb_dirty_mark(info->par, image->dx, image->dy,
336	image->width, image->height);
337	}
338
339	/*
340	* Bring up code
341	*/
342
343	static struct fb_ops vmw_fb_ops = {
344	.owner = THIS_MODULE,
345	.fb_check_var = vmw_fb_check_var,
346	.fb_set_par = vmw_fb_set_par,
347	.fb_setcolreg = vmw_fb_setcolreg,
348	.fb_fillrect = vmw_fb_fillrect,
349	.fb_copyarea = vmw_fb_copyarea,
350	.fb_imageblit = vmw_fb_imageblit,
351	.fb_pan_display = vmw_fb_pan_display,
352	.fb_blank = vmw_fb_blank,
353	};
354
355	static int vmw_fb_create_bo(struct vmw_private *vmw_priv,
356	size_t size, struct vmw_dma_buffer **out)
357	{
358	struct vmw_dma_buffer *vmw_bo;
359	struct ttm_placement ne_placement = vmw_vram_ne_placement;
360	int ret;
361
362	ne_placement.lpfn = (size + PAGE_SIZE - 1) >> PAGE_SHIFT;
363
364	/* interuptable? */
365	ret = ttm_write_lock(&vmw_priv->fbdev_master.lock, false);
366	if (unlikely(ret != 0))
367	return ret;
368
369	vmw_bo = kmalloc(sizeof(*vmw_bo), GFP_KERNEL);
370	if (!vmw_bo)
371	goto err_unlock;
372
373	ret = vmw_dmabuf_init(vmw_priv, vmw_bo, size,
374	&ne_placement,
375	false,
376	&vmw_dmabuf_bo_free);
377	if (unlikely(ret != 0))
378	goto err_unlock; /* init frees the buffer on failure */
379
380	*out = vmw_bo;
381
382	ttm_write_unlock(&vmw_priv->fbdev_master.lock);
383
384	return 0;
385
386	err_unlock:
387	ttm_write_unlock(&vmw_priv->fbdev_master.lock);
388	return ret;
389	}
390
391	int vmw_fb_init(struct vmw_private *vmw_priv)
392	{
393	struct device *device = &vmw_priv->dev->pdev->dev;
394	struct vmw_fb_par *par;
395	struct fb_info *info;
396	unsigned initial_width, initial_height;
397	unsigned fb_width, fb_height;
398	unsigned fb_bbp, fb_depth, fb_offset, fb_pitch, fb_size;
399	int ret;
400
d7e1958d	401	/* XXX These shouldn't be hardcoded. */
fb1d9738 JB	402	initial_width = 800;
	403	initial_height = 600;
	404
	405	fb_bbp = 32;
	406	fb_depth = 24;
	407
d7e1958d JB	408	/* XXX As shouldn't these be as well. */
	409	fb_width = min(vmw_priv->fb_max_width, (unsigned)2048);
	410	fb_height = min(vmw_priv->fb_max_height, (unsigned)2048);
fb1d9738 JB	411
	412	initial_width = min(fb_width, initial_width);
	413	initial_height = min(fb_height, initial_height);
	414
d7e1958d JB	415	fb_pitch = fb_width * fb_bbp / 8;
d7e1958d JB	416	fb_size = fb_pitch * fb_height;
fb1d9738	417	fb_offset = vmw_read(vmw_priv, SVGA_REG_FB_OFFSET);
fb1d9738 JB	418
	419	info = framebuffer_alloc(sizeof(*par), device);
	420	if (!info)
	421	return -ENOMEM;
	422
	423	/*
	424	* Par
	425	*/
	426	vmw_priv->fb_info = info;
	427	par = info->par;
	428	par->vmw_priv = vmw_priv;
	429	par->depth = fb_depth;
	430	par->bpp = fb_bbp;
	431	par->vmalloc = NULL;
	432	par->max_width = fb_width;
	433	par->max_height = fb_height;
	434
	435	/*
	436	* Create buffers and alloc memory
	437	*/
	438	par->vmalloc = vmalloc(fb_size);
	439	if (unlikely(par->vmalloc == NULL)) {
	440	ret = -ENOMEM;
	441	goto err_free;
	442	}
	443
	444	ret = vmw_fb_create_bo(vmw_priv, fb_size, &par->vmw_bo);
	445	if (unlikely(ret != 0))
	446	goto err_free;
	447
	448	ret = ttm_bo_kmap(&par->vmw_bo->base,
	449	0,
	450	par->vmw_bo->base.num_pages,
	451	&par->map);
	452	if (unlikely(ret != 0))
	453	goto err_unref;
	454	par->bo_ptr = ttm_kmap_obj_virtual(&par->map, &par->bo_iowrite);
	455	par->bo_size = fb_size;
	456
	457	/*
	458	* Fixed and var
	459	*/
	460	strcpy(info->fix.id, "svgadrmfb");
	461	info->fix.type = FB_TYPE_PACKED_PIXELS;
	462	info->fix.visual = FB_VISUAL_TRUECOLOR;
	463	info->fix.type_aux = 0;
	464	info->fix.xpanstep = 1; /* doing it in hw */
	465	info->fix.ypanstep = 1; /* doing it in hw */
	466	info->fix.ywrapstep = 0;
	467	info->fix.accel = FB_ACCEL_NONE;
	468	info->fix.line_length = fb_pitch;
	469
	470	info->fix.smem_start = 0;
	471	info->fix.smem_len = fb_size;
	472
	473	info->fix.mmio_start = 0;
	474	info->fix.mmio_len = 0;
	475
	476	info->pseudo_palette = par->pseudo_palette;
	477	info->screen_base = par->vmalloc;
	478	info->screen_size = fb_size;
	479
	480	info->flags = FBINFO_DEFAULT;
	481	info->fbops = &vmw_fb_ops;
482
483	/* 24 depth per default */
484	info->var.red.offset = 16;
485	info->var.green.offset = 8;
486	info->var.blue.offset = 0;
487	info->var.red.length = 8;
488	info->var.green.length = 8;
489	info->var.blue.length = 8;
490	info->var.transp.offset = 0;
491	info->var.transp.length = 0;
492
493	info->var.xres_virtual = fb_width;
494	info->var.yres_virtual = fb_height;
495	info->var.bits_per_pixel = par->bpp;
496	info->var.xoffset = 0;
497	info->var.yoffset = 0;
498	info->var.activate = FB_ACTIVATE_NOW;
499	info->var.height = -1;
500	info->var.width = -1;
501
502	info->var.xres = initial_width;
503	info->var.yres = initial_height;
504
505	#if 0
506	info->pixmap.size = 64*1024;
507	info->pixmap.buf_align = 8;
508	info->pixmap.access_align = 32;
509	info->pixmap.flags = FB_PIXMAP_SYSTEM;
510	info->pixmap.scan_align = 1;
511	#else
512	info->pixmap.size = 0;
513	info->pixmap.buf_align = 8;
514	info->pixmap.access_align = 32;
515	info->pixmap.flags = FB_PIXMAP_SYSTEM;
516	info->pixmap.scan_align = 1;
517	#endif
518
1471ca9a MS	519	info->apertures = alloc_apertures(1);
	520	if (!info->apertures) {
	521	ret = -ENOMEM;
	522	goto err_aper;
	523	}
	524	info->apertures->ranges[0].base = vmw_priv->vram_start;
	525	info->apertures->ranges[0].size = vmw_priv->vram_size;
f2d12b8e	526
fb1d9738 JB	527	/*
	528	* Dirty & Deferred IO
	529	*/
	530	par->dirty.x1 = par->dirty.x2 = 0;
c39721c7	531	par->dirty.y1 = par->dirty.y2 = 0;
fb1d9738 JB	532	par->dirty.active = true;
	533	spin_lock_init(&par->dirty.lock);
	534	info->fbdefio = &vmw_defio;
	535	fb_deferred_io_init(info);
	536
	537	ret = register_framebuffer(info);
	538	if (unlikely(ret != 0))
	539	goto err_defio;
	540
	541	return 0;
	542
	543	err_defio:
	544	fb_deferred_io_cleanup(info);
1471ca9a	545	err_aper:
fb1d9738 JB	546	ttm_bo_kunmap(&par->map);
	547	err_unref:
	548	ttm_bo_unref((struct ttm_buffer_object **)&par->vmw_bo);
	549	err_free:
	550	vfree(par->vmalloc);
	551	framebuffer_release(info);
	552	vmw_priv->fb_info = NULL;
	553
	554	return ret;
	555	}
	556
	557	int vmw_fb_close(struct vmw_private *vmw_priv)
	558	{
	559	struct fb_info *info;
	560	struct vmw_fb_par *par;
	561	struct ttm_buffer_object *bo;
	562
	563	if (!vmw_priv->fb_info)
	564	return 0;
	565
	566	info = vmw_priv->fb_info;
	567	par = info->par;
	568	bo = &par->vmw_bo->base;
	569	par->vmw_bo = NULL;
	570
	571	/* ??? order */
	572	fb_deferred_io_cleanup(info);
	573	unregister_framebuffer(info);
	574
	575	ttm_bo_kunmap(&par->map);
	576	ttm_bo_unref(&bo);
	577
	578	vfree(par->vmalloc);
	579	framebuffer_release(info);
	580
	581	return 0;
	582	}
	583
	584	int vmw_dmabuf_from_vram(struct vmw_private *vmw_priv,
	585	struct vmw_dma_buffer *vmw_bo)
	586	{
	587	struct ttm_buffer_object *bo = &vmw_bo->base;
	588	int ret = 0;
	589
	590	ret = ttm_bo_reserve(bo, false, false, false, 0);
	591	if (unlikely(ret != 0))
	592	return ret;
	593
9d87fa21	594	ret = ttm_bo_validate(bo, &vmw_sys_placement, false, false, false);
fb1d9738 JB	595	ttm_bo_unreserve(bo);
	596
	597	return ret;
	598	}
	599
	600	int vmw_dmabuf_to_start_of_vram(struct vmw_private *vmw_priv,
	601	struct vmw_dma_buffer *vmw_bo)
	602	{
	603	struct ttm_buffer_object *bo = &vmw_bo->base;
	604	struct ttm_placement ne_placement = vmw_vram_ne_placement;
	605	int ret = 0;
	606
	607	ne_placement.lpfn = bo->num_pages;
	608
	609	/* interuptable? */
	610	ret = ttm_write_lock(&vmw_priv->active_master->lock, false);
	611	if (unlikely(ret != 0))
	612	return ret;
	613
	614	ret = ttm_bo_reserve(bo, false, false, false, 0);
	615	if (unlikely(ret != 0))
	616	goto err_unlock;
	617
abb295f3 TH	618	if (bo->mem.mem_type == TTM_PL_VRAM &&
	619	bo->mem.mm_node->start < bo->num_pages)
	620	(void) ttm_bo_validate(bo, &vmw_sys_placement, false,
	621	false, false);
	622
9d87fa21	623	ret = ttm_bo_validate(bo, &ne_placement, false, false, false);
316ab13a JB	624
	625	/* Could probably bug on */
	626	WARN_ON(bo->offset != 0);
	627
fb1d9738 JB	628	ttm_bo_unreserve(bo);
	629	err_unlock:
	630	ttm_write_unlock(&vmw_priv->active_master->lock);
	631
	632	return ret;
	633	}
	634
	635	int vmw_fb_off(struct vmw_private *vmw_priv)
	636	{
	637	struct fb_info *info;
	638	struct vmw_fb_par *par;
	639	unsigned long flags;
	640
	641	if (!vmw_priv->fb_info)
	642	return -EINVAL;
	643
	644	info = vmw_priv->fb_info;
	645	par = info->par;
	646
	647	spin_lock_irqsave(&par->dirty.lock, flags);
	648	par->dirty.active = false;
	649	spin_unlock_irqrestore(&par->dirty.lock, flags);
	650
	651	flush_scheduled_work();
	652
	653	par->bo_ptr = NULL;
	654	ttm_bo_kunmap(&par->map);
	655
	656	vmw_dmabuf_from_vram(vmw_priv, par->vmw_bo);
	657
	658	return 0;
	659	}
	660
	661	int vmw_fb_on(struct vmw_private *vmw_priv)
	662	{
	663	struct fb_info *info;
	664	struct vmw_fb_par *par;
	665	unsigned long flags;
	666	bool dummy;
	667	int ret;
	668
	669	if (!vmw_priv->fb_info)
	670	return -EINVAL;
	671
	672	info = vmw_priv->fb_info;
	673	par = info->par;
	674
	675	/* we are already active */
	676	if (par->bo_ptr != NULL)
	677	return 0;
	678
	679	/* Make sure that all overlays are stoped when we take over */
	680	vmw_overlay_stop_all(vmw_priv);
	681
	682	ret = vmw_dmabuf_to_start_of_vram(vmw_priv, par->vmw_bo);
	683	if (unlikely(ret != 0)) {
	684	DRM_ERROR("could not move buffer to start of VRAM\n");
	685	goto err_no_buffer;
	686	}
	687
	688	ret = ttm_bo_kmap(&par->vmw_bo->base,
	689	0,
	690	par->vmw_bo->base.num_pages,
	691	&par->map);
692	BUG_ON(ret != 0);
693	par->bo_ptr = ttm_kmap_obj_virtual(&par->map, &dummy);
694
695	spin_lock_irqsave(&par->dirty.lock, flags);
696	par->dirty.active = true;
697	spin_unlock_irqrestore(&par->dirty.lock, flags);
698
699	err_no_buffer:
700	vmw_fb_set_par(info);
701
702	vmw_fb_dirty_mark(par, 0, 0, info->var.xres, info->var.yres);
703
704	/* If there already was stuff dirty we wont
705	* schedule a new work, so lets do it now */
706	schedule_delayed_work(&info->deferred_work, 0);
707
708	return 0;
709	}