radeon_cp.c 55.0 KB
Newer Older
1 2
/* radeon_cp.c -- CP support for Radeon -*- linux-c -*- */
/*
L
Linus Torvalds 已提交
3 4
 * Copyright 2000 Precision Insight, Inc., Cedar Park, Texas.
 * Copyright 2000 VA Linux Systems, Inc., Fremont, California.
5
 * Copyright 2007 Advanced Micro Devices, Inc.
L
Linus Torvalds 已提交
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33
 * All Rights Reserved.
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice (including the next
 * paragraph) shall be included in all copies or substantial portions of the
 * Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 * PRECISION INSIGHT 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.
 *
 * Authors:
 *    Kevin E. Martin <martin@valinux.com>
 *    Gareth Hughes <gareth@valinux.com>
 */

#include "drmP.h"
#include "drm.h"
34
#include "drm_sarea.h"
L
Linus Torvalds 已提交
35 36
#include "radeon_drm.h"
#include "radeon_drv.h"
D
Dave Airlie 已提交
37
#include "r300_reg.h"
L
Linus Torvalds 已提交
38

39 40
#include "radeon_microcode.h"

L
Linus Torvalds 已提交
41 42
#define RADEON_FIFO_DEBUG	0

43
static int radeon_do_cleanup_cp(struct drm_device * dev);
44
static void radeon_do_cp_start(drm_radeon_private_t * dev_priv);
L
Linus Torvalds 已提交
45

46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91
static u32 radeon_read_ring_rptr(drm_radeon_private_t *dev_priv, u32 off)
{
	u32 val;

	if (dev_priv->flags & RADEON_IS_AGP) {
		val = DRM_READ32(dev_priv->ring_rptr, off);
	} else {
		val = *(((volatile u32 *)
			 dev_priv->ring_rptr->handle) +
			(off / sizeof(u32)));
		val = le32_to_cpu(val);
	}
	return val;
}

u32 radeon_get_ring_head(drm_radeon_private_t *dev_priv)
{
	if (dev_priv->writeback_works)
		return radeon_read_ring_rptr(dev_priv, 0);
	else
		return RADEON_READ(RADEON_CP_RB_RPTR);
}

static void radeon_write_ring_rptr(drm_radeon_private_t *dev_priv, u32 off, u32 val)
{
	if (dev_priv->flags & RADEON_IS_AGP)
		DRM_WRITE32(dev_priv->ring_rptr, off, val);
	else
		*(((volatile u32 *) dev_priv->ring_rptr->handle) +
		  (off / sizeof(u32))) = cpu_to_le32(val);
}

void radeon_set_ring_head(drm_radeon_private_t *dev_priv, u32 val)
{
	radeon_write_ring_rptr(dev_priv, 0, val);
}

u32 radeon_get_scratch(drm_radeon_private_t *dev_priv, int index)
{
	if (dev_priv->writeback_works)
		return radeon_read_ring_rptr(dev_priv,
					     RADEON_SCRATCHOFF(index));
	else
		return RADEON_READ(RADEON_SCRATCH_REG0 + 4*index);
}

92
static u32 R500_READ_MCIND(drm_radeon_private_t *dev_priv, int addr)
D
Dave Airlie 已提交
93 94 95 96 97 98 99 100
{
	u32 ret;
	RADEON_WRITE(R520_MC_IND_INDEX, 0x7f0000 | (addr & 0xff));
	ret = RADEON_READ(R520_MC_IND_DATA);
	RADEON_WRITE(R520_MC_IND_INDEX, 0);
	return ret;
}

101 102 103 104 105 106 107 108 109
static u32 RS480_READ_MCIND(drm_radeon_private_t *dev_priv, int addr)
{
	u32 ret;
	RADEON_WRITE(RS480_NB_MC_INDEX, addr & 0xff);
	ret = RADEON_READ(RS480_NB_MC_DATA);
	RADEON_WRITE(RS480_NB_MC_INDEX, 0xff);
	return ret;
}

110 111
static u32 RS690_READ_MCIND(drm_radeon_private_t *dev_priv, int addr)
{
112
	u32 ret;
113
	RADEON_WRITE(RS690_MC_INDEX, (addr & RS690_MC_INDEX_MASK));
114 115 116 117 118 119 120
	ret = RADEON_READ(RS690_MC_DATA);
	RADEON_WRITE(RS690_MC_INDEX, RS690_MC_INDEX_MASK);
	return ret;
}

static u32 IGP_READ_MCIND(drm_radeon_private_t *dev_priv, int addr)
{
121 122
	if (((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS690) ||
	    ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS740))
123 124 125
		return RS690_READ_MCIND(dev_priv, addr);
	else
		return RS480_READ_MCIND(dev_priv, addr);
126 127
}

D
Dave Airlie 已提交
128 129 130 131
u32 radeon_read_fb_location(drm_radeon_private_t *dev_priv)
{

	if ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RV515)
132
		return R500_READ_MCIND(dev_priv, RV515_MC_FB_LOCATION);
133 134
	else if (((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS690) ||
		 ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS740))
135
		return RS690_READ_MCIND(dev_priv, RS690_MC_FB_LOCATION);
D
Dave Airlie 已提交
136
	else if ((dev_priv->flags & RADEON_FAMILY_MASK) > CHIP_RV515)
137
		return R500_READ_MCIND(dev_priv, R520_MC_FB_LOCATION);
D
Dave Airlie 已提交
138 139 140 141 142 143 144
	else
		return RADEON_READ(RADEON_MC_FB_LOCATION);
}

static void radeon_write_fb_location(drm_radeon_private_t *dev_priv, u32 fb_loc)
{
	if ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RV515)
145
		R500_WRITE_MCIND(RV515_MC_FB_LOCATION, fb_loc);
146 147
	else if (((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS690) ||
		 ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS740))
148
		RS690_WRITE_MCIND(RS690_MC_FB_LOCATION, fb_loc);
D
Dave Airlie 已提交
149
	else if ((dev_priv->flags & RADEON_FAMILY_MASK) > CHIP_RV515)
150
		R500_WRITE_MCIND(R520_MC_FB_LOCATION, fb_loc);
D
Dave Airlie 已提交
151 152 153 154 155 156 157
	else
		RADEON_WRITE(RADEON_MC_FB_LOCATION, fb_loc);
}

static void radeon_write_agp_location(drm_radeon_private_t *dev_priv, u32 agp_loc)
{
	if ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RV515)
158
		R500_WRITE_MCIND(RV515_MC_AGP_LOCATION, agp_loc);
159 160
	else if (((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS690) ||
		 ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS740))
161
		RS690_WRITE_MCIND(RS690_MC_AGP_LOCATION, agp_loc);
D
Dave Airlie 已提交
162
	else if ((dev_priv->flags & RADEON_FAMILY_MASK) > CHIP_RV515)
163
		R500_WRITE_MCIND(R520_MC_AGP_LOCATION, agp_loc);
D
Dave Airlie 已提交
164 165 166 167
	else
		RADEON_WRITE(RADEON_MC_AGP_LOCATION, agp_loc);
}

168 169 170 171 172 173 174 175
static void radeon_write_agp_base(drm_radeon_private_t *dev_priv, u64 agp_base)
{
	u32 agp_base_hi = upper_32_bits(agp_base);
	u32 agp_base_lo = agp_base & 0xffffffff;

	if ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RV515) {
		R500_WRITE_MCIND(RV515_MC_AGP_BASE, agp_base_lo);
		R500_WRITE_MCIND(RV515_MC_AGP_BASE_2, agp_base_hi);
176 177
	} else if (((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS690) ||
		 ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS740)) {
178 179 180 181 182
		RS690_WRITE_MCIND(RS690_MC_AGP_BASE, agp_base_lo);
		RS690_WRITE_MCIND(RS690_MC_AGP_BASE_2, agp_base_hi);
	} else if ((dev_priv->flags & RADEON_FAMILY_MASK) > CHIP_RV515) {
		R500_WRITE_MCIND(R520_MC_AGP_BASE, agp_base_lo);
		R500_WRITE_MCIND(R520_MC_AGP_BASE_2, agp_base_hi);
A
Alex Deucher 已提交
183 184
	} else if (((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS400) ||
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS480)) {
185
		RADEON_WRITE(RADEON_AGP_BASE, agp_base_lo);
A
Alex Deucher 已提交
186
		RADEON_WRITE(RS480_AGP_BASE_2, agp_base_hi);
187 188 189 190 191 192 193
	} else {
		RADEON_WRITE(RADEON_AGP_BASE, agp_base_lo);
		if ((dev_priv->flags & RADEON_FAMILY_MASK) >= CHIP_R200)
			RADEON_WRITE(RADEON_AGP_BASE_2, agp_base_hi);
	}
}

194
static int RADEON_READ_PLL(struct drm_device * dev, int addr)
L
Linus Torvalds 已提交
195 196 197 198 199 200 201
{
	drm_radeon_private_t *dev_priv = dev->dev_private;

	RADEON_WRITE8(RADEON_CLOCK_CNTL_INDEX, addr & 0x1f);
	return RADEON_READ(RADEON_CLOCK_CNTL_DATA);
}

D
Dave Airlie 已提交
202
static u32 RADEON_READ_PCIE(drm_radeon_private_t *dev_priv, int addr)
203 204 205 206 207
{
	RADEON_WRITE8(RADEON_PCIE_INDEX, addr & 0xff);
	return RADEON_READ(RADEON_PCIE_DATA);
}

L
Linus Torvalds 已提交
208
#if RADEON_FIFO_DEBUG
D
Dave Airlie 已提交
209
static void radeon_status(drm_radeon_private_t * dev_priv)
L
Linus Torvalds 已提交
210
{
211
	printk("%s:\n", __func__);
D
Dave Airlie 已提交
212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227
	printk("RBBM_STATUS = 0x%08x\n",
	       (unsigned int)RADEON_READ(RADEON_RBBM_STATUS));
	printk("CP_RB_RTPR = 0x%08x\n",
	       (unsigned int)RADEON_READ(RADEON_CP_RB_RPTR));
	printk("CP_RB_WTPR = 0x%08x\n",
	       (unsigned int)RADEON_READ(RADEON_CP_RB_WPTR));
	printk("AIC_CNTL = 0x%08x\n",
	       (unsigned int)RADEON_READ(RADEON_AIC_CNTL));
	printk("AIC_STAT = 0x%08x\n",
	       (unsigned int)RADEON_READ(RADEON_AIC_STAT));
	printk("AIC_PT_BASE = 0x%08x\n",
	       (unsigned int)RADEON_READ(RADEON_AIC_PT_BASE));
	printk("TLB_ADDR = 0x%08x\n",
	       (unsigned int)RADEON_READ(RADEON_AIC_TLB_ADDR));
	printk("TLB_DATA = 0x%08x\n",
	       (unsigned int)RADEON_READ(RADEON_AIC_TLB_DATA));
L
Linus Torvalds 已提交
228 229 230 231 232 233 234
}
#endif

/* ================================================================
 * Engine, FIFO control
 */

D
Dave Airlie 已提交
235
static int radeon_do_pixcache_flush(drm_radeon_private_t * dev_priv)
L
Linus Torvalds 已提交
236 237 238 239 240 241
{
	u32 tmp;
	int i;

	dev_priv->stats.boxes |= RADEON_BOX_WAIT_IDLE;

242 243 244 245 246 247 248 249 250 251 252 253 254
	if ((dev_priv->flags & RADEON_FAMILY_MASK) <= CHIP_RV280) {
		tmp = RADEON_READ(RADEON_RB3D_DSTCACHE_CTLSTAT);
		tmp |= RADEON_RB3D_DC_FLUSH_ALL;
		RADEON_WRITE(RADEON_RB3D_DSTCACHE_CTLSTAT, tmp);

		for (i = 0; i < dev_priv->usec_timeout; i++) {
			if (!(RADEON_READ(RADEON_RB3D_DSTCACHE_CTLSTAT)
			      & RADEON_RB3D_DC_BUSY)) {
				return 0;
			}
			DRM_UDELAY(1);
		}
	} else {
255 256
		/* don't flush or purge cache here or lockup */
		return 0;
L
Linus Torvalds 已提交
257 258 259
	}

#if RADEON_FIFO_DEBUG
D
Dave Airlie 已提交
260 261
	DRM_ERROR("failed!\n");
	radeon_status(dev_priv);
L
Linus Torvalds 已提交
262
#endif
E
Eric Anholt 已提交
263
	return -EBUSY;
L
Linus Torvalds 已提交
264 265
}

