18c2ecf20Sopenharmony_ci/* via_dma.c -- DMA support for the VIA Unichrome/Pro
28c2ecf20Sopenharmony_ci *
38c2ecf20Sopenharmony_ci * Copyright 2003 Tungsten Graphics, Inc., Cedar Park, Texas.
48c2ecf20Sopenharmony_ci * All Rights Reserved.
58c2ecf20Sopenharmony_ci *
68c2ecf20Sopenharmony_ci * Copyright 2004 Digeo, Inc., Palo Alto, CA, U.S.A.
78c2ecf20Sopenharmony_ci * All Rights Reserved.
88c2ecf20Sopenharmony_ci *
98c2ecf20Sopenharmony_ci * Copyright 2004 The Unichrome project.
108c2ecf20Sopenharmony_ci * All Rights Reserved.
118c2ecf20Sopenharmony_ci *
128c2ecf20Sopenharmony_ci * Permission is hereby granted, free of charge, to any person obtaining a
138c2ecf20Sopenharmony_ci * copy of this software and associated documentation files (the "Software"),
148c2ecf20Sopenharmony_ci * to deal in the Software without restriction, including without limitation
158c2ecf20Sopenharmony_ci * the rights to use, copy, modify, merge, publish, distribute, sub license,
168c2ecf20Sopenharmony_ci * and/or sell copies of the Software, and to permit persons to whom the
178c2ecf20Sopenharmony_ci * Software is furnished to do so, subject to the following conditions:
188c2ecf20Sopenharmony_ci *
198c2ecf20Sopenharmony_ci * The above copyright notice and this permission notice (including the
208c2ecf20Sopenharmony_ci * next paragraph) shall be included in all copies or substantial portions
218c2ecf20Sopenharmony_ci * of the Software.
228c2ecf20Sopenharmony_ci *
238c2ecf20Sopenharmony_ci * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
248c2ecf20Sopenharmony_ci * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
258c2ecf20Sopenharmony_ci * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
268c2ecf20Sopenharmony_ci * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
278c2ecf20Sopenharmony_ci * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
288c2ecf20Sopenharmony_ci * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
298c2ecf20Sopenharmony_ci * USE OR OTHER DEALINGS IN THE SOFTWARE.
308c2ecf20Sopenharmony_ci *
318c2ecf20Sopenharmony_ci * Authors:
328c2ecf20Sopenharmony_ci *    Tungsten Graphics,
338c2ecf20Sopenharmony_ci *    Erdi Chen,
348c2ecf20Sopenharmony_ci *    Thomas Hellstrom.
358c2ecf20Sopenharmony_ci */
368c2ecf20Sopenharmony_ci
378c2ecf20Sopenharmony_ci#include <linux/delay.h>
388c2ecf20Sopenharmony_ci#include <linux/uaccess.h>
398c2ecf20Sopenharmony_ci
408c2ecf20Sopenharmony_ci#include <drm/drm.h>
418c2ecf20Sopenharmony_ci#include <drm/drm_agpsupport.h>
428c2ecf20Sopenharmony_ci#include <drm/drm_device.h>
438c2ecf20Sopenharmony_ci#include <drm/drm_file.h>
448c2ecf20Sopenharmony_ci#include <drm/via_drm.h>
458c2ecf20Sopenharmony_ci
468c2ecf20Sopenharmony_ci#include "via_drv.h"
478c2ecf20Sopenharmony_ci#include "via_3d_reg.h"
488c2ecf20Sopenharmony_ci
498c2ecf20Sopenharmony_ci#define CMDBUF_ALIGNMENT_SIZE   (0x100)
508c2ecf20Sopenharmony_ci#define CMDBUF_ALIGNMENT_MASK   (0x0ff)
518c2ecf20Sopenharmony_ci
528c2ecf20Sopenharmony_ci/* defines for VIA 3D registers */
538c2ecf20Sopenharmony_ci#define VIA_REG_STATUS          0x400
548c2ecf20Sopenharmony_ci#define VIA_REG_TRANSET         0x43C
558c2ecf20Sopenharmony_ci#define VIA_REG_TRANSPACE       0x440
568c2ecf20Sopenharmony_ci
578c2ecf20Sopenharmony_ci/* VIA_REG_STATUS(0x400): Engine Status */
588c2ecf20Sopenharmony_ci#define VIA_CMD_RGTR_BUSY       0x00000080	/* Command Regulator is busy */
598c2ecf20Sopenharmony_ci#define VIA_2D_ENG_BUSY         0x00000001	/* 2D Engine is busy */
608c2ecf20Sopenharmony_ci#define VIA_3D_ENG_BUSY         0x00000002	/* 3D Engine is busy */
618c2ecf20Sopenharmony_ci#define VIA_VR_QUEUE_BUSY       0x00020000	/* Virtual Queue is busy */
628c2ecf20Sopenharmony_ci
638c2ecf20Sopenharmony_ci#define SetReg2DAGP(nReg, nData) {				\
648c2ecf20Sopenharmony_ci	*((uint32_t *)(vb)) = ((nReg) >> 2) | HALCYON_HEADER1;	\
658c2ecf20Sopenharmony_ci	*((uint32_t *)(vb) + 1) = (nData);			\
668c2ecf20Sopenharmony_ci	vb = ((uint32_t *)vb) + 2;				\
678c2ecf20Sopenharmony_ci	dev_priv->dma_low += 8;					\
688c2ecf20Sopenharmony_ci}
698c2ecf20Sopenharmony_ci
708c2ecf20Sopenharmony_ci#define via_flush_write_combine() mb()
718c2ecf20Sopenharmony_ci
728c2ecf20Sopenharmony_ci#define VIA_OUT_RING_QW(w1, w2)	do {		\
738c2ecf20Sopenharmony_ci	*vb++ = (w1);				\
748c2ecf20Sopenharmony_ci	*vb++ = (w2);				\
758c2ecf20Sopenharmony_ci	dev_priv->dma_low += 8;			\
768c2ecf20Sopenharmony_ci} while (0)
778c2ecf20Sopenharmony_ci
788c2ecf20Sopenharmony_cistatic void via_cmdbuf_start(drm_via_private_t *dev_priv);
798c2ecf20Sopenharmony_cistatic void via_cmdbuf_pause(drm_via_private_t *dev_priv);
808c2ecf20Sopenharmony_cistatic void via_cmdbuf_reset(drm_via_private_t *dev_priv);
818c2ecf20Sopenharmony_cistatic void via_cmdbuf_rewind(drm_via_private_t *dev_priv);
828c2ecf20Sopenharmony_cistatic int via_wait_idle(drm_via_private_t *dev_priv);
838c2ecf20Sopenharmony_cistatic void via_pad_cache(drm_via_private_t *dev_priv, int qwords);
848c2ecf20Sopenharmony_ci
858c2ecf20Sopenharmony_ci/*
868c2ecf20Sopenharmony_ci * Free space in command buffer.
878c2ecf20Sopenharmony_ci */
888c2ecf20Sopenharmony_ci
898c2ecf20Sopenharmony_cistatic uint32_t via_cmdbuf_space(drm_via_private_t *dev_priv)
908c2ecf20Sopenharmony_ci{
918c2ecf20Sopenharmony_ci	uint32_t agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
928c2ecf20Sopenharmony_ci	uint32_t hw_addr = *(dev_priv->hw_addr_ptr) - agp_base;
938c2ecf20Sopenharmony_ci
948c2ecf20Sopenharmony_ci	return ((hw_addr <= dev_priv->dma_low) ?
958c2ecf20Sopenharmony_ci		(dev_priv->dma_high + hw_addr - dev_priv->dma_low) :
968c2ecf20Sopenharmony_ci		(hw_addr - dev_priv->dma_low));
978c2ecf20Sopenharmony_ci}
988c2ecf20Sopenharmony_ci
998c2ecf20Sopenharmony_ci/*
1008c2ecf20Sopenharmony_ci * How much does the command regulator lag behind?
1018c2ecf20Sopenharmony_ci */
1028c2ecf20Sopenharmony_ci
1038c2ecf20Sopenharmony_cistatic uint32_t via_cmdbuf_lag(drm_via_private_t *dev_priv)
1048c2ecf20Sopenharmony_ci{
1058c2ecf20Sopenharmony_ci	uint32_t agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
1068c2ecf20Sopenharmony_ci	uint32_t hw_addr = *(dev_priv->hw_addr_ptr) - agp_base;
1078c2ecf20Sopenharmony_ci
1088c2ecf20Sopenharmony_ci	return ((hw_addr <= dev_priv->dma_low) ?
1098c2ecf20Sopenharmony_ci		(dev_priv->dma_low - hw_addr) :
1108c2ecf20Sopenharmony_ci		(dev_priv->dma_wrap + dev_priv->dma_low - hw_addr));
1118c2ecf20Sopenharmony_ci}
1128c2ecf20Sopenharmony_ci
1138c2ecf20Sopenharmony_ci/*
1148c2ecf20Sopenharmony_ci * Check that the given size fits in the buffer, otherwise wait.
1158c2ecf20Sopenharmony_ci */
1168c2ecf20Sopenharmony_ci
1178c2ecf20Sopenharmony_cistatic inline int
1188c2ecf20Sopenharmony_civia_cmdbuf_wait(drm_via_private_t *dev_priv, unsigned int size)
1198c2ecf20Sopenharmony_ci{
1208c2ecf20Sopenharmony_ci	uint32_t agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
1218c2ecf20Sopenharmony_ci	uint32_t cur_addr, hw_addr, next_addr;
1228c2ecf20Sopenharmony_ci	volatile uint32_t *hw_addr_ptr;
1238c2ecf20Sopenharmony_ci	uint32_t count;
1248c2ecf20Sopenharmony_ci	hw_addr_ptr = dev_priv->hw_addr_ptr;
1258c2ecf20Sopenharmony_ci	cur_addr = dev_priv->dma_low;
1268c2ecf20Sopenharmony_ci	next_addr = cur_addr + size + 512 * 1024;
1278c2ecf20Sopenharmony_ci	count = 1000000;
1288c2ecf20Sopenharmony_ci	do {
1298c2ecf20Sopenharmony_ci		hw_addr = *hw_addr_ptr - agp_base;
1308c2ecf20Sopenharmony_ci		if (count-- == 0) {
1318c2ecf20Sopenharmony_ci			DRM_ERROR
1328c2ecf20Sopenharmony_ci			    ("via_cmdbuf_wait timed out hw %x cur_addr %x next_addr %x\n",
1338c2ecf20Sopenharmony_ci			     hw_addr, cur_addr, next_addr);
1348c2ecf20Sopenharmony_ci			return -1;
1358c2ecf20Sopenharmony_ci		}
1368c2ecf20Sopenharmony_ci		if  ((cur_addr < hw_addr) && (next_addr >= hw_addr))
1378c2ecf20Sopenharmony_ci			msleep(1);
1388c2ecf20Sopenharmony_ci	} while ((cur_addr < hw_addr) && (next_addr >= hw_addr));
1398c2ecf20Sopenharmony_ci	return 0;
1408c2ecf20Sopenharmony_ci}
1418c2ecf20Sopenharmony_ci
1428c2ecf20Sopenharmony_ci/*
1438c2ecf20Sopenharmony_ci * Checks whether buffer head has reach the end. Rewind the ring buffer
1448c2ecf20Sopenharmony_ci * when necessary.
1458c2ecf20Sopenharmony_ci *
1468c2ecf20Sopenharmony_ci * Returns virtual pointer to ring buffer.
1478c2ecf20Sopenharmony_ci */
1488c2ecf20Sopenharmony_ci
1498c2ecf20Sopenharmony_cistatic inline uint32_t *via_check_dma(drm_via_private_t * dev_priv,
1508c2ecf20Sopenharmony_ci				      unsigned int size)
1518c2ecf20Sopenharmony_ci{
1528c2ecf20Sopenharmony_ci	if ((dev_priv->dma_low + size + 4 * CMDBUF_ALIGNMENT_SIZE) >
1538c2ecf20Sopenharmony_ci	    dev_priv->dma_high) {
1548c2ecf20Sopenharmony_ci		via_cmdbuf_rewind(dev_priv);
1558c2ecf20Sopenharmony_ci	}
1568c2ecf20Sopenharmony_ci	if (via_cmdbuf_wait(dev_priv, size) != 0)
1578c2ecf20Sopenharmony_ci		return NULL;
1588c2ecf20Sopenharmony_ci
1598c2ecf20Sopenharmony_ci	return (uint32_t *) (dev_priv->dma_ptr + dev_priv->dma_low);
1608c2ecf20Sopenharmony_ci}
1618c2ecf20Sopenharmony_ci
1628c2ecf20Sopenharmony_ciint via_dma_cleanup(struct drm_device *dev)
1638c2ecf20Sopenharmony_ci{
1648c2ecf20Sopenharmony_ci	if (dev->dev_private) {
1658c2ecf20Sopenharmony_ci		drm_via_private_t *dev_priv =
1668c2ecf20Sopenharmony_ci		    (drm_via_private_t *) dev->dev_private;
1678c2ecf20Sopenharmony_ci
1688c2ecf20Sopenharmony_ci		if (dev_priv->ring.virtual_start) {
1698c2ecf20Sopenharmony_ci			via_cmdbuf_reset(dev_priv);
1708c2ecf20Sopenharmony_ci
1718c2ecf20Sopenharmony_ci			drm_legacy_ioremapfree(&dev_priv->ring.map, dev);
1728c2ecf20Sopenharmony_ci			dev_priv->ring.virtual_start = NULL;
1738c2ecf20Sopenharmony_ci		}
1748c2ecf20Sopenharmony_ci
1758c2ecf20Sopenharmony_ci	}
1768c2ecf20Sopenharmony_ci
1778c2ecf20Sopenharmony_ci	return 0;
1788c2ecf20Sopenharmony_ci}
1798c2ecf20Sopenharmony_ci
1808c2ecf20Sopenharmony_cistatic int via_initialize(struct drm_device *dev,
1818c2ecf20Sopenharmony_ci			  drm_via_private_t *dev_priv,
1828c2ecf20Sopenharmony_ci			  drm_via_dma_init_t *init)
1838c2ecf20Sopenharmony_ci{
1848c2ecf20Sopenharmony_ci	if (!dev_priv || !dev_priv->mmio) {
1858c2ecf20Sopenharmony_ci		DRM_ERROR("via_dma_init called before via_map_init\n");
1868c2ecf20Sopenharmony_ci		return -EFAULT;
1878c2ecf20Sopenharmony_ci	}
1888c2ecf20Sopenharmony_ci
1898c2ecf20Sopenharmony_ci	if (dev_priv->ring.virtual_start != NULL) {
1908c2ecf20Sopenharmony_ci		DRM_ERROR("called again without calling cleanup\n");
1918c2ecf20Sopenharmony_ci		return -EFAULT;
1928c2ecf20Sopenharmony_ci	}
1938c2ecf20Sopenharmony_ci
1948c2ecf20Sopenharmony_ci	if (!dev->agp || !dev->agp->base) {
1958c2ecf20Sopenharmony_ci		DRM_ERROR("called with no agp memory available\n");
1968c2ecf20Sopenharmony_ci		return -EFAULT;
1978c2ecf20Sopenharmony_ci	}
1988c2ecf20Sopenharmony_ci
1998c2ecf20Sopenharmony_ci	if (dev_priv->chipset == VIA_DX9_0) {
2008c2ecf20Sopenharmony_ci		DRM_ERROR("AGP DMA is not supported on this chip\n");
2018c2ecf20Sopenharmony_ci		return -EINVAL;
2028c2ecf20Sopenharmony_ci	}
2038c2ecf20Sopenharmony_ci
2048c2ecf20Sopenharmony_ci	dev_priv->ring.map.offset = dev->agp->base + init->offset;
2058c2ecf20Sopenharmony_ci	dev_priv->ring.map.size = init->size;
2068c2ecf20Sopenharmony_ci	dev_priv->ring.map.type = 0;
2078c2ecf20Sopenharmony_ci	dev_priv->ring.map.flags = 0;
2088c2ecf20Sopenharmony_ci	dev_priv->ring.map.mtrr = 0;
2098c2ecf20Sopenharmony_ci
2108c2ecf20Sopenharmony_ci	drm_legacy_ioremap(&dev_priv->ring.map, dev);
2118c2ecf20Sopenharmony_ci
2128c2ecf20Sopenharmony_ci	if (dev_priv->ring.map.handle == NULL) {
2138c2ecf20Sopenharmony_ci		via_dma_cleanup(dev);
2148c2ecf20Sopenharmony_ci		DRM_ERROR("can not ioremap virtual address for"
2158c2ecf20Sopenharmony_ci			  " ring buffer\n");
2168c2ecf20Sopenharmony_ci		return -ENOMEM;
2178c2ecf20Sopenharmony_ci	}
2188c2ecf20Sopenharmony_ci
2198c2ecf20Sopenharmony_ci	dev_priv->ring.virtual_start = dev_priv->ring.map.handle;
2208c2ecf20Sopenharmony_ci
2218c2ecf20Sopenharmony_ci	dev_priv->dma_ptr = dev_priv->ring.virtual_start;
2228c2ecf20Sopenharmony_ci	dev_priv->dma_low = 0;
2238c2ecf20Sopenharmony_ci	dev_priv->dma_high = init->size;
2248c2ecf20Sopenharmony_ci	dev_priv->dma_wrap = init->size;
2258c2ecf20Sopenharmony_ci	dev_priv->dma_offset = init->offset;
2268c2ecf20Sopenharmony_ci	dev_priv->last_pause_ptr = NULL;
2278c2ecf20Sopenharmony_ci	dev_priv->hw_addr_ptr =
2288c2ecf20Sopenharmony_ci		(volatile uint32_t *)((char *)dev_priv->mmio->handle +
2298c2ecf20Sopenharmony_ci		init->reg_pause_addr);
2308c2ecf20Sopenharmony_ci
2318c2ecf20Sopenharmony_ci	via_cmdbuf_start(dev_priv);
2328c2ecf20Sopenharmony_ci
2338c2ecf20Sopenharmony_ci	return 0;
2348c2ecf20Sopenharmony_ci}
2358c2ecf20Sopenharmony_ci
2368c2ecf20Sopenharmony_cistatic int via_dma_init(struct drm_device *dev, void *data, struct drm_file *file_priv)
2378c2ecf20Sopenharmony_ci{
2388c2ecf20Sopenharmony_ci	drm_via_private_t *dev_priv = (drm_via_private_t *) dev->dev_private;
2398c2ecf20Sopenharmony_ci	drm_via_dma_init_t *init = data;
2408c2ecf20Sopenharmony_ci	int retcode = 0;
2418c2ecf20Sopenharmony_ci
2428c2ecf20Sopenharmony_ci	switch (init->func) {
2438c2ecf20Sopenharmony_ci	case VIA_INIT_DMA:
2448c2ecf20Sopenharmony_ci		if (!capable(CAP_SYS_ADMIN))
2458c2ecf20Sopenharmony_ci			retcode = -EPERM;
2468c2ecf20Sopenharmony_ci		else
2478c2ecf20Sopenharmony_ci			retcode = via_initialize(dev, dev_priv, init);
2488c2ecf20Sopenharmony_ci		break;
2498c2ecf20Sopenharmony_ci	case VIA_CLEANUP_DMA:
2508c2ecf20Sopenharmony_ci		if (!capable(CAP_SYS_ADMIN))
2518c2ecf20Sopenharmony_ci			retcode = -EPERM;
2528c2ecf20Sopenharmony_ci		else
2538c2ecf20Sopenharmony_ci			retcode = via_dma_cleanup(dev);
2548c2ecf20Sopenharmony_ci		break;
2558c2ecf20Sopenharmony_ci	case VIA_DMA_INITIALIZED:
2568c2ecf20Sopenharmony_ci		retcode = (dev_priv->ring.virtual_start != NULL) ?
2578c2ecf20Sopenharmony_ci			0 : -EFAULT;
2588c2ecf20Sopenharmony_ci		break;
2598c2ecf20Sopenharmony_ci	default:
2608c2ecf20Sopenharmony_ci		retcode = -EINVAL;
2618c2ecf20Sopenharmony_ci		break;
2628c2ecf20Sopenharmony_ci	}
2638c2ecf20Sopenharmony_ci
2648c2ecf20Sopenharmony_ci	return retcode;
2658c2ecf20Sopenharmony_ci}
2668c2ecf20Sopenharmony_ci
2678c2ecf20Sopenharmony_cistatic int via_dispatch_cmdbuffer(struct drm_device *dev, drm_via_cmdbuffer_t *cmd)
2688c2ecf20Sopenharmony_ci{
2698c2ecf20Sopenharmony_ci	drm_via_private_t *dev_priv;
2708c2ecf20Sopenharmony_ci	uint32_t *vb;
2718c2ecf20Sopenharmony_ci	int ret;
2728c2ecf20Sopenharmony_ci
2738c2ecf20Sopenharmony_ci	dev_priv = (drm_via_private_t *) dev->dev_private;
2748c2ecf20Sopenharmony_ci
2758c2ecf20Sopenharmony_ci	if (dev_priv->ring.virtual_start == NULL) {
2768c2ecf20Sopenharmony_ci		DRM_ERROR("called without initializing AGP ring buffer.\n");
2778c2ecf20Sopenharmony_ci		return -EFAULT;
2788c2ecf20Sopenharmony_ci	}
2798c2ecf20Sopenharmony_ci
2808c2ecf20Sopenharmony_ci	if (cmd->size > VIA_PCI_BUF_SIZE)
2818c2ecf20Sopenharmony_ci		return -ENOMEM;
2828c2ecf20Sopenharmony_ci
2838c2ecf20Sopenharmony_ci	if (copy_from_user(dev_priv->pci_buf, cmd->buf, cmd->size))
2848c2ecf20Sopenharmony_ci		return -EFAULT;
2858c2ecf20Sopenharmony_ci
2868c2ecf20Sopenharmony_ci	/*
2878c2ecf20Sopenharmony_ci	 * Running this function on AGP memory is dead slow. Therefore
2888c2ecf20Sopenharmony_ci	 * we run it on a temporary cacheable system memory buffer and
2898c2ecf20Sopenharmony_ci	 * copy it to AGP memory when ready.
2908c2ecf20Sopenharmony_ci	 */
2918c2ecf20Sopenharmony_ci
2928c2ecf20Sopenharmony_ci	if ((ret =
2938c2ecf20Sopenharmony_ci	     via_verify_command_stream((uint32_t *) dev_priv->pci_buf,
2948c2ecf20Sopenharmony_ci				       cmd->size, dev, 1))) {
2958c2ecf20Sopenharmony_ci		return ret;
2968c2ecf20Sopenharmony_ci	}
2978c2ecf20Sopenharmony_ci
2988c2ecf20Sopenharmony_ci	vb = via_check_dma(dev_priv, (cmd->size < 0x100) ? 0x102 : cmd->size);
2998c2ecf20Sopenharmony_ci	if (vb == NULL)
3008c2ecf20Sopenharmony_ci		return -EAGAIN;
3018c2ecf20Sopenharmony_ci
3028c2ecf20Sopenharmony_ci	memcpy(vb, dev_priv->pci_buf, cmd->size);
3038c2ecf20Sopenharmony_ci
3048c2ecf20Sopenharmony_ci	dev_priv->dma_low += cmd->size;
3058c2ecf20Sopenharmony_ci
3068c2ecf20Sopenharmony_ci	/*
3078c2ecf20Sopenharmony_ci	 * Small submissions somehow stalls the CPU. (AGP cache effects?)
3088c2ecf20Sopenharmony_ci	 * pad to greater size.
3098c2ecf20Sopenharmony_ci	 */
3108c2ecf20Sopenharmony_ci
3118c2ecf20Sopenharmony_ci	if (cmd->size < 0x100)
3128c2ecf20Sopenharmony_ci		via_pad_cache(dev_priv, (0x100 - cmd->size) >> 3);
3138c2ecf20Sopenharmony_ci	via_cmdbuf_pause(dev_priv);
3148c2ecf20Sopenharmony_ci
3158c2ecf20Sopenharmony_ci	return 0;
3168c2ecf20Sopenharmony_ci}
3178c2ecf20Sopenharmony_ci
3188c2ecf20Sopenharmony_ciint via_driver_dma_quiescent(struct drm_device *dev)
3198c2ecf20Sopenharmony_ci{
3208c2ecf20Sopenharmony_ci	drm_via_private_t *dev_priv = dev->dev_private;
3218c2ecf20Sopenharmony_ci
3228c2ecf20Sopenharmony_ci	if (!via_wait_idle(dev_priv))
3238c2ecf20Sopenharmony_ci		return -EBUSY;
3248c2ecf20Sopenharmony_ci	return 0;
3258c2ecf20Sopenharmony_ci}
3268c2ecf20Sopenharmony_ci
3278c2ecf20Sopenharmony_cistatic int via_flush_ioctl(struct drm_device *dev, void *data, struct drm_file *file_priv)
3288c2ecf20Sopenharmony_ci{
3298c2ecf20Sopenharmony_ci
3308c2ecf20Sopenharmony_ci	LOCK_TEST_WITH_RETURN(dev, file_priv);
3318c2ecf20Sopenharmony_ci
3328c2ecf20Sopenharmony_ci	return via_driver_dma_quiescent(dev);
3338c2ecf20Sopenharmony_ci}
3348c2ecf20Sopenharmony_ci
3358c2ecf20Sopenharmony_cistatic int via_cmdbuffer(struct drm_device *dev, void *data, struct drm_file *file_priv)
3368c2ecf20Sopenharmony_ci{
3378c2ecf20Sopenharmony_ci	drm_via_cmdbuffer_t *cmdbuf = data;
3388c2ecf20Sopenharmony_ci	int ret;
3398c2ecf20Sopenharmony_ci
3408c2ecf20Sopenharmony_ci	LOCK_TEST_WITH_RETURN(dev, file_priv);
3418c2ecf20Sopenharmony_ci
3428c2ecf20Sopenharmony_ci	DRM_DEBUG("buf %p size %lu\n", cmdbuf->buf, cmdbuf->size);
3438c2ecf20Sopenharmony_ci
3448c2ecf20Sopenharmony_ci	ret = via_dispatch_cmdbuffer(dev, cmdbuf);
3458c2ecf20Sopenharmony_ci	return ret;
3468c2ecf20Sopenharmony_ci}
3478c2ecf20Sopenharmony_ci
3488c2ecf20Sopenharmony_cistatic int via_dispatch_pci_cmdbuffer(struct drm_device *dev,
3498c2ecf20Sopenharmony_ci				      drm_via_cmdbuffer_t *cmd)
3508c2ecf20Sopenharmony_ci{
3518c2ecf20Sopenharmony_ci	drm_via_private_t *dev_priv = dev->dev_private;
3528c2ecf20Sopenharmony_ci	int ret;
3538c2ecf20Sopenharmony_ci
3548c2ecf20Sopenharmony_ci	if (cmd->size > VIA_PCI_BUF_SIZE)
3558c2ecf20Sopenharmony_ci		return -ENOMEM;
3568c2ecf20Sopenharmony_ci	if (copy_from_user(dev_priv->pci_buf, cmd->buf, cmd->size))
3578c2ecf20Sopenharmony_ci		return -EFAULT;
3588c2ecf20Sopenharmony_ci
3598c2ecf20Sopenharmony_ci	if ((ret =
3608c2ecf20Sopenharmony_ci	     via_verify_command_stream((uint32_t *) dev_priv->pci_buf,
3618c2ecf20Sopenharmony_ci				       cmd->size, dev, 0))) {
3628c2ecf20Sopenharmony_ci		return ret;
3638c2ecf20Sopenharmony_ci	}
3648c2ecf20Sopenharmony_ci
3658c2ecf20Sopenharmony_ci	ret =
3668c2ecf20Sopenharmony_ci	    via_parse_command_stream(dev, (const uint32_t *)dev_priv->pci_buf,
3678c2ecf20Sopenharmony_ci				     cmd->size);
3688c2ecf20Sopenharmony_ci	return ret;
3698c2ecf20Sopenharmony_ci}
3708c2ecf20Sopenharmony_ci
3718c2ecf20Sopenharmony_cistatic int via_pci_cmdbuffer(struct drm_device *dev, void *data, struct drm_file *file_priv)
3728c2ecf20Sopenharmony_ci{
3738c2ecf20Sopenharmony_ci	drm_via_cmdbuffer_t *cmdbuf = data;
3748c2ecf20Sopenharmony_ci	int ret;
3758c2ecf20Sopenharmony_ci
3768c2ecf20Sopenharmony_ci	LOCK_TEST_WITH_RETURN(dev, file_priv);
3778c2ecf20Sopenharmony_ci
3788c2ecf20Sopenharmony_ci	DRM_DEBUG("buf %p size %lu\n", cmdbuf->buf, cmdbuf->size);
3798c2ecf20Sopenharmony_ci
3808c2ecf20Sopenharmony_ci	ret = via_dispatch_pci_cmdbuffer(dev, cmdbuf);
3818c2ecf20Sopenharmony_ci	return ret;
3828c2ecf20Sopenharmony_ci}
3838c2ecf20Sopenharmony_ci
3848c2ecf20Sopenharmony_cistatic inline uint32_t *via_align_buffer(drm_via_private_t *dev_priv,
3858c2ecf20Sopenharmony_ci					 uint32_t * vb, int qw_count)
3868c2ecf20Sopenharmony_ci{
3878c2ecf20Sopenharmony_ci	for (; qw_count > 0; --qw_count)
3888c2ecf20Sopenharmony_ci		VIA_OUT_RING_QW(HC_DUMMY, HC_DUMMY);
3898c2ecf20Sopenharmony_ci	return vb;
3908c2ecf20Sopenharmony_ci}
3918c2ecf20Sopenharmony_ci
3928c2ecf20Sopenharmony_ci/*
3938c2ecf20Sopenharmony_ci * This function is used internally by ring buffer management code.
3948c2ecf20Sopenharmony_ci *
3958c2ecf20Sopenharmony_ci * Returns virtual pointer to ring buffer.
3968c2ecf20Sopenharmony_ci */
3978c2ecf20Sopenharmony_cistatic inline uint32_t *via_get_dma(drm_via_private_t *dev_priv)
3988c2ecf20Sopenharmony_ci{
3998c2ecf20Sopenharmony_ci	return (uint32_t *) (dev_priv->dma_ptr + dev_priv->dma_low);
4008c2ecf20Sopenharmony_ci}
4018c2ecf20Sopenharmony_ci
4028c2ecf20Sopenharmony_ci/*
4038c2ecf20Sopenharmony_ci * Hooks a segment of data into the tail of the ring-buffer by
4048c2ecf20Sopenharmony_ci * modifying the pause address stored in the buffer itself. If
4058c2ecf20Sopenharmony_ci * the regulator has already paused, restart it.
4068c2ecf20Sopenharmony_ci */
4078c2ecf20Sopenharmony_cistatic int via_hook_segment(drm_via_private_t *dev_priv,
4088c2ecf20Sopenharmony_ci			    uint32_t pause_addr_hi, uint32_t pause_addr_lo,
4098c2ecf20Sopenharmony_ci			    int no_pci_fire)
4108c2ecf20Sopenharmony_ci{
4118c2ecf20Sopenharmony_ci	int paused, count;
4128c2ecf20Sopenharmony_ci	volatile uint32_t *paused_at = dev_priv->last_pause_ptr;
4138c2ecf20Sopenharmony_ci	uint32_t reader, ptr;
4148c2ecf20Sopenharmony_ci	uint32_t diff;
4158c2ecf20Sopenharmony_ci
4168c2ecf20Sopenharmony_ci	paused = 0;
4178c2ecf20Sopenharmony_ci	via_flush_write_combine();
4188c2ecf20Sopenharmony_ci	(void) *(volatile uint32_t *)(via_get_dma(dev_priv) - 1);
4198c2ecf20Sopenharmony_ci
4208c2ecf20Sopenharmony_ci	*paused_at = pause_addr_lo;
4218c2ecf20Sopenharmony_ci	via_flush_write_combine();
4228c2ecf20Sopenharmony_ci	(void) *paused_at;
4238c2ecf20Sopenharmony_ci
4248c2ecf20Sopenharmony_ci	reader = *(dev_priv->hw_addr_ptr);
4258c2ecf20Sopenharmony_ci	ptr = ((volatile char *)paused_at - dev_priv->dma_ptr) +
4268c2ecf20Sopenharmony_ci		dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr + 4;
4278c2ecf20Sopenharmony_ci
4288c2ecf20Sopenharmony_ci	dev_priv->last_pause_ptr = via_get_dma(dev_priv) - 1;
4298c2ecf20Sopenharmony_ci
4308c2ecf20Sopenharmony_ci	/*
4318c2ecf20Sopenharmony_ci	 * If there is a possibility that the command reader will
4328c2ecf20Sopenharmony_ci	 * miss the new pause address and pause on the old one,
4338c2ecf20Sopenharmony_ci	 * In that case we need to program the new start address
4348c2ecf20Sopenharmony_ci	 * using PCI.
4358c2ecf20Sopenharmony_ci	 */
4368c2ecf20Sopenharmony_ci
4378c2ecf20Sopenharmony_ci	diff = (uint32_t) (ptr - reader) - dev_priv->dma_diff;
4388c2ecf20Sopenharmony_ci	count = 10000000;
4398c2ecf20Sopenharmony_ci	while (diff == 0 && count--) {
4408c2ecf20Sopenharmony_ci		paused = (via_read(dev_priv, 0x41c) & 0x80000000);
4418c2ecf20Sopenharmony_ci		if (paused)
4428c2ecf20Sopenharmony_ci			break;
4438c2ecf20Sopenharmony_ci		reader = *(dev_priv->hw_addr_ptr);
4448c2ecf20Sopenharmony_ci		diff = (uint32_t) (ptr - reader) - dev_priv->dma_diff;
4458c2ecf20Sopenharmony_ci	}
4468c2ecf20Sopenharmony_ci
4478c2ecf20Sopenharmony_ci	paused = via_read(dev_priv, 0x41c) & 0x80000000;
4488c2ecf20Sopenharmony_ci
4498c2ecf20Sopenharmony_ci	if (paused && !no_pci_fire) {
4508c2ecf20Sopenharmony_ci		reader = *(dev_priv->hw_addr_ptr);
4518c2ecf20Sopenharmony_ci		diff = (uint32_t) (ptr - reader) - dev_priv->dma_diff;
4528c2ecf20Sopenharmony_ci		diff &= (dev_priv->dma_high - 1);
4538c2ecf20Sopenharmony_ci		if (diff != 0 && diff < (dev_priv->dma_high >> 1)) {
4548c2ecf20Sopenharmony_ci			DRM_ERROR("Paused at incorrect address. "
4558c2ecf20Sopenharmony_ci				  "0x%08x, 0x%08x 0x%08x\n",
4568c2ecf20Sopenharmony_ci				  ptr, reader, dev_priv->dma_diff);
4578c2ecf20Sopenharmony_ci		} else if (diff == 0) {
4588c2ecf20Sopenharmony_ci			/*
4598c2ecf20Sopenharmony_ci			 * There is a concern that these writes may stall the PCI bus
4608c2ecf20Sopenharmony_ci			 * if the GPU is not idle. However, idling the GPU first
4618c2ecf20Sopenharmony_ci			 * doesn't make a difference.
4628c2ecf20Sopenharmony_ci			 */
4638c2ecf20Sopenharmony_ci
4648c2ecf20Sopenharmony_ci			via_write(dev_priv, VIA_REG_TRANSET, (HC_ParaType_PreCR << 16));
4658c2ecf20Sopenharmony_ci			via_write(dev_priv, VIA_REG_TRANSPACE, pause_addr_hi);
4668c2ecf20Sopenharmony_ci			via_write(dev_priv, VIA_REG_TRANSPACE, pause_addr_lo);
4678c2ecf20Sopenharmony_ci			via_read(dev_priv, VIA_REG_TRANSPACE);
4688c2ecf20Sopenharmony_ci		}
4698c2ecf20Sopenharmony_ci	}
4708c2ecf20Sopenharmony_ci	return paused;
4718c2ecf20Sopenharmony_ci}
4728c2ecf20Sopenharmony_ci
4738c2ecf20Sopenharmony_cistatic int via_wait_idle(drm_via_private_t *dev_priv)
4748c2ecf20Sopenharmony_ci{
4758c2ecf20Sopenharmony_ci	int count = 10000000;
4768c2ecf20Sopenharmony_ci
4778c2ecf20Sopenharmony_ci	while (!(via_read(dev_priv, VIA_REG_STATUS) & VIA_VR_QUEUE_BUSY) && --count)
4788c2ecf20Sopenharmony_ci		;
4798c2ecf20Sopenharmony_ci
4808c2ecf20Sopenharmony_ci	while (count && (via_read(dev_priv, VIA_REG_STATUS) &
4818c2ecf20Sopenharmony_ci			   (VIA_CMD_RGTR_BUSY | VIA_2D_ENG_BUSY |
4828c2ecf20Sopenharmony_ci			    VIA_3D_ENG_BUSY)))
4838c2ecf20Sopenharmony_ci		--count;
4848c2ecf20Sopenharmony_ci	return count;
4858c2ecf20Sopenharmony_ci}
4868c2ecf20Sopenharmony_ci
4878c2ecf20Sopenharmony_cistatic uint32_t *via_align_cmd(drm_via_private_t *dev_priv, uint32_t cmd_type,
4888c2ecf20Sopenharmony_ci			       uint32_t addr, uint32_t *cmd_addr_hi,
4898c2ecf20Sopenharmony_ci			       uint32_t *cmd_addr_lo, int skip_wait)
4908c2ecf20Sopenharmony_ci{
4918c2ecf20Sopenharmony_ci	uint32_t agp_base;
4928c2ecf20Sopenharmony_ci	uint32_t cmd_addr, addr_lo, addr_hi;
4938c2ecf20Sopenharmony_ci	uint32_t *vb;
4948c2ecf20Sopenharmony_ci	uint32_t qw_pad_count;
4958c2ecf20Sopenharmony_ci
4968c2ecf20Sopenharmony_ci	if (!skip_wait)
4978c2ecf20Sopenharmony_ci		via_cmdbuf_wait(dev_priv, 2 * CMDBUF_ALIGNMENT_SIZE);
4988c2ecf20Sopenharmony_ci
4998c2ecf20Sopenharmony_ci	vb = via_get_dma(dev_priv);
5008c2ecf20Sopenharmony_ci	VIA_OUT_RING_QW(HC_HEADER2 | ((VIA_REG_TRANSET >> 2) << 12) |
5018c2ecf20Sopenharmony_ci			(VIA_REG_TRANSPACE >> 2), HC_ParaType_PreCR << 16);
5028c2ecf20Sopenharmony_ci	agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
5038c2ecf20Sopenharmony_ci	qw_pad_count = (CMDBUF_ALIGNMENT_SIZE >> 3) -
5048c2ecf20Sopenharmony_ci	    ((dev_priv->dma_low & CMDBUF_ALIGNMENT_MASK) >> 3);
5058c2ecf20Sopenharmony_ci
5068c2ecf20Sopenharmony_ci	cmd_addr = (addr) ? addr :
5078c2ecf20Sopenharmony_ci	    agp_base + dev_priv->dma_low - 8 + (qw_pad_count << 3);
5088c2ecf20Sopenharmony_ci	addr_lo = ((HC_SubA_HAGPBpL << 24) | (cmd_type & HC_HAGPBpID_MASK) |
5098c2ecf20Sopenharmony_ci		   (cmd_addr & HC_HAGPBpL_MASK));
5108c2ecf20Sopenharmony_ci	addr_hi = ((HC_SubA_HAGPBpH << 24) | (cmd_addr >> 24));
5118c2ecf20Sopenharmony_ci
5128c2ecf20Sopenharmony_ci	vb = via_align_buffer(dev_priv, vb, qw_pad_count - 1);
5138c2ecf20Sopenharmony_ci	VIA_OUT_RING_QW(*cmd_addr_hi = addr_hi, *cmd_addr_lo = addr_lo);
5148c2ecf20Sopenharmony_ci	return vb;
5158c2ecf20Sopenharmony_ci}
5168c2ecf20Sopenharmony_ci
5178c2ecf20Sopenharmony_cistatic void via_cmdbuf_start(drm_via_private_t *dev_priv)
5188c2ecf20Sopenharmony_ci{
5198c2ecf20Sopenharmony_ci	uint32_t pause_addr_lo, pause_addr_hi;
5208c2ecf20Sopenharmony_ci	uint32_t start_addr, start_addr_lo;
5218c2ecf20Sopenharmony_ci	uint32_t end_addr, end_addr_lo;
5228c2ecf20Sopenharmony_ci	uint32_t command;
5238c2ecf20Sopenharmony_ci	uint32_t agp_base;
5248c2ecf20Sopenharmony_ci	uint32_t ptr;
5258c2ecf20Sopenharmony_ci	uint32_t reader;
5268c2ecf20Sopenharmony_ci	int count;
5278c2ecf20Sopenharmony_ci
5288c2ecf20Sopenharmony_ci	dev_priv->dma_low = 0;
5298c2ecf20Sopenharmony_ci
5308c2ecf20Sopenharmony_ci	agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
5318c2ecf20Sopenharmony_ci	start_addr = agp_base;
5328c2ecf20Sopenharmony_ci	end_addr = agp_base + dev_priv->dma_high;
5338c2ecf20Sopenharmony_ci
5348c2ecf20Sopenharmony_ci	start_addr_lo = ((HC_SubA_HAGPBstL << 24) | (start_addr & 0xFFFFFF));
5358c2ecf20Sopenharmony_ci	end_addr_lo = ((HC_SubA_HAGPBendL << 24) | (end_addr & 0xFFFFFF));
5368c2ecf20Sopenharmony_ci	command = ((HC_SubA_HAGPCMNT << 24) | (start_addr >> 24) |
5378c2ecf20Sopenharmony_ci		   ((end_addr & 0xff000000) >> 16));
5388c2ecf20Sopenharmony_ci
5398c2ecf20Sopenharmony_ci	dev_priv->last_pause_ptr =
5408c2ecf20Sopenharmony_ci	    via_align_cmd(dev_priv, HC_HAGPBpID_PAUSE, 0,
5418c2ecf20Sopenharmony_ci			  &pause_addr_hi, &pause_addr_lo, 1) - 1;
5428c2ecf20Sopenharmony_ci
5438c2ecf20Sopenharmony_ci	via_flush_write_combine();
5448c2ecf20Sopenharmony_ci	(void) *(volatile uint32_t *)dev_priv->last_pause_ptr;
5458c2ecf20Sopenharmony_ci
5468c2ecf20Sopenharmony_ci	via_write(dev_priv, VIA_REG_TRANSET, (HC_ParaType_PreCR << 16));
5478c2ecf20Sopenharmony_ci	via_write(dev_priv, VIA_REG_TRANSPACE, command);
5488c2ecf20Sopenharmony_ci	via_write(dev_priv, VIA_REG_TRANSPACE, start_addr_lo);
5498c2ecf20Sopenharmony_ci	via_write(dev_priv, VIA_REG_TRANSPACE, end_addr_lo);
5508c2ecf20Sopenharmony_ci
5518c2ecf20Sopenharmony_ci	via_write(dev_priv, VIA_REG_TRANSPACE, pause_addr_hi);
5528c2ecf20Sopenharmony_ci	via_write(dev_priv, VIA_REG_TRANSPACE, pause_addr_lo);
5538c2ecf20Sopenharmony_ci	wmb();
5548c2ecf20Sopenharmony_ci	via_write(dev_priv, VIA_REG_TRANSPACE, command | HC_HAGPCMNT_MASK);
5558c2ecf20Sopenharmony_ci	via_read(dev_priv, VIA_REG_TRANSPACE);
5568c2ecf20Sopenharmony_ci
5578c2ecf20Sopenharmony_ci	dev_priv->dma_diff = 0;
5588c2ecf20Sopenharmony_ci
5598c2ecf20Sopenharmony_ci	count = 10000000;
5608c2ecf20Sopenharmony_ci	while (!(via_read(dev_priv, 0x41c) & 0x80000000) && count--);
5618c2ecf20Sopenharmony_ci
5628c2ecf20Sopenharmony_ci	reader = *(dev_priv->hw_addr_ptr);
5638c2ecf20Sopenharmony_ci	ptr = ((volatile char *)dev_priv->last_pause_ptr - dev_priv->dma_ptr) +
5648c2ecf20Sopenharmony_ci	    dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr + 4;
5658c2ecf20Sopenharmony_ci
5668c2ecf20Sopenharmony_ci	/*
5678c2ecf20Sopenharmony_ci	 * This is the difference between where we tell the
5688c2ecf20Sopenharmony_ci	 * command reader to pause and where it actually pauses.
5698c2ecf20Sopenharmony_ci	 * This differs between hw implementation so we need to
5708c2ecf20Sopenharmony_ci	 * detect it.
5718c2ecf20Sopenharmony_ci	 */
5728c2ecf20Sopenharmony_ci
5738c2ecf20Sopenharmony_ci	dev_priv->dma_diff = ptr - reader;
5748c2ecf20Sopenharmony_ci}
5758c2ecf20Sopenharmony_ci
5768c2ecf20Sopenharmony_cistatic void via_pad_cache(drm_via_private_t *dev_priv, int qwords)
5778c2ecf20Sopenharmony_ci{
5788c2ecf20Sopenharmony_ci	uint32_t *vb;
5798c2ecf20Sopenharmony_ci
5808c2ecf20Sopenharmony_ci	via_cmdbuf_wait(dev_priv, qwords + 2);
5818c2ecf20Sopenharmony_ci	vb = via_get_dma(dev_priv);
5828c2ecf20Sopenharmony_ci	VIA_OUT_RING_QW(HC_HEADER2, HC_ParaType_NotTex << 16);
5838c2ecf20Sopenharmony_ci	via_align_buffer(dev_priv, vb, qwords);
5848c2ecf20Sopenharmony_ci}
5858c2ecf20Sopenharmony_ci
5868c2ecf20Sopenharmony_cistatic inline void via_dummy_bitblt(drm_via_private_t *dev_priv)
5878c2ecf20Sopenharmony_ci{
5888c2ecf20Sopenharmony_ci	uint32_t *vb = via_get_dma(dev_priv);
5898c2ecf20Sopenharmony_ci	SetReg2DAGP(0x0C, (0 | (0 << 16)));
5908c2ecf20Sopenharmony_ci	SetReg2DAGP(0x10, 0 | (0 << 16));
5918c2ecf20Sopenharmony_ci	SetReg2DAGP(0x0, 0x1 | 0x2000 | 0xAA000000);
5928c2ecf20Sopenharmony_ci}
5938c2ecf20Sopenharmony_ci
5948c2ecf20Sopenharmony_cistatic void via_cmdbuf_jump(drm_via_private_t *dev_priv)
5958c2ecf20Sopenharmony_ci{
5968c2ecf20Sopenharmony_ci	uint32_t agp_base;
5978c2ecf20Sopenharmony_ci	uint32_t pause_addr_lo, pause_addr_hi;
5988c2ecf20Sopenharmony_ci	uint32_t jump_addr_lo, jump_addr_hi;
5998c2ecf20Sopenharmony_ci	volatile uint32_t *last_pause_ptr;
6008c2ecf20Sopenharmony_ci	uint32_t dma_low_save1, dma_low_save2;
6018c2ecf20Sopenharmony_ci
6028c2ecf20Sopenharmony_ci	agp_base = dev_priv->dma_offset + (uint32_t) dev_priv->agpAddr;
6038c2ecf20Sopenharmony_ci	via_align_cmd(dev_priv, HC_HAGPBpID_JUMP, 0, &jump_addr_hi,
6048c2ecf20Sopenharmony_ci		      &jump_addr_lo, 0);
6058c2ecf20Sopenharmony_ci
6068c2ecf20Sopenharmony_ci	dev_priv->dma_wrap = dev_priv->dma_low;
6078c2ecf20Sopenharmony_ci
6088c2ecf20Sopenharmony_ci	/*
6098c2ecf20Sopenharmony_ci	 * Wrap command buffer to the beginning.
6108c2ecf20Sopenharmony_ci	 */
6118c2ecf20Sopenharmony_ci
6128c2ecf20Sopenharmony_ci	dev_priv->dma_low = 0;
6138c2ecf20Sopenharmony_ci	if (via_cmdbuf_wait(dev_priv, CMDBUF_ALIGNMENT_SIZE) != 0)
6148c2ecf20Sopenharmony_ci		DRM_ERROR("via_cmdbuf_jump failed\n");
6158c2ecf20Sopenharmony_ci
6168c2ecf20Sopenharmony_ci	via_dummy_bitblt(dev_priv);
6178c2ecf20Sopenharmony_ci	via_dummy_bitblt(dev_priv);
6188c2ecf20Sopenharmony_ci
6198c2ecf20Sopenharmony_ci	last_pause_ptr =
6208c2ecf20Sopenharmony_ci	    via_align_cmd(dev_priv, HC_HAGPBpID_PAUSE, 0, &pause_addr_hi,
6218c2ecf20Sopenharmony_ci			  &pause_addr_lo, 0) - 1;
6228c2ecf20Sopenharmony_ci	via_align_cmd(dev_priv, HC_HAGPBpID_PAUSE, 0, &pause_addr_hi,
6238c2ecf20Sopenharmony_ci		      &pause_addr_lo, 0);
6248c2ecf20Sopenharmony_ci
6258c2ecf20Sopenharmony_ci	*last_pause_ptr = pause_addr_lo;
6268c2ecf20Sopenharmony_ci	dma_low_save1 = dev_priv->dma_low;
6278c2ecf20Sopenharmony_ci
6288c2ecf20Sopenharmony_ci	/*
6298c2ecf20Sopenharmony_ci	 * Now, set a trap that will pause the regulator if it tries to rerun the old
6308c2ecf20Sopenharmony_ci	 * command buffer. (Which may happen if via_hook_segment detecs a command regulator pause
6318c2ecf20Sopenharmony_ci	 * and reissues the jump command over PCI, while the regulator has already taken the jump
6328c2ecf20Sopenharmony_ci	 * and actually paused at the current buffer end).
6338c2ecf20Sopenharmony_ci	 * There appears to be no other way to detect this condition, since the hw_addr_pointer
6348c2ecf20Sopenharmony_ci	 * does not seem to get updated immediately when a jump occurs.
6358c2ecf20Sopenharmony_ci	 */
6368c2ecf20Sopenharmony_ci
6378c2ecf20Sopenharmony_ci	last_pause_ptr =
6388c2ecf20Sopenharmony_ci		via_align_cmd(dev_priv, HC_HAGPBpID_PAUSE, 0, &pause_addr_hi,
6398c2ecf20Sopenharmony_ci			      &pause_addr_lo, 0) - 1;
6408c2ecf20Sopenharmony_ci	via_align_cmd(dev_priv, HC_HAGPBpID_PAUSE, 0, &pause_addr_hi,
6418c2ecf20Sopenharmony_ci		      &pause_addr_lo, 0);
6428c2ecf20Sopenharmony_ci	*last_pause_ptr = pause_addr_lo;
6438c2ecf20Sopenharmony_ci
6448c2ecf20Sopenharmony_ci	dma_low_save2 = dev_priv->dma_low;
6458c2ecf20Sopenharmony_ci	dev_priv->dma_low = dma_low_save1;
6468c2ecf20Sopenharmony_ci	via_hook_segment(dev_priv, jump_addr_hi, jump_addr_lo, 0);
6478c2ecf20Sopenharmony_ci	dev_priv->dma_low = dma_low_save2;
6488c2ecf20Sopenharmony_ci	via_hook_segment(dev_priv, pause_addr_hi, pause_addr_lo, 0);
6498c2ecf20Sopenharmony_ci}
6508c2ecf20Sopenharmony_ci
6518c2ecf20Sopenharmony_ci
6528c2ecf20Sopenharmony_cistatic void via_cmdbuf_rewind(drm_via_private_t *dev_priv)
6538c2ecf20Sopenharmony_ci{
6548c2ecf20Sopenharmony_ci	via_cmdbuf_jump(dev_priv);
6558c2ecf20Sopenharmony_ci}
6568c2ecf20Sopenharmony_ci
6578c2ecf20Sopenharmony_cistatic void via_cmdbuf_flush(drm_via_private_t *dev_priv, uint32_t cmd_type)
6588c2ecf20Sopenharmony_ci{
6598c2ecf20Sopenharmony_ci	uint32_t pause_addr_lo, pause_addr_hi;
6608c2ecf20Sopenharmony_ci
6618c2ecf20Sopenharmony_ci	via_align_cmd(dev_priv, cmd_type, 0, &pause_addr_hi, &pause_addr_lo, 0);
6628c2ecf20Sopenharmony_ci	via_hook_segment(dev_priv, pause_addr_hi, pause_addr_lo, 0);
6638c2ecf20Sopenharmony_ci}
6648c2ecf20Sopenharmony_ci
6658c2ecf20Sopenharmony_cistatic void via_cmdbuf_pause(drm_via_private_t *dev_priv)
6668c2ecf20Sopenharmony_ci{
6678c2ecf20Sopenharmony_ci	via_cmdbuf_flush(dev_priv, HC_HAGPBpID_PAUSE);
6688c2ecf20Sopenharmony_ci}
6698c2ecf20Sopenharmony_ci
6708c2ecf20Sopenharmony_cistatic void via_cmdbuf_reset(drm_via_private_t *dev_priv)
6718c2ecf20Sopenharmony_ci{
6728c2ecf20Sopenharmony_ci	via_cmdbuf_flush(dev_priv, HC_HAGPBpID_STOP);
6738c2ecf20Sopenharmony_ci	via_wait_idle(dev_priv);
6748c2ecf20Sopenharmony_ci}
6758c2ecf20Sopenharmony_ci
6768c2ecf20Sopenharmony_ci/*
6778c2ecf20Sopenharmony_ci * User interface to the space and lag functions.
6788c2ecf20Sopenharmony_ci */
6798c2ecf20Sopenharmony_ci
6808c2ecf20Sopenharmony_cistatic int via_cmdbuf_size(struct drm_device *dev, void *data, struct drm_file *file_priv)
6818c2ecf20Sopenharmony_ci{
6828c2ecf20Sopenharmony_ci	drm_via_cmdbuf_size_t *d_siz = data;
6838c2ecf20Sopenharmony_ci	int ret = 0;
6848c2ecf20Sopenharmony_ci	uint32_t tmp_size, count;
6858c2ecf20Sopenharmony_ci	drm_via_private_t *dev_priv;
6868c2ecf20Sopenharmony_ci
6878c2ecf20Sopenharmony_ci	DRM_DEBUG("\n");
6888c2ecf20Sopenharmony_ci	LOCK_TEST_WITH_RETURN(dev, file_priv);
6898c2ecf20Sopenharmony_ci
6908c2ecf20Sopenharmony_ci	dev_priv = (drm_via_private_t *) dev->dev_private;
6918c2ecf20Sopenharmony_ci
6928c2ecf20Sopenharmony_ci	if (dev_priv->ring.virtual_start == NULL) {
6938c2ecf20Sopenharmony_ci		DRM_ERROR("called without initializing AGP ring buffer.\n");
6948c2ecf20Sopenharmony_ci		return -EFAULT;
6958c2ecf20Sopenharmony_ci	}
6968c2ecf20Sopenharmony_ci
6978c2ecf20Sopenharmony_ci	count = 1000000;
6988c2ecf20Sopenharmony_ci	tmp_size = d_siz->size;
6998c2ecf20Sopenharmony_ci	switch (d_siz->func) {
7008c2ecf20Sopenharmony_ci	case VIA_CMDBUF_SPACE:
7018c2ecf20Sopenharmony_ci		while (((tmp_size = via_cmdbuf_space(dev_priv)) < d_siz->size)
7028c2ecf20Sopenharmony_ci		       && --count) {
7038c2ecf20Sopenharmony_ci			if (!d_siz->wait)
7048c2ecf20Sopenharmony_ci				break;
7058c2ecf20Sopenharmony_ci		}
7068c2ecf20Sopenharmony_ci		if (!count) {
7078c2ecf20Sopenharmony_ci			DRM_ERROR("VIA_CMDBUF_SPACE timed out.\n");
7088c2ecf20Sopenharmony_ci			ret = -EAGAIN;
7098c2ecf20Sopenharmony_ci		}
7108c2ecf20Sopenharmony_ci		break;
7118c2ecf20Sopenharmony_ci	case VIA_CMDBUF_LAG:
7128c2ecf20Sopenharmony_ci		while (((tmp_size = via_cmdbuf_lag(dev_priv)) > d_siz->size)
7138c2ecf20Sopenharmony_ci		       && --count) {
7148c2ecf20Sopenharmony_ci			if (!d_siz->wait)
7158c2ecf20Sopenharmony_ci				break;
7168c2ecf20Sopenharmony_ci		}
7178c2ecf20Sopenharmony_ci		if (!count) {
7188c2ecf20Sopenharmony_ci			DRM_ERROR("VIA_CMDBUF_LAG timed out.\n");
7198c2ecf20Sopenharmony_ci			ret = -EAGAIN;
7208c2ecf20Sopenharmony_ci		}
7218c2ecf20Sopenharmony_ci		break;
7228c2ecf20Sopenharmony_ci	default:
7238c2ecf20Sopenharmony_ci		ret = -EFAULT;
7248c2ecf20Sopenharmony_ci	}
7258c2ecf20Sopenharmony_ci	d_siz->size = tmp_size;
7268c2ecf20Sopenharmony_ci
7278c2ecf20Sopenharmony_ci	return ret;
7288c2ecf20Sopenharmony_ci}
7298c2ecf20Sopenharmony_ci
7308c2ecf20Sopenharmony_ciconst struct drm_ioctl_desc via_ioctls[] = {
7318c2ecf20Sopenharmony_ci	DRM_IOCTL_DEF_DRV(VIA_ALLOCMEM, via_mem_alloc, DRM_AUTH),
7328c2ecf20Sopenharmony_ci	DRM_IOCTL_DEF_DRV(VIA_FREEMEM, via_mem_free, DRM_AUTH),
7338c2ecf20Sopenharmony_ci	DRM_IOCTL_DEF_DRV(VIA_AGP_INIT, via_agp_init, DRM_AUTH|DRM_MASTER),
7348c2ecf20Sopenharmony_ci	DRM_IOCTL_DEF_DRV(VIA_FB_INIT, via_fb_init, DRM_AUTH|DRM_MASTER),
7358c2ecf20Sopenharmony_ci	DRM_IOCTL_DEF_DRV(VIA_MAP_INIT, via_map_init, DRM_AUTH|DRM_MASTER),
7368c2ecf20Sopenharmony_ci	DRM_IOCTL_DEF_DRV(VIA_DEC_FUTEX, via_decoder_futex, DRM_AUTH),
7378c2ecf20Sopenharmony_ci	DRM_IOCTL_DEF_DRV(VIA_DMA_INIT, via_dma_init, DRM_AUTH),
7388c2ecf20Sopenharmony_ci	DRM_IOCTL_DEF_DRV(VIA_CMDBUFFER, via_cmdbuffer, DRM_AUTH),
7398c2ecf20Sopenharmony_ci	DRM_IOCTL_DEF_DRV(VIA_FLUSH, via_flush_ioctl, DRM_AUTH),
7408c2ecf20Sopenharmony_ci	DRM_IOCTL_DEF_DRV(VIA_PCICMD, via_pci_cmdbuffer, DRM_AUTH),
7418c2ecf20Sopenharmony_ci	DRM_IOCTL_DEF_DRV(VIA_CMDBUF_SIZE, via_cmdbuf_size, DRM_AUTH),
7428c2ecf20Sopenharmony_ci	DRM_IOCTL_DEF_DRV(VIA_WAIT_IRQ, via_wait_irq, DRM_AUTH),
7438c2ecf20Sopenharmony_ci	DRM_IOCTL_DEF_DRV(VIA_DMA_BLIT, via_dma_blit, DRM_AUTH),
7448c2ecf20Sopenharmony_ci	DRM_IOCTL_DEF_DRV(VIA_BLIT_SYNC, via_dma_blit_sync, DRM_AUTH)
7458c2ecf20Sopenharmony_ci};
7468c2ecf20Sopenharmony_ci
7478c2ecf20Sopenharmony_ciint via_max_ioctl = ARRAY_SIZE(via_ioctls);
748