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

/**************************************************************************
 *
 * 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 "vmwgfx_drv.h"
#include "drmP.h"
#include "ttm/ttm_placement.h"

bool vmw_fifo_have_3d(struct vmw_private *dev_priv)
{
	__le32 __iomem *fifo_mem = dev_priv->mmio_virt;
	uint32_t fifo_min, hwversion;

	if (!(dev_priv->capabilities & SVGA_CAP_EXTENDED_FIFO))
		return false;

	fifo_min = ioread32(fifo_mem  + SVGA_FIFO_MIN);
	if (fifo_min <= SVGA_FIFO_3D_HWVERSION * sizeof(unsigned int))
		return false;

	hwversion = ioread32(fifo_mem + SVGA_FIFO_3D_HWVERSION);
	if (hwversion == 0)
		return false;

	if (hwversion < SVGA3D_HWVERSION_WS65_B1)
		return false;

	return true;
}

bool vmw_fifo_have_pitchlock(struct vmw_private *dev_priv)
{
	__le32 __iomem *fifo_mem = dev_priv->mmio_virt;
	uint32_t caps;

	if (!(dev_priv->capabilities & SVGA_CAP_EXTENDED_FIFO))
		return false;

	caps = ioread32(fifo_mem + SVGA_FIFO_CAPABILITIES);
	if (caps & SVGA_FIFO_CAP_PITCHLOCK)
		return true;

	return false;
}

int vmw_fifo_init(struct vmw_private *dev_priv, struct vmw_fifo_state *fifo)
{
	__le32 __iomem *fifo_mem = dev_priv->mmio_virt;
	uint32_t max;
	uint32_t min;
	uint32_t dummy;
	int ret;

	fifo->static_buffer_size = VMWGFX_FIFO_STATIC_SIZE;
	fifo->static_buffer = vmalloc(fifo->static_buffer_size);
	if (unlikely(fifo->static_buffer == NULL))
		return -ENOMEM;

	fifo->last_buffer_size = VMWGFX_FIFO_STATIC_SIZE;
	fifo->last_data_size = 0;
	fifo->last_buffer_add = false;
	fifo->last_buffer = vmalloc(fifo->last_buffer_size);
	if (unlikely(fifo->last_buffer == NULL)) {
		ret = -ENOMEM;
		goto out_err;
	}

	fifo->dynamic_buffer = NULL;
	fifo->reserved_size = 0;
	fifo->using_bounce_buffer = false;

	mutex_init(&fifo->fifo_mutex);
	init_rwsem(&fifo->rwsem);

	/*
	 * Allow mapping the first page read-only to user-space.
	 */

	DRM_INFO("width %d\n", vmw_read(dev_priv, SVGA_REG_WIDTH));
	DRM_INFO("height %d\n", vmw_read(dev_priv, SVGA_REG_HEIGHT));
	DRM_INFO("bpp %d\n", vmw_read(dev_priv, SVGA_REG_BITS_PER_PIXEL));

	mutex_lock(&dev_priv->hw_mutex);
	dev_priv->enable_state = vmw_read(dev_priv, SVGA_REG_ENABLE);
	dev_priv->config_done_state = vmw_read(dev_priv, SVGA_REG_CONFIG_DONE);
	vmw_write(dev_priv, SVGA_REG_ENABLE, 1);

	min = 4;
	if (dev_priv->capabilities & SVGA_CAP_EXTENDED_FIFO)
		min = vmw_read(dev_priv, SVGA_REG_MEM_REGS);
	min <<= 2;

	if (min < PAGE_SIZE)
		min = PAGE_SIZE;

	iowrite32(min, fifo_mem + SVGA_FIFO_MIN);
	iowrite32(dev_priv->mmio_size, fifo_mem + SVGA_FIFO_MAX);
	wmb();
	iowrite32(min,  fifo_mem + SVGA_FIFO_NEXT_CMD);
	iowrite32(min,  fifo_mem + SVGA_FIFO_STOP);
	iowrite32(0, fifo_mem + SVGA_FIFO_BUSY);
	mb();

	vmw_write(dev_priv, SVGA_REG_CONFIG_DONE, 1);
	mutex_unlock(&dev_priv->hw_mutex);

	max = ioread32(fifo_mem + SVGA_FIFO_MAX);
	min = ioread32(fifo_mem  + SVGA_FIFO_MIN);
	fifo->capabilities = ioread32(fifo_mem + SVGA_FIFO_CAPABILITIES);

	DRM_INFO("Fifo max 0x%08x min 0x%08x cap 0x%08x\n",
		 (unsigned int) max,
		 (unsigned int) min,
		 (unsigned int) fifo->capabilities);

	atomic_set(&dev_priv->fence_seq, dev_priv->last_read_sequence);
	iowrite32(dev_priv->last_read_sequence, fifo_mem + SVGA_FIFO_FENCE);
	vmw_fence_queue_init(&fifo->fence_queue);
	return vmw_fifo_send_fence(dev_priv, &dummy);
out_err:
	vfree(fifo->static_buffer);
	fifo->static_buffer = NULL;
	return ret;
}

void vmw_fifo_ping_host(struct vmw_private *dev_priv, uint32_t reason)
{
	__le32 __iomem *fifo_mem = dev_priv->mmio_virt;

	mutex_lock(&dev_priv->hw_mutex);

	if (unlikely(ioread32(fifo_mem + SVGA_FIFO_BUSY) == 0)) {
		iowrite32(1, fifo_mem + SVGA_FIFO_BUSY);
		vmw_write(dev_priv, SVGA_REG_SYNC, reason);
	}

	mutex_unlock(&dev_priv->hw_mutex);
}