D
Dave Airlie 已提交
266
static int radeon_do_wait_for_fifo(drm_radeon_private_t * dev_priv, int entries)
L
Linus Torvalds 已提交
267 268 269 270 271
{
	int i;

	dev_priv->stats.boxes |= RADEON_BOX_WAIT_IDLE;

D
Dave Airlie 已提交
272 273 274 275 276 277
	for (i = 0; i < dev_priv->usec_timeout; i++) {
		int slots = (RADEON_READ(RADEON_RBBM_STATUS)
			     & RADEON_RBBM_FIFOCNT_MASK);
		if (slots >= entries)
			return 0;
		DRM_UDELAY(1);
L
Linus Torvalds 已提交
278
	}
279
	DRM_DEBUG("wait for fifo failed status : 0x%08X 0x%08X\n",
280 281
		 RADEON_READ(RADEON_RBBM_STATUS),
		 RADEON_READ(R300_VAP_CNTL_STATUS));
L
Linus Torvalds 已提交
282 283

#if RADEON_FIFO_DEBUG
D
Dave Airlie 已提交
284 285
	DRM_ERROR("failed!\n");
	radeon_status(dev_priv);
L
Linus Torvalds 已提交
286
#endif
E
Eric Anholt 已提交
287
	return -EBUSY;
L
Linus Torvalds 已提交
288 289
}

D
Dave Airlie 已提交
290
static int radeon_do_wait_for_idle(drm_radeon_private_t * dev_priv)
L
Linus Torvalds 已提交
291 292 293 294 295
{
	int i, ret;

	dev_priv->stats.boxes |= RADEON_BOX_WAIT_IDLE;

D
Dave Airlie 已提交
296 297 298
	ret = radeon_do_wait_for_fifo(dev_priv, 64);
	if (ret)
		return ret;
L
Linus Torvalds 已提交
299

D
Dave Airlie 已提交
300 301 302 303
	for (i = 0; i < dev_priv->usec_timeout; i++) {
		if (!(RADEON_READ(RADEON_RBBM_STATUS)
		      & RADEON_RBBM_ACTIVE)) {
			radeon_do_pixcache_flush(dev_priv);
L
Linus Torvalds 已提交
304 305
			return 0;
		}
D
Dave Airlie 已提交
306
		DRM_UDELAY(1);
L
Linus Torvalds 已提交
307
	}
308
	DRM_DEBUG("wait idle failed status : 0x%08X 0x%08X\n",
309 310
		 RADEON_READ(RADEON_RBBM_STATUS),
		 RADEON_READ(R300_VAP_CNTL_STATUS));
L
Linus Torvalds 已提交
311 312

#if RADEON_FIFO_DEBUG
D
Dave Airlie 已提交
313 314
	DRM_ERROR("failed!\n");
	radeon_status(dev_priv);
L
Linus Torvalds 已提交
315
#endif
E
Eric Anholt 已提交
316
	return -EBUSY;
L
Linus Torvalds 已提交
317 318
}

319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362
static void radeon_init_pipes(drm_radeon_private_t *dev_priv)
{
	uint32_t gb_tile_config, gb_pipe_sel = 0;

	/* RS4xx/RS6xx/R4xx/R5xx */
	if ((dev_priv->flags & RADEON_FAMILY_MASK) >= CHIP_R420) {
		gb_pipe_sel = RADEON_READ(R400_GB_PIPE_SELECT);
		dev_priv->num_gb_pipes = ((gb_pipe_sel >> 12) & 0x3) + 1;
	} else {
		/* R3xx */
		if (((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_R300) ||
		    ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_R350)) {
			dev_priv->num_gb_pipes = 2;
		} else {
			/* R3Vxx */
			dev_priv->num_gb_pipes = 1;
		}
	}
	DRM_INFO("Num pipes: %d\n", dev_priv->num_gb_pipes);

	gb_tile_config = (R300_ENABLE_TILING | R300_TILE_SIZE_16 /*| R300_SUBPIXEL_1_16*/);

	switch (dev_priv->num_gb_pipes) {
	case 2: gb_tile_config |= R300_PIPE_COUNT_R300; break;
	case 3: gb_tile_config |= R300_PIPE_COUNT_R420_3P; break;
	case 4: gb_tile_config |= R300_PIPE_COUNT_R420; break;
	default:
	case 1: gb_tile_config |= R300_PIPE_COUNT_RV350; break;
	}

	if ((dev_priv->flags & RADEON_FAMILY_MASK) >= CHIP_RV515) {
		RADEON_WRITE_PLL(R500_DYN_SCLK_PWMEM_PIPE, (1 | ((gb_pipe_sel >> 8) & 0xf) << 4));
		RADEON_WRITE(R500_SU_REG_DEST, ((1 << dev_priv->num_gb_pipes) - 1));
	}
	RADEON_WRITE(R300_GB_TILE_CONFIG, gb_tile_config);
	radeon_do_wait_for_idle(dev_priv);
	RADEON_WRITE(R300_DST_PIPE_CONFIG, RADEON_READ(R300_DST_PIPE_CONFIG) | R300_PIPE_AUTO_CONFIG);
	RADEON_WRITE(R300_RB2D_DSTCACHE_MODE, (RADEON_READ(R300_RB2D_DSTCACHE_MODE) |
					       R300_DC_AUTOFLUSH_ENABLE |
					       R300_DC_DC_DISABLE_IGNORE_PE));


}

L
Linus Torvalds 已提交
363 364 365 366 367
/* ================================================================
 * CP control, initialization
 */

/* Load the microcode for the CP */
D
Dave Airlie 已提交
368
static void radeon_cp_load_microcode(drm_radeon_private_t * dev_priv)
L
Linus Torvalds 已提交
369 370
{
	int i;
D
Dave Airlie 已提交
371
	DRM_DEBUG("\n");
L
Linus Torvalds 已提交
372

D
Dave Airlie 已提交
373
	radeon_do_wait_for_idle(dev_priv);
L
Linus Torvalds 已提交
374

D
Dave Airlie 已提交
375
	RADEON_WRITE(RADEON_CP_ME_RAM_ADDR, 0);
376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391
	if (((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_R100) ||
	    ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RV100) ||
	    ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RV200) ||
	    ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS100) ||
	    ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS200)) {
		DRM_INFO("Loading R100 Microcode\n");
		for (i = 0; i < 256; i++) {
			RADEON_WRITE(RADEON_CP_ME_RAM_DATAH,
				     R100_cp_microcode[i][1]);
			RADEON_WRITE(RADEON_CP_ME_RAM_DATAL,
				     R100_cp_microcode[i][0]);
		}
	} else if (((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_R200) ||
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RV250) ||
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RV280) ||
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS300)) {
L
Linus Torvalds 已提交
392
		DRM_INFO("Loading R200 Microcode\n");
D
Dave Airlie 已提交
393 394 395 396 397
		for (i = 0; i < 256; i++) {
			RADEON_WRITE(RADEON_CP_ME_RAM_DATAH,
				     R200_cp_microcode[i][1]);
			RADEON_WRITE(RADEON_CP_ME_RAM_DATAL,
				     R200_cp_microcode[i][0]);
L
Linus Torvalds 已提交
398
		}
399 400 401 402
	} else if (((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_R300) ||
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_R350) ||
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RV350) ||
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RV380) ||
A
Alex Deucher 已提交
403
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS400) ||
404
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS480)) {
L
Linus Torvalds 已提交
405
		DRM_INFO("Loading R300 Microcode\n");
D
Dave Airlie 已提交
406 407 408 409 410
		for (i = 0; i < 256; i++) {
			RADEON_WRITE(RADEON_CP_ME_RAM_DATAH,
				     R300_cp_microcode[i][1]);
			RADEON_WRITE(RADEON_CP_ME_RAM_DATAL,
				     R300_cp_microcode[i][0]);
L
Linus Torvalds 已提交
411
		}
412
	} else if (((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_R420) ||
413
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_R423) ||
414 415 416 417 418 419 420 421
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RV410)) {
		DRM_INFO("Loading R400 Microcode\n");
		for (i = 0; i < 256; i++) {
			RADEON_WRITE(RADEON_CP_ME_RAM_DATAH,
				     R420_cp_microcode[i][1]);
			RADEON_WRITE(RADEON_CP_ME_RAM_DATAL,
				     R420_cp_microcode[i][0]);
		}
422 423 424
	} else if (((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS690) ||
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS740)) {
		DRM_INFO("Loading RS690/RS740 Microcode\n");
425 426 427 428 429 430 431 432 433 434 435 436 437
		for (i = 0; i < 256; i++) {
			RADEON_WRITE(RADEON_CP_ME_RAM_DATAH,
				     RS690_cp_microcode[i][1]);
			RADEON_WRITE(RADEON_CP_ME_RAM_DATAL,
				     RS690_cp_microcode[i][0]);
		}
	} else if (((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RV515) ||
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_R520) ||
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RV530) ||
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_R580) ||
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RV560) ||
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RV570)) {
		DRM_INFO("Loading R500 Microcode\n");
D
Dave Airlie 已提交
438 439
		for (i = 0; i < 256; i++) {
			RADEON_WRITE(RADEON_CP_ME_RAM_DATAH,
440
				     R520_cp_microcode[i][1]);
D
Dave Airlie 已提交
441
			RADEON_WRITE(RADEON_CP_ME_RAM_DATAL,
442
				     R520_cp_microcode[i][0]);
L
Linus Torvalds 已提交
443 444 445 446 447 448 449 450
		}
	}
}

/* Flush any pending commands to the CP.  This should only be used just
 * prior to a wait for idle, as it informs the engine that the command
 * stream is ending.
 */
D
Dave Airlie 已提交
451
static void radeon_do_cp_flush(drm_radeon_private_t * dev_priv)
L
Linus Torvalds 已提交
452
{
D
Dave Airlie 已提交
453
	DRM_DEBUG("\n");
L
Linus Torvalds 已提交
454 455 456
#if 0
	u32 tmp;

D
Dave Airlie 已提交
457 458
	tmp = RADEON_READ(RADEON_CP_RB_WPTR) | (1 << 31);
	RADEON_WRITE(RADEON_CP_RB_WPTR, tmp);
L
Linus Torvalds 已提交
459 460 461 462 463
#endif
}

/* Wait for the CP to go idle.
 */
D
Dave Airlie 已提交
464
int radeon_do_cp_idle(drm_radeon_private_t * dev_priv)
L
Linus Torvalds 已提交
465 466
{
	RING_LOCALS;
D
Dave Airlie 已提交
467
	DRM_DEBUG("\n");
L
Linus Torvalds 已提交
468

D
Dave Airlie 已提交
469
	BEGIN_RING(6);
L
Linus Torvalds 已提交
470 471 472 473 474 475 476 477

	RADEON_PURGE_CACHE();
	RADEON_PURGE_ZCACHE();
	RADEON_WAIT_UNTIL_IDLE();

	ADVANCE_RING();
	COMMIT_RING();

D
Dave Airlie 已提交
478
	return radeon_do_wait_for_idle(dev_priv);
L
Linus Torvalds 已提交
479 480 481 482
}

/* Start the Command Processor.
 */
D
Dave Airlie 已提交
483
static void radeon_do_cp_start(drm_radeon_private_t * dev_priv)
L
Linus Torvalds 已提交
484 485
{
	RING_LOCALS;
D
Dave Airlie 已提交
486
	DRM_DEBUG("\n");
L
Linus Torvalds 已提交
487

D
Dave Airlie 已提交
488
	radeon_do_wait_for_idle(dev_priv);
L
Linus Torvalds 已提交
489

D
Dave Airlie 已提交
490
	RADEON_WRITE(RADEON_CP_CSQ_CNTL, dev_priv->cp_mode);
L
Linus Torvalds 已提交
491 492 493

	dev_priv->cp_running = 1;

494 495 496 497 498 499 500
	BEGIN_RING(8);
	/* isync can only be written through cp on r5xx write it here */
	OUT_RING(CP_PACKET0(RADEON_ISYNC_CNTL, 0));
	OUT_RING(RADEON_ISYNC_ANY2D_IDLE3D |
		 RADEON_ISYNC_ANY3D_IDLE2D |
		 RADEON_ISYNC_WAIT_IDLEGUI |
		 RADEON_ISYNC_CPSCRATCH_IDLEGUI);
L
Linus Torvalds 已提交
501 502 503 504 505
	RADEON_PURGE_CACHE();
	RADEON_PURGE_ZCACHE();
	RADEON_WAIT_UNTIL_IDLE();
	ADVANCE_RING();
	COMMIT_RING();
506 507

	dev_priv->track_flush |= RADEON_FLUSH_EMITED | RADEON_PURGE_EMITED;
L
Linus Torvalds 已提交
508 509 510 511 512 513
}

/* Reset the Command Processor.  This will not flush any pending
 * commands, so you must wait for the CP command stream to complete
 * before calling this routine.
 */
