Linux Audio

Check our new training course

Loading...
v5.9
  1/* r128_cce.c -- ATI Rage 128 driver -*- linux-c -*-
  2 * Created: Wed Apr  5 19:24:19 2000 by kevin@precisioninsight.com
  3 */
  4/*
  5 * Copyright 2000 Precision Insight, Inc., Cedar Park, Texas.
  6 * Copyright 2000 VA Linux Systems, Inc., Sunnyvale, California.
  7 * All Rights Reserved.
  8 *
  9 * Permission is hereby granted, free of charge, to any person obtaining a
 10 * copy of this software and associated documentation files (the "Software"),
 11 * to deal in the Software without restriction, including without limitation
 12 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 13 * and/or sell copies of the Software, and to permit persons to whom the
 14 * Software is furnished to do so, subject to the following conditions:
 15 *
 16 * The above copyright notice and this permission notice (including the next
 17 * paragraph) shall be included in all copies or substantial portions of the
 18 * Software.
 19 *
 20 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 21 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 22 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 23 * PRECISION INSIGHT AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
 24 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
 25 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
 26 * DEALINGS IN THE SOFTWARE.
 27 *
 28 * Authors:
 29 *    Gareth Hughes <gareth@valinux.com>
 30 */
 31
 32#include <linux/delay.h>
 33#include <linux/dma-mapping.h>
 34#include <linux/firmware.h>
 35#include <linux/module.h>
 36#include <linux/platform_device.h>
 37#include <linux/slab.h>
 38#include <linux/uaccess.h>
 39
 40#include <drm/drm_agpsupport.h>
 41#include <drm/drm_device.h>
 42#include <drm/drm_file.h>
 43#include <drm/drm_irq.h>
 44#include <drm/drm_print.h>
 45#include <drm/r128_drm.h>
 46
 
 
 
 47#include "r128_drv.h"
 48
 49#define R128_FIFO_DEBUG		0
 50
 51#define FIRMWARE_NAME		"r128/r128_cce.bin"
 52
 53MODULE_FIRMWARE(FIRMWARE_NAME);
 54
 55static int R128_READ_PLL(struct drm_device *dev, int addr)
 56{
 57	drm_r128_private_t *dev_priv = dev->dev_private;
 58
 59	R128_WRITE8(R128_CLOCK_CNTL_INDEX, addr & 0x1f);
 60	return R128_READ(R128_CLOCK_CNTL_DATA);
 61}
 62
 63#if R128_FIFO_DEBUG
 64static void r128_status(drm_r128_private_t *dev_priv)
 65{
 66	printk("GUI_STAT           = 0x%08x\n",
 67	       (unsigned int)R128_READ(R128_GUI_STAT));
 68	printk("PM4_STAT           = 0x%08x\n",
 69	       (unsigned int)R128_READ(R128_PM4_STAT));
 70	printk("PM4_BUFFER_DL_WPTR = 0x%08x\n",
 71	       (unsigned int)R128_READ(R128_PM4_BUFFER_DL_WPTR));
 72	printk("PM4_BUFFER_DL_RPTR = 0x%08x\n",
 73	       (unsigned int)R128_READ(R128_PM4_BUFFER_DL_RPTR));
 74	printk("PM4_MICRO_CNTL     = 0x%08x\n",
 75	       (unsigned int)R128_READ(R128_PM4_MICRO_CNTL));
 76	printk("PM4_BUFFER_CNTL    = 0x%08x\n",
 77	       (unsigned int)R128_READ(R128_PM4_BUFFER_CNTL));
 78}
 79#endif
 80
 81/* ================================================================
 82 * Engine, FIFO control
 83 */
 84
 85static int r128_do_pixcache_flush(drm_r128_private_t *dev_priv)
 86{
 87	u32 tmp;
 88	int i;
 89
 90	tmp = R128_READ(R128_PC_NGUI_CTLSTAT) | R128_PC_FLUSH_ALL;
 91	R128_WRITE(R128_PC_NGUI_CTLSTAT, tmp);
 92
 93	for (i = 0; i < dev_priv->usec_timeout; i++) {
 94		if (!(R128_READ(R128_PC_NGUI_CTLSTAT) & R128_PC_BUSY))
 95			return 0;
 96		udelay(1);
 97	}
 98
 99#if R128_FIFO_DEBUG
100	DRM_ERROR("failed!\n");
101#endif
102	return -EBUSY;
103}
104
105static int r128_do_wait_for_fifo(drm_r128_private_t *dev_priv, int entries)
106{
107	int i;
108
109	for (i = 0; i < dev_priv->usec_timeout; i++) {
110		int slots = R128_READ(R128_GUI_STAT) & R128_GUI_FIFOCNT_MASK;
111		if (slots >= entries)
112			return 0;
113		udelay(1);
114	}
115
116#if R128_FIFO_DEBUG
117	DRM_ERROR("failed!\n");
118#endif
119	return -EBUSY;
120}
121
122static int r128_do_wait_for_idle(drm_r128_private_t *dev_priv)
123{
124	int i, ret;
125
126	ret = r128_do_wait_for_fifo(dev_priv, 64);
127	if (ret)
128		return ret;
129
130	for (i = 0; i < dev_priv->usec_timeout; i++) {
131		if (!(R128_READ(R128_GUI_STAT) & R128_GUI_ACTIVE)) {
132			r128_do_pixcache_flush(dev_priv);
133			return 0;
134		}
135		udelay(1);
136	}
137
138#if R128_FIFO_DEBUG
139	DRM_ERROR("failed!\n");
140#endif
141	return -EBUSY;
142}
143
144/* ================================================================
145 * CCE control, initialization
146 */
147
148/* Load the microcode for the CCE */
149static int r128_cce_load_microcode(drm_r128_private_t *dev_priv)
150{
151	struct platform_device *pdev;
152	const struct firmware *fw;
153	const __be32 *fw_data;
154	int rc, i;
155
156	DRM_DEBUG("\n");
157
158	pdev = platform_device_register_simple("r128_cce", 0, NULL, 0);
159	if (IS_ERR(pdev)) {
160		pr_err("r128_cce: Failed to register firmware\n");
161		return PTR_ERR(pdev);
162	}
163	rc = request_firmware(&fw, FIRMWARE_NAME, &pdev->dev);
164	platform_device_unregister(pdev);
165	if (rc) {
166		pr_err("r128_cce: Failed to load firmware \"%s\"\n",
167		       FIRMWARE_NAME);
168		return rc;
169	}
170
171	if (fw->size != 256 * 8) {
172		pr_err("r128_cce: Bogus length %zu in firmware \"%s\"\n",
 
173		       fw->size, FIRMWARE_NAME);
174		rc = -EINVAL;
175		goto out_release;
176	}
177
178	r128_do_wait_for_idle(dev_priv);
179
180	fw_data = (const __be32 *)fw->data;
181	R128_WRITE(R128_PM4_MICROCODE_ADDR, 0);
182	for (i = 0; i < 256; i++) {
183		R128_WRITE(R128_PM4_MICROCODE_DATAH,
184			   be32_to_cpup(&fw_data[i * 2]));
185		R128_WRITE(R128_PM4_MICROCODE_DATAL,
186			   be32_to_cpup(&fw_data[i * 2 + 1]));
187	}
188
189out_release:
190	release_firmware(fw);
191	return rc;
192}
193
194/* Flush any pending commands to the CCE.  This should only be used just
195 * prior to a wait for idle, as it informs the engine that the command
196 * stream is ending.
197 */
198static void r128_do_cce_flush(drm_r128_private_t *dev_priv)
199{
200	u32 tmp;
201
202	tmp = R128_READ(R128_PM4_BUFFER_DL_WPTR) | R128_PM4_BUFFER_DL_DONE;
203	R128_WRITE(R128_PM4_BUFFER_DL_WPTR, tmp);
204}
205
206/* Wait for the CCE to go idle.
207 */
208int r128_do_cce_idle(drm_r128_private_t *dev_priv)
209{
210	int i;
211
212	for (i = 0; i < dev_priv->usec_timeout; i++) {
213		if (GET_RING_HEAD(dev_priv) == dev_priv->ring.tail) {
214			int pm4stat = R128_READ(R128_PM4_STAT);
215			if (((pm4stat & R128_PM4_FIFOCNT_MASK) >=
216			     dev_priv->cce_fifo_size) &&
217			    !(pm4stat & (R128_PM4_BUSY |
218					 R128_PM4_GUI_ACTIVE))) {
219				return r128_do_pixcache_flush(dev_priv);
220			}
221		}
222		udelay(1);
223	}
224
225#if R128_FIFO_DEBUG
226	DRM_ERROR("failed!\n");
227	r128_status(dev_priv);
228#endif
229	return -EBUSY;
230}
231
232/* Start the Concurrent Command Engine.
233 */
234static void r128_do_cce_start(drm_r128_private_t *dev_priv)
235{
236	r128_do_wait_for_idle(dev_priv);
237
238	R128_WRITE(R128_PM4_BUFFER_CNTL,
239		   dev_priv->cce_mode | dev_priv->ring.size_l2qw
240		   | R128_PM4_BUFFER_CNTL_NOUPDATE);
241	R128_READ(R128_PM4_BUFFER_ADDR);	/* as per the sample code */
242	R128_WRITE(R128_PM4_MICRO_CNTL, R128_PM4_MICRO_FREERUN);
243
244	dev_priv->cce_running = 1;
245}
246
247/* Reset the Concurrent Command Engine.  This will not flush any pending
248 * commands, so you must wait for the CCE command stream to complete
249 * before calling this routine.
250 */
251static void r128_do_cce_reset(drm_r128_private_t *dev_priv)
252{
253	R128_WRITE(R128_PM4_BUFFER_DL_WPTR, 0);
254	R128_WRITE(R128_PM4_BUFFER_DL_RPTR, 0);
255	dev_priv->ring.tail = 0;
256}
257
258/* Stop the Concurrent Command Engine.  This will not flush any pending
259 * commands, so you must flush the command stream and wait for the CCE
260 * to go idle before calling this routine.
261 */
262static void r128_do_cce_stop(drm_r128_private_t *dev_priv)
263{
264	R128_WRITE(R128_PM4_MICRO_CNTL, 0);
265	R128_WRITE(R128_PM4_BUFFER_CNTL,
266		   R128_PM4_NONPM4 | R128_PM4_BUFFER_CNTL_NOUPDATE);
267
268	dev_priv->cce_running = 0;
269}
270
271/* Reset the engine.  This will stop the CCE if it is running.
272 */
273static int r128_do_engine_reset(struct drm_device *dev)
274{
275	drm_r128_private_t *dev_priv = dev->dev_private;
276	u32 clock_cntl_index, mclk_cntl, gen_reset_cntl;
277
278	r128_do_pixcache_flush(dev_priv);
279
280	clock_cntl_index = R128_READ(R128_CLOCK_CNTL_INDEX);
281	mclk_cntl = R128_READ_PLL(dev, R128_MCLK_CNTL);
282
283	R128_WRITE_PLL(R128_MCLK_CNTL,
284		       mclk_cntl | R128_FORCE_GCP | R128_FORCE_PIPE3D_CP);
285
286	gen_reset_cntl = R128_READ(R128_GEN_RESET_CNTL);
287
288	/* Taken from the sample code - do not change */
289	R128_WRITE(R128_GEN_RESET_CNTL, gen_reset_cntl | R128_SOFT_RESET_GUI);
290	R128_READ(R128_GEN_RESET_CNTL);
291	R128_WRITE(R128_GEN_RESET_CNTL, gen_reset_cntl & ~R128_SOFT_RESET_GUI);
292	R128_READ(R128_GEN_RESET_CNTL);
293
294	R128_WRITE_PLL(R128_MCLK_CNTL, mclk_cntl);
295	R128_WRITE(R128_CLOCK_CNTL_INDEX, clock_cntl_index);
296	R128_WRITE(R128_GEN_RESET_CNTL, gen_reset_cntl);
297
298	/* Reset the CCE ring */
299	r128_do_cce_reset(dev_priv);
300
301	/* The CCE is no longer running after an engine reset */
302	dev_priv->cce_running = 0;
303
304	/* Reset any pending vertex, indirect buffers */
305	r128_freelist_reset(dev);
306
307	return 0;
308}
309
310static void r128_cce_init_ring_buffer(struct drm_device *dev,
311				      drm_r128_private_t *dev_priv)
312{
313	u32 ring_start;
314	u32 tmp;
315
316	DRM_DEBUG("\n");
317
318	/* The manual (p. 2) says this address is in "VM space".  This
319	 * means it's an offset from the start of AGP space.
320	 */
321#if IS_ENABLED(CONFIG_AGP)
322	if (!dev_priv->is_pci)
323		ring_start = dev_priv->cce_ring->offset - dev->agp->base;
324	else
325#endif
326		ring_start = dev_priv->cce_ring->offset -
327		    (unsigned long)dev->sg->virtual;
328
329	R128_WRITE(R128_PM4_BUFFER_OFFSET, ring_start | R128_AGP_OFFSET);
330
331	R128_WRITE(R128_PM4_BUFFER_DL_WPTR, 0);
332	R128_WRITE(R128_PM4_BUFFER_DL_RPTR, 0);
333
334	/* Set watermark control */
335	R128_WRITE(R128_PM4_BUFFER_WM_CNTL,
336		   ((R128_WATERMARK_L / 4) << R128_WMA_SHIFT)
337		   | ((R128_WATERMARK_M / 4) << R128_WMB_SHIFT)
338		   | ((R128_WATERMARK_N / 4) << R128_WMC_SHIFT)
339		   | ((R128_WATERMARK_K / 64) << R128_WB_WM_SHIFT));
340
341	/* Force read.  Why?  Because it's in the examples... */
342	R128_READ(R128_PM4_BUFFER_ADDR);
343
344	/* Turn on bus mastering */
345	tmp = R128_READ(R128_BUS_CNTL) & ~R128_BUS_MASTER_DIS;
346	R128_WRITE(R128_BUS_CNTL, tmp);
347}
348
349static int r128_do_init_cce(struct drm_device *dev, drm_r128_init_t *init)
350{
351	drm_r128_private_t *dev_priv;
352	int rc;
353
354	DRM_DEBUG("\n");
355
356	if (dev->dev_private) {
357		DRM_DEBUG("called when already initialized\n");
358		return -EINVAL;
359	}
360
361	dev_priv = kzalloc(sizeof(drm_r128_private_t), GFP_KERNEL);
362	if (dev_priv == NULL)
363		return -ENOMEM;
364
365	dev_priv->is_pci = init->is_pci;
366
367	if (dev_priv->is_pci && !dev->sg) {
368		DRM_ERROR("PCI GART memory not allocated!\n");
369		dev->dev_private = (void *)dev_priv;
370		r128_do_cleanup_cce(dev);
371		return -EINVAL;
372	}
373
374	dev_priv->usec_timeout = init->usec_timeout;
375	if (dev_priv->usec_timeout < 1 ||
376	    dev_priv->usec_timeout > R128_MAX_USEC_TIMEOUT) {
377		DRM_DEBUG("TIMEOUT problem!\n");
378		dev->dev_private = (void *)dev_priv;
379		r128_do_cleanup_cce(dev);
380		return -EINVAL;
381	}
382
383	dev_priv->cce_mode = init->cce_mode;
384
385	/* GH: Simple idle check.
386	 */
387	atomic_set(&dev_priv->idle_count, 0);
388
389	/* We don't support anything other than bus-mastering ring mode,
390	 * but the ring can be in either AGP or PCI space for the ring
391	 * read pointer.
392	 */
393	if ((init->cce_mode != R128_PM4_192BM) &&
394	    (init->cce_mode != R128_PM4_128BM_64INDBM) &&
395	    (init->cce_mode != R128_PM4_64BM_128INDBM) &&
396	    (init->cce_mode != R128_PM4_64BM_64VCBM_64INDBM)) {
397		DRM_DEBUG("Bad cce_mode!\n");
398		dev->dev_private = (void *)dev_priv;
399		r128_do_cleanup_cce(dev);
400		return -EINVAL;
401	}
402
403	switch (init->cce_mode) {
404	case R128_PM4_NONPM4:
405		dev_priv->cce_fifo_size = 0;
406		break;
407	case R128_PM4_192PIO:
408	case R128_PM4_192BM:
409		dev_priv->cce_fifo_size = 192;
410		break;
411	case R128_PM4_128PIO_64INDBM:
412	case R128_PM4_128BM_64INDBM:
413		dev_priv->cce_fifo_size = 128;
414		break;
415	case R128_PM4_64PIO_128INDBM:
416	case R128_PM4_64BM_128INDBM:
417	case R128_PM4_64PIO_64VCBM_64INDBM:
418	case R128_PM4_64BM_64VCBM_64INDBM:
419	case R128_PM4_64PIO_64VCPIO_64INDPIO:
420		dev_priv->cce_fifo_size = 64;
421		break;
422	}
423
424	switch (init->fb_bpp) {
425	case 16:
426		dev_priv->color_fmt = R128_DATATYPE_RGB565;
427		break;
428	case 32:
429	default:
430		dev_priv->color_fmt = R128_DATATYPE_ARGB8888;
431		break;
432	}
433	dev_priv->front_offset = init->front_offset;
434	dev_priv->front_pitch = init->front_pitch;
435	dev_priv->back_offset = init->back_offset;
436	dev_priv->back_pitch = init->back_pitch;
437
438	switch (init->depth_bpp) {
439	case 16:
440		dev_priv->depth_fmt = R128_DATATYPE_RGB565;
441		break;
442	case 24:
443	case 32:
444	default:
445		dev_priv->depth_fmt = R128_DATATYPE_ARGB8888;
446		break;
447	}
448	dev_priv->depth_offset = init->depth_offset;
449	dev_priv->depth_pitch = init->depth_pitch;
450	dev_priv->span_offset = init->span_offset;
451
452	dev_priv->front_pitch_offset_c = (((dev_priv->front_pitch / 8) << 21) |
453					  (dev_priv->front_offset >> 5));
454	dev_priv->back_pitch_offset_c = (((dev_priv->back_pitch / 8) << 21) |
455					 (dev_priv->back_offset >> 5));
456	dev_priv->depth_pitch_offset_c = (((dev_priv->depth_pitch / 8) << 21) |
457					  (dev_priv->depth_offset >> 5) |
458					  R128_DST_TILE);
459	dev_priv->span_pitch_offset_c = (((dev_priv->depth_pitch / 8) << 21) |
460					 (dev_priv->span_offset >> 5));
461
462	dev_priv->sarea = drm_legacy_getsarea(dev);
463	if (!dev_priv->sarea) {
464		DRM_ERROR("could not find sarea!\n");
465		dev->dev_private = (void *)dev_priv;
466		r128_do_cleanup_cce(dev);
467		return -EINVAL;
468	}
469
470	dev_priv->mmio = drm_legacy_findmap(dev, init->mmio_offset);
471	if (!dev_priv->mmio) {
472		DRM_ERROR("could not find mmio region!\n");
473		dev->dev_private = (void *)dev_priv;
474		r128_do_cleanup_cce(dev);
475		return -EINVAL;
476	}
477	dev_priv->cce_ring = drm_legacy_findmap(dev, init->ring_offset);
478	if (!dev_priv->cce_ring) {
479		DRM_ERROR("could not find cce ring region!\n");
480		dev->dev_private = (void *)dev_priv;
481		r128_do_cleanup_cce(dev);
482		return -EINVAL;
483	}
484	dev_priv->ring_rptr = drm_legacy_findmap(dev, init->ring_rptr_offset);
485	if (!dev_priv->ring_rptr) {
486		DRM_ERROR("could not find ring read pointer!\n");
487		dev->dev_private = (void *)dev_priv;
488		r128_do_cleanup_cce(dev);
489		return -EINVAL;
490	}
491	dev->agp_buffer_token = init->buffers_offset;
492	dev->agp_buffer_map = drm_legacy_findmap(dev, init->buffers_offset);
493	if (!dev->agp_buffer_map) {
494		DRM_ERROR("could not find dma buffer region!\n");
495		dev->dev_private = (void *)dev_priv;
496		r128_do_cleanup_cce(dev);
497		return -EINVAL;
498	}
499
500	if (!dev_priv->is_pci) {
501		dev_priv->agp_textures =
502		    drm_legacy_findmap(dev, init->agp_textures_offset);
503		if (!dev_priv->agp_textures) {
504			DRM_ERROR("could not find agp texture region!\n");
505			dev->dev_private = (void *)dev_priv;
506			r128_do_cleanup_cce(dev);
507			return -EINVAL;
508		}
509	}
510
511	dev_priv->sarea_priv =
512	    (drm_r128_sarea_t *) ((u8 *) dev_priv->sarea->handle +
513				  init->sarea_priv_offset);
514
515#if IS_ENABLED(CONFIG_AGP)
516	if (!dev_priv->is_pci) {
517		drm_legacy_ioremap_wc(dev_priv->cce_ring, dev);
518		drm_legacy_ioremap_wc(dev_priv->ring_rptr, dev);
519		drm_legacy_ioremap_wc(dev->agp_buffer_map, dev);
520		if (!dev_priv->cce_ring->handle ||
521		    !dev_priv->ring_rptr->handle ||
522		    !dev->agp_buffer_map->handle) {
523			DRM_ERROR("Could not ioremap agp regions!\n");
524			dev->dev_private = (void *)dev_priv;
525			r128_do_cleanup_cce(dev);
526			return -ENOMEM;
527		}
528	} else
529#endif
530	{
531		dev_priv->cce_ring->handle =
532			(void *)(unsigned long)dev_priv->cce_ring->offset;
533		dev_priv->ring_rptr->handle =
534			(void *)(unsigned long)dev_priv->ring_rptr->offset;
535		dev->agp_buffer_map->handle =
536			(void *)(unsigned long)dev->agp_buffer_map->offset;
537	}
538
539#if IS_ENABLED(CONFIG_AGP)
540	if (!dev_priv->is_pci)
541		dev_priv->cce_buffers_offset = dev->agp->base;
542	else
543#endif
544		dev_priv->cce_buffers_offset = (unsigned long)dev->sg->virtual;
545
546	dev_priv->ring.start = (u32 *) dev_priv->cce_ring->handle;
547	dev_priv->ring.end = ((u32 *) dev_priv->cce_ring->handle
548			      + init->ring_size / sizeof(u32));
549	dev_priv->ring.size = init->ring_size;
550	dev_priv->ring.size_l2qw = order_base_2(init->ring_size / 8);
551
552	dev_priv->ring.tail_mask = (dev_priv->ring.size / sizeof(u32)) - 1;
553
554	dev_priv->ring.high_mark = 128;
555
556	dev_priv->sarea_priv->last_frame = 0;
557	R128_WRITE(R128_LAST_FRAME_REG, dev_priv->sarea_priv->last_frame);
558
559	dev_priv->sarea_priv->last_dispatch = 0;
560	R128_WRITE(R128_LAST_DISPATCH_REG, dev_priv->sarea_priv->last_dispatch);
561
562#if IS_ENABLED(CONFIG_AGP)
563	if (dev_priv->is_pci) {
564#endif
565		dev_priv->gart_info.table_mask = DMA_BIT_MASK(32);
566		dev_priv->gart_info.gart_table_location = DRM_ATI_GART_MAIN;
567		dev_priv->gart_info.table_size = R128_PCIGART_TABLE_SIZE;
568		dev_priv->gart_info.addr = NULL;
569		dev_priv->gart_info.bus_addr = 0;
570		dev_priv->gart_info.gart_reg_if = DRM_ATI_GART_PCI;
571		rc = drm_ati_pcigart_init(dev, &dev_priv->gart_info);
572		if (rc) {
573			DRM_ERROR("failed to init PCI GART!\n");
574			dev->dev_private = (void *)dev_priv;
575			r128_do_cleanup_cce(dev);
576			return rc;
577		}
578		R128_WRITE(R128_PCI_GART_PAGE, dev_priv->gart_info.bus_addr);
579#if IS_ENABLED(CONFIG_AGP)
580	}
581#endif
582
583	r128_cce_init_ring_buffer(dev, dev_priv);
584	rc = r128_cce_load_microcode(dev_priv);
585
586	dev->dev_private = (void *)dev_priv;
587
588	r128_do_engine_reset(dev);
589
590	if (rc) {
591		DRM_ERROR("Failed to load firmware!\n");
592		r128_do_cleanup_cce(dev);
593	}
594
595	return rc;
596}
597
598int r128_do_cleanup_cce(struct drm_device *dev)
599{
600
601	/* Make sure interrupts are disabled here because the uninstall ioctl
602	 * may not have been called from userspace and after dev_private
603	 * is freed, it's too late.
604	 */
605	if (dev->irq_enabled)
606		drm_irq_uninstall(dev);
607
608	if (dev->dev_private) {
609		drm_r128_private_t *dev_priv = dev->dev_private;
610
611#if IS_ENABLED(CONFIG_AGP)
612		if (!dev_priv->is_pci) {
613			if (dev_priv->cce_ring != NULL)
614				drm_legacy_ioremapfree(dev_priv->cce_ring, dev);
615			if (dev_priv->ring_rptr != NULL)
616				drm_legacy_ioremapfree(dev_priv->ring_rptr, dev);
617			if (dev->agp_buffer_map != NULL) {
618				drm_legacy_ioremapfree(dev->agp_buffer_map, dev);
619				dev->agp_buffer_map = NULL;
620			}
621		} else
622#endif
623		{
624			if (dev_priv->gart_info.bus_addr)
625				if (!drm_ati_pcigart_cleanup(dev,
626							&dev_priv->gart_info))
627					DRM_ERROR
628					    ("failed to cleanup PCI GART!\n");
629		}
630
631		kfree(dev->dev_private);
632		dev->dev_private = NULL;
633	}
634
635	return 0;
636}
637
638int r128_cce_init(struct drm_device *dev, void *data, struct drm_file *file_priv)
639{
640	drm_r128_init_t *init = data;
641
642	DRM_DEBUG("\n");
643
644	LOCK_TEST_WITH_RETURN(dev, file_priv);
645
646	switch (init->func) {
647	case R128_INIT_CCE:
648		return r128_do_init_cce(dev, init);
649	case R128_CLEANUP_CCE:
650		return r128_do_cleanup_cce(dev);
651	}
652
653	return -EINVAL;
654}
655
656int r128_cce_start(struct drm_device *dev, void *data, struct drm_file *file_priv)
657{
658	drm_r128_private_t *dev_priv = dev->dev_private;
659	DRM_DEBUG("\n");
660
661	LOCK_TEST_WITH_RETURN(dev, file_priv);
662
663	DEV_INIT_TEST_WITH_RETURN(dev_priv);
664
665	if (dev_priv->cce_running || dev_priv->cce_mode == R128_PM4_NONPM4) {
666		DRM_DEBUG("while CCE running\n");
667		return 0;
668	}
669
670	r128_do_cce_start(dev_priv);
671
672	return 0;
673}
674
675/* Stop the CCE.  The engine must have been idled before calling this
676 * routine.
677 */
678int r128_cce_stop(struct drm_device *dev, void *data, struct drm_file *file_priv)
679{
680	drm_r128_private_t *dev_priv = dev->dev_private;
681	drm_r128_cce_stop_t *stop = data;
682	int ret;
683	DRM_DEBUG("\n");
684
685	LOCK_TEST_WITH_RETURN(dev, file_priv);
686
687	DEV_INIT_TEST_WITH_RETURN(dev_priv);
688
689	/* Flush any pending CCE commands.  This ensures any outstanding
690	 * commands are exectuted by the engine before we turn it off.
691	 */
692	if (stop->flush)
693		r128_do_cce_flush(dev_priv);
694
695	/* If we fail to make the engine go idle, we return an error
696	 * code so that the DRM ioctl wrapper can try again.
697	 */
698	if (stop->idle) {
699		ret = r128_do_cce_idle(dev_priv);
700		if (ret)
701			return ret;
702	}
703
704	/* Finally, we can turn off the CCE.  If the engine isn't idle,
705	 * we will get some dropped triangles as they won't be fully
706	 * rendered before the CCE is shut down.
707	 */
708	r128_do_cce_stop(dev_priv);
709
710	/* Reset the engine */
711	r128_do_engine_reset(dev);
712
713	return 0;
714}
715
716/* Just reset the CCE ring.  Called as part of an X Server engine reset.
717 */
718int r128_cce_reset(struct drm_device *dev, void *data, struct drm_file *file_priv)
719{
720	drm_r128_private_t *dev_priv = dev->dev_private;
721	DRM_DEBUG("\n");
722
723	LOCK_TEST_WITH_RETURN(dev, file_priv);
724
725	DEV_INIT_TEST_WITH_RETURN(dev_priv);
726
727	r128_do_cce_reset(dev_priv);
728
729	/* The CCE is no longer running after an engine reset */
730	dev_priv->cce_running = 0;
731
732	return 0;
733}
734
735int r128_cce_idle(struct drm_device *dev, void *data, struct drm_file *file_priv)
736{
737	drm_r128_private_t *dev_priv = dev->dev_private;
738	DRM_DEBUG("\n");
739
740	LOCK_TEST_WITH_RETURN(dev, file_priv);
741
742	DEV_INIT_TEST_WITH_RETURN(dev_priv);
743
744	if (dev_priv->cce_running)
745		r128_do_cce_flush(dev_priv);
746
747	return r128_do_cce_idle(dev_priv);
748}
749
750int r128_engine_reset(struct drm_device *dev, void *data, struct drm_file *file_priv)
751{
752	DRM_DEBUG("\n");
753
754	LOCK_TEST_WITH_RETURN(dev, file_priv);
755
756	DEV_INIT_TEST_WITH_RETURN(dev->dev_private);
757
758	return r128_do_engine_reset(dev);
759}
760
761int r128_fullscreen(struct drm_device *dev, void *data, struct drm_file *file_priv)
762{
763	return -EINVAL;
764}
765
766/* ================================================================
767 * Freelist management
768 */
769#define R128_BUFFER_USED	0xffffffff
770#define R128_BUFFER_FREE	0
771
772#if 0
773static int r128_freelist_init(struct drm_device *dev)
774{
775	struct drm_device_dma *dma = dev->dma;
776	drm_r128_private_t *dev_priv = dev->dev_private;
777	struct drm_buf *buf;
778	drm_r128_buf_priv_t *buf_priv;
779	drm_r128_freelist_t *entry;
780	int i;
781
782	dev_priv->head = kzalloc(sizeof(drm_r128_freelist_t), GFP_KERNEL);
783	if (dev_priv->head == NULL)
784		return -ENOMEM;
785
786	dev_priv->head->age = R128_BUFFER_USED;
787
788	for (i = 0; i < dma->buf_count; i++) {
789		buf = dma->buflist[i];
790		buf_priv = buf->dev_private;
791
792		entry = kmalloc(sizeof(drm_r128_freelist_t), GFP_KERNEL);
793		if (!entry)
794			return -ENOMEM;
795
796		entry->age = R128_BUFFER_FREE;
797		entry->buf = buf;
798		entry->prev = dev_priv->head;
799		entry->next = dev_priv->head->next;
800		if (!entry->next)
801			dev_priv->tail = entry;
802
803		buf_priv->discard = 0;
804		buf_priv->dispatched = 0;
805		buf_priv->list_entry = entry;
806
807		dev_priv->head->next = entry;
808
809		if (dev_priv->head->next)
810			dev_priv->head->next->prev = entry;
811	}
812
813	return 0;
814
815}
816#endif
817
818static struct drm_buf *r128_freelist_get(struct drm_device * dev)
819{
820	struct drm_device_dma *dma = dev->dma;
821	drm_r128_private_t *dev_priv = dev->dev_private;
822	drm_r128_buf_priv_t *buf_priv;
823	struct drm_buf *buf;
824	int i, t;
825
826	/* FIXME: Optimize -- use freelist code */
827
828	for (i = 0; i < dma->buf_count; i++) {
829		buf = dma->buflist[i];
830		buf_priv = buf->dev_private;
831		if (!buf->file_priv)
832			return buf;
833	}
834
835	for (t = 0; t < dev_priv->usec_timeout; t++) {
836		u32 done_age = R128_READ(R128_LAST_DISPATCH_REG);
837
838		for (i = 0; i < dma->buf_count; i++) {
839			buf = dma->buflist[i];
840			buf_priv = buf->dev_private;
841			if (buf->pending && buf_priv->age <= done_age) {
842				/* The buffer has been processed, so it
843				 * can now be used.
844				 */
845				buf->pending = 0;
846				return buf;
847			}
848		}
849		udelay(1);
850	}
851
852	DRM_DEBUG("returning NULL!\n");
853	return NULL;
854}
855
856void r128_freelist_reset(struct drm_device *dev)
857{
858	struct drm_device_dma *dma = dev->dma;
859	int i;
860
861	for (i = 0; i < dma->buf_count; i++) {
862		struct drm_buf *buf = dma->buflist[i];
863		drm_r128_buf_priv_t *buf_priv = buf->dev_private;
864		buf_priv->age = 0;
865	}
866}
867
868/* ================================================================
869 * CCE command submission
870 */
871
872int r128_wait_ring(drm_r128_private_t *dev_priv, int n)
873{
874	drm_r128_ring_buffer_t *ring = &dev_priv->ring;
875	int i;
876
877	for (i = 0; i < dev_priv->usec_timeout; i++) {
878		r128_update_ring_snapshot(dev_priv);
879		if (ring->space >= n)
880			return 0;
881		udelay(1);
882	}
883
884	/* FIXME: This is being ignored... */
885	DRM_ERROR("failed!\n");
886	return -EBUSY;
887}
888
889static int r128_cce_get_buffers(struct drm_device *dev,
890				struct drm_file *file_priv,
891				struct drm_dma *d)
892{
893	int i;
894	struct drm_buf *buf;
895
896	for (i = d->granted_count; i < d->request_count; i++) {
897		buf = r128_freelist_get(dev);
898		if (!buf)
899			return -EAGAIN;
900
901		buf->file_priv = file_priv;
902
903		if (copy_to_user(&d->request_indices[i], &buf->idx,
904				     sizeof(buf->idx)))
905			return -EFAULT;
906		if (copy_to_user(&d->request_sizes[i], &buf->total,
907				     sizeof(buf->total)))
908			return -EFAULT;
909
910		d->granted_count++;
911	}
912	return 0;
913}
914
915int r128_cce_buffers(struct drm_device *dev, void *data, struct drm_file *file_priv)
916{
917	struct drm_device_dma *dma = dev->dma;
918	int ret = 0;
919	struct drm_dma *d = data;
920
921	LOCK_TEST_WITH_RETURN(dev, file_priv);
922
923	/* Please don't send us buffers.
924	 */
925	if (d->send_count != 0) {
926		DRM_ERROR("Process %d trying to send %d buffers via drmDMA\n",
927			  task_pid_nr(current), d->send_count);
928		return -EINVAL;
929	}
930
931	/* We'll send you buffers.
932	 */
933	if (d->request_count < 0 || d->request_count > dma->buf_count) {
934		DRM_ERROR("Process %d trying to get %d buffers (of %d max)\n",
935			  task_pid_nr(current), d->request_count, dma->buf_count);
936		return -EINVAL;
937	}
938
939	d->granted_count = 0;
940
941	if (d->request_count)
942		ret = r128_cce_get_buffers(dev, file_priv, d);
943
944	return ret;
945}
v3.5.6
  1/* r128_cce.c -- ATI Rage 128 driver -*- linux-c -*-
  2 * Created: Wed Apr  5 19:24:19 2000 by kevin@precisioninsight.com
  3 */
  4/*
  5 * Copyright 2000 Precision Insight, Inc., Cedar Park, Texas.
  6 * Copyright 2000 VA Linux Systems, Inc., Sunnyvale, California.
  7 * All Rights Reserved.
  8 *
  9 * Permission is hereby granted, free of charge, to any person obtaining a
 10 * copy of this software and associated documentation files (the "Software"),
 11 * to deal in the Software without restriction, including without limitation
 12 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 13 * and/or sell copies of the Software, and to permit persons to whom the
 14 * Software is furnished to do so, subject to the following conditions:
 15 *
 16 * The above copyright notice and this permission notice (including the next
 17 * paragraph) shall be included in all copies or substantial portions of the
 18 * Software.
 19 *
 20 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 21 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 22 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 23 * PRECISION INSIGHT AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
 24 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
 25 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
 26 * DEALINGS IN THE SOFTWARE.
 27 *
 28 * Authors:
 29 *    Gareth Hughes <gareth@valinux.com>
 30 */
 31
 
 
 32#include <linux/firmware.h>
 
 33#include <linux/platform_device.h>
 34#include <linux/slab.h>
 35#include <linux/module.h>
 
 
 
 
 
 
 
 36
 37#include "drmP.h"
 38#include "drm.h"
 39#include "r128_drm.h"
 40#include "r128_drv.h"
 41
 42#define R128_FIFO_DEBUG		0
 43
 44#define FIRMWARE_NAME		"r128/r128_cce.bin"
 45
 46MODULE_FIRMWARE(FIRMWARE_NAME);
 47
 48static int R128_READ_PLL(struct drm_device *dev, int addr)
 49{
 50	drm_r128_private_t *dev_priv = dev->dev_private;
 51
 52	R128_WRITE8(R128_CLOCK_CNTL_INDEX, addr & 0x1f);
 53	return R128_READ(R128_CLOCK_CNTL_DATA);
 54}
 55
 56#if R128_FIFO_DEBUG
 57static void r128_status(drm_r128_private_t *dev_priv)
 58{
 59	printk("GUI_STAT           = 0x%08x\n",
 60	       (unsigned int)R128_READ(R128_GUI_STAT));
 61	printk("PM4_STAT           = 0x%08x\n",
 62	       (unsigned int)R128_READ(R128_PM4_STAT));
 63	printk("PM4_BUFFER_DL_WPTR = 0x%08x\n",
 64	       (unsigned int)R128_READ(R128_PM4_BUFFER_DL_WPTR));
 65	printk("PM4_BUFFER_DL_RPTR = 0x%08x\n",
 66	       (unsigned int)R128_READ(R128_PM4_BUFFER_DL_RPTR));
 67	printk("PM4_MICRO_CNTL     = 0x%08x\n",
 68	       (unsigned int)R128_READ(R128_PM4_MICRO_CNTL));
 69	printk("PM4_BUFFER_CNTL    = 0x%08x\n",
 70	       (unsigned int)R128_READ(R128_PM4_BUFFER_CNTL));
 71}
 72#endif
 73
 74/* ================================================================
 75 * Engine, FIFO control
 76 */
 77
 78static int r128_do_pixcache_flush(drm_r128_private_t *dev_priv)
 79{
 80	u32 tmp;
 81	int i;
 82
 83	tmp = R128_READ(R128_PC_NGUI_CTLSTAT) | R128_PC_FLUSH_ALL;
 84	R128_WRITE(R128_PC_NGUI_CTLSTAT, tmp);
 85
 86	for (i = 0; i < dev_priv->usec_timeout; i++) {
 87		if (!(R128_READ(R128_PC_NGUI_CTLSTAT) & R128_PC_BUSY))
 88			return 0;
 89		DRM_UDELAY(1);
 90	}
 91
 92#if R128_FIFO_DEBUG
 93	DRM_ERROR("failed!\n");
 94#endif
 95	return -EBUSY;
 96}
 97
 98static int r128_do_wait_for_fifo(drm_r128_private_t *dev_priv, int entries)
 99{
100	int i;
101
102	for (i = 0; i < dev_priv->usec_timeout; i++) {
103		int slots = R128_READ(R128_GUI_STAT) & R128_GUI_FIFOCNT_MASK;
104		if (slots >= entries)
105			return 0;
106		DRM_UDELAY(1);
107	}
108
109#if R128_FIFO_DEBUG
110	DRM_ERROR("failed!\n");
111#endif
112	return -EBUSY;
113}
114
115static int r128_do_wait_for_idle(drm_r128_private_t *dev_priv)
116{
117	int i, ret;
118
119	ret = r128_do_wait_for_fifo(dev_priv, 64);
120	if (ret)
121		return ret;
122
123	for (i = 0; i < dev_priv->usec_timeout; i++) {
124		if (!(R128_READ(R128_GUI_STAT) & R128_GUI_ACTIVE)) {
125			r128_do_pixcache_flush(dev_priv);
126			return 0;
127		}
128		DRM_UDELAY(1);
129	}
130
131#if R128_FIFO_DEBUG
132	DRM_ERROR("failed!\n");
133#endif
134	return -EBUSY;
135}
136
137/* ================================================================
138 * CCE control, initialization
139 */
140
141/* Load the microcode for the CCE */
142static int r128_cce_load_microcode(drm_r128_private_t *dev_priv)
143{
144	struct platform_device *pdev;
145	const struct firmware *fw;
146	const __be32 *fw_data;
147	int rc, i;
148
149	DRM_DEBUG("\n");
150
151	pdev = platform_device_register_simple("r128_cce", 0, NULL, 0);
152	if (IS_ERR(pdev)) {
153		printk(KERN_ERR "r128_cce: Failed to register firmware\n");
154		return PTR_ERR(pdev);
155	}
156	rc = request_firmware(&fw, FIRMWARE_NAME, &pdev->dev);
157	platform_device_unregister(pdev);
158	if (rc) {
159		printk(KERN_ERR "r128_cce: Failed to load firmware \"%s\"\n",
160		       FIRMWARE_NAME);
161		return rc;
162	}
163
164	if (fw->size != 256 * 8) {
165		printk(KERN_ERR
166		       "r128_cce: Bogus length %zu in firmware \"%s\"\n",
167		       fw->size, FIRMWARE_NAME);
168		rc = -EINVAL;
169		goto out_release;
170	}
171
172	r128_do_wait_for_idle(dev_priv);
173
174	fw_data = (const __be32 *)fw->data;
175	R128_WRITE(R128_PM4_MICROCODE_ADDR, 0);
176	for (i = 0; i < 256; i++) {
177		R128_WRITE(R128_PM4_MICROCODE_DATAH,
178			   be32_to_cpup(&fw_data[i * 2]));
179		R128_WRITE(R128_PM4_MICROCODE_DATAL,
180			   be32_to_cpup(&fw_data[i * 2 + 1]));
181	}
182
183out_release:
184	release_firmware(fw);
185	return rc;
186}
187
188/* Flush any pending commands to the CCE.  This should only be used just
189 * prior to a wait for idle, as it informs the engine that the command
190 * stream is ending.
191 */
192static void r128_do_cce_flush(drm_r128_private_t *dev_priv)
193{
194	u32 tmp;
195
196	tmp = R128_READ(R128_PM4_BUFFER_DL_WPTR) | R128_PM4_BUFFER_DL_DONE;
197	R128_WRITE(R128_PM4_BUFFER_DL_WPTR, tmp);
198}
199
200/* Wait for the CCE to go idle.
201 */
202int r128_do_cce_idle(drm_r128_private_t *dev_priv)
203{
204	int i;
205
206	for (i = 0; i < dev_priv->usec_timeout; i++) {
207		if (GET_RING_HEAD(dev_priv) == dev_priv->ring.tail) {
208			int pm4stat = R128_READ(R128_PM4_STAT);
209			if (((pm4stat & R128_PM4_FIFOCNT_MASK) >=
210			     dev_priv->cce_fifo_size) &&
211			    !(pm4stat & (R128_PM4_BUSY |
212					 R128_PM4_GUI_ACTIVE))) {
213				return r128_do_pixcache_flush(dev_priv);
214			}
215		}
216		DRM_UDELAY(1);
217	}
218
219#if R128_FIFO_DEBUG
220	DRM_ERROR("failed!\n");
221	r128_status(dev_priv);
222#endif
223	return -EBUSY;
224}
225
226/* Start the Concurrent Command Engine.
227 */
228static void r128_do_cce_start(drm_r128_private_t *dev_priv)
229{
230	r128_do_wait_for_idle(dev_priv);
231
232	R128_WRITE(R128_PM4_BUFFER_CNTL,
233		   dev_priv->cce_mode | dev_priv->ring.size_l2qw
234		   | R128_PM4_BUFFER_CNTL_NOUPDATE);
235	R128_READ(R128_PM4_BUFFER_ADDR);	/* as per the sample code */
236	R128_WRITE(R128_PM4_MICRO_CNTL, R128_PM4_MICRO_FREERUN);
237
238	dev_priv->cce_running = 1;
239}
240
241/* Reset the Concurrent Command Engine.  This will not flush any pending
242 * commands, so you must wait for the CCE command stream to complete
243 * before calling this routine.
244 */
245static void r128_do_cce_reset(drm_r128_private_t *dev_priv)
246{
247	R128_WRITE(R128_PM4_BUFFER_DL_WPTR, 0);
248	R128_WRITE(R128_PM4_BUFFER_DL_RPTR, 0);
249	dev_priv->ring.tail = 0;
250}
251
252/* Stop the Concurrent Command Engine.  This will not flush any pending
253 * commands, so you must flush the command stream and wait for the CCE
254 * to go idle before calling this routine.
255 */
256static void r128_do_cce_stop(drm_r128_private_t *dev_priv)
257{
258	R128_WRITE(R128_PM4_MICRO_CNTL, 0);
259	R128_WRITE(R128_PM4_BUFFER_CNTL,
260		   R128_PM4_NONPM4 | R128_PM4_BUFFER_CNTL_NOUPDATE);
261
262	dev_priv->cce_running = 0;
263}
264
265/* Reset the engine.  This will stop the CCE if it is running.
266 */
267static int r128_do_engine_reset(struct drm_device *dev)
268{
269	drm_r128_private_t *dev_priv = dev->dev_private;
270	u32 clock_cntl_index, mclk_cntl, gen_reset_cntl;
271
272	r128_do_pixcache_flush(dev_priv);
273
274	clock_cntl_index = R128_READ(R128_CLOCK_CNTL_INDEX);
275	mclk_cntl = R128_READ_PLL(dev, R128_MCLK_CNTL);
276
277	R128_WRITE_PLL(R128_MCLK_CNTL,
278		       mclk_cntl | R128_FORCE_GCP | R128_FORCE_PIPE3D_CP);
279
280	gen_reset_cntl = R128_READ(R128_GEN_RESET_CNTL);
281
282	/* Taken from the sample code - do not change */
283	R128_WRITE(R128_GEN_RESET_CNTL, gen_reset_cntl | R128_SOFT_RESET_GUI);
284	R128_READ(R128_GEN_RESET_CNTL);
285	R128_WRITE(R128_GEN_RESET_CNTL, gen_reset_cntl & ~R128_SOFT_RESET_GUI);
286	R128_READ(R128_GEN_RESET_CNTL);
287
288	R128_WRITE_PLL(R128_MCLK_CNTL, mclk_cntl);
289	R128_WRITE(R128_CLOCK_CNTL_INDEX, clock_cntl_index);
290	R128_WRITE(R128_GEN_RESET_CNTL, gen_reset_cntl);
291
292	/* Reset the CCE ring */
293	r128_do_cce_reset(dev_priv);
294
295	/* The CCE is no longer running after an engine reset */
296	dev_priv->cce_running = 0;
297
298	/* Reset any pending vertex, indirect buffers */
299	r128_freelist_reset(dev);
300
301	return 0;
302}
303
304static void r128_cce_init_ring_buffer(struct drm_device *dev,
305				      drm_r128_private_t *dev_priv)
306{
307	u32 ring_start;
308	u32 tmp;
309
310	DRM_DEBUG("\n");
311
312	/* The manual (p. 2) says this address is in "VM space".  This
313	 * means it's an offset from the start of AGP space.
314	 */
315#if __OS_HAS_AGP
316	if (!dev_priv->is_pci)
317		ring_start = dev_priv->cce_ring->offset - dev->agp->base;
318	else
319#endif
320		ring_start = dev_priv->cce_ring->offset -
321		    (unsigned long)dev->sg->virtual;
322
323	R128_WRITE(R128_PM4_BUFFER_OFFSET, ring_start | R128_AGP_OFFSET);
324
325	R128_WRITE(R128_PM4_BUFFER_DL_WPTR, 0);
326	R128_WRITE(R128_PM4_BUFFER_DL_RPTR, 0);
327
328	/* Set watermark control */
329	R128_WRITE(R128_PM4_BUFFER_WM_CNTL,
330		   ((R128_WATERMARK_L / 4) << R128_WMA_SHIFT)
331		   | ((R128_WATERMARK_M / 4) << R128_WMB_SHIFT)
332		   | ((R128_WATERMARK_N / 4) << R128_WMC_SHIFT)
333		   | ((R128_WATERMARK_K / 64) << R128_WB_WM_SHIFT));
334
335	/* Force read.  Why?  Because it's in the examples... */
336	R128_READ(R128_PM4_BUFFER_ADDR);
337
338	/* Turn on bus mastering */
339	tmp = R128_READ(R128_BUS_CNTL) & ~R128_BUS_MASTER_DIS;
340	R128_WRITE(R128_BUS_CNTL, tmp);
341}
342
343static int r128_do_init_cce(struct drm_device *dev, drm_r128_init_t *init)
344{
345	drm_r128_private_t *dev_priv;
346	int rc;
347
348	DRM_DEBUG("\n");
349
350	if (dev->dev_private) {
351		DRM_DEBUG("called when already initialized\n");
352		return -EINVAL;
353	}
354
355	dev_priv = kzalloc(sizeof(drm_r128_private_t), GFP_KERNEL);
356	if (dev_priv == NULL)
357		return -ENOMEM;
358
359	dev_priv->is_pci = init->is_pci;
360
361	if (dev_priv->is_pci && !dev->sg) {
362		DRM_ERROR("PCI GART memory not allocated!\n");
363		dev->dev_private = (void *)dev_priv;
364		r128_do_cleanup_cce(dev);
365		return -EINVAL;
366	}
367
368	dev_priv->usec_timeout = init->usec_timeout;
369	if (dev_priv->usec_timeout < 1 ||
370	    dev_priv->usec_timeout > R128_MAX_USEC_TIMEOUT) {
371		DRM_DEBUG("TIMEOUT problem!\n");
372		dev->dev_private = (void *)dev_priv;
373		r128_do_cleanup_cce(dev);
374		return -EINVAL;
375	}
376
377	dev_priv->cce_mode = init->cce_mode;
378
379	/* GH: Simple idle check.
380	 */
381	atomic_set(&dev_priv->idle_count, 0);
382
383	/* We don't support anything other than bus-mastering ring mode,
384	 * but the ring can be in either AGP or PCI space for the ring
385	 * read pointer.
386	 */
387	if ((init->cce_mode != R128_PM4_192BM) &&
388	    (init->cce_mode != R128_PM4_128BM_64INDBM) &&
389	    (init->cce_mode != R128_PM4_64BM_128INDBM) &&
390	    (init->cce_mode != R128_PM4_64BM_64VCBM_64INDBM)) {
391		DRM_DEBUG("Bad cce_mode!\n");
392		dev->dev_private = (void *)dev_priv;
393		r128_do_cleanup_cce(dev);
394		return -EINVAL;
395	}
396
397	switch (init->cce_mode) {
398	case R128_PM4_NONPM4:
399		dev_priv->cce_fifo_size = 0;
400		break;
401	case R128_PM4_192PIO:
402	case R128_PM4_192BM:
403		dev_priv->cce_fifo_size = 192;
404		break;
405	case R128_PM4_128PIO_64INDBM:
406	case R128_PM4_128BM_64INDBM:
407		dev_priv->cce_fifo_size = 128;
408		break;
409	case R128_PM4_64PIO_128INDBM:
410	case R128_PM4_64BM_128INDBM:
411	case R128_PM4_64PIO_64VCBM_64INDBM:
412	case R128_PM4_64BM_64VCBM_64INDBM:
413	case R128_PM4_64PIO_64VCPIO_64INDPIO:
414		dev_priv->cce_fifo_size = 64;
415		break;
416	}
417
418	switch (init->fb_bpp) {
419	case 16:
420		dev_priv->color_fmt = R128_DATATYPE_RGB565;
421		break;
422	case 32:
423	default:
424		dev_priv->color_fmt = R128_DATATYPE_ARGB8888;
425		break;
426	}
427	dev_priv->front_offset = init->front_offset;
428	dev_priv->front_pitch = init->front_pitch;
429	dev_priv->back_offset = init->back_offset;
430	dev_priv->back_pitch = init->back_pitch;
431
432	switch (init->depth_bpp) {
433	case 16:
434		dev_priv->depth_fmt = R128_DATATYPE_RGB565;
435		break;
436	case 24:
437	case 32:
438	default:
439		dev_priv->depth_fmt = R128_DATATYPE_ARGB8888;
440		break;
441	}
442	dev_priv->depth_offset = init->depth_offset;
443	dev_priv->depth_pitch = init->depth_pitch;
444	dev_priv->span_offset = init->span_offset;
445
446	dev_priv->front_pitch_offset_c = (((dev_priv->front_pitch / 8) << 21) |
447					  (dev_priv->front_offset >> 5));
448	dev_priv->back_pitch_offset_c = (((dev_priv->back_pitch / 8) << 21) |
449					 (dev_priv->back_offset >> 5));
450	dev_priv->depth_pitch_offset_c = (((dev_priv->depth_pitch / 8) << 21) |
451					  (dev_priv->depth_offset >> 5) |
452					  R128_DST_TILE);
453	dev_priv->span_pitch_offset_c = (((dev_priv->depth_pitch / 8) << 21) |
454					 (dev_priv->span_offset >> 5));
455
456	dev_priv->sarea = drm_getsarea(dev);
457	if (!dev_priv->sarea) {
458		DRM_ERROR("could not find sarea!\n");
459		dev->dev_private = (void *)dev_priv;
460		r128_do_cleanup_cce(dev);
461		return -EINVAL;
462	}
463
464	dev_priv->mmio = drm_core_findmap(dev, init->mmio_offset);
465	if (!dev_priv->mmio) {
466		DRM_ERROR("could not find mmio region!\n");
467		dev->dev_private = (void *)dev_priv;
468		r128_do_cleanup_cce(dev);
469		return -EINVAL;
470	}
471	dev_priv->cce_ring = drm_core_findmap(dev, init->ring_offset);
472	if (!dev_priv->cce_ring) {
473		DRM_ERROR("could not find cce ring region!\n");
474		dev->dev_private = (void *)dev_priv;
475		r128_do_cleanup_cce(dev);
476		return -EINVAL;
477	}
478	dev_priv->ring_rptr = drm_core_findmap(dev, init->ring_rptr_offset);
479	if (!dev_priv->ring_rptr) {
480		DRM_ERROR("could not find ring read pointer!\n");
481		dev->dev_private = (void *)dev_priv;
482		r128_do_cleanup_cce(dev);
483		return -EINVAL;
484	}
485	dev->agp_buffer_token = init->buffers_offset;
486	dev->agp_buffer_map = drm_core_findmap(dev, init->buffers_offset);
487	if (!dev->agp_buffer_map) {
488		DRM_ERROR("could not find dma buffer region!\n");
489		dev->dev_private = (void *)dev_priv;
490		r128_do_cleanup_cce(dev);
491		return -EINVAL;
492	}
493
494	if (!dev_priv->is_pci) {
495		dev_priv->agp_textures =
496		    drm_core_findmap(dev, init->agp_textures_offset);
497		if (!dev_priv->agp_textures) {
498			DRM_ERROR("could not find agp texture region!\n");
499			dev->dev_private = (void *)dev_priv;
500			r128_do_cleanup_cce(dev);
501			return -EINVAL;
502		}
503	}
504
505	dev_priv->sarea_priv =
506	    (drm_r128_sarea_t *) ((u8 *) dev_priv->sarea->handle +
507				  init->sarea_priv_offset);
508
509#if __OS_HAS_AGP
510	if (!dev_priv->is_pci) {
511		drm_core_ioremap_wc(dev_priv->cce_ring, dev);
512		drm_core_ioremap_wc(dev_priv->ring_rptr, dev);
513		drm_core_ioremap_wc(dev->agp_buffer_map, dev);
514		if (!dev_priv->cce_ring->handle ||
515		    !dev_priv->ring_rptr->handle ||
516		    !dev->agp_buffer_map->handle) {
517			DRM_ERROR("Could not ioremap agp regions!\n");
518			dev->dev_private = (void *)dev_priv;
519			r128_do_cleanup_cce(dev);
520			return -ENOMEM;
521		}
522	} else
523#endif
524	{
525		dev_priv->cce_ring->handle =
526			(void *)(unsigned long)dev_priv->cce_ring->offset;
527		dev_priv->ring_rptr->handle =
528			(void *)(unsigned long)dev_priv->ring_rptr->offset;
529		dev->agp_buffer_map->handle =
530			(void *)(unsigned long)dev->agp_buffer_map->offset;
531	}
532
533#if __OS_HAS_AGP
534	if (!dev_priv->is_pci)
535		dev_priv->cce_buffers_offset = dev->agp->base;
536	else
537#endif
538		dev_priv->cce_buffers_offset = (unsigned long)dev->sg->virtual;
539
540	dev_priv->ring.start = (u32 *) dev_priv->cce_ring->handle;
541	dev_priv->ring.end = ((u32 *) dev_priv->cce_ring->handle
542			      + init->ring_size / sizeof(u32));
543	dev_priv->ring.size = init->ring_size;
544	dev_priv->ring.size_l2qw = drm_order(init->ring_size / 8);
545
546	dev_priv->ring.tail_mask = (dev_priv->ring.size / sizeof(u32)) - 1;
547
548	dev_priv->ring.high_mark = 128;
549
550	dev_priv->sarea_priv->last_frame = 0;
551	R128_WRITE(R128_LAST_FRAME_REG, dev_priv->sarea_priv->last_frame);
552
553	dev_priv->sarea_priv->last_dispatch = 0;
554	R128_WRITE(R128_LAST_DISPATCH_REG, dev_priv->sarea_priv->last_dispatch);
555
556#if __OS_HAS_AGP
557	if (dev_priv->is_pci) {
558#endif
559		dev_priv->gart_info.table_mask = DMA_BIT_MASK(32);
560		dev_priv->gart_info.gart_table_location = DRM_ATI_GART_MAIN;
561		dev_priv->gart_info.table_size = R128_PCIGART_TABLE_SIZE;
562		dev_priv->gart_info.addr = NULL;
563		dev_priv->gart_info.bus_addr = 0;
564		dev_priv->gart_info.gart_reg_if = DRM_ATI_GART_PCI;
565		if (!drm_ati_pcigart_init(dev, &dev_priv->gart_info)) {
 
566			DRM_ERROR("failed to init PCI GART!\n");
567			dev->dev_private = (void *)dev_priv;
568			r128_do_cleanup_cce(dev);
569			return -ENOMEM;
570		}
571		R128_WRITE(R128_PCI_GART_PAGE, dev_priv->gart_info.bus_addr);
572#if __OS_HAS_AGP
573	}
574#endif
575
576	r128_cce_init_ring_buffer(dev, dev_priv);
577	rc = r128_cce_load_microcode(dev_priv);
578
579	dev->dev_private = (void *)dev_priv;
580
581	r128_do_engine_reset(dev);
582
583	if (rc) {
584		DRM_ERROR("Failed to load firmware!\n");
585		r128_do_cleanup_cce(dev);
586	}
587
588	return rc;
589}
590
591int r128_do_cleanup_cce(struct drm_device *dev)
592{
593
594	/* Make sure interrupts are disabled here because the uninstall ioctl
595	 * may not have been called from userspace and after dev_private
596	 * is freed, it's too late.
597	 */
598	if (dev->irq_enabled)
599		drm_irq_uninstall(dev);
600
601	if (dev->dev_private) {
602		drm_r128_private_t *dev_priv = dev->dev_private;
603
604#if __OS_HAS_AGP
605		if (!dev_priv->is_pci) {
606			if (dev_priv->cce_ring != NULL)
607				drm_core_ioremapfree(dev_priv->cce_ring, dev);
608			if (dev_priv->ring_rptr != NULL)
609				drm_core_ioremapfree(dev_priv->ring_rptr, dev);
610			if (dev->agp_buffer_map != NULL) {
611				drm_core_ioremapfree(dev->agp_buffer_map, dev);
612				dev->agp_buffer_map = NULL;
613			}
614		} else
615#endif
616		{
617			if (dev_priv->gart_info.bus_addr)
618				if (!drm_ati_pcigart_cleanup(dev,
619							&dev_priv->gart_info))
620					DRM_ERROR
621					    ("failed to cleanup PCI GART!\n");
622		}
623
624		kfree(dev->dev_private);
625		dev->dev_private = NULL;
626	}
627
628	return 0;
629}
630
631int r128_cce_init(struct drm_device *dev, void *data, struct drm_file *file_priv)
632{
633	drm_r128_init_t *init = data;
634
635	DRM_DEBUG("\n");
636
637	LOCK_TEST_WITH_RETURN(dev, file_priv);
638
639	switch (init->func) {
640	case R128_INIT_CCE:
641		return r128_do_init_cce(dev, init);
642	case R128_CLEANUP_CCE:
643		return r128_do_cleanup_cce(dev);
644	}
645
646	return -EINVAL;
647}
648
649int r128_cce_start(struct drm_device *dev, void *data, struct drm_file *file_priv)
650{
651	drm_r128_private_t *dev_priv = dev->dev_private;
652	DRM_DEBUG("\n");
653
654	LOCK_TEST_WITH_RETURN(dev, file_priv);
655
656	DEV_INIT_TEST_WITH_RETURN(dev_priv);
657
658	if (dev_priv->cce_running || dev_priv->cce_mode == R128_PM4_NONPM4) {
659		DRM_DEBUG("while CCE running\n");
660		return 0;
661	}
662
663	r128_do_cce_start(dev_priv);
664
665	return 0;
666}
667
668/* Stop the CCE.  The engine must have been idled before calling this
669 * routine.
670 */
671int r128_cce_stop(struct drm_device *dev, void *data, struct drm_file *file_priv)
672{
673	drm_r128_private_t *dev_priv = dev->dev_private;
674	drm_r128_cce_stop_t *stop = data;
675	int ret;
676	DRM_DEBUG("\n");
677
678	LOCK_TEST_WITH_RETURN(dev, file_priv);
679
680	DEV_INIT_TEST_WITH_RETURN(dev_priv);
681
682	/* Flush any pending CCE commands.  This ensures any outstanding
683	 * commands are exectuted by the engine before we turn it off.
684	 */
685	if (stop->flush)
686		r128_do_cce_flush(dev_priv);
687
688	/* If we fail to make the engine go idle, we return an error
689	 * code so that the DRM ioctl wrapper can try again.
690	 */
691	if (stop->idle) {
692		ret = r128_do_cce_idle(dev_priv);
693		if (ret)
694			return ret;
695	}
696
697	/* Finally, we can turn off the CCE.  If the engine isn't idle,
698	 * we will get some dropped triangles as they won't be fully
699	 * rendered before the CCE is shut down.
700	 */
701	r128_do_cce_stop(dev_priv);
702
703	/* Reset the engine */
704	r128_do_engine_reset(dev);
705
706	return 0;
707}
708
709/* Just reset the CCE ring.  Called as part of an X Server engine reset.
710 */
711int r128_cce_reset(struct drm_device *dev, void *data, struct drm_file *file_priv)
712{
713	drm_r128_private_t *dev_priv = dev->dev_private;
714	DRM_DEBUG("\n");
715
716	LOCK_TEST_WITH_RETURN(dev, file_priv);
717
718	DEV_INIT_TEST_WITH_RETURN(dev_priv);
719
720	r128_do_cce_reset(dev_priv);
721
722	/* The CCE is no longer running after an engine reset */
723	dev_priv->cce_running = 0;
724
725	return 0;
726}
727
728int r128_cce_idle(struct drm_device *dev, void *data, struct drm_file *file_priv)
729{
730	drm_r128_private_t *dev_priv = dev->dev_private;
731	DRM_DEBUG("\n");
732
733	LOCK_TEST_WITH_RETURN(dev, file_priv);
734
735	DEV_INIT_TEST_WITH_RETURN(dev_priv);
736
737	if (dev_priv->cce_running)
738		r128_do_cce_flush(dev_priv);
739
740	return r128_do_cce_idle(dev_priv);
741}
742
743int r128_engine_reset(struct drm_device *dev, void *data, struct drm_file *file_priv)
744{
745	DRM_DEBUG("\n");
746
747	LOCK_TEST_WITH_RETURN(dev, file_priv);
748
749	DEV_INIT_TEST_WITH_RETURN(dev->dev_private);
750
751	return r128_do_engine_reset(dev);
752}
753
754int r128_fullscreen(struct drm_device *dev, void *data, struct drm_file *file_priv)
755{
756	return -EINVAL;
757}
758
759/* ================================================================
760 * Freelist management
761 */
762#define R128_BUFFER_USED	0xffffffff
763#define R128_BUFFER_FREE	0
764
765#if 0
766static int r128_freelist_init(struct drm_device *dev)
767{
768	struct drm_device_dma *dma = dev->dma;
769	drm_r128_private_t *dev_priv = dev->dev_private;
770	struct drm_buf *buf;
771	drm_r128_buf_priv_t *buf_priv;
772	drm_r128_freelist_t *entry;
773	int i;
774
775	dev_priv->head = kzalloc(sizeof(drm_r128_freelist_t), GFP_KERNEL);
776	if (dev_priv->head == NULL)
777		return -ENOMEM;
778
779	dev_priv->head->age = R128_BUFFER_USED;
780
781	for (i = 0; i < dma->buf_count; i++) {
782		buf = dma->buflist[i];
783		buf_priv = buf->dev_private;
784
785		entry = kmalloc(sizeof(drm_r128_freelist_t), GFP_KERNEL);
786		if (!entry)
787			return -ENOMEM;
788
789		entry->age = R128_BUFFER_FREE;
790		entry->buf = buf;
791		entry->prev = dev_priv->head;
792		entry->next = dev_priv->head->next;
793		if (!entry->next)
794			dev_priv->tail = entry;
795
796		buf_priv->discard = 0;
797		buf_priv->dispatched = 0;
798		buf_priv->list_entry = entry;
799
800		dev_priv->head->next = entry;
801
802		if (dev_priv->head->next)
803			dev_priv->head->next->prev = entry;
804	}
805
806	return 0;
807
808}
809#endif
810
811static struct drm_buf *r128_freelist_get(struct drm_device * dev)
812{
813	struct drm_device_dma *dma = dev->dma;
814	drm_r128_private_t *dev_priv = dev->dev_private;
815	drm_r128_buf_priv_t *buf_priv;
816	struct drm_buf *buf;
817	int i, t;
818
819	/* FIXME: Optimize -- use freelist code */
820
821	for (i = 0; i < dma->buf_count; i++) {
822		buf = dma->buflist[i];
823		buf_priv = buf->dev_private;
824		if (!buf->file_priv)
825			return buf;
826	}
827
828	for (t = 0; t < dev_priv->usec_timeout; t++) {
829		u32 done_age = R128_READ(R128_LAST_DISPATCH_REG);
830
831		for (i = 0; i < dma->buf_count; i++) {
832			buf = dma->buflist[i];
833			buf_priv = buf->dev_private;
834			if (buf->pending && buf_priv->age <= done_age) {
835				/* The buffer has been processed, so it
836				 * can now be used.
837				 */
838				buf->pending = 0;
839				return buf;
840			}
841		}
842		DRM_UDELAY(1);
843	}
844
845	DRM_DEBUG("returning NULL!\n");
846	return NULL;
847}
848
849void r128_freelist_reset(struct drm_device *dev)
850{
851	struct drm_device_dma *dma = dev->dma;
852	int i;
853
854	for (i = 0; i < dma->buf_count; i++) {
855		struct drm_buf *buf = dma->buflist[i];
856		drm_r128_buf_priv_t *buf_priv = buf->dev_private;
857		buf_priv->age = 0;
858	}
859}
860
861/* ================================================================
862 * CCE command submission
863 */
864
865int r128_wait_ring(drm_r128_private_t *dev_priv, int n)
866{
867	drm_r128_ring_buffer_t *ring = &dev_priv->ring;
868	int i;
869
870	for (i = 0; i < dev_priv->usec_timeout; i++) {
871		r128_update_ring_snapshot(dev_priv);
872		if (ring->space >= n)
873			return 0;
874		DRM_UDELAY(1);
875	}
876
877	/* FIXME: This is being ignored... */
878	DRM_ERROR("failed!\n");
879	return -EBUSY;
880}
881
882static int r128_cce_get_buffers(struct drm_device *dev,
883				struct drm_file *file_priv,
884				struct drm_dma *d)
885{
886	int i;
887	struct drm_buf *buf;
888
889	for (i = d->granted_count; i < d->request_count; i++) {
890		buf = r128_freelist_get(dev);
891		if (!buf)
892			return -EAGAIN;
893
894		buf->file_priv = file_priv;
895
896		if (DRM_COPY_TO_USER(&d->request_indices[i], &buf->idx,
897				     sizeof(buf->idx)))
898			return -EFAULT;
899		if (DRM_COPY_TO_USER(&d->request_sizes[i], &buf->total,
900				     sizeof(buf->total)))
901			return -EFAULT;
902
903		d->granted_count++;
904	}
905	return 0;
906}
907
908int r128_cce_buffers(struct drm_device *dev, void *data, struct drm_file *file_priv)
909{
910	struct drm_device_dma *dma = dev->dma;
911	int ret = 0;
912	struct drm_dma *d = data;
913
914	LOCK_TEST_WITH_RETURN(dev, file_priv);
915
916	/* Please don't send us buffers.
917	 */
918	if (d->send_count != 0) {
919		DRM_ERROR("Process %d trying to send %d buffers via drmDMA\n",
920			  DRM_CURRENTPID, d->send_count);
921		return -EINVAL;
922	}
923
924	/* We'll send you buffers.
925	 */
926	if (d->request_count < 0 || d->request_count > dma->buf_count) {
927		DRM_ERROR("Process %d trying to get %d buffers (of %d max)\n",
928			  DRM_CURRENTPID, d->request_count, dma->buf_count);
929		return -EINVAL;
930	}
931
932	d->granted_count = 0;
933
934	if (d->request_count)
935		ret = r128_cce_get_buffers(dev, file_priv, d);
936
937	return ret;
938}