void vmw_fifo_release(struct vmw_private *dev_priv, struct vmw_fifo_state *fifo)
{
	__le32 __iomem *fifo_mem = dev_priv->mmio_virt;

	mutex_lock(&dev_priv->hw_mutex);

	while (vmw_read(dev_priv, SVGA_REG_BUSY) != 0)
		vmw_write(dev_priv, SVGA_REG_SYNC, SVGA_SYNC_GENERIC);

	dev_priv->last_read_sequence = ioread32(fifo_mem + SVGA_FIFO_FENCE);

	vmw_write(dev_priv, SVGA_REG_CONFIG_DONE,
		  dev_priv->config_done_state);
	vmw_write(dev_priv, SVGA_REG_ENABLE,
		  dev_priv->enable_state);

	mutex_unlock(&dev_priv->hw_mutex);
	vmw_fence_queue_takedown(&fifo->fence_queue);

	if (likely(fifo->last_buffer != NULL)) {
		vfree(fifo->last_buffer);
		fifo->last_buffer = NULL;
	}

	if (likely(fifo->static_buffer != NULL)) {
		vfree(fifo->static_buffer);
		fifo->static_buffer = NULL;
	}

	if (likely(fifo->dynamic_buffer != NULL)) {
		vfree(fifo->dynamic_buffer);
		fifo->dynamic_buffer = NULL;
	}
}

static bool vmw_fifo_is_full(struct vmw_private *dev_priv, uint32_t bytes)
{
	__le32 __iomem *fifo_mem = dev_priv->mmio_virt;
	uint32_t max = ioread32(fifo_mem + SVGA_FIFO_MAX);
	uint32_t next_cmd = ioread32(fifo_mem + SVGA_FIFO_NEXT_CMD);
	uint32_t min = ioread32(fifo_mem + SVGA_FIFO_MIN);
	uint32_t stop = ioread32(fifo_mem + SVGA_FIFO_STOP);

	return ((max - next_cmd) + (stop - min) <= bytes);
}

static int vmw_fifo_wait_noirq(struct vmw_private *dev_priv,
			       uint32_t bytes, bool interruptible,
			       unsigned long timeout)
{
	int ret = 0;
	unsigned long end_jiffies = jiffies + timeout;
	DEFINE_WAIT(__wait);

	DRM_INFO("Fifo wait noirq.\n");

	for (;;) {
		prepare_to_wait(&dev_priv->fifo_queue, &__wait,
				(interruptible) ?
				TASK_INTERRUPTIBLE : TASK_UNINTERRUPTIBLE);
		if (!vmw_fifo_is_full(dev_priv, bytes))
			break;
		if (time_after_eq(jiffies, end_jiffies)) {
			ret = -EBUSY;
			DRM_ERROR("SVGA device lockup.\n");
			break;
		}
		schedule_timeout(1);
		if (interruptible && signal_pending(current)) {
			ret = -ERESTARTSYS;
			break;
		}
	}
	finish_wait(&dev_priv->fifo_queue, &__wait);
	wake_up_all(&dev_priv->fifo_queue);
	DRM_INFO("Fifo noirq exit.\n");
	return ret;
}

static int vmw_fifo_wait(struct vmw_private *dev_priv,
			 uint32_t bytes, bool interruptible,
			 unsigned long timeout)
{
	long ret = 1L;
	unsigned long irq_flags;

	if (likely(!vmw_fifo_is_full(dev_priv, bytes)))
		return 0;

	vmw_fifo_ping_host(dev_priv, SVGA_SYNC_FIFOFULL);
	if (!(dev_priv->capabilities & SVGA_CAP_IRQMASK))
		return vmw_fifo_wait_noirq(dev_priv, bytes,
					   interruptible, timeout);

	mutex_lock(&dev_priv->hw_mutex);
	if (atomic_add_return(1, &dev_priv->fifo_queue_waiters) > 0) {
		spin_lock_irqsave(&dev_priv->irq_lock, irq_flags);
		outl(SVGA_IRQFLAG_FIFO_PROGRESS,
		     dev_priv->io_start + VMWGFX_IRQSTATUS_PORT);
		vmw_write(dev_priv, SVGA_REG_IRQMASK,
			  vmw_read(dev_priv, SVGA_REG_IRQMASK) |
			  SVGA_IRQFLAG_FIFO_PROGRESS);
		spin_unlock_irqrestore(&dev_priv->irq_lock, irq_flags);
	}
	mutex_unlock(&dev_priv->hw_mutex);

	if (interruptible)
		ret = wait_event_interruptible_timeout
		    (dev_priv->fifo_queue,
		     !vmw_fifo_is_full(dev_priv, bytes), timeout);
	else
		ret = wait_event_timeout
		    (dev_priv->fifo_queue,
		     !vmw_fifo_is_full(dev_priv, bytes), timeout);

	if (unlikely(ret == 0))
		ret = -EBUSY;
	else if (likely(ret > 0))
		ret = 0;

	mutex_lock(&dev_priv->hw_mutex);
	if (atomic_dec_and_test(&dev_priv->fifo_queue_waiters)) {
		spin_lock_irqsave(&dev_priv->irq_lock, irq_flags);
		vmw_write(dev_priv, SVGA_REG_IRQMASK,
			  vmw_read(dev_priv, SVGA_REG_IRQMASK) &
			  ~SVGA_IRQFLAG_FIFO_PROGRESS);
		spin_unlock_irqrestore(&dev_priv->irq_lock, irq_flags);
	}
	mutex_unlock(&dev_priv->hw_mutex);

	return ret;
}