D
Dave Airlie 已提交
514
static void radeon_do_cp_reset(drm_radeon_private_t * dev_priv)
L
Linus Torvalds 已提交
515 516
{
	u32 cur_read_ptr;
D
Dave Airlie 已提交
517
	DRM_DEBUG("\n");
L
Linus Torvalds 已提交
518

D
Dave Airlie 已提交
519 520 521
	cur_read_ptr = RADEON_READ(RADEON_CP_RB_RPTR);
	RADEON_WRITE(RADEON_CP_RB_WPTR, cur_read_ptr);
	SET_RING_HEAD(dev_priv, cur_read_ptr);
L
Linus Torvalds 已提交
522 523 524 525 526 527 528
	dev_priv->ring.tail = cur_read_ptr;
}

/* Stop the Command Processor.  This will not flush any pending
 * commands, so you must flush the command stream and wait for the CP
 * to go idle before calling this routine.
 */
D
Dave Airlie 已提交
529
static void radeon_do_cp_stop(drm_radeon_private_t * dev_priv)
L
Linus Torvalds 已提交
530
{
D
Dave Airlie 已提交
531
	DRM_DEBUG("\n");
L
Linus Torvalds 已提交
532

D
Dave Airlie 已提交
533
	RADEON_WRITE(RADEON_CP_CSQ_CNTL, RADEON_CSQ_PRIDIS_INDDIS);
L
Linus Torvalds 已提交
534 535 536 537 538 539

	dev_priv->cp_running = 0;
}

/* Reset the engine.  This will stop the CP if it is running.
 */
540
static int radeon_do_engine_reset(struct drm_device * dev)
L
Linus Torvalds 已提交
541 542
{
	drm_radeon_private_t *dev_priv = dev->dev_private;
543
	u32 clock_cntl_index = 0, mclk_cntl = 0, rbbm_soft_reset;
D
Dave Airlie 已提交
544
	DRM_DEBUG("\n");
L
Linus Torvalds 已提交
545

D
Dave Airlie 已提交
546 547
	radeon_do_pixcache_flush(dev_priv);

548 549
	if ((dev_priv->flags & RADEON_FAMILY_MASK) <= CHIP_RV410) {
		/* may need something similar for newer chips */
D
Dave Airlie 已提交
550 551 552 553 554 555 556 557 558 559
		clock_cntl_index = RADEON_READ(RADEON_CLOCK_CNTL_INDEX);
		mclk_cntl = RADEON_READ_PLL(dev, RADEON_MCLK_CNTL);

		RADEON_WRITE_PLL(RADEON_MCLK_CNTL, (mclk_cntl |
						    RADEON_FORCEON_MCLKA |
						    RADEON_FORCEON_MCLKB |
						    RADEON_FORCEON_YCLKA |
						    RADEON_FORCEON_YCLKB |
						    RADEON_FORCEON_MC |
						    RADEON_FORCEON_AIC));
560
	}
D
Dave Airlie 已提交
561

562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583
	rbbm_soft_reset = RADEON_READ(RADEON_RBBM_SOFT_RESET);

	RADEON_WRITE(RADEON_RBBM_SOFT_RESET, (rbbm_soft_reset |
					      RADEON_SOFT_RESET_CP |
					      RADEON_SOFT_RESET_HI |
					      RADEON_SOFT_RESET_SE |
					      RADEON_SOFT_RESET_RE |
					      RADEON_SOFT_RESET_PP |
					      RADEON_SOFT_RESET_E2 |
					      RADEON_SOFT_RESET_RB));
	RADEON_READ(RADEON_RBBM_SOFT_RESET);
	RADEON_WRITE(RADEON_RBBM_SOFT_RESET, (rbbm_soft_reset &
					      ~(RADEON_SOFT_RESET_CP |
						RADEON_SOFT_RESET_HI |
						RADEON_SOFT_RESET_SE |
						RADEON_SOFT_RESET_RE |
						RADEON_SOFT_RESET_PP |
						RADEON_SOFT_RESET_E2 |
						RADEON_SOFT_RESET_RB)));
	RADEON_READ(RADEON_RBBM_SOFT_RESET);

	if ((dev_priv->flags & RADEON_FAMILY_MASK) <= CHIP_RV410) {
D
Dave Airlie 已提交
584 585 586 587
		RADEON_WRITE_PLL(RADEON_MCLK_CNTL, mclk_cntl);
		RADEON_WRITE(RADEON_CLOCK_CNTL_INDEX, clock_cntl_index);
		RADEON_WRITE(RADEON_RBBM_SOFT_RESET, rbbm_soft_reset);
	}
L
Linus Torvalds 已提交
588

589 590 591 592
	/* setup the raster pipes */
	if ((dev_priv->flags & RADEON_FAMILY_MASK) >= CHIP_R300)
	    radeon_init_pipes(dev_priv);

L
Linus Torvalds 已提交
593
	/* Reset the CP ring */
D
Dave Airlie 已提交
594
	radeon_do_cp_reset(dev_priv);
L
Linus Torvalds 已提交
595 596 597 598 599

	/* The CP is no longer running after an engine reset */
	dev_priv->cp_running = 0;

	/* Reset any pending vertex, indirect buffers */
D
Dave Airlie 已提交
600
	radeon_freelist_reset(dev);
L
Linus Torvalds 已提交
601 602 603 604

	return 0;
}

605
static void radeon_cp_init_ring_buffer(struct drm_device * dev,
606 607
				       drm_radeon_private_t *dev_priv,
				       struct drm_file *file_priv)
L
Linus Torvalds 已提交
608
{
609
	struct drm_radeon_master_private *master_priv;
L
Linus Torvalds 已提交
610 611
	u32 ring_start, cur_read_ptr;
	u32 tmp;
D
Dave Airlie 已提交
612

613 614 615 616 617 618
	/* Initialize the memory controller. With new memory map, the fb location
	 * is not changed, it should have been properly initialized already. Part
	 * of the problem is that the code below is bogus, assuming the GART is
	 * always appended to the fb which is not necessarily the case
	 */
	if (!dev_priv->new_memmap)
D
Dave Airlie 已提交
619
		radeon_write_fb_location(dev_priv,
620 621
			     ((dev_priv->gart_vm_start - 1) & 0xffff0000)
			     | (dev_priv->fb_location >> 16));
L
Linus Torvalds 已提交
622 623

#if __OS_HAS_AGP
624
	if (dev_priv->flags & RADEON_IS_AGP) {
625 626
		radeon_write_agp_base(dev_priv, dev->agp->base);

D
Dave Airlie 已提交
627
		radeon_write_agp_location(dev_priv,
D
Dave Airlie 已提交
628 629 630
			     (((dev_priv->gart_vm_start - 1 +
				dev_priv->gart_size) & 0xffff0000) |
			      (dev_priv->gart_vm_start >> 16)));
L
Linus Torvalds 已提交
631 632 633 634

		ring_start = (dev_priv->cp_ring->offset
			      - dev->agp->base
			      + dev_priv->gart_vm_start);
635
	} else
L
Linus Torvalds 已提交
636 637
#endif
		ring_start = (dev_priv->cp_ring->offset
638
			      - (unsigned long)dev->sg->virtual
L
Linus Torvalds 已提交
639 640
			      + dev_priv->gart_vm_start);

D
Dave Airlie 已提交
641
	RADEON_WRITE(RADEON_CP_RB_BASE, ring_start);
L
Linus Torvalds 已提交
642 643

	/* Set the write pointer delay */
D
Dave Airlie 已提交
644
	RADEON_WRITE(RADEON_CP_RB_WPTR_DELAY, 0);
L
Linus Torvalds 已提交
645 646

	/* Initialize the ring buffer's read and write pointers */
D
Dave Airlie 已提交
647 648 649
	cur_read_ptr = RADEON_READ(RADEON_CP_RB_RPTR);
	RADEON_WRITE(RADEON_CP_RB_WPTR, cur_read_ptr);
	SET_RING_HEAD(dev_priv, cur_read_ptr);
L
Linus Torvalds 已提交
650 651 652
	dev_priv->ring.tail = cur_read_ptr;

#if __OS_HAS_AGP
653
	if (dev_priv->flags & RADEON_IS_AGP) {
D
Dave Airlie 已提交
654 655 656
		RADEON_WRITE(RADEON_CP_RB_RPTR_ADDR,
			     dev_priv->ring_rptr->offset
			     - dev->agp->base + dev_priv->gart_vm_start);
L
Linus Torvalds 已提交
657 658 659
	} else
#endif
	{
660 661 662 663
		RADEON_WRITE(RADEON_CP_RB_RPTR_ADDR,
			     dev_priv->ring_rptr->offset
			     - ((unsigned long) dev->sg->virtual)
			     + dev_priv->gart_vm_start);
L
Linus Torvalds 已提交
664 665
	}

666 667 668
	/* Set ring buffer size */
#ifdef __BIG_ENDIAN
	RADEON_WRITE(RADEON_CP_RB_CNTL,
669 670 671 672
		     RADEON_BUF_SWAP_32BIT |
		     (dev_priv->ring.fetch_size_l2ow << 18) |
		     (dev_priv->ring.rptr_update_l2qw << 8) |
		     dev_priv->ring.size_l2qw);
673
#else
674 675 676 677
	RADEON_WRITE(RADEON_CP_RB_CNTL,
		     (dev_priv->ring.fetch_size_l2ow << 18) |
		     (dev_priv->ring.rptr_update_l2qw << 8) |
		     dev_priv->ring.size_l2qw);
678 679 680
#endif


L
Linus Torvalds 已提交
681 682 683 684 685 686 687
	/* Initialize the scratch register pointer.  This will cause
	 * the scratch register values to be written out to memory
	 * whenever they are updated.
	 *
	 * We simply put this behind the ring read pointer, this works
	 * with PCI GART as well as (whatever kind of) AGP GART
	 */
D
Dave Airlie 已提交
688 689
	RADEON_WRITE(RADEON_SCRATCH_ADDR, RADEON_READ(RADEON_CP_RB_RPTR_ADDR)
		     + RADEON_SCRATCH_REG_OFFSET);
L
Linus Torvalds 已提交
690

D
Dave Airlie 已提交
691
	RADEON_WRITE(RADEON_SCRATCH_UMSK, 0x7);
L
Linus Torvalds 已提交
692

693
	/* Turn on bus mastering */
694
	if (((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS690) ||
695
	    ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS740)) {
696 697
		/* rs600/rs690/rs740 */
		tmp = RADEON_READ(RADEON_BUS_CNTL) & ~RS600_BUS_MASTER_DIS;
698
		RADEON_WRITE(RADEON_BUS_CNTL, tmp);
699 700 701 702 703
	} else if (((dev_priv->flags & RADEON_FAMILY_MASK) <= CHIP_RV350) ||
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_R420) ||
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS400) ||
		   ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS480)) {
		/* r1xx, r2xx, r300, r(v)350, r420/r481, rs400/rs480 */
704 705 706
		tmp = RADEON_READ(RADEON_BUS_CNTL) & ~RADEON_BUS_MASTER_DIS;
		RADEON_WRITE(RADEON_BUS_CNTL, tmp);
	} /* PCIE cards appears to not need this */
L
Linus Torvalds 已提交
707

708
	radeon_write_ring_rptr(dev_priv, RADEON_SCRATCHOFF(0), 0);
709
	RADEON_WRITE(RADEON_LAST_FRAME_REG, 0);
L
Linus Torvalds 已提交
710

711
	radeon_write_ring_rptr(dev_priv, RADEON_SCRATCHOFF(1), 0);
712
	RADEON_WRITE(RADEON_LAST_DISPATCH_REG, 0);
L
Linus Torvalds 已提交
713

714
	radeon_write_ring_rptr(dev_priv, RADEON_SCRATCHOFF(2), 0);
715
	RADEON_WRITE(RADEON_LAST_CLEAR_REG, 0);
L
Linus Torvalds 已提交
716

717 718 719 720 721 722 723 724
	/* reset sarea copies of these */
	master_priv = file_priv->master->driver_priv;
	if (master_priv->sarea_priv) {
		master_priv->sarea_priv->last_frame = 0;
		master_priv->sarea_priv->last_dispatch = 0;
		master_priv->sarea_priv->last_clear = 0;
	}

D
Dave Airlie 已提交
725
	radeon_do_wait_for_idle(dev_priv);
L
Linus Torvalds 已提交
726 727

	/* Sync everything up */
D
Dave Airlie 已提交
728 729 730 731 732
	RADEON_WRITE(RADEON_ISYNC_CNTL,
		     (RADEON_ISYNC_ANY2D_IDLE3D |
		      RADEON_ISYNC_ANY3D_IDLE2D |
		      RADEON_ISYNC_WAIT_IDLEGUI |
		      RADEON_ISYNC_CPSCRATCH_IDLEGUI));
733 734 735 736 737 738 739

}