void *vmw_fifo_reserve(struct vmw_private *dev_priv, uint32_t bytes)
{
	struct vmw_fifo_state *fifo_state = &dev_priv->fifo;
	__le32 __iomem *fifo_mem = dev_priv->mmio_virt;
	uint32_t max;
	uint32_t min;
	uint32_t next_cmd;
	uint32_t reserveable = fifo_state->capabilities & SVGA_FIFO_CAP_RESERVE;
	int ret;

	mutex_lock(&fifo_state->fifo_mutex);
	max = ioread32(fifo_mem + SVGA_FIFO_MAX);
	min = ioread32(fifo_mem + SVGA_FIFO_MIN);
	next_cmd = ioread32(fifo_mem + SVGA_FIFO_NEXT_CMD);

	if (unlikely(bytes >= (max - min)))
		goto out_err;

	BUG_ON(fifo_state->reserved_size != 0);
	BUG_ON(fifo_state->dynamic_buffer != NULL);

	fifo_state->reserved_size = bytes;

	while (1) {
		uint32_t stop = ioread32(fifo_mem + SVGA_FIFO_STOP);
		bool need_bounce = false;
		bool reserve_in_place = false;

		if (next_cmd >= stop) {
			if (likely((next_cmd + bytes < max ||
				    (next_cmd + bytes == max && stop > min))))
				reserve_in_place = true;

			else if (vmw_fifo_is_full(dev_priv, bytes)) {
				ret = vmw_fifo_wait(dev_priv, bytes,
						    false, 3 * HZ);
				if (unlikely(ret != 0))
					goto out_err;
			} else
				need_bounce = true;

		} else {

			if (likely((next_cmd + bytes < stop)))
				reserve_in_place = true;
			else {
				ret = vmw_fifo_wait(dev_priv, bytes,
						    false, 3 * HZ);
				if (unlikely(ret != 0))
					goto out_err;
			}
		}

		if (reserve_in_place) {
			if (reserveable || bytes <= sizeof(uint32_t)) {
				fifo_state->using_bounce_buffer = false;

				if (reserveable)
					iowrite32(bytes, fifo_mem +
						  SVGA_FIFO_RESERVED);
				return fifo_mem + (next_cmd >> 2);
			} else {
				need_bounce = true;
			}
		}

		if (need_bounce) {
			fifo_state->using_bounce_buffer = true;
			if (bytes < fifo_state->static_buffer_size)
				return fifo_state->static_buffer;
			else {
				fifo_state->dynamic_buffer = vmalloc(bytes);
				return fifo_state->dynamic_buffer;
			}
		}
	}
out_err:
	fifo_state->reserved_size = 0;
	mutex_unlock(&fifo_state->fifo_mutex);
	return NULL;
}

static void vmw_fifo_res_copy(struct vmw_fifo_state *fifo_state,
			      __le32 __iomem *fifo_mem,
			      uint32_t next_cmd,
			      uint32_t max, uint32_t min, uint32_t bytes)
{
	uint32_t chunk_size = max - next_cmd;
	uint32_t rest;
	uint32_t *buffer = (fifo_state->dynamic_buffer != NULL) ?
	    fifo_state->dynamic_buffer : fifo_state->static_buffer;

	if (bytes < chunk_size)
		chunk_size = bytes;

	iowrite32(bytes, fifo_mem + SVGA_FIFO_RESERVED);
	mb();
	memcpy_toio(fifo_mem + (next_cmd >> 2), buffer, chunk_size);
	rest = bytes - chunk_size;
	if (rest)
		memcpy_toio(fifo_mem + (min >> 2), buffer + (chunk_size >> 2),
			    rest);
}

static void vmw_fifo_slow_copy(struct vmw_fifo_state *fifo_state,
			       __le32 __iomem *fifo_mem,
			       uint32_t next_cmd,
			       uint32_t max, uint32_t min, uint32_t bytes)
{
	uint32_t *buffer = (fifo_state->dynamic_buffer != NULL) ?
	    fifo_state->dynamic_buffer : fifo_state->static_buffer;

	while (bytes > 0) {
		iowrite32(*buffer++, fifo_mem + (next_cmd >> 2));
		next_cmd += sizeof(uint32_t);
		if (unlikely(next_cmd == max))
			next_cmd = min;
		mb();
		iowrite32(next_cmd, fifo_mem + SVGA_FIFO_NEXT_CMD);
		mb();
		bytes -= sizeof(uint32_t);
	}
}

void vmw_fifo_commit(struct vmw_private *dev_priv, uint32_t bytes)
{
	struct vmw_fifo_state *fifo_state = &dev_priv->fifo;
	__le32 __iomem *fifo_mem = dev_priv->mmio_virt;
	uint32_t next_cmd = ioread32(fifo_mem + SVGA_FIFO_NEXT_CMD);
	uint32_t max = ioread32(fifo_mem + SVGA_FIFO_MAX);
	uint32_t min = ioread32(fifo_mem + SVGA_FIFO_MIN);
	bool reserveable = fifo_state->capabilities & SVGA_FIFO_CAP_RESERVE;

	BUG_ON((bytes & 3) != 0);
	BUG_ON(bytes > fifo_state->reserved_size);

	fifo_state->reserved_size = 0;

	if (fifo_state->using_bounce_buffer) {
		if (reserveable)
			vmw_fifo_res_copy(fifo_state, fifo_mem,
					  next_cmd, max, min, bytes);
		else
			vmw_fifo_slow_copy(fifo_state, fifo_mem,
					   next_cmd, max, min, bytes);

		if (fifo_state->dynamic_buffer) {
			vfree(fifo_state->dynamic_buffer);
			fifo_state->dynamic_buffer = NULL;
		}

	}

	down_write(&fifo_state->rwsem);
	if (fifo_state->using_bounce_buffer || reserveable) {
		next_cmd += bytes;
		if (next_cmd >= max)
			next_cmd -= max - min;
		mb();
		iowrite32(next_cmd, fifo_mem + SVGA_FIFO_NEXT_CMD);
	}

	if (reserveable)
		iowrite32(0, fifo_mem + SVGA_FIFO_RESERVED);
	mb();
	up_write(&fifo_state->rwsem);
	vmw_fifo_ping_host(dev_priv, SVGA_SYNC_GENERIC);
	mutex_unlock(&fifo_state->fifo_mutex);
}

int vmw_fifo_send_fence(struct vmw_private *dev_priv, uint32_t *sequence)
{
	struct vmw_fifo_state *fifo_state = &dev_priv->fifo;
	struct svga_fifo_cmd_fence *cmd_fence;
	void *fm;
	int ret = 0;
	uint32_t bytes = sizeof(__le32) + sizeof(*cmd_fence);

	fm = vmw_fifo_reserve(dev_priv, bytes);
	if (unlikely(fm == NULL)) {
		*sequence = atomic_read(&dev_priv->fence_seq);
		ret = -ENOMEM;
		(void)vmw_fallback_wait(dev_priv, false, true, *sequence,
					false, 3*HZ);
		goto out_err;
	}

	do {
		*sequence = atomic_add_return(1, &dev_priv->fence_seq);
	} while (*sequence == 0);

	if (!(fifo_state->capabilities & SVGA_FIFO_CAP_FENCE)) {

		/*
		 * Don't request hardware to send a fence. The
		 * waiting code in vmwgfx_irq.c will emulate this.
		 */

		vmw_fifo_commit(dev_priv, 0);
		return 0;
	}

	*(__le32 *) fm = cpu_to_le32(SVGA_CMD_FENCE);
	cmd_fence = (struct svga_fifo_cmd_fence *)
	    ((unsigned long)fm + sizeof(__le32));

	iowrite32(*sequence, &cmd_fence->fence);
	fifo_state->last_buffer_add = true;
	vmw_fifo_commit(dev_priv, bytes);
	fifo_state->last_buffer_add = false;
	(void) vmw_fence_push(&fifo_state->fence_queue, *sequence);
	vmw_update_sequence(dev_priv, fifo_state);

out_err:
	return ret;
}

/**
 * Map the first page of the FIFO read-only to user-space.
 */

static int vmw_fifo_vm_fault(struct vm_area_struct *vma, struct vm_fault *vmf)
{
	int ret;
	unsigned long address = (unsigned long)vmf->virtual_address;

	if (address != vma->vm_start)
		return VM_FAULT_SIGBUS;

	ret = vm_insert_pfn(vma, address, vma->vm_pgoff);
	if (likely(ret == -EBUSY || ret == 0))
		return VM_FAULT_NOPAGE;
	else if (ret == -ENOMEM)
		return VM_FAULT_OOM;

	return VM_FAULT_SIGBUS;
}

static struct vm_operations_struct vmw_fifo_vm_ops = {
	.fault = vmw_fifo_vm_fault,
	.open = NULL,
	.close = NULL
};

int vmw_fifo_mmap(struct file *filp, struct vm_area_struct *vma)
{
	struct drm_file *file_priv;
	struct vmw_private *dev_priv;

	file_priv = filp->private_data;
	dev_priv = vmw_priv(file_priv->minor->dev);

	if (vma->vm_pgoff != (dev_priv->mmio_start >> PAGE_SHIFT) ||
	    (vma->vm_end - vma->vm_start) != PAGE_SIZE)
		return -EINVAL;

	vma->vm_flags &= ~(VM_WRITE | VM_MAYWRITE);
	vma->vm_flags |= VM_IO | VM_PFNMAP | VM_DONTEXPAND | VM_SHARED;
	vma->vm_page_prot = vm_get_page_prot(vma->vm_flags);
	vma->vm_page_prot = ttm_io_prot(TTM_PL_FLAG_UNCACHED,
					vma->vm_page_prot);
	vma->vm_ops = &vmw_fifo_vm_ops;
	return 0;
}
Commit	Line	Data
fb1d9738 JB	1	/**************************************************************************
	2	*
	3	* Copyright © 2009 VMware, Inc., Palo Alto, CA., USA
	4	* All Rights Reserved.
	5	*
	6	* Permission is hereby granted, free of charge, to any person obtaining a
	7	* copy of this software and associated documentation files (the
	8	* "Software"), to deal in the Software without restriction, including
	9	* without limitation the rights to use, copy, modify, merge, publish,
	10	* distribute, sub license, and/or sell copies of the Software, and to
	11	* permit persons to whom the Software is furnished to do so, subject to
	12	* the following conditions:
	13	*
	14	* The above copyright notice and this permission notice (including the
	15	* next paragraph) shall be included in all copies or substantial portions
	16	* of the Software.
	17	*
	18	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	19	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	20	* FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
	21	* THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
	22	* DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
	23	* OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
	24	* USE OR OTHER DEALINGS IN THE SOFTWARE.
	25	*
	26	**************************************************************************/
	27
	28	#include "vmwgfx_drv.h"
	29	#include "drmP.h"
	30	#include "ttm/ttm_placement.h"
	31
8e19a951 JB	32	bool vmw_fifo_have_3d(struct vmw_private *dev_priv)
	33	{
	34	__le32 __iomem *fifo_mem = dev_priv->mmio_virt;
	35	uint32_t fifo_min, hwversion;
	36
d7e1958d JB	37	if (!(dev_priv->capabilities & SVGA_CAP_EXTENDED_FIFO))
	38	return false;
	39
8e19a951 JB	40	fifo_min = ioread32(fifo_mem + SVGA_FIFO_MIN);
	41	if (fifo_min <= SVGA_FIFO_3D_HWVERSION * sizeof(unsigned int))
	42	return false;
	43
	44	hwversion = ioread32(fifo_mem + SVGA_FIFO_3D_HWVERSION);
	45	if (hwversion == 0)
	46	return false;
	47
	48	if (hwversion < SVGA3D_HWVERSION_WS65_B1)
	49	return false;
	50
	51	return true;
	52	}
	53