static void radeon_test_writeback(drm_radeon_private_t * dev_priv)
{
	u32 tmp;

740 741 742
	/* Start with assuming that writeback doesn't work */
	dev_priv->writeback_works = 0;

743 744 745
	/* Writeback doesn't seem to work everywhere, test it here and possibly
	 * enable it if it appears to work
	 */
746 747
	radeon_write_ring_rptr(dev_priv, RADEON_SCRATCHOFF(1), 0);

748 749 750
	RADEON_WRITE(RADEON_SCRATCH_REG1, 0xdeadbeef);

	for (tmp = 0; tmp < dev_priv->usec_timeout; tmp++) {
751 752 753 754
		u32 val;

		val = radeon_read_ring_rptr(dev_priv, RADEON_SCRATCHOFF(1));
		if (val == 0xdeadbeef)
755 756 757 758 759 760 761 762 763 764 765 766 767 768 769
			break;
		DRM_UDELAY(1);
	}

	if (tmp < dev_priv->usec_timeout) {
		dev_priv->writeback_works = 1;
		DRM_INFO("writeback test succeeded in %d usecs\n", tmp);
	} else {
		dev_priv->writeback_works = 0;
		DRM_INFO("writeback test failed\n");
	}
	if (radeon_no_wb == 1) {
		dev_priv->writeback_works = 0;
		DRM_INFO("writeback forced off\n");
	}
770 771 772 773 774 775 776

	if (!dev_priv->writeback_works) {
		/* Disable writeback to avoid unnecessary bus master transfer */
		RADEON_WRITE(RADEON_CP_RB_CNTL, RADEON_READ(RADEON_CP_RB_CNTL) |
			     RADEON_RB_NO_UPDATE);
		RADEON_WRITE(RADEON_SCRATCH_UMSK, 0);
	}
L
Linus Torvalds 已提交
777 778
}

779 780
/* Enable or disable IGP GART on the chip */
static void radeon_set_igpgart(drm_radeon_private_t * dev_priv, int on)
781 782 783 784
{
	u32 temp;

	if (on) {
785
		DRM_DEBUG("programming igp gart %08X %08lX %08X\n",
786 787 788 789
			  dev_priv->gart_vm_start,
			  (long)dev_priv->gart_info.bus_addr,
			  dev_priv->gart_size);

790
		temp = IGP_READ_MCIND(dev_priv, RS480_MC_MISC_CNTL);
791 792
		if (((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS690) ||
		    ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS740))
793 794 795 796
			IGP_WRITE_MCIND(RS480_MC_MISC_CNTL, (RS480_GART_INDEX_REG_EN |
							     RS690_BLOCK_GFX_D3_EN));
		else
			IGP_WRITE_MCIND(RS480_MC_MISC_CNTL, RS480_GART_INDEX_REG_EN);
797

798 799
		IGP_WRITE_MCIND(RS480_AGP_ADDRESS_SPACE_SIZE, (RS480_GART_EN |
							       RS480_VA_SIZE_32MB));
800

801 802 803 804 805
		temp = IGP_READ_MCIND(dev_priv, RS480_GART_FEATURE_ID);
		IGP_WRITE_MCIND(RS480_GART_FEATURE_ID, (RS480_HANG_EN |
							RS480_TLB_ENABLE |
							RS480_GTW_LAC_EN |
							RS480_1LEVEL_GART));
806

807 808
		temp = dev_priv->gart_info.bus_addr & 0xfffff000;
		temp |= (upper_32_bits(dev_priv->gart_info.bus_addr) & 0xff) << 4;
809 810 811 812 813 814
		IGP_WRITE_MCIND(RS480_GART_BASE, temp);

		temp = IGP_READ_MCIND(dev_priv, RS480_AGP_MODE_CNTL);
		IGP_WRITE_MCIND(RS480_AGP_MODE_CNTL, ((1 << RS480_REQ_TYPE_SNOOP_SHIFT) |
						      RS480_REQ_TYPE_SNOOP_DIS));

815
		radeon_write_agp_base(dev_priv, dev_priv->gart_vm_start);
D
Dave Airlie 已提交
816

817 818 819 820
		dev_priv->gart_size = 32*1024*1024;
		temp = (((dev_priv->gart_vm_start - 1 + dev_priv->gart_size) &
			 0xffff0000) | (dev_priv->gart_vm_start >> 16));

821
		radeon_write_agp_location(dev_priv, temp);
822

823 824 825
		temp = IGP_READ_MCIND(dev_priv, RS480_AGP_ADDRESS_SPACE_SIZE);
		IGP_WRITE_MCIND(RS480_AGP_ADDRESS_SPACE_SIZE, (RS480_GART_EN |
							       RS480_VA_SIZE_32MB));
826 827

		do {
828 829
			temp = IGP_READ_MCIND(dev_priv, RS480_GART_CACHE_CNTRL);
			if ((temp & RS480_GART_CACHE_INVALIDATE) == 0)
830 831 832 833
				break;
			DRM_UDELAY(1);
		} while (1);

834 835
		IGP_WRITE_MCIND(RS480_GART_CACHE_CNTRL,
				RS480_GART_CACHE_INVALIDATE);
836

837
		do {
838 839
			temp = IGP_READ_MCIND(dev_priv, RS480_GART_CACHE_CNTRL);
			if ((temp & RS480_GART_CACHE_INVALIDATE) == 0)
840 841 842 843
				break;
			DRM_UDELAY(1);
		} while (1);

844
		IGP_WRITE_MCIND(RS480_GART_CACHE_CNTRL, 0);
845
	} else {
846
		IGP_WRITE_MCIND(RS480_AGP_ADDRESS_SPACE_SIZE, 0);
847 848 849
	}
}

850 851 852 853 854 855
static void radeon_set_pciegart(drm_radeon_private_t * dev_priv, int on)
{
	u32 tmp = RADEON_READ_PCIE(dev_priv, RADEON_PCIE_TX_GART_CNTL);
	if (on) {

		DRM_DEBUG("programming pcie %08X %08lX %08X\n",
D
Dave Airlie 已提交
856 857
			  dev_priv->gart_vm_start,
			  (long)dev_priv->gart_info.bus_addr,
858
			  dev_priv->gart_size);
D
Dave Airlie 已提交
859 860 861 862 863 864 865 866 867 868
		RADEON_WRITE_PCIE(RADEON_PCIE_TX_DISCARD_RD_ADDR_LO,
				  dev_priv->gart_vm_start);
		RADEON_WRITE_PCIE(RADEON_PCIE_TX_GART_BASE,
				  dev_priv->gart_info.bus_addr);
		RADEON_WRITE_PCIE(RADEON_PCIE_TX_GART_START_LO,
				  dev_priv->gart_vm_start);
		RADEON_WRITE_PCIE(RADEON_PCIE_TX_GART_END_LO,
				  dev_priv->gart_vm_start +
				  dev_priv->gart_size - 1);

D
Dave Airlie 已提交
869
		radeon_write_agp_location(dev_priv, 0xffffffc0); /* ?? */
D
Dave Airlie 已提交
870 871 872

		RADEON_WRITE_PCIE(RADEON_PCIE_TX_GART_CNTL,
				  RADEON_PCIE_TX_GART_EN);
873
	} else {
D
Dave Airlie 已提交
874 875
		RADEON_WRITE_PCIE(RADEON_PCIE_TX_GART_CNTL,
				  tmp & ~RADEON_PCIE_TX_GART_EN);
876
	}
L
Linus Torvalds 已提交
877 878 879
}

/* Enable or disable PCI GART on the chip */
D
Dave Airlie 已提交
880
static void radeon_set_pcigart(drm_radeon_private_t * dev_priv, int on)
L
Linus Torvalds 已提交
881
{
882
	u32 tmp;
L
Linus Torvalds 已提交
883

884
	if (((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS690) ||
885
	    ((dev_priv->flags & RADEON_FAMILY_MASK) == CHIP_RS740) ||
886
	    (dev_priv->flags & RADEON_IS_IGPGART)) {
887 888 889 890
		radeon_set_igpgart(dev_priv, on);
		return;
	}

891
	if (dev_priv->flags & RADEON_IS_PCIE) {
892 893 894
		radeon_set_pciegart(dev_priv, on);
		return;
	}
L
Linus Torvalds 已提交
895

D
Dave Airlie 已提交
896
	tmp = RADEON_READ(RADEON_AIC_CNTL);
897

D
Dave Airlie 已提交
898 899 900
	if (on) {
		RADEON_WRITE(RADEON_AIC_CNTL,
			     tmp | RADEON_PCIGART_TRANSLATE_EN);
L
Linus Torvalds 已提交
901 902 903

		/* set PCI GART page-table base address
		 */
904
		RADEON_WRITE(RADEON_AIC_PT_BASE, dev_priv->gart_info.bus_addr);
L
Linus Torvalds 已提交
905 906 907

		/* set address range for PCI address translate
		 */
D
Dave Airlie 已提交
908 909 910
		RADEON_WRITE(RADEON_AIC_LO_ADDR, dev_priv->gart_vm_start);
		RADEON_WRITE(RADEON_AIC_HI_ADDR, dev_priv->gart_vm_start
			     + dev_priv->gart_size - 1);
L
Linus Torvalds 已提交
911 912 913

		/* Turn off AGP aperture -- is this required for PCI GART?
		 */
D
Dave Airlie 已提交
914
		radeon_write_agp_location(dev_priv, 0xffffffc0);
D
Dave Airlie 已提交
915
		RADEON_WRITE(RADEON_AGP_COMMAND, 0);	/* clear AGP_COMMAND */
L
Linus Torvalds 已提交
916
	} else {
D
Dave Airlie 已提交
917 918
		RADEON_WRITE(RADEON_AIC_CNTL,
			     tmp & ~RADEON_PCIGART_TRANSLATE_EN);
L
Linus Torvalds 已提交
919 920 921
	}
}

922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961
static int radeon_setup_pcigart_surface(drm_radeon_private_t *dev_priv)
{
	struct drm_ati_pcigart_info *gart_info = &dev_priv->gart_info;
	struct radeon_virt_surface *vp;
	int i;

	for (i = 0; i < RADEON_MAX_SURFACES * 2; i++) {
		if (!dev_priv->virt_surfaces[i].file_priv ||
		    dev_priv->virt_surfaces[i].file_priv == PCIGART_FILE_PRIV)
			break;
	}
	if (i >= 2 * RADEON_MAX_SURFACES)
		return -ENOMEM;
	vp = &dev_priv->virt_surfaces[i];

	for (i = 0; i < RADEON_MAX_SURFACES; i++) {
		struct radeon_surface *sp = &dev_priv->surfaces[i];
		if (sp->refcount)
			continue;

		vp->surface_index = i;
		vp->lower = gart_info->bus_addr;
		vp->upper = vp->lower + gart_info->table_size;
		vp->flags = 0;
		vp->file_priv = PCIGART_FILE_PRIV;

		sp->refcount = 1;
		sp->lower = vp->lower;
		sp->upper = vp->upper;
		sp->flags = 0;

		RADEON_WRITE(RADEON_SURFACE0_INFO + 16 * i, sp->flags);
		RADEON_WRITE(RADEON_SURFACE0_LOWER_BOUND + 16 * i, sp->lower);
		RADEON_WRITE(RADEON_SURFACE0_UPPER_BOUND + 16 * i, sp->upper);
		return 0;
	}

	return -ENOMEM;
}

962 963
static int radeon_do_init_cp(struct drm_device *dev, drm_radeon_init_t *init,
			     struct drm_file *file_priv)
L
Linus Torvalds 已提交
964
{
965
	drm_radeon_private_t *dev_priv = dev->dev_private;
966
	struct drm_radeon_master_private *master_priv = file_priv->master->driver_priv;
967

D
Dave Airlie 已提交
968
	DRM_DEBUG("\n");
L
Linus Torvalds 已提交
969

D
Dave Airlie 已提交
970
	/* if we require new memory map but we don't have it fail */
971
	if ((dev_priv->flags & RADEON_NEW_MEMMAP) && !dev_priv->new_memmap) {
972
		DRM_ERROR("Cannot initialise DRM on this card\nThis card requires a new X.org DDX for 3D\n");
D
Dave Airlie 已提交
973
		radeon_do_cleanup_cp(dev);
E
Eric Anholt 已提交
974
		return -EINVAL;
D
Dave Airlie 已提交
975 976
	}

977
	if (init->is_pci && (dev_priv->flags & RADEON_IS_AGP)) {
978
		DRM_DEBUG("Forcing AGP card to PCI mode\n");
979 980
		dev_priv->flags &= ~RADEON_IS_AGP;
	} else if (!(dev_priv->flags & (RADEON_IS_AGP | RADEON_IS_PCI | RADEON_IS_PCIE))
981 982
		   && !init->is_pci) {
		DRM_DEBUG("Restoring AGP flag\n");
983
		dev_priv->flags |= RADEON_IS_AGP;
984
	}
L
Linus Torvalds 已提交
985

986
	if ((!(dev_priv->flags & RADEON_IS_AGP)) && !dev->sg) {
D
Dave Airlie 已提交
987
		DRM_ERROR("PCI GART memory not allocated!\n");
L
Linus Torvalds 已提交
988
		radeon_do_cleanup_cp(dev);
E
Eric Anholt 已提交
989
		return -EINVAL;
L
Linus Torvalds 已提交
990 991 992
	}

	dev_priv->usec_timeout = init->usec_timeout;
D
Dave Airlie 已提交
993 994 995
	if (dev_priv->usec_timeout < 1 ||
	    dev_priv->usec_timeout > RADEON_MAX_USEC_TIMEOUT) {
		DRM_DEBUG("TIMEOUT problem!\n");
L
Linus Torvalds 已提交
996
		radeon_do_cleanup_cp(dev);
E
Eric Anholt 已提交
997
		return -EINVAL;
L
Linus Torvalds 已提交
998 999
	}

1000 1001 1002 1003
	/* Enable vblank on CRTC1 for older X servers
	 */
	dev_priv->vblank_crtc = DRM_RADEON_VBLANK_CRTC1;

1004
	switch(init->func) {
L
Linus Torvalds 已提交
1005
	case RADEON_INIT_R200_CP:
D
Dave Airlie 已提交
1006
		dev_priv->microcode_version = UCODE_R200;
L
Linus Torvalds 已提交
1007 1008
		break;
	case RADEON_INIT_R300_CP:
D
Dave Airlie 已提交
1009
		dev_priv->microcode_version = UCODE_R300;
L
Linus Torvalds 已提交
1010 1011
		break;
	default:
D
Dave Airlie 已提交
1012
		dev_priv->microcode_version = UCODE_R100;
L
Linus Torvalds 已提交
1013
	}
D
Dave Airlie 已提交
1014

L
Linus Torvalds 已提交
1015 1016 1017 1018 1019 1020 1021
	dev_priv->do_boxes = 0;
	dev_priv->cp_mode = init->cp_mode;

	/* We don't support anything other than bus-mastering ring mode,
	 * but the ring can be in either AGP or PCI space for the ring
	 * read pointer.
	 */
D
Dave Airlie 已提交
1022 1023 1024
	if ((init->cp_mode != RADEON_CSQ_PRIBM_INDDIS) &&
	    (init->cp_mode != RADEON_CSQ_PRIBM_INDBM)) {
		DRM_DEBUG("BAD cp_mode (%x)!\n", init->cp_mode);
L
Linus Torvalds 已提交
1025
		radeon_do_cleanup_cp(dev);
E
Eric Anholt 已提交
1026
		return -EINVAL;
L
Linus Torvalds 已提交
1027 1028
	}

D
Dave Airlie 已提交
1029
	switch (init->fb_bpp) {
L
Linus Torvalds 已提交
1030 1031 1032 1033 1034 1035 1036 1037
	case 16:
		dev_priv->color_fmt = RADEON_COLOR_FORMAT_RGB565;
		break;
	case 32:
	default:
		dev_priv->color_fmt = RADEON_COLOR_FORMAT_ARGB8888;
		break;
	}
D
Dave Airlie 已提交
1038 1039 1040 1041
	dev_priv->front_offset = init->front_offset;
	dev_priv->front_pitch = init->front_pitch;
	dev_priv->back_offset = init->back_offset;
	dev_priv->back_pitch = init->back_pitch;
L
Linus Torvalds 已提交
1042

D
Dave Airlie 已提交
1043
	switch (init->depth_bpp) {
L
Linus Torvalds 已提交
1044 1045 1046 1047 1048 1049 1050 1051
	case 16:
		dev_priv->depth_fmt = RADEON_DEPTH_FORMAT_16BIT_INT_Z;
		break;
	case 32:
	default:
		dev_priv->depth_fmt = RADEON_DEPTH_FORMAT_24BIT_INT_Z;
		break;
	}
D
Dave Airlie 已提交
1052 1053
	dev_priv->depth_offset = init->depth_offset;
	dev_priv->depth_pitch = init->depth_pitch;
L
Linus Torvalds 已提交
1054 1055 1056 1057 1058 1059 1060 1061

	/* Hardware state for depth clears.  Remove this if/when we no
	 * longer clear the depth buffer with a 3D rectangle.  Hard-code
	 * all values to prevent unwanted 3D state from slipping through
	 * and screwing with the clear operation.
	 */
	dev_priv->depth_clear.rb3d_cntl = (RADEON_PLANE_MASK_ENABLE |
					   (dev_priv->color_fmt << 10) |
D
Dave Airlie 已提交
1062 1063
					   (dev_priv->microcode_version ==
					    UCODE_R100 ? RADEON_ZBLOCK16 : 0));
L
Linus Torvalds 已提交
1064

D
Dave Airlie 已提交
1065 1066 1067 1068 1069 1070 1071
	dev_priv->depth_clear.rb3d_zstencilcntl =
	    (dev_priv->depth_fmt |
	     RADEON_Z_TEST_ALWAYS |
	     RADEON_STENCIL_TEST_ALWAYS |
	     RADEON_STENCIL_S_FAIL_REPLACE |
	     RADEON_STENCIL_ZPASS_REPLACE |
	     RADEON_STENCIL_ZFAIL_REPLACE | RADEON_Z_WRITE_ENABLE);
L
Linus Torvalds 已提交
1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089

	dev_priv->depth_clear.se_cntl = (RADEON_FFACE_CULL_CW |
					 RADEON_BFACE_SOLID |
					 RADEON_FFACE_SOLID |
					 RADEON_FLAT_SHADE_VTX_LAST |
					 RADEON_DIFFUSE_SHADE_FLAT |
					 RADEON_ALPHA_SHADE_FLAT |
					 RADEON_SPECULAR_SHADE_FLAT |
					 RADEON_FOG_SHADE_FLAT |
					 RADEON_VTX_PIX_CENTER_OGL |
					 RADEON_ROUND_MODE_TRUNC |
					 RADEON_ROUND_PREC_8TH_PIX);


	dev_priv->ring_offset = init->ring_offset;
	dev_priv->ring_rptr_offset = init->ring_rptr_offset;
	dev_priv->buffers_offset = init->buffers_offset;
	dev_priv->gart_textures_offset = init->gart_textures_offset;
D
Dave Airlie 已提交
1090

1091 1092
	master_priv->sarea = drm_getsarea(dev);
	if (!master_priv->sarea) {
L
Linus Torvalds 已提交
1093 1094
		DRM_ERROR("could not find sarea!\n");
		radeon_do_cleanup_cp(dev);
E
Eric Anholt 已提交
1095
		return -EINVAL;
L
Linus Torvalds 已提交
1096 1097 1098
	}

	dev_priv->cp_ring = drm_core_findmap(dev, init->ring_offset);
D
Dave Airlie 已提交
1099
	if (!dev_priv->cp_ring) {
L
Linus Torvalds 已提交
1100 1101
		DRM_ERROR("could not find cp ring region!\n");
		radeon_do_cleanup_cp(dev);
E
Eric Anholt 已提交
1102
		return -EINVAL;
L
Linus Torvalds 已提交
1103 1104
	}
	dev_priv->ring_rptr = drm_core_findmap(dev, init->ring_rptr_offset);
D
Dave Airlie 已提交
1105
	if (!dev_priv->ring_rptr) {
L
Linus Torvalds 已提交
1106 1107
		DRM_ERROR("could not find ring read pointer!\n");
		radeon_do_cleanup_cp(dev);
E
Eric Anholt 已提交
1108
		return -EINVAL;
L
Linus Torvalds 已提交
1109
	}
1110
	dev->agp_buffer_token = init->buffers_offset;
L
Linus Torvalds 已提交
1111
	dev->agp_buffer_map = drm_core_findmap(dev, init->buffers_offset);
D
Dave Airlie 已提交
1112
	if (!dev->agp_buffer_map) {
L
Linus Torvalds 已提交
1113 1114
		DRM_ERROR("could not find dma buffer region!\n");
		radeon_do_cleanup_cp(dev);
E
Eric Anholt 已提交
1115
		return -EINVAL;
L
Linus Torvalds 已提交
1116 1117
	}

D
Dave Airlie 已提交
1118 1119 1120 1121
	if (init->gart_textures_offset) {
		dev_priv->gart_textures =
		    drm_core_findmap(dev, init->gart_textures_offset);
		if (!dev_priv->gart_textures) {
L
Linus Torvalds 已提交
1122 1123
			DRM_ERROR("could not find GART texture region!\n");
			radeon_do_cleanup_cp(dev);
E
Eric Anholt 已提交
1124
			return -EINVAL;
L
Linus Torvalds 已提交
1125 1126 1127 1128
		}
	}

#if __OS_HAS_AGP
1129
	if (dev_priv->flags & RADEON_IS_AGP) {
1130 1131 1132
		drm_core_ioremap_wc(dev_priv->cp_ring, dev);
		drm_core_ioremap_wc(dev_priv->ring_rptr, dev);
		drm_core_ioremap_wc(dev->agp_buffer_map, dev);
D
Dave Airlie 已提交
1133 1134 1135
		if (!dev_priv->cp_ring->handle ||
		    !dev_priv->ring_rptr->handle ||
		    !dev->agp_buffer_map->handle) {
L
Linus Torvalds 已提交
1136 1137
			DRM_ERROR("could not find ioremap agp regions!\n");
			radeon_do_cleanup_cp(dev);
E
Eric Anholt 已提交
1138
			return -EINVAL;
L
Linus Torvalds 已提交
1139 1140 1141 1142
		}
	} else
#endif
	{
1143 1144
		dev_priv->cp_ring->handle =
			(void *)(unsigned long)dev_priv->cp_ring->offset;
L
Linus Torvalds 已提交
1145
		dev_priv->ring_rptr->handle =
1146
			(void *)(unsigned long)dev_priv->ring_rptr->offset;
D
Dave Airlie 已提交
1147
		dev->agp_buffer_map->handle =
1148
			(void *)(unsigned long)dev->agp_buffer_map->offset;
D
Dave Airlie 已提交
1149 1150 1151 1152 1153 1154 1155

		DRM_DEBUG("dev_priv->cp_ring->handle %p\n",
			  dev_priv->cp_ring->handle);
		DRM_DEBUG("dev_priv->ring_rptr->handle %p\n",
			  dev_priv->ring_rptr->handle);
		DRM_DEBUG("dev->agp_buffer_map->handle %p\n",
			  dev->agp_buffer_map->handle);
L
Linus Torvalds 已提交
1156 1157
	}

D
Dave Airlie 已提交
1158
	dev_priv->fb_location = (radeon_read_fb_location(dev_priv) & 0xffff) << 16;
D
Dave Airlie 已提交
1159
	dev_priv->fb_size =
D
Dave Airlie 已提交
1160
		((radeon_read_fb_location(dev_priv) & 0xffff0000u) + 0x10000)
1161
		- dev_priv->fb_location;
L
Linus Torvalds 已提交
1162

D
Dave Airlie 已提交
1163 1164 1165
	dev_priv->front_pitch_offset = (((dev_priv->front_pitch / 64) << 22) |
					((dev_priv->front_offset
					  + dev_priv->fb_location) >> 10));
L
Linus Torvalds 已提交
1166

D
Dave Airlie 已提交
1167 1168 1169
	dev_priv->back_pitch_offset = (((dev_priv->back_pitch / 64) << 22) |
				       ((dev_priv->back_offset
					 + dev_priv->fb_location) >> 10));
L
Linus Torvalds 已提交
1170

D
Dave Airlie 已提交
1171 1172 1173
	dev_priv->depth_pitch_offset = (((dev_priv->depth_pitch / 64) << 22) |
					((dev_priv->depth_offset
					  + dev_priv->fb_location) >> 10));
L
Linus Torvalds 已提交
1174 1175

	dev_priv->gart_size = init->gart_size;
1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187

	/* New let's set the memory map ... */
	if (dev_priv->new_memmap) {
		u32 base = 0;

		DRM_INFO("Setting GART location based on new memory map\n");

		/* If using AGP, try to locate the AGP aperture at the same
		 * location in the card and on the bus, though we have to
		 * align it down.
		 */
#if __OS_HAS_AGP
1188
		if (dev_priv->flags & RADEON_IS_AGP) {
1189 1190
			base = dev->agp->base;
			/* Check if valid */
1191 1192
			if ((base + dev_priv->gart_size - 1) >= dev_priv->fb_location &&
			    base < (dev_priv->fb_location + dev_priv->fb_size - 1)) {
1193 1194 1195 1196 1197 1198 1199 1200 1201
				DRM_INFO("Can't use AGP base @0x%08lx, won't fit\n",
					 dev->agp->base);
				base = 0;
			}
		}
#endif
		/* If not or if AGP is at 0 (Macs), try to put it elsewhere */
		if (base == 0) {
			base = dev_priv->fb_location + dev_priv->fb_size;
1202 1203
			if (base < dev_priv->fb_location ||
			    ((base + dev_priv->gart_size) & 0xfffffffful) < base)
1204 1205
				base = dev_priv->fb_location
					- dev_priv->gart_size;
D
Dave Airlie 已提交
1206
		}
1207 1208 1209 1210 1211 1212 1213 1214 1215
		dev_priv->gart_vm_start = base & 0xffc00000u;
		if (dev_priv->gart_vm_start != base)
			DRM_INFO("GART aligned down from 0x%08x to 0x%08x\n",
				 base, dev_priv->gart_vm_start);
	} else {
		DRM_INFO("Setting GART location based on old memory map\n");
		dev_priv->gart_vm_start = dev_priv->fb_location +
			RADEON_READ(RADEON_CONFIG_APER_SIZE);
	}
L
Linus Torvalds 已提交
1216 1217

#if __OS_HAS_AGP
1218
	if (dev_priv->flags & RADEON_IS_AGP)
L
Linus Torvalds 已提交
1219
		dev_priv->gart_buffers_offset = (dev->agp_buffer_map->offset
D
Dave Airlie 已提交
1220 1221
						 - dev->agp->base
						 + dev_priv->gart_vm_start);
L
Linus Torvalds 已提交
1222 1223 1224
	else
#endif
		dev_priv->gart_buffers_offset = (dev->agp_buffer_map->offset
1225 1226
					- (unsigned long)dev->sg->virtual
					+ dev_priv->gart_vm_start);
L
Linus Torvalds 已提交
1227

D
Dave Airlie 已提交
1228 1229 1230 1231
	DRM_DEBUG("dev_priv->gart_size %d\n", dev_priv->gart_size);
	DRM_DEBUG("dev_priv->gart_vm_start 0x%x\n", dev_priv->gart_vm_start);
	DRM_DEBUG("dev_priv->gart_buffers_offset 0x%lx\n",
		  dev_priv->gart_buffers_offset);
L
Linus Torvalds 已提交
1232

D
Dave Airlie 已提交
1233 1234
	dev_priv->ring.start = (u32 *) dev_priv->cp_ring->handle;
	dev_priv->ring.end = ((u32 *) dev_priv->cp_ring->handle
L
Linus Torvalds 已提交
1235 1236
			      + init->ring_size / sizeof(u32));
	dev_priv->ring.size = init->ring_size;
D
Dave Airlie 已提交
1237
	dev_priv->ring.size_l2qw = drm_order(init->ring_size / 8);
L
Linus Torvalds 已提交
1238

1239 1240 1241 1242 1243
	dev_priv->ring.rptr_update = /* init->rptr_update */ 4096;
	dev_priv->ring.rptr_update_l2qw = drm_order( /* init->rptr_update */ 4096 / 8);

	dev_priv->ring.fetch_size = /* init->fetch_size */ 32;
	dev_priv->ring.fetch_size_l2ow = drm_order( /* init->fetch_size */ 32 / 16);
D
Dave Airlie 已提交
1244
	dev_priv->ring.tail_mask = (dev_priv->ring.size / sizeof(u32)) - 1;
L
Linus Torvalds 已提交
1245 1246 1247 1248

	dev_priv->ring.high_mark = RADEON_RING_HIGH_MARK;

#if __OS_HAS_AGP
1249
	if (dev_priv->flags & RADEON_IS_AGP) {
L
Linus Torvalds 已提交
1250
		/* Turn off PCI GART */
D
Dave Airlie 已提交
1251
		radeon_set_pcigart(dev_priv, 0);
L
Linus Torvalds 已提交
1252 1253 1254
	} else
#endif
	{
1255 1256 1257
		u32 sctrl;
		int ret;

1258
		dev_priv->gart_info.table_mask = DMA_BIT_MASK(32);
1259
		/* if we have an offset set from userspace */
1260
		if (dev_priv->pcigart_offset_set) {
D
Dave Airlie 已提交
1261
			dev_priv->gart_info.bus_addr =
1262
				(resource_size_t)dev_priv->pcigart_offset + dev_priv->fb_location;
1263
			dev_priv->gart_info.mapping.offset =
1264
			    dev_priv->pcigart_offset + dev_priv->fb_aper_offset;
1265
			dev_priv->gart_info.mapping.size =
1266
			    dev_priv->gart_info.table_size;
1267

1268
			drm_core_ioremap_wc(&dev_priv->gart_info.mapping, dev);
D
Dave Airlie 已提交
1269
			dev_priv->gart_info.addr =
1270
			    dev_priv->gart_info.mapping.handle;
D
Dave Airlie 已提交
1271

1272 1273 1274 1275
			if (dev_priv->flags & RADEON_IS_PCIE)
				dev_priv->gart_info.gart_reg_if = DRM_ATI_GART_PCIE;
			else
				dev_priv->gart_info.gart_reg_if = DRM_ATI_GART_PCI;
D
Dave Airlie 已提交
1276 1277 1278
			dev_priv->gart_info.gart_table_location =
			    DRM_ATI_GART_FB;

1279
			DRM_DEBUG("Setting phys_pci_gart to %p %08lX\n",
D
Dave Airlie 已提交
1280 1281 1282
				  dev_priv->gart_info.addr,
				  dev_priv->pcigart_offset);
		} else {
1283 1284 1285 1286
			if (dev_priv->flags & RADEON_IS_IGPGART)
				dev_priv->gart_info.gart_reg_if = DRM_ATI_GART_IGP;
			else
				dev_priv->gart_info.gart_reg_if = DRM_ATI_GART_PCI;
D
Dave Airlie 已提交
1287 1288
			dev_priv->gart_info.gart_table_location =
			    DRM_ATI_GART_MAIN;
1289 1290
			dev_priv->gart_info.addr = NULL;
			dev_priv->gart_info.bus_addr = 0;
1291
			if (dev_priv->flags & RADEON_IS_PCIE) {
D
Dave Airlie 已提交
1292 1293
				DRM_ERROR
				    ("Cannot use PCI Express without GART in FB memory\n");
1294
				radeon_do_cleanup_cp(dev);
E
Eric Anholt 已提交
1295
				return -EINVAL;
1296 1297 1298
			}
		}

1299 1300 1301 1302 1303 1304
		sctrl = RADEON_READ(RADEON_SURFACE_CNTL);
		RADEON_WRITE(RADEON_SURFACE_CNTL, 0);
		ret = drm_ati_pcigart_init(dev, &dev_priv->gart_info);
		RADEON_WRITE(RADEON_SURFACE_CNTL, sctrl);

		if (!ret) {
D
Dave Airlie 已提交
1305
			DRM_ERROR("failed to init PCI GART!\n");
L
Linus Torvalds 已提交
1306
			radeon_do_cleanup_cp(dev);
E
Eric Anholt 已提交
1307
			return -ENOMEM;
L
Linus Torvalds 已提交
1308 1309
		}

1310 1311 1312 1313 1314 1315 1316 1317
		ret = radeon_setup_pcigart_surface(dev_priv);
		if (ret) {
			DRM_ERROR("failed to setup GART surface!\n");
			drm_ati_pcigart_cleanup(dev, &dev_priv->gart_info);
			radeon_do_cleanup_cp(dev);
			return ret;
		}

L
Linus Torvalds 已提交
1318
		/* Turn on PCI GART */
D
Dave Airlie 已提交
1319
		radeon_set_pcigart(dev_priv, 1);
L
Linus Torvalds 已提交
1320 1321
	}

D
Dave Airlie 已提交
1322
	radeon_cp_load_microcode(dev_priv);
1323
	radeon_cp_init_ring_buffer(dev, dev_priv, file_priv);
L
Linus Torvalds 已提交
1324 1325 1326

	dev_priv->last_buf = 0;

D
Dave Airlie 已提交
1327
	radeon_do_engine_reset(dev);
1328
	radeon_test_writeback(dev_priv);
L
Linus Torvalds 已提交
1329 1330 1331 1332

	return 0;
}

1333
static int radeon_do_cleanup_cp(struct drm_device * dev)
L
Linus Torvalds 已提交
1334 1335
{
	drm_radeon_private_t *dev_priv = dev->dev_private;
D
Dave Airlie 已提交
1336
	DRM_DEBUG("\n");
L
Linus Torvalds 已提交
1337 1338 1339 1340 1341

	/* Make sure interrupts are disabled here because the uninstall ioctl
	 * may not have been called from userspace and after dev_private
	 * is freed, it's too late.
	 */
D
Dave Airlie 已提交
1342 1343
	if (dev->irq_enabled)
		drm_irq_uninstall(dev);
L
Linus Torvalds 已提交
1344 1345

#if __OS_HAS_AGP
1346
	if (dev_priv->flags & RADEON_IS_AGP) {
1347
		if (dev_priv->cp_ring != NULL) {
D
Dave Airlie 已提交
1348
			drm_core_ioremapfree(dev_priv->cp_ring, dev);
1349 1350 1351
			dev_priv->cp_ring = NULL;
		}
		if (dev_priv->ring_rptr != NULL) {
D
Dave Airlie 已提交
1352
			drm_core_ioremapfree(dev_priv->ring_rptr, dev);
1353 1354
			dev_priv->ring_rptr = NULL;
		}
D
Dave Airlie 已提交
1355 1356
		if (dev->agp_buffer_map != NULL) {
			drm_core_ioremapfree(dev->agp_buffer_map, dev);
L
Linus Torvalds 已提交
1357 1358 1359 1360 1361
			dev->agp_buffer_map = NULL;
		}
	} else
#endif
	{
1362 1363 1364 1365

		if (dev_priv->gart_info.bus_addr) {
			/* Turn off PCI GART */
			radeon_set_pcigart(dev_priv, 0);
1366 1367
			if (!drm_ati_pcigart_cleanup(dev, &dev_priv->gart_info))
				DRM_ERROR("failed to cleanup PCI GART!\n");
1368
		}
D
Dave Airlie 已提交
1369

1370 1371
		if (dev_priv->gart_info.gart_table_location == DRM_ATI_GART_FB)
		{
1372
			drm_core_ioremapfree(&dev_priv->gart_info.mapping, dev);
1373
			dev_priv->gart_info.addr = 0;
1374
		}
L
Linus Torvalds 已提交
1375 1376 1377 1378 1379 1380 1381
	}
	/* only clear to the start of flags */
	memset(dev_priv, 0, offsetof(drm_radeon_private_t, flags));

	return 0;
}

D
Dave Airlie 已提交
1382 1383
/* This code will reinit the Radeon CP hardware after a resume from disc.
 * AFAIK, it would be very difficult to pickle the state at suspend time, so
L
Linus Torvalds 已提交
1384 1385 1386 1387 1388
 * here we make sure that all Radeon hardware initialisation is re-done without
 * affecting running applications.
 *
 * Charl P. Botha <http://cpbotha.net>
 */
1389
static int radeon_do_resume_cp(struct drm_device *dev, struct drm_file *file_priv)
L
Linus Torvalds 已提交
1390 1391 1392
{
	drm_radeon_private_t *dev_priv = dev->dev_private;

D
Dave Airlie 已提交
1393 1394
	if (!dev_priv) {
		DRM_ERROR("Called with no initialization\n");
E
Eric Anholt 已提交
1395
		return -EINVAL;
L
Linus Torvalds 已提交
1396 1397 1398 1399 1400
	}

	DRM_DEBUG("Starting radeon_do_resume_cp()\n");

#if __OS_HAS_AGP
1401
	if (dev_priv->flags & RADEON_IS_AGP) {
L
Linus Torvalds 已提交
1402
		/* Turn off PCI GART */
D
Dave Airlie 已提交
1403
		radeon_set_pcigart(dev_priv, 0);
L
Linus Torvalds 已提交
1404 1405 1406 1407
	} else
#endif
	{
		/* Turn on PCI GART */
D
Dave Airlie 已提交
1408
		radeon_set_pcigart(dev_priv, 1);
L
Linus Torvalds 已提交
1409 1410
	}

D
Dave Airlie 已提交
1411
	radeon_cp_load_microcode(dev_priv);
1412
	radeon_cp_init_ring_buffer(dev, dev_priv, file_priv);
L
Linus Torvalds 已提交
1413

D
Dave Airlie 已提交
1414
	radeon_do_engine_reset(dev);
1415
	radeon_irq_set_state(dev, RADEON_SW_INT_ENABLE, 1);
L
Linus Torvalds 已提交
1416 1417 1418 1419 1420 1421

	DRM_DEBUG("radeon_do_resume_cp() complete\n");

	return 0;
}

1422
int radeon_cp_init(struct drm_device *dev, void *data, struct drm_file *file_priv)
L
Linus Torvalds 已提交
1423
{
1424
	drm_radeon_init_t *init = data;
L
Linus Torvalds 已提交
1425

1426
	LOCK_TEST_WITH_RETURN(dev, file_priv);
L
Linus Torvalds 已提交
1427

1428
	if (init->func == RADEON_INIT_R300_CP)
D
Dave Airlie 已提交
1429
		r300_init_reg_flags(dev);
D
Dave Airlie 已提交
1430

1431
	switch (init->func) {
L
Linus Torvalds 已提交
1432 1433 1434
	case RADEON_INIT_CP:
	case RADEON_INIT_R200_CP:
	case RADEON_INIT_R300_CP:
1435
		return radeon_do_init_cp(dev, init, file_priv);
L
Linus Torvalds 已提交
1436
	case RADEON_CLEANUP_CP:
D
Dave Airlie 已提交
1437
		return radeon_do_cleanup_cp(dev);
L
Linus Torvalds 已提交
1438 1439
	}

E
Eric Anholt 已提交
1440
	return -EINVAL;
L
Linus Torvalds 已提交
1441 1442
}

1443
int radeon_cp_start(struct drm_device *dev, void *data, struct drm_file *file_priv)
L
Linus Torvalds 已提交
1444 1445
{
	drm_radeon_private_t *dev_priv = dev->dev_private;
D
Dave Airlie 已提交
1446
	DRM_DEBUG("\n");
L
Linus Torvalds 已提交
1447

1448
	LOCK_TEST_WITH_RETURN(dev, file_priv);
L
Linus Torvalds 已提交
1449

D
Dave Airlie 已提交
1450
	if (dev_priv->cp_running) {
1451
		DRM_DEBUG("while CP running\n");
L
Linus Torvalds 已提交
1452 1453
		return 0;
	}
D
Dave Airlie 已提交
1454
	if (dev_priv->cp_mode == RADEON_CSQ_PRIDIS_INDDIS) {
1455 1456
		DRM_DEBUG("called with bogus CP mode (%d)\n",
			  dev_priv->cp_mode);
L
Linus Torvalds 已提交
1457 1458 1459
		return 0;
	}

D
Dave Airlie 已提交
1460
	radeon_do_cp_start(dev_priv);
L
Linus Torvalds 已提交
1461 1462 1463 1464 1465 1466 1467

	return 0;
}

/* Stop the CP.  The engine must have been idled before calling this
 * routine.
 */
1468
int radeon_cp_stop(struct drm_device *dev, void *data, struct drm_file *file_priv)
L
Linus Torvalds 已提交
1469 1470
{
	drm_radeon_private_t *dev_priv = dev->dev_private;
1471
	drm_radeon_cp_stop_t *stop = data;
L
Linus Torvalds 已提交
1472
	int ret;
D
Dave Airlie 已提交
1473
	DRM_DEBUG("\n");
L
Linus Torvalds 已提交
1474

1475
	LOCK_TEST_WITH_RETURN(dev, file_priv);
L
Linus Torvalds 已提交
1476 1477 1478 1479 1480 1481 1482

	if (!dev_priv->cp_running)
		return 0;

	/* Flush any pending CP commands.  This ensures any outstanding
	 * commands are exectuted by the engine before we turn it off.
	 */
1483
	if (stop->flush) {
D
Dave Airlie 已提交
1484
		radeon_do_cp_flush(dev_priv);
L
Linus Torvalds 已提交
1485 1486 1487 1488 1489
	}

	/* If we fail to make the engine go idle, we return an error
	 * code so that the DRM ioctl wrapper can try again.
	 */
1490
	if (stop->idle) {
D
Dave Airlie 已提交
1491 1492 1493
		ret = radeon_do_cp_idle(dev_priv);
		if (ret)
			return ret;
L
Linus Torvalds 已提交
1494 1495 1496 1497 1498 1499
	}

	/* Finally, we can turn off the CP.  If the engine isn't idle,
	 * we will get some dropped triangles as they won't be fully
	 * rendered before the CP is shut down.
	 */
D
Dave Airlie 已提交
1500
	radeon_do_cp_stop(dev_priv);
L
Linus Torvalds 已提交
1501 1502

	/* Reset the engine */
D
Dave Airlie 已提交
1503
	radeon_do_engine_reset(dev);
L
Linus Torvalds 已提交
1504 1505 1506 1507

	return 0;
}

1508
void radeon_do_release(struct drm_device * dev)
L
Linus Torvalds 已提交
1509 1510 1511 1512 1513 1514 1515
{
	drm_radeon_private_t *dev_priv = dev->dev_private;
	int i, ret;

	if (dev_priv) {
		if (dev_priv->cp_running) {
			/* Stop the cp */
D
Dave Airlie 已提交
1516
			while ((ret = radeon_do_cp_idle(dev_priv)) != 0) {
L
Linus Torvalds 已提交
1517 1518 1519 1520 1521 1522 1523
				DRM_DEBUG("radeon_do_cp_idle %d\n", ret);
#ifdef __linux__
				schedule();
#else
				tsleep(&ret, PZERO, "rdnrel", 1);
#endif
			}
D
Dave Airlie 已提交
1524 1525
			radeon_do_cp_stop(dev_priv);
			radeon_do_engine_reset(dev);
L
Linus Torvalds 已提交
1526 1527 1528 1529
		}

		/* Disable *all* interrupts */
		if (dev_priv->mmio)	/* remove this after permanent addmaps */
D
Dave Airlie 已提交
1530
			RADEON_WRITE(RADEON_GEN_INT_CNTL, 0);
L
Linus Torvalds 已提交
1531

D
Dave Airlie 已提交
1532
		if (dev_priv->mmio) {	/* remove all surfaces */
L
Linus Torvalds 已提交
1533
			for (i = 0; i < RADEON_MAX_SURFACES; i++) {
D
Dave Airlie 已提交
1534 1535 1536 1537 1538
				RADEON_WRITE(RADEON_SURFACE0_INFO + 16 * i, 0);
				RADEON_WRITE(RADEON_SURFACE0_LOWER_BOUND +
					     16 * i, 0);
				RADEON_WRITE(RADEON_SURFACE0_UPPER_BOUND +
					     16 * i, 0);
L
Linus Torvalds 已提交
1539 1540 1541 1542
			}
		}

		/* Free memory heap structures */
D
Dave Airlie 已提交
1543 1544
		radeon_mem_takedown(&(dev_priv->gart_heap));
		radeon_mem_takedown(&(dev_priv->fb_heap));
L
Linus Torvalds 已提交
1545 1546

		/* deallocate kernel resources */
D
Dave Airlie 已提交
1547
		radeon_do_cleanup_cp(dev);
L
Linus Torvalds 已提交
1548 1549 1550 1551 1552
	}
}

/* Just reset the CP ring.  Called as part of an X Server engine reset.
 */
1553
int radeon_cp_reset(struct drm_device *dev, void *data, struct drm_file *file_priv)
L
Linus Torvalds 已提交
1554 1555
{
	drm_radeon_private_t *dev_priv = dev->dev_private;
D
Dave Airlie 已提交
1556
	DRM_DEBUG("\n");
L
Linus Torvalds 已提交
1557

1558
	LOCK_TEST_WITH_RETURN(dev, file_priv);
L
Linus Torvalds 已提交
1559

D
Dave Airlie 已提交
1560
	if (!dev_priv) {
1561
		DRM_DEBUG("called before init done\n");
E
Eric Anholt 已提交
1562
		return -EINVAL;
L
Linus Torvalds 已提交
1563 1564
	}

D
Dave Airlie 已提交
1565
	radeon_do_cp_reset(dev_priv);
L
Linus Torvalds 已提交
1566 1567 1568 1569 1570 1571 1572

	/* The CP is no longer running after an engine reset */
	dev_priv->cp_running = 0;

	return 0;
}

1573
int radeon_cp_idle(struct drm_device *dev, void *data, struct drm_file *file_priv)
L
Linus Torvalds 已提交
1574 1575
{
	drm_radeon_private_t *dev_priv = dev->dev_private;
D
Dave Airlie 已提交
1576
	DRM_DEBUG("\n");
L
Linus Torvalds 已提交
1577

1578
	LOCK_TEST_WITH_RETURN(dev, file_priv);
L
Linus Torvalds 已提交
1579

D
Dave Airlie 已提交
1580
	return radeon_do_cp_idle(dev_priv);
L
Linus Torvalds 已提交
1581 1582 1583 1584
}

/* Added by Charl P. Botha to call radeon_do_resume_cp().
 */
1585
int radeon_cp_resume(struct drm_device *dev, void *data, struct drm_file *file_priv)
L
Linus Torvalds 已提交
1586
{
1587
	return radeon_do_resume_cp(dev, file_priv);
L
Linus Torvalds 已提交
1588 1589
}

1590
int radeon_engine_reset(struct drm_device *dev, void *data, struct drm_file *file_priv)
L
Linus Torvalds 已提交
1591
{
D
Dave Airlie 已提交
1592
	DRM_DEBUG("\n");
L
Linus Torvalds 已提交
1593

1594
	LOCK_TEST_WITH_RETURN(dev, file_priv);
L
Linus Torvalds 已提交
1595

D
Dave Airlie 已提交
1596
	return radeon_do_engine_reset(dev);
L
Linus Torvalds 已提交
1597 1598 1599 1600 1601 1602 1603 1604
}

/* ================================================================
 * Fullscreen mode
 */

/* KW: Deprecated to say the least:
 */
1605
int radeon_fullscreen(struct drm_device *dev, void *data, struct drm_file *file_priv)
L
Linus Torvalds 已提交
1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617
{
	return 0;
}

/* ================================================================
 * Freelist management
 */

/* Original comment: FIXME: ROTATE_BUFS is a hack to cycle through
 *   bufs until freelist code is used.  Note this hides a problem with
 *   the scratch register * (used to keep track of last buffer
 *   completed) being written to before * the last buffer has actually
D
Dave Airlie 已提交
1618
 *   completed rendering.
L
Linus Torvalds 已提交
1619 1620 1621 1622 1623 1624
 *
 * KW:  It's also a good way to find free buffers quickly.
 *
 * KW: Ideally this loop wouldn't exist, and freelist_get wouldn't
 * sleep.  However, bugs in older versions of radeon_accel.c mean that
 * we essentially have to do this, else old clients will break.
D
Dave Airlie 已提交
1625
 *
L
Linus Torvalds 已提交
1626 1627
 * However, it does leave open a potential deadlock where all the
 * buffers are held by other clients, which can't release them because
D
Dave Airlie 已提交
1628
 * they can't get the lock.
L
Linus Torvalds 已提交
1629 1630
 */

D
Dave Airlie 已提交
1631
struct drm_buf *radeon_freelist_get(struct drm_device * dev)
L
Linus Torvalds 已提交
1632
{
1633
	struct drm_device_dma *dma = dev->dma;
L
Linus Torvalds 已提交
1634 1635
	drm_radeon_private_t *dev_priv = dev->dev_private;
	drm_radeon_buf_priv_t *buf_priv;
D
Dave Airlie 已提交
1636
	struct drm_buf *buf;
L
Linus Torvalds 已提交
1637 1638 1639
	int i, t;
	int start;

D
Dave Airlie 已提交
1640
	if (++dev_priv->last_buf >= dma->buf_count)
L
Linus Torvalds 已提交
1641 1642 1643 1644
		dev_priv->last_buf = 0;

	start = dev_priv->last_buf;

D
Dave Airlie 已提交
1645
	for (t = 0; t < dev_priv->usec_timeout; t++) {
1646
		u32 done_age = GET_SCRATCH(dev_priv, 1);
D
Dave Airlie 已提交
1647 1648
		DRM_DEBUG("done_age = %d\n", done_age);
		for (i = start; i < dma->buf_count; i++) {
L
Linus Torvalds 已提交
1649 1650
			buf = dma->buflist[i];
			buf_priv = buf->dev_private;
1651 1652 1653
			if (buf->file_priv == NULL || (buf->pending &&
						       buf_priv->age <=
						       done_age)) {
L
Linus Torvalds 已提交
1654 1655 1656 1657 1658 1659 1660 1661
				dev_priv->stats.requested_bufs++;
				buf->pending = 0;
				return buf;
			}
			start = 0;
		}

		if (t) {
D
Dave Airlie 已提交
1662
			DRM_UDELAY(1);
L
Linus Torvalds 已提交
1663 1664 1665 1666
			dev_priv->stats.freelist_loops++;
		}
	}

D
Dave Airlie 已提交
1667
	DRM_DEBUG("returning NULL!\n");
L
Linus Torvalds 已提交
1668 1669
	return NULL;
}
D
Dave Airlie 已提交
1670

L
Linus Torvalds 已提交
1671
#if 0
D
Dave Airlie 已提交
1672
struct drm_buf *radeon_freelist_get(struct drm_device * dev)
L
Linus Torvalds 已提交
1673
{
1674
	struct drm_device_dma *dma = dev->dma;
L
Linus Torvalds 已提交
1675 1676
	drm_radeon_private_t *dev_priv = dev->dev_private;
	drm_radeon_buf_priv_t *buf_priv;
D
Dave Airlie 已提交
1677
	struct drm_buf *buf;
L
Linus Torvalds 已提交
1678 1679
	int i, t;
	int start;
1680
	u32 done_age;
L
Linus Torvalds 已提交
1681

1682
	done_age = radeon_read_ring_rptr(dev_priv, RADEON_SCRATCHOFF(1));
D
Dave Airlie 已提交
1683
	if (++dev_priv->last_buf >= dma->buf_count)
L
Linus Torvalds 已提交
1684 1685 1686 1687
		dev_priv->last_buf = 0;

	start = dev_priv->last_buf;
	dev_priv->stats.freelist_loops++;
D
Dave Airlie 已提交
1688 1689 1690

	for (t = 0; t < 2; t++) {
		for (i = start; i < dma->buf_count; i++) {
L
Linus Torvalds 已提交
1691 1692
			buf = dma->buflist[i];
			buf_priv = buf->dev_private;
1693 1694 1695
			if (buf->file_priv == 0 || (buf->pending &&
						    buf_priv->age <=
						    done_age)) {
L
Linus Torvalds 已提交
1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707
				dev_priv->stats.requested_bufs++;
				buf->pending = 0;
				return buf;
			}
		}
		start = 0;
	}

	return NULL;
}
#endif

1708
void radeon_freelist_reset(struct drm_device * dev)
L
Linus Torvalds 已提交
1709
{
1710
	struct drm_device_dma *dma = dev->dma;
L
Linus Torvalds 已提交
1711 1712 1713 1714
	drm_radeon_private_t *dev_priv = dev->dev_private;
	int i;

	dev_priv->last_buf = 0;
D
Dave Airlie 已提交
1715
	for (i = 0; i < dma->buf_count; i++) {
D
Dave Airlie 已提交
1716
		struct drm_buf *buf = dma->buflist[i];
L
Linus Torvalds 已提交
1717 1718 1719 1720 1721 1722 1723 1724 1725
		drm_radeon_buf_priv_t *buf_priv = buf->dev_private;
		buf_priv->age = 0;
	}
}

/* ================================================================
 * CP command submission
 */

D
Dave Airlie 已提交
1726
int radeon_wait_ring(drm_radeon_private_t * dev_priv, int n)
L
Linus Torvalds 已提交
1727 1728 1729
{
	drm_radeon_ring_buffer_t *ring = &dev_priv->ring;
	int i;
D
Dave Airlie 已提交
1730
	u32 last_head = GET_RING_HEAD(dev_priv);
L
Linus Torvalds 已提交
1731

D
Dave Airlie 已提交
1732 1733
	for (i = 0; i < dev_priv->usec_timeout; i++) {
		u32 head = GET_RING_HEAD(dev_priv);
L
Linus Torvalds 已提交
1734 1735

		ring->space = (head - ring->tail) * sizeof(u32);
D
Dave Airlie 已提交
1736
		if (ring->space <= 0)
L
Linus Torvalds 已提交
1737
			ring->space += ring->size;
D
Dave Airlie 已提交
1738
		if (ring->space > n)
L
Linus Torvalds 已提交
1739
			return 0;
D
Dave Airlie 已提交
1740

L
Linus Torvalds 已提交
1741 1742 1743 1744 1745 1746
		dev_priv->stats.boxes |= RADEON_BOX_WAIT_IDLE;

		if (head != last_head)
			i = 0;
		last_head = head;

D
Dave Airlie 已提交
1747
		DRM_UDELAY(1);
L
Linus Torvalds 已提交
1748 1749 1750 1751
	}

	/* FIXME: This return value is ignored in the BEGIN_RING macro! */
#if RADEON_FIFO_DEBUG
D
Dave Airlie 已提交
1752 1753
	radeon_status(dev_priv);
	DRM_ERROR("failed!\n");
L
Linus Torvalds 已提交
1754
#endif
E
Eric Anholt 已提交
1755
	return -EBUSY;
L
Linus Torvalds 已提交
1756 1757
}

1758 1759
static int radeon_cp_get_buffers(struct drm_device *dev,
				 struct drm_file *file_priv,
1760
				 struct drm_dma * d)
L
Linus Torvalds 已提交
1761 1762
{
	int i;
D
Dave Airlie 已提交
1763
	struct drm_buf *buf;
L
Linus Torvalds 已提交
1764

D
Dave Airlie 已提交
1765 1766 1767
	for (i = d->granted_count; i < d->request_count; i++) {
		buf = radeon_freelist_get(dev);
		if (!buf)
E
Eric Anholt 已提交
1768
			return -EBUSY;	/* NOTE: broken client */
L
Linus Torvalds 已提交
1769

1770
		buf->file_priv = file_priv;
L
Linus Torvalds 已提交
1771

D
Dave Airlie 已提交
1772 1773
		if (DRM_COPY_TO_USER(&d->request_indices[i], &buf->idx,
				     sizeof(buf->idx)))
E
Eric Anholt 已提交
1774
			return -EFAULT;
D
Dave Airlie 已提交
1775 1776
		if (DRM_COPY_TO_USER(&d->request_sizes[i], &buf->total,
				     sizeof(buf->total)))
E
Eric Anholt 已提交
1777
			return -EFAULT;
L
Linus Torvalds 已提交
1778 1779 1780 1781 1782 1783

		d->granted_count++;
	}
	return 0;
}

1784
int radeon_cp_buffers(struct drm_device *dev, void *data, struct drm_file *file_priv)
L
Linus Torvalds 已提交
1785
{
1786
	struct drm_device_dma *dma = dev->dma;
L
Linus Torvalds 已提交
1787
	int ret = 0;
1788
	struct drm_dma *d = data;
L
Linus Torvalds 已提交
1789

1790
	LOCK_TEST_WITH_RETURN(dev, file_priv);
L
Linus Torvalds 已提交
1791 1792 1793

	/* Please don't send us buffers.
	 */
1794
	if (d->send_count != 0) {
D
Dave Airlie 已提交
1795
		DRM_ERROR("Process %d trying to send %d buffers via drmDMA\n",
1796
			  DRM_CURRENTPID, d->send_count);
E
Eric Anholt 已提交
1797
		return -EINVAL;
L
Linus Torvalds 已提交
1798 1799 1800 1801
	}

	/* We'll send you buffers.
	 */
1802
	if (d->request_count < 0 || d->request_count > dma->buf_count) {
D
Dave Airlie 已提交
1803
		DRM_ERROR("Process %d trying to get %d buffers (of %d max)\n",
1804
			  DRM_CURRENTPID, d->request_count, dma->buf_count);
E
Eric Anholt 已提交
1805
		return -EINVAL;
L
Linus Torvalds 已提交
1806 1807
	}

1808
	d->granted_count = 0;
L
Linus Torvalds 已提交
1809

1810 1811
	if (d->request_count) {
		ret = radeon_cp_get_buffers(dev, file_priv, d);
L
Linus Torvalds 已提交
1812 1813 1814 1815 1816
	}

	return ret;
}

1817
int radeon_driver_load(struct drm_device *dev, unsigned long flags)
L
Linus Torvalds 已提交
1818 1819 1820 1821 1822 1823
{
	drm_radeon_private_t *dev_priv;
	int ret = 0;

	dev_priv = drm_alloc(sizeof(drm_radeon_private_t), DRM_MEM_DRIVER);
	if (dev_priv == NULL)
E
Eric Anholt 已提交
1824
		return -ENOMEM;
L
Linus Torvalds 已提交
1825 1826 1827 1828 1829

	memset(dev_priv, 0, sizeof(drm_radeon_private_t));
	dev->dev_private = (void *)dev_priv;
	dev_priv->flags = flags;

1830
	switch (flags & RADEON_FAMILY_MASK) {
L
Linus Torvalds 已提交
1831 1832 1833 1834
	case CHIP_R100:
	case CHIP_RV200:
	case CHIP_R200:
	case CHIP_R300:
1835
	case CHIP_R350:
D
Dave Airlie 已提交
1836
	case CHIP_R420:
1837
	case CHIP_R423:
1838
	case CHIP_RV410:
D
Dave Airlie 已提交
1839 1840 1841 1842
	case CHIP_RV515:
	case CHIP_R520:
	case CHIP_RV570:
	case CHIP_R580:
1843
		dev_priv->flags |= RADEON_HAS_HIERZ;
L
Linus Torvalds 已提交
1844 1845
		break;
	default:
D
Dave Airlie 已提交
1846
		/* all other chips have no hierarchical z buffer */
L
Linus Torvalds 已提交
1847 1848
		break;
	}
D
Dave Airlie 已提交
1849 1850

	if (drm_device_is_agp(dev))
1851
		dev_priv->flags |= RADEON_IS_AGP;
1852
	else if (drm_device_is_pcie(dev))
1853
		dev_priv->flags |= RADEON_IS_PCIE;
1854
	else
1855
		dev_priv->flags |= RADEON_IS_PCI;
1856

1857 1858 1859 1860 1861 1862
	ret = drm_addmap(dev, drm_get_resource_start(dev, 2),
			 drm_get_resource_len(dev, 2), _DRM_REGISTERS,
			 _DRM_READ_ONLY | _DRM_DRIVER, &dev_priv->mmio);
	if (ret != 0)
		return ret;

1863 1864 1865 1866 1867 1868
	ret = drm_vblank_init(dev, 2);
	if (ret) {
		radeon_driver_unload(dev);
		return ret;
	}

D
Dave Airlie 已提交
1869
	DRM_DEBUG("%s card detected\n",
1870
		  ((dev_priv->flags & RADEON_IS_AGP) ? "AGP" : (((dev_priv->flags & RADEON_IS_PCIE) ? "PCIE" : "PCI"))));
L
Linus Torvalds 已提交
1871 1872 1873
	return ret;
}

1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884
int radeon_master_create(struct drm_device *dev, struct drm_master *master)
{
	struct drm_radeon_master_private *master_priv;
	unsigned long sareapage;
	int ret;

	master_priv = drm_calloc(1, sizeof(*master_priv), DRM_MEM_DRIVER);
	if (!master_priv)
		return -ENOMEM;

	/* prebuild the SAREA */
1885
	sareapage = max_t(unsigned long, SAREA_MAX, PAGE_SIZE);
1886 1887 1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911
	ret = drm_addmap(dev, 0, sareapage, _DRM_SHM, _DRM_CONTAINS_LOCK|_DRM_DRIVER,
			 &master_priv->sarea);
	if (ret) {
		DRM_ERROR("SAREA setup failed\n");
		return ret;
	}
	master_priv->sarea_priv = master_priv->sarea->handle + sizeof(struct drm_sarea);
	master_priv->sarea_priv->pfCurrentPage = 0;

	master->driver_priv = master_priv;
	return 0;
}

void radeon_master_destroy(struct drm_device *dev, struct drm_master *master)
{
	struct drm_radeon_master_private *master_priv = master->driver_priv;

	if (!master_priv)
		return;

	if (master_priv->sarea_priv &&
	    master_priv->sarea_priv->pfCurrentPage != 0)
		radeon_cp_dispatch_flip(dev, master);

	master_priv->sarea_priv = NULL;
	if (master_priv->sarea)
1912
		drm_rmmap_locked(dev, master_priv->sarea);
1913 1914 1915 1916 1917 1918

	drm_free(master_priv, sizeof(*master_priv), DRM_MEM_DRIVER);

	master->driver_priv = NULL;
}

1919 1920 1921 1922
/* Create mappings for registers and framebuffer so userland doesn't necessarily
 * have to find them.
 */
int radeon_driver_firstopen(struct drm_device *dev)
D
Dave Airlie 已提交
1923 1924 1925 1926 1927
{
	int ret;
	drm_local_map_t *map;
	drm_radeon_private_t *dev_priv = dev->dev_private;

1928 1929
	dev_priv->gart_info.table_size = RADEON_PCIGART_TABLE_SIZE;

1930 1931
	dev_priv->fb_aper_offset = drm_get_resource_start(dev, 0);
	ret = drm_addmap(dev, dev_priv->fb_aper_offset,
D
Dave Airlie 已提交
1932 1933 1934 1935 1936 1937 1938 1939
			 drm_get_resource_len(dev, 0), _DRM_FRAME_BUFFER,
			 _DRM_WRITE_COMBINING, &map);
	if (ret != 0)
		return ret;

	return 0;
}

1940
int radeon_driver_unload(struct drm_device *dev)
L
Linus Torvalds 已提交
1941 1942 1943 1944
{
	drm_radeon_private_t *dev_priv = dev->dev_private;

	DRM_DEBUG("\n");
1945 1946 1947

	drm_rmmap(dev, dev_priv->mmio);

L
Linus Torvalds 已提交
1948 1949 1950 1951 1952
	drm_free(dev_priv, sizeof(*dev_priv), DRM_MEM_DRIVER);

	dev->dev_private = NULL;
	return 0;
}