d7e1958d JB	54	bool vmw_fifo_have_pitchlock(struct vmw_private *dev_priv)
	55	{
	56	__le32 __iomem *fifo_mem = dev_priv->mmio_virt;
	57	uint32_t caps;
	58
	59	if (!(dev_priv->capabilities & SVGA_CAP_EXTENDED_FIFO))
	60	return false;
	61
	62	caps = ioread32(fifo_mem + SVGA_FIFO_CAPABILITIES);
	63	if (caps & SVGA_FIFO_CAP_PITCHLOCK)
	64	return true;
	65
	66	return false;
	67	}
	68
fb1d9738 JB	69	int vmw_fifo_init(struct vmw_private dev_priv, struct vmw_fifo_state fifo)
	70	{
	71	__le32 __iomem *fifo_mem = dev_priv->mmio_virt;
	72	uint32_t max;
	73	uint32_t min;
	74	uint32_t dummy;
	75	int ret;
	76
	77	fifo->static_buffer_size = VMWGFX_FIFO_STATIC_SIZE;
	78	fifo->static_buffer = vmalloc(fifo->static_buffer_size);
	79	if (unlikely(fifo->static_buffer == NULL))
	80	return -ENOMEM;
	81
	82	fifo->last_buffer_size = VMWGFX_FIFO_STATIC_SIZE;
	83	fifo->last_data_size = 0;
	84	fifo->last_buffer_add = false;
	85	fifo->last_buffer = vmalloc(fifo->last_buffer_size);
	86	if (unlikely(fifo->last_buffer == NULL)) {
	87	ret = -ENOMEM;
	88	goto out_err;
	89	}
	90
	91	fifo->dynamic_buffer = NULL;
	92	fifo->reserved_size = 0;
	93	fifo->using_bounce_buffer = false;
	94
85b9e487	95	mutex_init(&fifo->fifo_mutex);
fb1d9738 JB	96	init_rwsem(&fifo->rwsem);
	97
	98	/*
	99	* Allow mapping the first page read-only to user-space.
	100	*/
	101
	102	DRM_INFO("width %d\n", vmw_read(dev_priv, SVGA_REG_WIDTH));
	103	DRM_INFO("height %d\n", vmw_read(dev_priv, SVGA_REG_HEIGHT));
	104	DRM_INFO("bpp %d\n", vmw_read(dev_priv, SVGA_REG_BITS_PER_PIXEL));
	105
	106	mutex_lock(&dev_priv->hw_mutex);
	107	dev_priv->enable_state = vmw_read(dev_priv, SVGA_REG_ENABLE);
	108	dev_priv->config_done_state = vmw_read(dev_priv, SVGA_REG_CONFIG_DONE);
	109	vmw_write(dev_priv, SVGA_REG_ENABLE, 1);
	110
	111	min = 4;
	112	if (dev_priv->capabilities & SVGA_CAP_EXTENDED_FIFO)
	113	min = vmw_read(dev_priv, SVGA_REG_MEM_REGS);
	114	min <<= 2;
	115
	116	if (min < PAGE_SIZE)
	117	min = PAGE_SIZE;
	118
	119	iowrite32(min, fifo_mem + SVGA_FIFO_MIN);
	120	iowrite32(dev_priv->mmio_size, fifo_mem + SVGA_FIFO_MAX);
	121	wmb();
	122	iowrite32(min, fifo_mem + SVGA_FIFO_NEXT_CMD);
	123	iowrite32(min, fifo_mem + SVGA_FIFO_STOP);
	124	iowrite32(0, fifo_mem + SVGA_FIFO_BUSY);
	125	mb();
	126
	127	vmw_write(dev_priv, SVGA_REG_CONFIG_DONE, 1);
	128	mutex_unlock(&dev_priv->hw_mutex);
	129
	130	max = ioread32(fifo_mem + SVGA_FIFO_MAX);
	131	min = ioread32(fifo_mem + SVGA_FIFO_MIN);
	132	fifo->capabilities = ioread32(fifo_mem + SVGA_FIFO_CAPABILITIES);
	133
	134	DRM_INFO("Fifo max 0x%08x min 0x%08x cap 0x%08x\n",
	135	(unsigned int) max,
	136	(unsigned int) min,
	137	(unsigned int) fifo->capabilities);
	138
85b9e487	139	atomic_set(&dev_priv->fence_seq, dev_priv->last_read_sequence);
fb1d9738	140	iowrite32(dev_priv->last_read_sequence, fifo_mem + SVGA_FIFO_FENCE);
1925d456	141	vmw_fence_queue_init(&fifo->fence_queue);
fb1d9738 JB	142	return vmw_fifo_send_fence(dev_priv, &dummy);
	143	out_err:
	144	vfree(fifo->static_buffer);
	145	fifo->static_buffer = NULL;
	146	return ret;
	147	}
	148
	149	void vmw_fifo_ping_host(struct vmw_private *dev_priv, uint32_t reason)
	150	{
	151	__le32 __iomem *fifo_mem = dev_priv->mmio_virt;
	152
	153	mutex_lock(&dev_priv->hw_mutex);
	154
	155	if (unlikely(ioread32(fifo_mem + SVGA_FIFO_BUSY) == 0)) {
	156	iowrite32(1, fifo_mem + SVGA_FIFO_BUSY);
	157	vmw_write(dev_priv, SVGA_REG_SYNC, reason);
	158	}
	159
	160	mutex_unlock(&dev_priv->hw_mutex);
	161	}
	162
	163	void vmw_fifo_release(struct vmw_private dev_priv, struct vmw_fifo_state fifo)
	164	{
	165	__le32 __iomem *fifo_mem = dev_priv->mmio_virt;
	166
	167	mutex_lock(&dev_priv->hw_mutex);
	168
	169	while (vmw_read(dev_priv, SVGA_REG_BUSY) != 0)
	170	vmw_write(dev_priv, SVGA_REG_SYNC, SVGA_SYNC_GENERIC);
	171
	172	dev_priv->last_read_sequence = ioread32(fifo_mem + SVGA_FIFO_FENCE);
	173
	174	vmw_write(dev_priv, SVGA_REG_CONFIG_DONE,
	175	dev_priv->config_done_state);
	176	vmw_write(dev_priv, SVGA_REG_ENABLE,
	177	dev_priv->enable_state);
	178
	179	mutex_unlock(&dev_priv->hw_mutex);
1925d456	180	vmw_fence_queue_takedown(&fifo->fence_queue);
fb1d9738 JB	181
	182	if (likely(fifo->last_buffer != NULL)) {
	183	vfree(fifo->last_buffer);
	184	fifo->last_buffer = NULL;
	185	}
	186
	187	if (likely(fifo->static_buffer != NULL)) {
	188	vfree(fifo->static_buffer);
	189	fifo->static_buffer = NULL;
	190	}
	191
	192	if (likely(fifo->dynamic_buffer != NULL)) {
	193	vfree(fifo->dynamic_buffer);
	194	fifo->dynamic_buffer = NULL;
	195	}
	196	}
	197
	198	static bool vmw_fifo_is_full(struct vmw_private *dev_priv, uint32_t bytes)
	199	{
	200	__le32 __iomem *fifo_mem = dev_priv->mmio_virt;
	201	uint32_t max = ioread32(fifo_mem + SVGA_FIFO_MAX);
	202	uint32_t next_cmd = ioread32(fifo_mem + SVGA_FIFO_NEXT_CMD);
	203	uint32_t min = ioread32(fifo_mem + SVGA_FIFO_MIN);
	204	uint32_t stop = ioread32(fifo_mem + SVGA_FIFO_STOP);
	205
	206	return ((max - next_cmd) + (stop - min) <= bytes);
	207	}
	208
	209	static int vmw_fifo_wait_noirq(struct vmw_private *dev_priv,
	210	uint32_t bytes, bool interruptible,
	211	unsigned long timeout)
	212	{
	213	int ret = 0;
	214	unsigned long end_jiffies = jiffies + timeout;
	215	DEFINE_WAIT(__wait);
	216
	217	DRM_INFO("Fifo wait noirq.\n");
	218
	219	for (;;) {
	220	prepare_to_wait(&dev_priv->fifo_queue, &__wait,
	221	(interruptible) ?
	222	TASK_INTERRUPTIBLE : TASK_UNINTERRUPTIBLE);
	223	if (!vmw_fifo_is_full(dev_priv, bytes))
	224	break;
	225	if (time_after_eq(jiffies, end_jiffies)) {
	226	ret = -EBUSY;
	227	DRM_ERROR("SVGA device lockup.\n");
	228	break;
	229	}
	230	schedule_timeout(1);
	231	if (interruptible && signal_pending(current)) {
3d3a5b32	232	ret = -ERESTARTSYS;
fb1d9738 JB	233	break;
	234	}
	235	}
	236	finish_wait(&dev_priv->fifo_queue, &__wait);
	237	wake_up_all(&dev_priv->fifo_queue);
	238	DRM_INFO("Fifo noirq exit.\n");
	239	return ret;
	240	}
	241
	242	static int vmw_fifo_wait(struct vmw_private *dev_priv,
	243	uint32_t bytes, bool interruptible,
	244	unsigned long timeout)
	245	{
	246	long ret = 1L;
	247	unsigned long irq_flags;
	248
	249	if (likely(!vmw_fifo_is_full(dev_priv, bytes)))
	250	return 0;
	251
	252	vmw_fifo_ping_host(dev_priv, SVGA_SYNC_FIFOFULL);
	253	if (!(dev_priv->capabilities & SVGA_CAP_IRQMASK))
	254	return vmw_fifo_wait_noirq(dev_priv, bytes,
	255	interruptible, timeout);
	256
	257	mutex_lock(&dev_priv->hw_mutex);
	258	if (atomic_add_return(1, &dev_priv->fifo_queue_waiters) > 0) {
	259	spin_lock_irqsave(&dev_priv->irq_lock, irq_flags);
	260	outl(SVGA_IRQFLAG_FIFO_PROGRESS,
	261	dev_priv->io_start + VMWGFX_IRQSTATUS_PORT);
	262	vmw_write(dev_priv, SVGA_REG_IRQMASK,
	263	vmw_read(dev_priv, SVGA_REG_IRQMASK) \|
	264	SVGA_IRQFLAG_FIFO_PROGRESS);
	265	spin_unlock_irqrestore(&dev_priv->irq_lock, irq_flags);
	266	}
	267	mutex_unlock(&dev_priv->hw_mutex);
	268
	269	if (interruptible)
	270	ret = wait_event_interruptible_timeout
	271	(dev_priv->fifo_queue,
	272	!vmw_fifo_is_full(dev_priv, bytes), timeout);
	273	else
	274	ret = wait_event_timeout
	275	(dev_priv->fifo_queue,
	276	!vmw_fifo_is_full(dev_priv, bytes), timeout);
	277
3d3a5b32	278	if (unlikely(ret == 0))
fb1d9738 JB	279	ret = -EBUSY;
	280	else if (likely(ret > 0))
	281	ret = 0;
	282
	283	mutex_lock(&dev_priv->hw_mutex);
	284	if (atomic_dec_and_test(&dev_priv->fifo_queue_waiters)) {
	285	spin_lock_irqsave(&dev_priv->irq_lock, irq_flags);
	286	vmw_write(dev_priv, SVGA_REG_IRQMASK,
	287	vmw_read(dev_priv, SVGA_REG_IRQMASK) &
	288	~SVGA_IRQFLAG_FIFO_PROGRESS);
	289	spin_unlock_irqrestore(&dev_priv->irq_lock, irq_flags);
	290	}
	291	mutex_unlock(&dev_priv->hw_mutex);
	292
	293	return ret;
	294	}
	295
	296	void vmw_fifo_reserve(struct vmw_private dev_priv, uint32_t bytes)
	297	{
	298	struct vmw_fifo_state *fifo_state = &dev_priv->fifo;
	299	__le32 __iomem *fifo_mem = dev_priv->mmio_virt;
	300	uint32_t max;
	301	uint32_t min;
	302	uint32_t next_cmd;
	303	uint32_t reserveable = fifo_state->capabilities & SVGA_FIFO_CAP_RESERVE;
	304	int ret;
	305
85b9e487	306	mutex_lock(&fifo_state->fifo_mutex);
fb1d9738 JB	307	max = ioread32(fifo_mem + SVGA_FIFO_MAX);
	308	min = ioread32(fifo_mem + SVGA_FIFO_MIN);
	309	next_cmd = ioread32(fifo_mem + SVGA_FIFO_NEXT_CMD);
	310
	311	if (unlikely(bytes >= (max - min)))
	312	goto out_err;
	313
	314	BUG_ON(fifo_state->reserved_size != 0);
	315	BUG_ON(fifo_state->dynamic_buffer != NULL);
	316
	317	fifo_state->reserved_size = bytes;
	318
	319	while (1) {
	320	uint32_t stop = ioread32(fifo_mem + SVGA_FIFO_STOP);
	321	bool need_bounce = false;
	322	bool reserve_in_place = false;
	323
	324	if (next_cmd >= stop) {
	325	if (likely((next_cmd + bytes < max \|\|
	326	(next_cmd + bytes == max && stop > min))))
	327	reserve_in_place = true;
	328
	329	else if (vmw_fifo_is_full(dev_priv, bytes)) {
	330	ret = vmw_fifo_wait(dev_priv, bytes,
	331	false, 3 * HZ);
	332	if (unlikely(ret != 0))
	333	goto out_err;
	334	} else
	335	need_bounce = true;
	336
	337	} else {
	338
	339	if (likely((next_cmd + bytes < stop)))
	340	reserve_in_place = true;
	341	else {
	342	ret = vmw_fifo_wait(dev_priv, bytes,
	343	false, 3 * HZ);
	344	if (unlikely(ret != 0))
	345	goto out_err;
	346	}
	347	}
	348
	349	if (reserve_in_place) {
	350	if (reserveable \|\| bytes <= sizeof(uint32_t)) {
	351	fifo_state->using_bounce_buffer = false;
	352
	353	if (reserveable)
	354	iowrite32(bytes, fifo_mem +
	355	SVGA_FIFO_RESERVED);
	356	return fifo_mem + (next_cmd >> 2);
	357	} else {
	358	need_bounce = true;
	359	}
	360	}
	361
	362	if (need_bounce) {
	363	fifo_state->using_bounce_buffer = true;
	364	if (bytes < fifo_state->static_buffer_size)
	365	return fifo_state->static_buffer;
	366	else {
	367	fifo_state->dynamic_buffer = vmalloc(bytes);
	368	return fifo_state->dynamic_buffer;
	369	}
	370	}
371	}
372	out_err:
373	fifo_state->reserved_size = 0;
85b9e487	374	mutex_unlock(&fifo_state->fifo_mutex);
fb1d9738 JB	375	return NULL;
	376	}
	377
	378	static void vmw_fifo_res_copy(struct vmw_fifo_state *fifo_state,
	379	__le32 __iomem *fifo_mem,
	380	uint32_t next_cmd,
	381	uint32_t max, uint32_t min, uint32_t bytes)
	382	{
	383	uint32_t chunk_size = max - next_cmd;
	384	uint32_t rest;
	385	uint32_t *buffer = (fifo_state->dynamic_buffer != NULL) ?
	386	fifo_state->dynamic_buffer : fifo_state->static_buffer;
	387
	388	if (bytes < chunk_size)
	389	chunk_size = bytes;
	390
	391	iowrite32(bytes, fifo_mem + SVGA_FIFO_RESERVED);
	392	mb();
	393	memcpy_toio(fifo_mem + (next_cmd >> 2), buffer, chunk_size);
	394	rest = bytes - chunk_size;
	395	if (rest)
	396	memcpy_toio(fifo_mem + (min >> 2), buffer + (chunk_size >> 2),
	397	rest);
	398	}
	399
	400	static void vmw_fifo_slow_copy(struct vmw_fifo_state *fifo_state,
	401	__le32 __iomem *fifo_mem,
	402	uint32_t next_cmd,
	403	uint32_t max, uint32_t min, uint32_t bytes)
	404	{
	405	uint32_t *buffer = (fifo_state->dynamic_buffer != NULL) ?
	406	fifo_state->dynamic_buffer : fifo_state->static_buffer;
	407
	408	while (bytes > 0) {
	409	iowrite32(*buffer++, fifo_mem + (next_cmd >> 2));
	410	next_cmd += sizeof(uint32_t);
	411	if (unlikely(next_cmd == max))
	412	next_cmd = min;
	413	mb();
	414	iowrite32(next_cmd, fifo_mem + SVGA_FIFO_NEXT_CMD);
	415	mb();
	416	bytes -= sizeof(uint32_t);
	417	}
	418	}
	419
	420	void vmw_fifo_commit(struct vmw_private *dev_priv, uint32_t bytes)
	421	{
	422	struct vmw_fifo_state *fifo_state = &dev_priv->fifo;
	423	__le32 __iomem *fifo_mem = dev_priv->mmio_virt;
	424	uint32_t next_cmd = ioread32(fifo_mem + SVGA_FIFO_NEXT_CMD);
	425	uint32_t max = ioread32(fifo_mem + SVGA_FIFO_MAX);
	426	uint32_t min = ioread32(fifo_mem + SVGA_FIFO_MIN);
	427	bool reserveable = fifo_state->capabilities & SVGA_FIFO_CAP_RESERVE;
	428
	429	BUG_ON((bytes & 3) != 0);
	430	BUG_ON(bytes > fifo_state->reserved_size);
	431
	432	fifo_state->reserved_size = 0;
	433
	434	if (fifo_state->using_bounce_buffer) {
	435	if (reserveable)
	436	vmw_fifo_res_copy(fifo_state, fifo_mem,
	437	next_cmd, max, min, bytes);
	438	else
439	vmw_fifo_slow_copy(fifo_state, fifo_mem,
440	next_cmd, max, min, bytes);
441
442	if (fifo_state->dynamic_buffer) {
443	vfree(fifo_state->dynamic_buffer);
444	fifo_state->dynamic_buffer = NULL;
445	}
446
447	}
448
85b9e487	449	down_write(&fifo_state->rwsem);
fb1d9738 JB	450	if (fifo_state->using_bounce_buffer \|\| reserveable) {
	451	next_cmd += bytes;
	452	if (next_cmd >= max)
	453	next_cmd -= max - min;
	454	mb();
	455	iowrite32(next_cmd, fifo_mem + SVGA_FIFO_NEXT_CMD);
	456	}
	457
	458	if (reserveable)
	459	iowrite32(0, fifo_mem + SVGA_FIFO_RESERVED);
	460	mb();
fb1d9738	461	up_write(&fifo_state->rwsem);
85b9e487 TH	462	vmw_fifo_ping_host(dev_priv, SVGA_SYNC_GENERIC);
85b9e487 TH	463	mutex_unlock(&fifo_state->fifo_mutex);
fb1d9738 JB	464	}
	465
	466	int vmw_fifo_send_fence(struct vmw_private dev_priv, uint32_t sequence)
	467	{
	468	struct vmw_fifo_state *fifo_state = &dev_priv->fifo;
	469	struct svga_fifo_cmd_fence *cmd_fence;
	470	void *fm;
	471	int ret = 0;
	472	uint32_t bytes = sizeof(__le32) + sizeof(*cmd_fence);
	473
	474	fm = vmw_fifo_reserve(dev_priv, bytes);
	475	if (unlikely(fm == NULL)) {
85b9e487	476	*sequence = atomic_read(&dev_priv->fence_seq);
fb1d9738 JB	477	ret = -ENOMEM;
	478	(void)vmw_fallback_wait(dev_priv, false, true, *sequence,
	479	false, 3*HZ);
	480	goto out_err;
	481	}
	482
	483	do {
85b9e487	484	*sequence = atomic_add_return(1, &dev_priv->fence_seq);
fb1d9738 JB	485	} while (*sequence == 0);
	486
	487	if (!(fifo_state->capabilities & SVGA_FIFO_CAP_FENCE)) {
	488
	489	/*
	490	* Don't request hardware to send a fence. The
	491	* waiting code in vmwgfx_irq.c will emulate this.
	492	*/
	493
	494	vmw_fifo_commit(dev_priv, 0);
	495	return 0;
	496	}
	497
	498	(__le32 ) fm = cpu_to_le32(SVGA_CMD_FENCE);
	499	cmd_fence = (struct svga_fifo_cmd_fence *)
	500	((unsigned long)fm + sizeof(__le32));
	501
	502	iowrite32(*sequence, &cmd_fence->fence);
	503	fifo_state->last_buffer_add = true;
	504	vmw_fifo_commit(dev_priv, bytes);
	505	fifo_state->last_buffer_add = false;
1925d456 TH	506	(void) vmw_fence_push(&fifo_state->fence_queue, *sequence);
1925d456 TH	507	vmw_update_sequence(dev_priv, fifo_state);
fb1d9738 JB	508
	509	out_err:
	510	return ret;
	511	}
	512
	513	/**
	514	* Map the first page of the FIFO read-only to user-space.
	515	*/
	516
	517	static int vmw_fifo_vm_fault(struct vm_area_struct vma, struct vm_fault vmf)
	518	{
	519	int ret;
	520	unsigned long address = (unsigned long)vmf->virtual_address;
	521
	522	if (address != vma->vm_start)
	523	return VM_FAULT_SIGBUS;
	524
	525	ret = vm_insert_pfn(vma, address, vma->vm_pgoff);
	526	if (likely(ret == -EBUSY \|\| ret == 0))
	527	return VM_FAULT_NOPAGE;
	528	else if (ret == -ENOMEM)
	529	return VM_FAULT_OOM;
	530
	531	return VM_FAULT_SIGBUS;
	532	}
	533
	534	static struct vm_operations_struct vmw_fifo_vm_ops = {
	535	.fault = vmw_fifo_vm_fault,
	536	.open = NULL,
	537	.close = NULL
	538	};
	539
	540	int vmw_fifo_mmap(struct file filp, struct vm_area_struct vma)
	541	{
	542	struct drm_file *file_priv;
	543	struct vmw_private *dev_priv;
	544
40b3be3f	545	file_priv = filp->private_data;
fb1d9738 JB	546	dev_priv = vmw_priv(file_priv->minor->dev);
	547
	548	if (vma->vm_pgoff != (dev_priv->mmio_start >> PAGE_SHIFT) \|\|
	549	(vma->vm_end - vma->vm_start) != PAGE_SIZE)
	550	return -EINVAL;
	551
	552	vma->vm_flags &= ~(VM_WRITE \| VM_MAYWRITE);
	553	vma->vm_flags \|= VM_IO \| VM_PFNMAP \| VM_DONTEXPAND \| VM_SHARED;
	554	vma->vm_page_prot = vm_get_page_prot(vma->vm_flags);
	555	vma->vm_page_prot = ttm_io_prot(TTM_PL_FLAG_UNCACHED,
	556	vma->vm_page_prot);
	557	vma->vm_ops = &vmw_fifo_vm_ops;
	558	return 0;
	559	}