Linux Audio

Check our new training course

Loading...
v6.8
   1/*
   2 * AGPGART driver.
   3 * Copyright (C) 2004 Silicon Graphics, Inc.
   4 * Copyright (C) 2002-2005 Dave Jones.
   5 * Copyright (C) 1999 Jeff Hartmann.
   6 * Copyright (C) 1999 Precision Insight, Inc.
   7 * Copyright (C) 1999 Xi Graphics, Inc.
   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 shall be included
  17 * in all copies or substantial portions of the Software.
  18 *
  19 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
  20 * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  21 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  22 * JEFF HARTMANN, OR ANY OTHER CONTRIBUTORS BE LIABLE FOR ANY CLAIM,
  23 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
  24 * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE
  25 * OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  26 *
  27 * TODO:
  28 * - Allocate more than order 0 pages to avoid too much linear map splitting.
  29 */
  30#include <linux/module.h>
  31#include <linux/pci.h>
 
  32#include <linux/pagemap.h>
  33#include <linux/miscdevice.h>
  34#include <linux/pm.h>
  35#include <linux/agp_backend.h>
  36#include <linux/vmalloc.h>
  37#include <linux/dma-mapping.h>
  38#include <linux/mm.h>
  39#include <linux/sched.h>
  40#include <linux/slab.h>
  41#include <asm/io.h>
  42#ifdef CONFIG_X86
  43#include <asm/set_memory.h>
  44#endif
  45#include "agp.h"
  46
  47__u32 *agp_gatt_table;
  48int agp_memory_reserved;
  49
  50/*
  51 * Needed by the Nforce GART driver for the time being. Would be
  52 * nice to do this some other way instead of needing this export.
  53 */
  54EXPORT_SYMBOL_GPL(agp_memory_reserved);
  55
  56/*
  57 * Generic routines for handling agp_memory structures -
  58 * They use the basic page allocation routines to do the brunt of the work.
  59 */
  60
  61void agp_free_key(int key)
  62{
  63	if (key < 0)
  64		return;
  65
  66	if (key < MAXKEY)
  67		clear_bit(key, agp_bridge->key_list);
  68}
  69EXPORT_SYMBOL(agp_free_key);
  70
  71
  72static int agp_get_key(void)
  73{
  74	int bit;
  75
  76	bit = find_first_zero_bit(agp_bridge->key_list, MAXKEY);
  77	if (bit < MAXKEY) {
  78		set_bit(bit, agp_bridge->key_list);
  79		return bit;
  80	}
  81	return -1;
  82}
  83
  84/*
  85 * Use kmalloc if possible for the page list. Otherwise fall back to
  86 * vmalloc. This speeds things up and also saves memory for small AGP
  87 * regions.
  88 */
  89
  90void agp_alloc_page_array(size_t size, struct agp_memory *mem)
  91{
  92	mem->pages = kvmalloc(size, GFP_KERNEL);
 
 
 
 
 
 
  93}
  94EXPORT_SYMBOL(agp_alloc_page_array);
  95
 
 
 
 
 
 
 
 
 
 
 
  96static struct agp_memory *agp_create_user_memory(unsigned long num_agp_pages)
  97{
  98	struct agp_memory *new;
  99	unsigned long alloc_size = num_agp_pages*sizeof(struct page *);
 100
 101	if (INT_MAX/sizeof(struct page *) < num_agp_pages)
 102		return NULL;
 103
 104	new = kzalloc(sizeof(struct agp_memory), GFP_KERNEL);
 105	if (new == NULL)
 106		return NULL;
 107
 108	new->key = agp_get_key();
 109
 110	if (new->key < 0) {
 111		kfree(new);
 112		return NULL;
 113	}
 114
 115	agp_alloc_page_array(alloc_size, new);
 116
 117	if (new->pages == NULL) {
 118		agp_free_key(new->key);
 119		kfree(new);
 120		return NULL;
 121	}
 122	new->num_scratch_pages = 0;
 123	return new;
 124}
 125
 126struct agp_memory *agp_create_memory(int scratch_pages)
 127{
 128	struct agp_memory *new;
 129
 130	new = kzalloc(sizeof(struct agp_memory), GFP_KERNEL);
 131	if (new == NULL)
 132		return NULL;
 133
 134	new->key = agp_get_key();
 135
 136	if (new->key < 0) {
 137		kfree(new);
 138		return NULL;
 139	}
 140
 141	agp_alloc_page_array(PAGE_SIZE * scratch_pages, new);
 142
 143	if (new->pages == NULL) {
 144		agp_free_key(new->key);
 145		kfree(new);
 146		return NULL;
 147	}
 148	new->num_scratch_pages = scratch_pages;
 149	new->type = AGP_NORMAL_MEMORY;
 150	return new;
 151}
 152EXPORT_SYMBOL(agp_create_memory);
 153
 154/**
 155 *	agp_free_memory - free memory associated with an agp_memory pointer.
 156 *
 157 *	@curr:		agp_memory pointer to be freed.
 158 *
 159 *	It is the only function that can be called when the backend is not owned
 160 *	by the caller.  (So it can free memory on client death.)
 161 */
 162void agp_free_memory(struct agp_memory *curr)
 163{
 164	size_t i;
 165
 166	if (curr == NULL)
 167		return;
 168
 169	if (curr->is_bound)
 170		agp_unbind_memory(curr);
 171
 172	if (curr->type >= AGP_USER_TYPES) {
 173		agp_generic_free_by_type(curr);
 174		return;
 175	}
 176
 177	if (curr->type != 0) {
 178		curr->bridge->driver->free_by_type(curr);
 179		return;
 180	}
 181	if (curr->page_count != 0) {
 182		if (curr->bridge->driver->agp_destroy_pages) {
 183			curr->bridge->driver->agp_destroy_pages(curr);
 184		} else {
 185
 186			for (i = 0; i < curr->page_count; i++) {
 187				curr->bridge->driver->agp_destroy_page(
 188					curr->pages[i],
 189					AGP_PAGE_DESTROY_UNMAP);
 190			}
 191			for (i = 0; i < curr->page_count; i++) {
 192				curr->bridge->driver->agp_destroy_page(
 193					curr->pages[i],
 194					AGP_PAGE_DESTROY_FREE);
 195			}
 196		}
 197	}
 198	agp_free_key(curr->key);
 199	agp_free_page_array(curr);
 200	kfree(curr);
 201}
 202EXPORT_SYMBOL(agp_free_memory);
 203
 204#define ENTRIES_PER_PAGE		(PAGE_SIZE / sizeof(unsigned long))
 205
 206/**
 207 *	agp_allocate_memory  -  allocate a group of pages of a certain type.
 208 *
 209 *	@bridge: an agp_bridge_data struct allocated for the AGP host bridge.
 210 *	@page_count:	size_t argument of the number of pages
 211 *	@type:	u32 argument of the type of memory to be allocated.
 212 *
 213 *	Every agp bridge device will allow you to allocate AGP_NORMAL_MEMORY which
 214 *	maps to physical ram.  Any other type is device dependent.
 215 *
 216 *	It returns NULL whenever memory is unavailable.
 217 */
 218struct agp_memory *agp_allocate_memory(struct agp_bridge_data *bridge,
 219					size_t page_count, u32 type)
 220{
 221	int scratch_pages;
 222	struct agp_memory *new;
 223	size_t i;
 224	int cur_memory;
 225
 226	if (!bridge)
 227		return NULL;
 228
 229	cur_memory = atomic_read(&bridge->current_memory_agp);
 230	if ((cur_memory + page_count > bridge->max_memory_agp) ||
 231	    (cur_memory + page_count < page_count))
 232		return NULL;
 233
 234	if (type >= AGP_USER_TYPES) {
 235		new = agp_generic_alloc_user(page_count, type);
 236		if (new)
 237			new->bridge = bridge;
 238		return new;
 239	}
 240
 241	if (type != 0) {
 242		new = bridge->driver->alloc_by_type(page_count, type);
 243		if (new)
 244			new->bridge = bridge;
 245		return new;
 246	}
 247
 248	scratch_pages = (page_count + ENTRIES_PER_PAGE - 1) / ENTRIES_PER_PAGE;
 249
 250	new = agp_create_memory(scratch_pages);
 251
 252	if (new == NULL)
 253		return NULL;
 254
 255	if (bridge->driver->agp_alloc_pages) {
 256		if (bridge->driver->agp_alloc_pages(bridge, new, page_count)) {
 257			agp_free_memory(new);
 258			return NULL;
 259		}
 260		new->bridge = bridge;
 261		return new;
 262	}
 263
 264	for (i = 0; i < page_count; i++) {
 265		struct page *page = bridge->driver->agp_alloc_page(bridge);
 266
 267		if (page == NULL) {
 268			agp_free_memory(new);
 269			return NULL;
 270		}
 271		new->pages[i] = page;
 272		new->page_count++;
 273	}
 274	new->bridge = bridge;
 275
 276	return new;
 277}
 278EXPORT_SYMBOL(agp_allocate_memory);
 279
 280
 281/* End - Generic routines for handling agp_memory structures */
 282
 283
 284static int agp_return_size(void)
 285{
 286	int current_size;
 287	void *temp;
 288
 289	temp = agp_bridge->current_size;
 290
 291	switch (agp_bridge->driver->size_type) {
 292	case U8_APER_SIZE:
 293		current_size = A_SIZE_8(temp)->size;
 294		break;
 295	case U16_APER_SIZE:
 296		current_size = A_SIZE_16(temp)->size;
 297		break;
 298	case U32_APER_SIZE:
 299		current_size = A_SIZE_32(temp)->size;
 300		break;
 301	case LVL2_APER_SIZE:
 302		current_size = A_SIZE_LVL2(temp)->size;
 303		break;
 304	case FIXED_APER_SIZE:
 305		current_size = A_SIZE_FIX(temp)->size;
 306		break;
 307	default:
 308		current_size = 0;
 309		break;
 310	}
 311
 312	current_size -= (agp_memory_reserved / (1024*1024));
 313	if (current_size <0)
 314		current_size = 0;
 315	return current_size;
 316}
 317
 318
 319int agp_num_entries(void)
 320{
 321	int num_entries;
 322	void *temp;
 323
 324	temp = agp_bridge->current_size;
 325
 326	switch (agp_bridge->driver->size_type) {
 327	case U8_APER_SIZE:
 328		num_entries = A_SIZE_8(temp)->num_entries;
 329		break;
 330	case U16_APER_SIZE:
 331		num_entries = A_SIZE_16(temp)->num_entries;
 332		break;
 333	case U32_APER_SIZE:
 334		num_entries = A_SIZE_32(temp)->num_entries;
 335		break;
 336	case LVL2_APER_SIZE:
 337		num_entries = A_SIZE_LVL2(temp)->num_entries;
 338		break;
 339	case FIXED_APER_SIZE:
 340		num_entries = A_SIZE_FIX(temp)->num_entries;
 341		break;
 342	default:
 343		num_entries = 0;
 344		break;
 345	}
 346
 347	num_entries -= agp_memory_reserved>>PAGE_SHIFT;
 348	if (num_entries<0)
 349		num_entries = 0;
 350	return num_entries;
 351}
 352EXPORT_SYMBOL_GPL(agp_num_entries);
 353
 354
 355/**
 356 *	agp_copy_info  -  copy bridge state information
 357 *
 358 *	@bridge: an agp_bridge_data struct allocated for the AGP host bridge.
 359 *	@info:		agp_kern_info pointer.  The caller should insure that this pointer is valid.
 360 *
 361 *	This function copies information about the agp bridge device and the state of
 362 *	the agp backend into an agp_kern_info pointer.
 363 */
 364int agp_copy_info(struct agp_bridge_data *bridge, struct agp_kern_info *info)
 365{
 366	memset(info, 0, sizeof(struct agp_kern_info));
 367	if (!bridge) {
 368		info->chipset = NOT_SUPPORTED;
 369		return -EIO;
 370	}
 371
 372	info->version.major = bridge->version->major;
 373	info->version.minor = bridge->version->minor;
 374	info->chipset = SUPPORTED;
 375	info->device = bridge->dev;
 376	if (bridge->mode & AGPSTAT_MODE_3_0)
 377		info->mode = bridge->mode & ~AGP3_RESERVED_MASK;
 378	else
 379		info->mode = bridge->mode & ~AGP2_RESERVED_MASK;
 380	info->aper_base = bridge->gart_bus_addr;
 381	info->aper_size = agp_return_size();
 382	info->max_memory = bridge->max_memory_agp;
 383	info->current_memory = atomic_read(&bridge->current_memory_agp);
 384	info->cant_use_aperture = bridge->driver->cant_use_aperture;
 385	info->vm_ops = bridge->vm_ops;
 386	info->page_mask = ~0UL;
 387	return 0;
 388}
 389EXPORT_SYMBOL(agp_copy_info);
 390
 391/* End - Routine to copy over information structure */
 392
 393/*
 394 * Routines for handling swapping of agp_memory into the GATT -
 395 * These routines take agp_memory and insert them into the GATT.
 396 * They call device specific routines to actually write to the GATT.
 397 */
 398
 399/**
 400 *	agp_bind_memory  -  Bind an agp_memory structure into the GATT.
 401 *
 402 *	@curr:		agp_memory pointer
 403 *	@pg_start:	an offset into the graphics aperture translation table
 404 *
 405 *	It returns -EINVAL if the pointer == NULL.
 406 *	It returns -EBUSY if the area of the table requested is already in use.
 407 */
 408int agp_bind_memory(struct agp_memory *curr, off_t pg_start)
 409{
 410	int ret_val;
 411
 412	if (curr == NULL)
 413		return -EINVAL;
 414
 415	if (curr->is_bound) {
 416		printk(KERN_INFO PFX "memory %p is already bound!\n", curr);
 417		return -EINVAL;
 418	}
 419	if (!curr->is_flushed) {
 420		curr->bridge->driver->cache_flush();
 421		curr->is_flushed = true;
 422	}
 423
 424	ret_val = curr->bridge->driver->insert_memory(curr, pg_start, curr->type);
 425
 426	if (ret_val != 0)
 427		return ret_val;
 428
 429	curr->is_bound = true;
 430	curr->pg_start = pg_start;
 431	spin_lock(&agp_bridge->mapped_lock);
 432	list_add(&curr->mapped_list, &agp_bridge->mapped_list);
 433	spin_unlock(&agp_bridge->mapped_lock);
 434
 435	return 0;
 436}
 437EXPORT_SYMBOL(agp_bind_memory);
 438
 439
 440/**
 441 *	agp_unbind_memory  -  Removes an agp_memory structure from the GATT
 442 *
 443 * @curr:	agp_memory pointer to be removed from the GATT.
 444 *
 445 * It returns -EINVAL if this piece of agp_memory is not currently bound to
 446 * the graphics aperture translation table or if the agp_memory pointer == NULL
 447 */
 448int agp_unbind_memory(struct agp_memory *curr)
 449{
 450	int ret_val;
 451
 452	if (curr == NULL)
 453		return -EINVAL;
 454
 455	if (!curr->is_bound) {
 456		printk(KERN_INFO PFX "memory %p was not bound!\n", curr);
 457		return -EINVAL;
 458	}
 459
 460	ret_val = curr->bridge->driver->remove_memory(curr, curr->pg_start, curr->type);
 461
 462	if (ret_val != 0)
 463		return ret_val;
 464
 465	curr->is_bound = false;
 466	curr->pg_start = 0;
 467	spin_lock(&curr->bridge->mapped_lock);
 468	list_del(&curr->mapped_list);
 469	spin_unlock(&curr->bridge->mapped_lock);
 470	return 0;
 471}
 472EXPORT_SYMBOL(agp_unbind_memory);
 473
 474
 475/* End - Routines for handling swapping of agp_memory into the GATT */
 476
 477
 478/* Generic Agp routines - Start */
 479static void agp_v2_parse_one(u32 *requested_mode, u32 *bridge_agpstat, u32 *vga_agpstat)
 480{
 481	u32 tmp;
 482
 483	if (*requested_mode & AGP2_RESERVED_MASK) {
 484		printk(KERN_INFO PFX "reserved bits set (%x) in mode 0x%x. Fixed.\n",
 485			*requested_mode & AGP2_RESERVED_MASK, *requested_mode);
 486		*requested_mode &= ~AGP2_RESERVED_MASK;
 487	}
 488
 489	/*
 490	 * Some dumb bridges are programmed to disobey the AGP2 spec.
 491	 * This is likely a BIOS misprogramming rather than poweron default, or
 492	 * it would be a lot more common.
 493	 * https://bugs.freedesktop.org/show_bug.cgi?id=8816
 494	 * AGPv2 spec 6.1.9 states:
 495	 *   The RATE field indicates the data transfer rates supported by this
 496	 *   device. A.G.P. devices must report all that apply.
 497	 * Fix them up as best we can.
 498	 */
 499	switch (*bridge_agpstat & 7) {
 500	case 4:
 501		*bridge_agpstat |= (AGPSTAT2_2X | AGPSTAT2_1X);
 502		printk(KERN_INFO PFX "BIOS bug. AGP bridge claims to only support x4 rate. "
 503			"Fixing up support for x2 & x1\n");
 504		break;
 505	case 2:
 506		*bridge_agpstat |= AGPSTAT2_1X;
 507		printk(KERN_INFO PFX "BIOS bug. AGP bridge claims to only support x2 rate. "
 508			"Fixing up support for x1\n");
 509		break;
 510	default:
 511		break;
 512	}
 513
 514	/* Check the speed bits make sense. Only one should be set. */
 515	tmp = *requested_mode & 7;
 516	switch (tmp) {
 517		case 0:
 518			printk(KERN_INFO PFX "%s tried to set rate=x0. Setting to x1 mode.\n", current->comm);
 519			*requested_mode |= AGPSTAT2_1X;
 520			break;
 521		case 1:
 522		case 2:
 523			break;
 524		case 3:
 525			*requested_mode &= ~(AGPSTAT2_1X);	/* rate=2 */
 526			break;
 527		case 4:
 528			break;
 529		case 5:
 530		case 6:
 531		case 7:
 532			*requested_mode &= ~(AGPSTAT2_1X|AGPSTAT2_2X); /* rate=4*/
 533			break;
 534	}
 535
 536	/* disable SBA if it's not supported */
 537	if (!((*bridge_agpstat & AGPSTAT_SBA) && (*vga_agpstat & AGPSTAT_SBA) && (*requested_mode & AGPSTAT_SBA)))
 538		*bridge_agpstat &= ~AGPSTAT_SBA;
 539
 540	/* Set rate */
 541	if (!((*bridge_agpstat & AGPSTAT2_4X) && (*vga_agpstat & AGPSTAT2_4X) && (*requested_mode & AGPSTAT2_4X)))
 542		*bridge_agpstat &= ~AGPSTAT2_4X;
 543
 544	if (!((*bridge_agpstat & AGPSTAT2_2X) && (*vga_agpstat & AGPSTAT2_2X) && (*requested_mode & AGPSTAT2_2X)))
 545		*bridge_agpstat &= ~AGPSTAT2_2X;
 546
 547	if (!((*bridge_agpstat & AGPSTAT2_1X) && (*vga_agpstat & AGPSTAT2_1X) && (*requested_mode & AGPSTAT2_1X)))
 548		*bridge_agpstat &= ~AGPSTAT2_1X;
 549
 550	/* Now we know what mode it should be, clear out the unwanted bits. */
 551	if (*bridge_agpstat & AGPSTAT2_4X)
 552		*bridge_agpstat &= ~(AGPSTAT2_1X | AGPSTAT2_2X);	/* 4X */
 553
 554	if (*bridge_agpstat & AGPSTAT2_2X)
 555		*bridge_agpstat &= ~(AGPSTAT2_1X | AGPSTAT2_4X);	/* 2X */
 556
 557	if (*bridge_agpstat & AGPSTAT2_1X)
 558		*bridge_agpstat &= ~(AGPSTAT2_2X | AGPSTAT2_4X);	/* 1X */
 559
 560	/* Apply any errata. */
 561	if (agp_bridge->flags & AGP_ERRATA_FASTWRITES)
 562		*bridge_agpstat &= ~AGPSTAT_FW;
 563
 564	if (agp_bridge->flags & AGP_ERRATA_SBA)
 565		*bridge_agpstat &= ~AGPSTAT_SBA;
 566
 567	if (agp_bridge->flags & AGP_ERRATA_1X) {
 568		*bridge_agpstat &= ~(AGPSTAT2_2X | AGPSTAT2_4X);
 569		*bridge_agpstat |= AGPSTAT2_1X;
 570	}
 571
 572	/* If we've dropped down to 1X, disable fast writes. */
 573	if (*bridge_agpstat & AGPSTAT2_1X)
 574		*bridge_agpstat &= ~AGPSTAT_FW;
 575}
 576
 577/*
 578 * requested_mode = Mode requested by (typically) X.
 579 * bridge_agpstat = PCI_AGP_STATUS from agp bridge.
 580 * vga_agpstat = PCI_AGP_STATUS from graphic card.
 581 */
 582static void agp_v3_parse_one(u32 *requested_mode, u32 *bridge_agpstat, u32 *vga_agpstat)
 583{
 584	u32 origbridge=*bridge_agpstat, origvga=*vga_agpstat;
 585	u32 tmp;
 586
 587	if (*requested_mode & AGP3_RESERVED_MASK) {
 588		printk(KERN_INFO PFX "reserved bits set (%x) in mode 0x%x. Fixed.\n",
 589			*requested_mode & AGP3_RESERVED_MASK, *requested_mode);
 590		*requested_mode &= ~AGP3_RESERVED_MASK;
 591	}
 592
 593	/* Check the speed bits make sense. */
 594	tmp = *requested_mode & 7;
 595	if (tmp == 0) {
 596		printk(KERN_INFO PFX "%s tried to set rate=x0. Setting to AGP3 x4 mode.\n", current->comm);
 597		*requested_mode |= AGPSTAT3_4X;
 598	}
 599	if (tmp >= 3) {
 600		printk(KERN_INFO PFX "%s tried to set rate=x%d. Setting to AGP3 x8 mode.\n", current->comm, tmp * 4);
 601		*requested_mode = (*requested_mode & ~7) | AGPSTAT3_8X;
 602	}
 603
 604	/* ARQSZ - Set the value to the maximum one.
 605	 * Don't allow the mode register to override values. */
 606	*bridge_agpstat = ((*bridge_agpstat & ~AGPSTAT_ARQSZ) |
 607		max_t(u32,(*bridge_agpstat & AGPSTAT_ARQSZ),(*vga_agpstat & AGPSTAT_ARQSZ)));
 608
 609	/* Calibration cycle.
 610	 * Don't allow the mode register to override values. */
 611	*bridge_agpstat = ((*bridge_agpstat & ~AGPSTAT_CAL_MASK) |
 612		min_t(u32,(*bridge_agpstat & AGPSTAT_CAL_MASK),(*vga_agpstat & AGPSTAT_CAL_MASK)));
 613
 614	/* SBA *must* be supported for AGP v3 */
 615	*bridge_agpstat |= AGPSTAT_SBA;
 616
 617	/*
 618	 * Set speed.
 619	 * Check for invalid speeds. This can happen when applications
 620	 * written before the AGP 3.0 standard pass AGP2.x modes to AGP3 hardware
 621	 */
 622	if (*requested_mode & AGPSTAT_MODE_3_0) {
 623		/*
 624		 * Caller hasn't a clue what it is doing. Bridge is in 3.0 mode,
 625		 * have been passed a 3.0 mode, but with 2.x speed bits set.
 626		 * AGP2.x 4x -> AGP3.0 4x.
 627		 */
 628		if (*requested_mode & AGPSTAT2_4X) {
 629			printk(KERN_INFO PFX "%s passes broken AGP3 flags (%x). Fixed.\n",
 630						current->comm, *requested_mode);
 631			*requested_mode &= ~AGPSTAT2_4X;
 632			*requested_mode |= AGPSTAT3_4X;
 633		}
 634	} else {
 635		/*
 636		 * The caller doesn't know what they are doing. We are in 3.0 mode,
 637		 * but have been passed an AGP 2.x mode.
 638		 * Convert AGP 1x,2x,4x -> AGP 3.0 4x.
 639		 */
 640		printk(KERN_INFO PFX "%s passes broken AGP2 flags (%x) in AGP3 mode. Fixed.\n",
 641					current->comm, *requested_mode);
 642		*requested_mode &= ~(AGPSTAT2_4X | AGPSTAT2_2X | AGPSTAT2_1X);
 643		*requested_mode |= AGPSTAT3_4X;
 644	}
 645
 646	if (*requested_mode & AGPSTAT3_8X) {
 647		if (!(*bridge_agpstat & AGPSTAT3_8X)) {
 648			*bridge_agpstat &= ~(AGPSTAT3_8X | AGPSTAT3_RSVD);
 649			*bridge_agpstat |= AGPSTAT3_4X;
 650			printk(KERN_INFO PFX "%s requested AGPx8 but bridge not capable.\n", current->comm);
 651			return;
 652		}
 653		if (!(*vga_agpstat & AGPSTAT3_8X)) {
 654			*bridge_agpstat &= ~(AGPSTAT3_8X | AGPSTAT3_RSVD);
 655			*bridge_agpstat |= AGPSTAT3_4X;
 656			printk(KERN_INFO PFX "%s requested AGPx8 but graphic card not capable.\n", current->comm);
 657			return;
 658		}
 659		/* All set, bridge & device can do AGP x8*/
 660		*bridge_agpstat &= ~(AGPSTAT3_4X | AGPSTAT3_RSVD);
 661		goto done;
 662
 663	} else if (*requested_mode & AGPSTAT3_4X) {
 664		*bridge_agpstat &= ~(AGPSTAT3_8X | AGPSTAT3_RSVD);
 665		*bridge_agpstat |= AGPSTAT3_4X;
 666		goto done;
 667
 668	} else {
 669
 670		/*
 671		 * If we didn't specify an AGP mode, we see if both
 672		 * the graphics card, and the bridge can do x8, and use if so.
 673		 * If not, we fall back to x4 mode.
 674		 */
 675		if ((*bridge_agpstat & AGPSTAT3_8X) && (*vga_agpstat & AGPSTAT3_8X)) {
 676			printk(KERN_INFO PFX "No AGP mode specified. Setting to highest mode "
 677				"supported by bridge & card (x8).\n");
 678			*bridge_agpstat &= ~(AGPSTAT3_4X | AGPSTAT3_RSVD);
 679			*vga_agpstat &= ~(AGPSTAT3_4X | AGPSTAT3_RSVD);
 680		} else {
 681			printk(KERN_INFO PFX "Fell back to AGPx4 mode because ");
 682			if (!(*bridge_agpstat & AGPSTAT3_8X)) {
 683				printk(KERN_INFO PFX "bridge couldn't do x8. bridge_agpstat:%x (orig=%x)\n",
 684					*bridge_agpstat, origbridge);
 685				*bridge_agpstat &= ~(AGPSTAT3_8X | AGPSTAT3_RSVD);
 686				*bridge_agpstat |= AGPSTAT3_4X;
 687			}
 688			if (!(*vga_agpstat & AGPSTAT3_8X)) {
 689				printk(KERN_INFO PFX "graphics card couldn't do x8. vga_agpstat:%x (orig=%x)\n",
 690					*vga_agpstat, origvga);
 691				*vga_agpstat &= ~(AGPSTAT3_8X | AGPSTAT3_RSVD);
 692				*vga_agpstat |= AGPSTAT3_4X;
 693			}
 694		}
 695	}
 696
 697done:
 698	/* Apply any errata. */
 699	if (agp_bridge->flags & AGP_ERRATA_FASTWRITES)
 700		*bridge_agpstat &= ~AGPSTAT_FW;
 701
 702	if (agp_bridge->flags & AGP_ERRATA_SBA)
 703		*bridge_agpstat &= ~AGPSTAT_SBA;
 704
 705	if (agp_bridge->flags & AGP_ERRATA_1X) {
 706		*bridge_agpstat &= ~(AGPSTAT2_2X | AGPSTAT2_4X);
 707		*bridge_agpstat |= AGPSTAT2_1X;
 708	}
 709}
 710
 711
 712/**
 713 * agp_collect_device_status - determine correct agp_cmd from various agp_stat's
 714 * @bridge: an agp_bridge_data struct allocated for the AGP host bridge.
 715 * @requested_mode: requested agp_stat from userspace (Typically from X)
 716 * @bridge_agpstat: current agp_stat from AGP bridge.
 717 *
 718 * This function will hunt for an AGP graphics card, and try to match
 719 * the requested mode to the capabilities of both the bridge and the card.
 720 */
 721u32 agp_collect_device_status(struct agp_bridge_data *bridge, u32 requested_mode, u32 bridge_agpstat)
 722{
 723	struct pci_dev *device = NULL;
 724	u32 vga_agpstat;
 725	u8 cap_ptr;
 726
 727	for (;;) {
 728		device = pci_get_class(PCI_CLASS_DISPLAY_VGA << 8, device);
 729		if (!device) {
 730			printk(KERN_INFO PFX "Couldn't find an AGP VGA controller.\n");
 731			return 0;
 732		}
 733		cap_ptr = pci_find_capability(device, PCI_CAP_ID_AGP);
 734		if (cap_ptr)
 735			break;
 736	}
 737
 738	/*
 739	 * Ok, here we have a AGP device. Disable impossible
 740	 * settings, and adjust the readqueue to the minimum.
 741	 */
 742	pci_read_config_dword(device, cap_ptr+PCI_AGP_STATUS, &vga_agpstat);
 743
 744	/* adjust RQ depth */
 745	bridge_agpstat = ((bridge_agpstat & ~AGPSTAT_RQ_DEPTH) |
 746	     min_t(u32, (requested_mode & AGPSTAT_RQ_DEPTH),
 747		 min_t(u32, (bridge_agpstat & AGPSTAT_RQ_DEPTH), (vga_agpstat & AGPSTAT_RQ_DEPTH))));
 748
 749	/* disable FW if it's not supported */
 750	if (!((bridge_agpstat & AGPSTAT_FW) &&
 751		 (vga_agpstat & AGPSTAT_FW) &&
 752		 (requested_mode & AGPSTAT_FW)))
 753		bridge_agpstat &= ~AGPSTAT_FW;
 754
 755	/* Check to see if we are operating in 3.0 mode */
 756	if (agp_bridge->mode & AGPSTAT_MODE_3_0)
 757		agp_v3_parse_one(&requested_mode, &bridge_agpstat, &vga_agpstat);
 758	else
 759		agp_v2_parse_one(&requested_mode, &bridge_agpstat, &vga_agpstat);
 760
 761	pci_dev_put(device);
 762	return bridge_agpstat;
 763}
 764EXPORT_SYMBOL(agp_collect_device_status);
 765
 766
 767void agp_device_command(u32 bridge_agpstat, bool agp_v3)
 768{
 769	struct pci_dev *device = NULL;
 770	int mode;
 771
 772	mode = bridge_agpstat & 0x7;
 773	if (agp_v3)
 774		mode *= 4;
 775
 776	for_each_pci_dev(device) {
 777		u8 agp = pci_find_capability(device, PCI_CAP_ID_AGP);
 778		if (!agp)
 779			continue;
 780
 781		dev_info(&device->dev, "putting AGP V%d device into %dx mode\n",
 782			 agp_v3 ? 3 : 2, mode);
 783		pci_write_config_dword(device, agp + PCI_AGP_COMMAND, bridge_agpstat);
 784	}
 785}
 786EXPORT_SYMBOL(agp_device_command);
 787
 788
 789void get_agp_version(struct agp_bridge_data *bridge)
 790{
 791	u32 ncapid;
 792
 793	/* Exit early if already set by errata workarounds. */
 794	if (bridge->major_version != 0)
 795		return;
 796
 797	pci_read_config_dword(bridge->dev, bridge->capndx, &ncapid);
 798	bridge->major_version = (ncapid >> AGP_MAJOR_VERSION_SHIFT) & 0xf;
 799	bridge->minor_version = (ncapid >> AGP_MINOR_VERSION_SHIFT) & 0xf;
 800}
 801EXPORT_SYMBOL(get_agp_version);
 802
 803
 804void agp_generic_enable(struct agp_bridge_data *bridge, u32 requested_mode)
 805{
 806	u32 bridge_agpstat, temp;
 807
 808	get_agp_version(agp_bridge);
 809
 810	dev_info(&agp_bridge->dev->dev, "AGP %d.%d bridge\n",
 811		 agp_bridge->major_version, agp_bridge->minor_version);
 812
 813	pci_read_config_dword(agp_bridge->dev,
 814		      agp_bridge->capndx + PCI_AGP_STATUS, &bridge_agpstat);
 815
 816	bridge_agpstat = agp_collect_device_status(agp_bridge, requested_mode, bridge_agpstat);
 817	if (bridge_agpstat == 0)
 818		/* Something bad happened. FIXME: Return error code? */
 819		return;
 820
 821	bridge_agpstat |= AGPSTAT_AGP_ENABLE;
 822
 823	/* Do AGP version specific frobbing. */
 824	if (bridge->major_version >= 3) {
 825		if (bridge->mode & AGPSTAT_MODE_3_0) {
 826			/* If we have 3.5, we can do the isoch stuff. */
 827			if (bridge->minor_version >= 5)
 828				agp_3_5_enable(bridge);
 829			agp_device_command(bridge_agpstat, true);
 830			return;
 831		} else {
 832		    /* Disable calibration cycle in RX91<1> when not in AGP3.0 mode of operation.*/
 833		    bridge_agpstat &= ~(7<<10) ;
 834		    pci_read_config_dword(bridge->dev,
 835					bridge->capndx+AGPCTRL, &temp);
 836		    temp |= (1<<9);
 837		    pci_write_config_dword(bridge->dev,
 838					bridge->capndx+AGPCTRL, temp);
 839
 840		    dev_info(&bridge->dev->dev, "bridge is in legacy mode, falling back to 2.x\n");
 841		}
 842	}
 843
 844	/* AGP v<3 */
 845	agp_device_command(bridge_agpstat, false);
 846}
 847EXPORT_SYMBOL(agp_generic_enable);
 848
 849
 850int agp_generic_create_gatt_table(struct agp_bridge_data *bridge)
 851{
 852	char *table;
 853	char *table_end;
 
 854	int page_order;
 855	int num_entries;
 856	int i;
 857	void *temp;
 858	struct page *page;
 859
 860	/* The generic routines can't handle 2 level gatt's */
 861	if (bridge->driver->size_type == LVL2_APER_SIZE)
 862		return -EINVAL;
 863
 864	table = NULL;
 865	i = bridge->aperture_size_idx;
 866	temp = bridge->current_size;
 867	page_order = num_entries = 0;
 868
 869	if (bridge->driver->size_type != FIXED_APER_SIZE) {
 870		do {
 871			switch (bridge->driver->size_type) {
 872			case U8_APER_SIZE:
 
 873				page_order =
 874				    A_SIZE_8(temp)->page_order;
 875				num_entries =
 876				    A_SIZE_8(temp)->num_entries;
 877				break;
 878			case U16_APER_SIZE:
 
 879				page_order = A_SIZE_16(temp)->page_order;
 880				num_entries = A_SIZE_16(temp)->num_entries;
 881				break;
 882			case U32_APER_SIZE:
 
 883				page_order = A_SIZE_32(temp)->page_order;
 884				num_entries = A_SIZE_32(temp)->num_entries;
 885				break;
 886				/* This case will never really happen. */
 887			case FIXED_APER_SIZE:
 888			case LVL2_APER_SIZE:
 889			default:
 890				page_order = num_entries = 0;
 891				break;
 892			}
 893
 894			table = alloc_gatt_pages(page_order);
 895
 896			if (table == NULL) {
 897				i++;
 898				switch (bridge->driver->size_type) {
 899				case U8_APER_SIZE:
 900					bridge->current_size = A_IDX8(bridge);
 901					break;
 902				case U16_APER_SIZE:
 903					bridge->current_size = A_IDX16(bridge);
 904					break;
 905				case U32_APER_SIZE:
 906					bridge->current_size = A_IDX32(bridge);
 907					break;
 908				/* These cases will never really happen. */
 909				case FIXED_APER_SIZE:
 910				case LVL2_APER_SIZE:
 911				default:
 912					break;
 913				}
 914				temp = bridge->current_size;
 915			} else {
 916				bridge->aperture_size_idx = i;
 917			}
 918		} while (!table && (i < bridge->driver->num_aperture_sizes));
 919	} else {
 
 920		page_order = ((struct aper_size_info_fixed *) temp)->page_order;
 921		num_entries = ((struct aper_size_info_fixed *) temp)->num_entries;
 922		table = alloc_gatt_pages(page_order);
 923	}
 924
 925	if (table == NULL)
 926		return -ENOMEM;
 927
 928	table_end = table + ((PAGE_SIZE * (1 << page_order)) - 1);
 929
 930	for (page = virt_to_page(table); page <= virt_to_page(table_end); page++)
 931		SetPageReserved(page);
 932
 933	bridge->gatt_table_real = (u32 *) table;
 934	agp_gatt_table = (void *)table;
 935
 936	bridge->driver->cache_flush();
 937#ifdef CONFIG_X86
 938	if (set_memory_uc((unsigned long)table, 1 << page_order))
 939		printk(KERN_WARNING "Could not set GATT table memory to UC!\n");
 940
 941	bridge->gatt_table = (u32 __iomem *)table;
 942#else
 943	bridge->gatt_table = ioremap(virt_to_phys(table),
 944					(PAGE_SIZE * (1 << page_order)));
 945	bridge->driver->cache_flush();
 946#endif
 947
 948	if (bridge->gatt_table == NULL) {
 949		for (page = virt_to_page(table); page <= virt_to_page(table_end); page++)
 950			ClearPageReserved(page);
 951
 952		free_gatt_pages(table, page_order);
 953
 954		return -ENOMEM;
 955	}
 956	bridge->gatt_bus_addr = virt_to_phys(bridge->gatt_table_real);
 957
 958	/* AK: bogus, should encode addresses > 4GB */
 959	for (i = 0; i < num_entries; i++) {
 960		writel(bridge->scratch_page, bridge->gatt_table+i);
 961		readl(bridge->gatt_table+i);	/* PCI Posting. */
 962	}
 963
 964	return 0;
 965}
 966EXPORT_SYMBOL(agp_generic_create_gatt_table);
 967
 968int agp_generic_free_gatt_table(struct agp_bridge_data *bridge)
 969{
 970	int page_order;
 971	char *table, *table_end;
 972	void *temp;
 973	struct page *page;
 974
 975	temp = bridge->current_size;
 976
 977	switch (bridge->driver->size_type) {
 978	case U8_APER_SIZE:
 979		page_order = A_SIZE_8(temp)->page_order;
 980		break;
 981	case U16_APER_SIZE:
 982		page_order = A_SIZE_16(temp)->page_order;
 983		break;
 984	case U32_APER_SIZE:
 985		page_order = A_SIZE_32(temp)->page_order;
 986		break;
 987	case FIXED_APER_SIZE:
 988		page_order = A_SIZE_FIX(temp)->page_order;
 989		break;
 990	case LVL2_APER_SIZE:
 991		/* The generic routines can't deal with 2 level gatt's */
 992		return -EINVAL;
 993	default:
 994		page_order = 0;
 995		break;
 996	}
 997
 998	/* Do not worry about freeing memory, because if this is
 999	 * called, then all agp memory is deallocated and removed
1000	 * from the table. */
1001
1002#ifdef CONFIG_X86
1003	set_memory_wb((unsigned long)bridge->gatt_table, 1 << page_order);
1004#else
1005	iounmap(bridge->gatt_table);
1006#endif
1007	table = (char *) bridge->gatt_table_real;
1008	table_end = table + ((PAGE_SIZE * (1 << page_order)) - 1);
1009
1010	for (page = virt_to_page(table); page <= virt_to_page(table_end); page++)
1011		ClearPageReserved(page);
1012
1013	free_gatt_pages(bridge->gatt_table_real, page_order);
1014
1015	agp_gatt_table = NULL;
1016	bridge->gatt_table = NULL;
1017	bridge->gatt_table_real = NULL;
1018	bridge->gatt_bus_addr = 0;
1019
1020	return 0;
1021}
1022EXPORT_SYMBOL(agp_generic_free_gatt_table);
1023
1024
1025int agp_generic_insert_memory(struct agp_memory * mem, off_t pg_start, int type)
1026{
1027	int num_entries;
1028	size_t i;
1029	off_t j;
1030	void *temp;
1031	struct agp_bridge_data *bridge;
1032	int mask_type;
1033
1034	bridge = mem->bridge;
1035	if (!bridge)
1036		return -EINVAL;
1037
1038	if (mem->page_count == 0)
1039		return 0;
1040
1041	temp = bridge->current_size;
1042
1043	switch (bridge->driver->size_type) {
1044	case U8_APER_SIZE:
1045		num_entries = A_SIZE_8(temp)->num_entries;
1046		break;
1047	case U16_APER_SIZE:
1048		num_entries = A_SIZE_16(temp)->num_entries;
1049		break;
1050	case U32_APER_SIZE:
1051		num_entries = A_SIZE_32(temp)->num_entries;
1052		break;
1053	case FIXED_APER_SIZE:
1054		num_entries = A_SIZE_FIX(temp)->num_entries;
1055		break;
1056	case LVL2_APER_SIZE:
1057		/* The generic routines can't deal with 2 level gatt's */
1058		return -EINVAL;
1059	default:
1060		num_entries = 0;
1061		break;
1062	}
1063
1064	num_entries -= agp_memory_reserved/PAGE_SIZE;
1065	if (num_entries < 0) num_entries = 0;
1066
1067	if (type != mem->type)
1068		return -EINVAL;
1069
1070	mask_type = bridge->driver->agp_type_to_mask_type(bridge, type);
1071	if (mask_type != 0) {
1072		/* The generic routines know nothing of memory types */
1073		return -EINVAL;
1074	}
1075
1076	if (((pg_start + mem->page_count) > num_entries) ||
1077	    ((pg_start + mem->page_count) < pg_start))
1078		return -EINVAL;
1079
1080	j = pg_start;
1081
1082	while (j < (pg_start + mem->page_count)) {
1083		if (!PGE_EMPTY(bridge, readl(bridge->gatt_table+j)))
1084			return -EBUSY;
1085		j++;
1086	}
1087
1088	if (!mem->is_flushed) {
1089		bridge->driver->cache_flush();
1090		mem->is_flushed = true;
1091	}
1092
1093	for (i = 0, j = pg_start; i < mem->page_count; i++, j++) {
1094		writel(bridge->driver->mask_memory(bridge,
1095						   page_to_phys(mem->pages[i]),
1096						   mask_type),
1097		       bridge->gatt_table+j);
1098	}
1099	readl(bridge->gatt_table+j-1);	/* PCI Posting. */
1100
1101	bridge->driver->tlb_flush(mem);
1102	return 0;
1103}
1104EXPORT_SYMBOL(agp_generic_insert_memory);
1105
1106
1107int agp_generic_remove_memory(struct agp_memory *mem, off_t pg_start, int type)
1108{
1109	size_t i;
1110	struct agp_bridge_data *bridge;
1111	int mask_type, num_entries;
1112
1113	bridge = mem->bridge;
1114	if (!bridge)
1115		return -EINVAL;
1116
1117	if (mem->page_count == 0)
1118		return 0;
1119
1120	if (type != mem->type)
1121		return -EINVAL;
1122
1123	num_entries = agp_num_entries();
1124	if (((pg_start + mem->page_count) > num_entries) ||
1125	    ((pg_start + mem->page_count) < pg_start))
1126		return -EINVAL;
1127
1128	mask_type = bridge->driver->agp_type_to_mask_type(bridge, type);
1129	if (mask_type != 0) {
1130		/* The generic routines know nothing of memory types */
1131		return -EINVAL;
1132	}
1133
1134	/* AK: bogus, should encode addresses > 4GB */
1135	for (i = pg_start; i < (mem->page_count + pg_start); i++) {
1136		writel(bridge->scratch_page, bridge->gatt_table+i);
1137	}
1138	readl(bridge->gatt_table+i-1);	/* PCI Posting. */
1139
1140	bridge->driver->tlb_flush(mem);
1141	return 0;
1142}
1143EXPORT_SYMBOL(agp_generic_remove_memory);
1144
1145struct agp_memory *agp_generic_alloc_by_type(size_t page_count, int type)
1146{
1147	return NULL;
1148}
1149EXPORT_SYMBOL(agp_generic_alloc_by_type);
1150
1151void agp_generic_free_by_type(struct agp_memory *curr)
1152{
1153	agp_free_page_array(curr);
1154	agp_free_key(curr->key);
1155	kfree(curr);
1156}
1157EXPORT_SYMBOL(agp_generic_free_by_type);
1158
1159struct agp_memory *agp_generic_alloc_user(size_t page_count, int type)
1160{
1161	struct agp_memory *new;
1162	int i;
1163	int pages;
1164
1165	pages = (page_count + ENTRIES_PER_PAGE - 1) / ENTRIES_PER_PAGE;
1166	new = agp_create_user_memory(page_count);
1167	if (new == NULL)
1168		return NULL;
1169
1170	for (i = 0; i < page_count; i++)
1171		new->pages[i] = NULL;
1172	new->page_count = 0;
1173	new->type = type;
1174	new->num_scratch_pages = pages;
1175
1176	return new;
1177}
1178EXPORT_SYMBOL(agp_generic_alloc_user);
1179
1180/*
1181 * Basic Page Allocation Routines -
1182 * These routines handle page allocation and by default they reserve the allocated
1183 * memory.  They also handle incrementing the current_memory_agp value, Which is checked
1184 * against a maximum value.
1185 */
1186
1187int agp_generic_alloc_pages(struct agp_bridge_data *bridge, struct agp_memory *mem, size_t num_pages)
1188{
1189	struct page * page;
1190	int i, ret = -ENOMEM;
1191
1192	for (i = 0; i < num_pages; i++) {
1193		page = alloc_page(GFP_KERNEL | GFP_DMA32 | __GFP_ZERO);
1194		/* agp_free_memory() needs gart address */
1195		if (page == NULL)
1196			goto out;
1197
1198#ifndef CONFIG_X86
1199		map_page_into_agp(page);
1200#endif
1201		get_page(page);
1202		atomic_inc(&agp_bridge->current_memory_agp);
1203
1204		mem->pages[i] = page;
1205		mem->page_count++;
1206	}
1207
1208#ifdef CONFIG_X86
1209	set_pages_array_uc(mem->pages, num_pages);
1210#endif
1211	ret = 0;
1212out:
1213	return ret;
1214}
1215EXPORT_SYMBOL(agp_generic_alloc_pages);
1216
1217struct page *agp_generic_alloc_page(struct agp_bridge_data *bridge)
1218{
1219	struct page * page;
1220
1221	page = alloc_page(GFP_KERNEL | GFP_DMA32 | __GFP_ZERO);
1222	if (page == NULL)
1223		return NULL;
1224
1225	map_page_into_agp(page);
1226
1227	get_page(page);
1228	atomic_inc(&agp_bridge->current_memory_agp);
1229	return page;
1230}
1231EXPORT_SYMBOL(agp_generic_alloc_page);
1232
1233void agp_generic_destroy_pages(struct agp_memory *mem)
1234{
1235	int i;
1236	struct page *page;
1237
1238	if (!mem)
1239		return;
1240
1241#ifdef CONFIG_X86
1242	set_pages_array_wb(mem->pages, mem->page_count);
1243#endif
1244
1245	for (i = 0; i < mem->page_count; i++) {
1246		page = mem->pages[i];
1247
1248#ifndef CONFIG_X86
1249		unmap_page_from_agp(page);
1250#endif
1251		put_page(page);
1252		__free_page(page);
1253		atomic_dec(&agp_bridge->current_memory_agp);
1254		mem->pages[i] = NULL;
1255	}
1256}
1257EXPORT_SYMBOL(agp_generic_destroy_pages);
1258
1259void agp_generic_destroy_page(struct page *page, int flags)
1260{
1261	if (page == NULL)
1262		return;
1263
1264	if (flags & AGP_PAGE_DESTROY_UNMAP)
1265		unmap_page_from_agp(page);
1266
1267	if (flags & AGP_PAGE_DESTROY_FREE) {
1268		put_page(page);
1269		__free_page(page);
1270		atomic_dec(&agp_bridge->current_memory_agp);
1271	}
1272}
1273EXPORT_SYMBOL(agp_generic_destroy_page);
1274
1275/* End Basic Page Allocation Routines */
1276
1277
1278/**
1279 * agp_enable  -  initialise the agp point-to-point connection.
1280 *
1281 * @bridge: an agp_bridge_data struct allocated for the AGP host bridge.
1282 * @mode:	agp mode register value to configure with.
1283 */
1284void agp_enable(struct agp_bridge_data *bridge, u32 mode)
1285{
1286	if (!bridge)
1287		return;
1288	bridge->driver->agp_enable(bridge, mode);
1289}
1290EXPORT_SYMBOL(agp_enable);
1291
1292/* When we remove the global variable agp_bridge from all drivers
1293 * then agp_alloc_bridge and agp_generic_find_bridge need to be updated
1294 */
1295
1296struct agp_bridge_data *agp_generic_find_bridge(struct pci_dev *pdev)
1297{
1298	if (list_empty(&agp_bridges))
1299		return NULL;
1300
1301	return agp_bridge;
1302}
1303
1304static void ipi_handler(void *null)
1305{
1306	flush_agp_cache();
1307}
1308
1309void global_cache_flush(void)
1310{
1311	on_each_cpu(ipi_handler, NULL, 1);
 
1312}
1313EXPORT_SYMBOL(global_cache_flush);
1314
1315unsigned long agp_generic_mask_memory(struct agp_bridge_data *bridge,
1316				      dma_addr_t addr, int type)
1317{
1318	/* memory type is ignored in the generic routine */
1319	if (bridge->driver->masks)
1320		return addr | bridge->driver->masks[0].mask;
1321	else
1322		return addr;
1323}
1324EXPORT_SYMBOL(agp_generic_mask_memory);
1325
1326int agp_generic_type_to_mask_type(struct agp_bridge_data *bridge,
1327				  int type)
1328{
1329	if (type >= AGP_USER_TYPES)
1330		return 0;
1331	return type;
1332}
1333EXPORT_SYMBOL(agp_generic_type_to_mask_type);
1334
1335/*
1336 * These functions are implemented according to the AGPv3 spec,
1337 * which covers implementation details that had previously been
1338 * left open.
1339 */
1340
1341int agp3_generic_fetch_size(void)
1342{
1343	u16 temp_size;
1344	int i;
1345	struct aper_size_info_16 *values;
1346
1347	pci_read_config_word(agp_bridge->dev, agp_bridge->capndx+AGPAPSIZE, &temp_size);
1348	values = A_SIZE_16(agp_bridge->driver->aperture_sizes);
1349
1350	for (i = 0; i < agp_bridge->driver->num_aperture_sizes; i++) {
1351		if (temp_size == values[i].size_value) {
1352			agp_bridge->previous_size =
1353				agp_bridge->current_size = (void *) (values + i);
1354
1355			agp_bridge->aperture_size_idx = i;
1356			return values[i].size;
1357		}
1358	}
1359	return 0;
1360}
1361EXPORT_SYMBOL(agp3_generic_fetch_size);
1362
1363void agp3_generic_tlbflush(struct agp_memory *mem)
1364{
1365	u32 ctrl;
1366	pci_read_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, &ctrl);
1367	pci_write_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, ctrl & ~AGPCTRL_GTLBEN);
1368	pci_write_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, ctrl);
1369}
1370EXPORT_SYMBOL(agp3_generic_tlbflush);
1371
1372int agp3_generic_configure(void)
1373{
1374	u32 temp;
1375	struct aper_size_info_16 *current_size;
1376
1377	current_size = A_SIZE_16(agp_bridge->current_size);
1378
1379	agp_bridge->gart_bus_addr = pci_bus_address(agp_bridge->dev,
1380						    AGP_APERTURE_BAR);
1381
1382	/* set aperture size */
1383	pci_write_config_word(agp_bridge->dev, agp_bridge->capndx+AGPAPSIZE, current_size->size_value);
1384	/* set gart pointer */
1385	pci_write_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPGARTLO, agp_bridge->gatt_bus_addr);
1386	/* enable aperture and GTLB */
1387	pci_read_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, &temp);
1388	pci_write_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, temp | AGPCTRL_APERENB | AGPCTRL_GTLBEN);
1389	return 0;
1390}
1391EXPORT_SYMBOL(agp3_generic_configure);
1392
1393void agp3_generic_cleanup(void)
1394{
1395	u32 ctrl;
1396	pci_read_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, &ctrl);
1397	pci_write_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, ctrl & ~AGPCTRL_APERENB);
1398}
1399EXPORT_SYMBOL(agp3_generic_cleanup);
1400
1401const struct aper_size_info_16 agp3_generic_sizes[AGP_GENERIC_SIZES_ENTRIES] =
1402{
1403	{4096, 1048576, 10,0x000},
1404	{2048,  524288, 9, 0x800},
1405	{1024,  262144, 8, 0xc00},
1406	{ 512,  131072, 7, 0xe00},
1407	{ 256,   65536, 6, 0xf00},
1408	{ 128,   32768, 5, 0xf20},
1409	{  64,   16384, 4, 0xf30},
1410	{  32,    8192, 3, 0xf38},
1411	{  16,    4096, 2, 0xf3c},
1412	{   8,    2048, 1, 0xf3e},
1413	{   4,    1024, 0, 0xf3f}
1414};
1415EXPORT_SYMBOL(agp3_generic_sizes);
1416
v3.5.6
   1/*
   2 * AGPGART driver.
   3 * Copyright (C) 2004 Silicon Graphics, Inc.
   4 * Copyright (C) 2002-2005 Dave Jones.
   5 * Copyright (C) 1999 Jeff Hartmann.
   6 * Copyright (C) 1999 Precision Insight, Inc.
   7 * Copyright (C) 1999 Xi Graphics, Inc.
   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 shall be included
  17 * in all copies or substantial portions of the Software.
  18 *
  19 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
  20 * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  21 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  22 * JEFF HARTMANN, OR ANY OTHER CONTRIBUTORS BE LIABLE FOR ANY CLAIM,
  23 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
  24 * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE
  25 * OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  26 *
  27 * TODO:
  28 * - Allocate more than order 0 pages to avoid too much linear map splitting.
  29 */
  30#include <linux/module.h>
  31#include <linux/pci.h>
  32#include <linux/init.h>
  33#include <linux/pagemap.h>
  34#include <linux/miscdevice.h>
  35#include <linux/pm.h>
  36#include <linux/agp_backend.h>
  37#include <linux/vmalloc.h>
  38#include <linux/dma-mapping.h>
  39#include <linux/mm.h>
  40#include <linux/sched.h>
  41#include <linux/slab.h>
  42#include <asm/io.h>
  43#include <asm/cacheflush.h>
  44#include <asm/pgtable.h>
 
  45#include "agp.h"
  46
  47__u32 *agp_gatt_table;
  48int agp_memory_reserved;
  49
  50/*
  51 * Needed by the Nforce GART driver for the time being. Would be
  52 * nice to do this some other way instead of needing this export.
  53 */
  54EXPORT_SYMBOL_GPL(agp_memory_reserved);
  55
  56/*
  57 * Generic routines for handling agp_memory structures -
  58 * They use the basic page allocation routines to do the brunt of the work.
  59 */
  60
  61void agp_free_key(int key)
  62{
  63	if (key < 0)
  64		return;
  65
  66	if (key < MAXKEY)
  67		clear_bit(key, agp_bridge->key_list);
  68}
  69EXPORT_SYMBOL(agp_free_key);
  70
  71
  72static int agp_get_key(void)
  73{
  74	int bit;
  75
  76	bit = find_first_zero_bit(agp_bridge->key_list, MAXKEY);
  77	if (bit < MAXKEY) {
  78		set_bit(bit, agp_bridge->key_list);
  79		return bit;
  80	}
  81	return -1;
  82}
  83
  84/*
  85 * Use kmalloc if possible for the page list. Otherwise fall back to
  86 * vmalloc. This speeds things up and also saves memory for small AGP
  87 * regions.
  88 */
  89
  90void agp_alloc_page_array(size_t size, struct agp_memory *mem)
  91{
  92	mem->pages = NULL;
  93
  94	if (size <= 2*PAGE_SIZE)
  95		mem->pages = kmalloc(size, GFP_KERNEL | __GFP_NOWARN);
  96	if (mem->pages == NULL) {
  97		mem->pages = vmalloc(size);
  98	}
  99}
 100EXPORT_SYMBOL(agp_alloc_page_array);
 101
 102void agp_free_page_array(struct agp_memory *mem)
 103{
 104	if (is_vmalloc_addr(mem->pages)) {
 105		vfree(mem->pages);
 106	} else {
 107		kfree(mem->pages);
 108	}
 109}
 110EXPORT_SYMBOL(agp_free_page_array);
 111
 112
 113static struct agp_memory *agp_create_user_memory(unsigned long num_agp_pages)
 114{
 115	struct agp_memory *new;
 116	unsigned long alloc_size = num_agp_pages*sizeof(struct page *);
 117
 118	if (INT_MAX/sizeof(struct page *) < num_agp_pages)
 119		return NULL;
 120
 121	new = kzalloc(sizeof(struct agp_memory), GFP_KERNEL);
 122	if (new == NULL)
 123		return NULL;
 124
 125	new->key = agp_get_key();
 126
 127	if (new->key < 0) {
 128		kfree(new);
 129		return NULL;
 130	}
 131
 132	agp_alloc_page_array(alloc_size, new);
 133
 134	if (new->pages == NULL) {
 135		agp_free_key(new->key);
 136		kfree(new);
 137		return NULL;
 138	}
 139	new->num_scratch_pages = 0;
 140	return new;
 141}
 142
 143struct agp_memory *agp_create_memory(int scratch_pages)
 144{
 145	struct agp_memory *new;
 146
 147	new = kzalloc(sizeof(struct agp_memory), GFP_KERNEL);
 148	if (new == NULL)
 149		return NULL;
 150
 151	new->key = agp_get_key();
 152
 153	if (new->key < 0) {
 154		kfree(new);
 155		return NULL;
 156	}
 157
 158	agp_alloc_page_array(PAGE_SIZE * scratch_pages, new);
 159
 160	if (new->pages == NULL) {
 161		agp_free_key(new->key);
 162		kfree(new);
 163		return NULL;
 164	}
 165	new->num_scratch_pages = scratch_pages;
 166	new->type = AGP_NORMAL_MEMORY;
 167	return new;
 168}
 169EXPORT_SYMBOL(agp_create_memory);
 170
 171/**
 172 *	agp_free_memory - free memory associated with an agp_memory pointer.
 173 *
 174 *	@curr:		agp_memory pointer to be freed.
 175 *
 176 *	It is the only function that can be called when the backend is not owned
 177 *	by the caller.  (So it can free memory on client death.)
 178 */
 179void agp_free_memory(struct agp_memory *curr)
 180{
 181	size_t i;
 182
 183	if (curr == NULL)
 184		return;
 185
 186	if (curr->is_bound)
 187		agp_unbind_memory(curr);
 188
 189	if (curr->type >= AGP_USER_TYPES) {
 190		agp_generic_free_by_type(curr);
 191		return;
 192	}
 193
 194	if (curr->type != 0) {
 195		curr->bridge->driver->free_by_type(curr);
 196		return;
 197	}
 198	if (curr->page_count != 0) {
 199		if (curr->bridge->driver->agp_destroy_pages) {
 200			curr->bridge->driver->agp_destroy_pages(curr);
 201		} else {
 202
 203			for (i = 0; i < curr->page_count; i++) {
 204				curr->bridge->driver->agp_destroy_page(
 205					curr->pages[i],
 206					AGP_PAGE_DESTROY_UNMAP);
 207			}
 208			for (i = 0; i < curr->page_count; i++) {
 209				curr->bridge->driver->agp_destroy_page(
 210					curr->pages[i],
 211					AGP_PAGE_DESTROY_FREE);
 212			}
 213		}
 214	}
 215	agp_free_key(curr->key);
 216	agp_free_page_array(curr);
 217	kfree(curr);
 218}
 219EXPORT_SYMBOL(agp_free_memory);
 220
 221#define ENTRIES_PER_PAGE		(PAGE_SIZE / sizeof(unsigned long))
 222
 223/**
 224 *	agp_allocate_memory  -  allocate a group of pages of a certain type.
 225 *
 
 226 *	@page_count:	size_t argument of the number of pages
 227 *	@type:	u32 argument of the type of memory to be allocated.
 228 *
 229 *	Every agp bridge device will allow you to allocate AGP_NORMAL_MEMORY which
 230 *	maps to physical ram.  Any other type is device dependent.
 231 *
 232 *	It returns NULL whenever memory is unavailable.
 233 */
 234struct agp_memory *agp_allocate_memory(struct agp_bridge_data *bridge,
 235					size_t page_count, u32 type)
 236{
 237	int scratch_pages;
 238	struct agp_memory *new;
 239	size_t i;
 240	int cur_memory;
 241
 242	if (!bridge)
 243		return NULL;
 244
 245	cur_memory = atomic_read(&bridge->current_memory_agp);
 246	if ((cur_memory + page_count > bridge->max_memory_agp) ||
 247	    (cur_memory + page_count < page_count))
 248		return NULL;
 249
 250	if (type >= AGP_USER_TYPES) {
 251		new = agp_generic_alloc_user(page_count, type);
 252		if (new)
 253			new->bridge = bridge;
 254		return new;
 255	}
 256
 257	if (type != 0) {
 258		new = bridge->driver->alloc_by_type(page_count, type);
 259		if (new)
 260			new->bridge = bridge;
 261		return new;
 262	}
 263
 264	scratch_pages = (page_count + ENTRIES_PER_PAGE - 1) / ENTRIES_PER_PAGE;
 265
 266	new = agp_create_memory(scratch_pages);
 267
 268	if (new == NULL)
 269		return NULL;
 270
 271	if (bridge->driver->agp_alloc_pages) {
 272		if (bridge->driver->agp_alloc_pages(bridge, new, page_count)) {
 273			agp_free_memory(new);
 274			return NULL;
 275		}
 276		new->bridge = bridge;
 277		return new;
 278	}
 279
 280	for (i = 0; i < page_count; i++) {
 281		struct page *page = bridge->driver->agp_alloc_page(bridge);
 282
 283		if (page == NULL) {
 284			agp_free_memory(new);
 285			return NULL;
 286		}
 287		new->pages[i] = page;
 288		new->page_count++;
 289	}
 290	new->bridge = bridge;
 291
 292	return new;
 293}
 294EXPORT_SYMBOL(agp_allocate_memory);
 295
 296
 297/* End - Generic routines for handling agp_memory structures */
 298
 299
 300static int agp_return_size(void)
 301{
 302	int current_size;
 303	void *temp;
 304
 305	temp = agp_bridge->current_size;
 306
 307	switch (agp_bridge->driver->size_type) {
 308	case U8_APER_SIZE:
 309		current_size = A_SIZE_8(temp)->size;
 310		break;
 311	case U16_APER_SIZE:
 312		current_size = A_SIZE_16(temp)->size;
 313		break;
 314	case U32_APER_SIZE:
 315		current_size = A_SIZE_32(temp)->size;
 316		break;
 317	case LVL2_APER_SIZE:
 318		current_size = A_SIZE_LVL2(temp)->size;
 319		break;
 320	case FIXED_APER_SIZE:
 321		current_size = A_SIZE_FIX(temp)->size;
 322		break;
 323	default:
 324		current_size = 0;
 325		break;
 326	}
 327
 328	current_size -= (agp_memory_reserved / (1024*1024));
 329	if (current_size <0)
 330		current_size = 0;
 331	return current_size;
 332}
 333
 334
 335int agp_num_entries(void)
 336{
 337	int num_entries;
 338	void *temp;
 339
 340	temp = agp_bridge->current_size;
 341
 342	switch (agp_bridge->driver->size_type) {
 343	case U8_APER_SIZE:
 344		num_entries = A_SIZE_8(temp)->num_entries;
 345		break;
 346	case U16_APER_SIZE:
 347		num_entries = A_SIZE_16(temp)->num_entries;
 348		break;
 349	case U32_APER_SIZE:
 350		num_entries = A_SIZE_32(temp)->num_entries;
 351		break;
 352	case LVL2_APER_SIZE:
 353		num_entries = A_SIZE_LVL2(temp)->num_entries;
 354		break;
 355	case FIXED_APER_SIZE:
 356		num_entries = A_SIZE_FIX(temp)->num_entries;
 357		break;
 358	default:
 359		num_entries = 0;
 360		break;
 361	}
 362
 363	num_entries -= agp_memory_reserved>>PAGE_SHIFT;
 364	if (num_entries<0)
 365		num_entries = 0;
 366	return num_entries;
 367}
 368EXPORT_SYMBOL_GPL(agp_num_entries);
 369
 370
 371/**
 372 *	agp_copy_info  -  copy bridge state information
 373 *
 
 374 *	@info:		agp_kern_info pointer.  The caller should insure that this pointer is valid.
 375 *
 376 *	This function copies information about the agp bridge device and the state of
 377 *	the agp backend into an agp_kern_info pointer.
 378 */
 379int agp_copy_info(struct agp_bridge_data *bridge, struct agp_kern_info *info)
 380{
 381	memset(info, 0, sizeof(struct agp_kern_info));
 382	if (!bridge) {
 383		info->chipset = NOT_SUPPORTED;
 384		return -EIO;
 385	}
 386
 387	info->version.major = bridge->version->major;
 388	info->version.minor = bridge->version->minor;
 389	info->chipset = SUPPORTED;
 390	info->device = bridge->dev;
 391	if (bridge->mode & AGPSTAT_MODE_3_0)
 392		info->mode = bridge->mode & ~AGP3_RESERVED_MASK;
 393	else
 394		info->mode = bridge->mode & ~AGP2_RESERVED_MASK;
 395	info->aper_base = bridge->gart_bus_addr;
 396	info->aper_size = agp_return_size();
 397	info->max_memory = bridge->max_memory_agp;
 398	info->current_memory = atomic_read(&bridge->current_memory_agp);
 399	info->cant_use_aperture = bridge->driver->cant_use_aperture;
 400	info->vm_ops = bridge->vm_ops;
 401	info->page_mask = ~0UL;
 402	return 0;
 403}
 404EXPORT_SYMBOL(agp_copy_info);
 405
 406/* End - Routine to copy over information structure */
 407
 408/*
 409 * Routines for handling swapping of agp_memory into the GATT -
 410 * These routines take agp_memory and insert them into the GATT.
 411 * They call device specific routines to actually write to the GATT.
 412 */
 413
 414/**
 415 *	agp_bind_memory  -  Bind an agp_memory structure into the GATT.
 416 *
 417 *	@curr:		agp_memory pointer
 418 *	@pg_start:	an offset into the graphics aperture translation table
 419 *
 420 *	It returns -EINVAL if the pointer == NULL.
 421 *	It returns -EBUSY if the area of the table requested is already in use.
 422 */
 423int agp_bind_memory(struct agp_memory *curr, off_t pg_start)
 424{
 425	int ret_val;
 426
 427	if (curr == NULL)
 428		return -EINVAL;
 429
 430	if (curr->is_bound) {
 431		printk(KERN_INFO PFX "memory %p is already bound!\n", curr);
 432		return -EINVAL;
 433	}
 434	if (!curr->is_flushed) {
 435		curr->bridge->driver->cache_flush();
 436		curr->is_flushed = true;
 437	}
 438
 439	ret_val = curr->bridge->driver->insert_memory(curr, pg_start, curr->type);
 440
 441	if (ret_val != 0)
 442		return ret_val;
 443
 444	curr->is_bound = true;
 445	curr->pg_start = pg_start;
 446	spin_lock(&agp_bridge->mapped_lock);
 447	list_add(&curr->mapped_list, &agp_bridge->mapped_list);
 448	spin_unlock(&agp_bridge->mapped_lock);
 449
 450	return 0;
 451}
 452EXPORT_SYMBOL(agp_bind_memory);
 453
 454
 455/**
 456 *	agp_unbind_memory  -  Removes an agp_memory structure from the GATT
 457 *
 458 * @curr:	agp_memory pointer to be removed from the GATT.
 459 *
 460 * It returns -EINVAL if this piece of agp_memory is not currently bound to
 461 * the graphics aperture translation table or if the agp_memory pointer == NULL
 462 */
 463int agp_unbind_memory(struct agp_memory *curr)
 464{
 465	int ret_val;
 466
 467	if (curr == NULL)
 468		return -EINVAL;
 469
 470	if (!curr->is_bound) {
 471		printk(KERN_INFO PFX "memory %p was not bound!\n", curr);
 472		return -EINVAL;
 473	}
 474
 475	ret_val = curr->bridge->driver->remove_memory(curr, curr->pg_start, curr->type);
 476
 477	if (ret_val != 0)
 478		return ret_val;
 479
 480	curr->is_bound = false;
 481	curr->pg_start = 0;
 482	spin_lock(&curr->bridge->mapped_lock);
 483	list_del(&curr->mapped_list);
 484	spin_unlock(&curr->bridge->mapped_lock);
 485	return 0;
 486}
 487EXPORT_SYMBOL(agp_unbind_memory);
 488
 489
 490/* End - Routines for handling swapping of agp_memory into the GATT */
 491
 492
 493/* Generic Agp routines - Start */
 494static void agp_v2_parse_one(u32 *requested_mode, u32 *bridge_agpstat, u32 *vga_agpstat)
 495{
 496	u32 tmp;
 497
 498	if (*requested_mode & AGP2_RESERVED_MASK) {
 499		printk(KERN_INFO PFX "reserved bits set (%x) in mode 0x%x. Fixed.\n",
 500			*requested_mode & AGP2_RESERVED_MASK, *requested_mode);
 501		*requested_mode &= ~AGP2_RESERVED_MASK;
 502	}
 503
 504	/*
 505	 * Some dumb bridges are programmed to disobey the AGP2 spec.
 506	 * This is likely a BIOS misprogramming rather than poweron default, or
 507	 * it would be a lot more common.
 508	 * https://bugs.freedesktop.org/show_bug.cgi?id=8816
 509	 * AGPv2 spec 6.1.9 states:
 510	 *   The RATE field indicates the data transfer rates supported by this
 511	 *   device. A.G.P. devices must report all that apply.
 512	 * Fix them up as best we can.
 513	 */
 514	switch (*bridge_agpstat & 7) {
 515	case 4:
 516		*bridge_agpstat |= (AGPSTAT2_2X | AGPSTAT2_1X);
 517		printk(KERN_INFO PFX "BIOS bug. AGP bridge claims to only support x4 rate. "
 518			"Fixing up support for x2 & x1\n");
 519		break;
 520	case 2:
 521		*bridge_agpstat |= AGPSTAT2_1X;
 522		printk(KERN_INFO PFX "BIOS bug. AGP bridge claims to only support x2 rate. "
 523			"Fixing up support for x1\n");
 524		break;
 525	default:
 526		break;
 527	}
 528
 529	/* Check the speed bits make sense. Only one should be set. */
 530	tmp = *requested_mode & 7;
 531	switch (tmp) {
 532		case 0:
 533			printk(KERN_INFO PFX "%s tried to set rate=x0. Setting to x1 mode.\n", current->comm);
 534			*requested_mode |= AGPSTAT2_1X;
 535			break;
 536		case 1:
 537		case 2:
 538			break;
 539		case 3:
 540			*requested_mode &= ~(AGPSTAT2_1X);	/* rate=2 */
 541			break;
 542		case 4:
 543			break;
 544		case 5:
 545		case 6:
 546		case 7:
 547			*requested_mode &= ~(AGPSTAT2_1X|AGPSTAT2_2X); /* rate=4*/
 548			break;
 549	}
 550
 551	/* disable SBA if it's not supported */
 552	if (!((*bridge_agpstat & AGPSTAT_SBA) && (*vga_agpstat & AGPSTAT_SBA) && (*requested_mode & AGPSTAT_SBA)))
 553		*bridge_agpstat &= ~AGPSTAT_SBA;
 554
 555	/* Set rate */
 556	if (!((*bridge_agpstat & AGPSTAT2_4X) && (*vga_agpstat & AGPSTAT2_4X) && (*requested_mode & AGPSTAT2_4X)))
 557		*bridge_agpstat &= ~AGPSTAT2_4X;
 558
 559	if (!((*bridge_agpstat & AGPSTAT2_2X) && (*vga_agpstat & AGPSTAT2_2X) && (*requested_mode & AGPSTAT2_2X)))
 560		*bridge_agpstat &= ~AGPSTAT2_2X;
 561
 562	if (!((*bridge_agpstat & AGPSTAT2_1X) && (*vga_agpstat & AGPSTAT2_1X) && (*requested_mode & AGPSTAT2_1X)))
 563		*bridge_agpstat &= ~AGPSTAT2_1X;
 564
 565	/* Now we know what mode it should be, clear out the unwanted bits. */
 566	if (*bridge_agpstat & AGPSTAT2_4X)
 567		*bridge_agpstat &= ~(AGPSTAT2_1X | AGPSTAT2_2X);	/* 4X */
 568
 569	if (*bridge_agpstat & AGPSTAT2_2X)
 570		*bridge_agpstat &= ~(AGPSTAT2_1X | AGPSTAT2_4X);	/* 2X */
 571
 572	if (*bridge_agpstat & AGPSTAT2_1X)
 573		*bridge_agpstat &= ~(AGPSTAT2_2X | AGPSTAT2_4X);	/* 1X */
 574
 575	/* Apply any errata. */
 576	if (agp_bridge->flags & AGP_ERRATA_FASTWRITES)
 577		*bridge_agpstat &= ~AGPSTAT_FW;
 578
 579	if (agp_bridge->flags & AGP_ERRATA_SBA)
 580		*bridge_agpstat &= ~AGPSTAT_SBA;
 581
 582	if (agp_bridge->flags & AGP_ERRATA_1X) {
 583		*bridge_agpstat &= ~(AGPSTAT2_2X | AGPSTAT2_4X);
 584		*bridge_agpstat |= AGPSTAT2_1X;
 585	}
 586
 587	/* If we've dropped down to 1X, disable fast writes. */
 588	if (*bridge_agpstat & AGPSTAT2_1X)
 589		*bridge_agpstat &= ~AGPSTAT_FW;
 590}
 591
 592/*
 593 * requested_mode = Mode requested by (typically) X.
 594 * bridge_agpstat = PCI_AGP_STATUS from agp bridge.
 595 * vga_agpstat = PCI_AGP_STATUS from graphic card.
 596 */
 597static void agp_v3_parse_one(u32 *requested_mode, u32 *bridge_agpstat, u32 *vga_agpstat)
 598{
 599	u32 origbridge=*bridge_agpstat, origvga=*vga_agpstat;
 600	u32 tmp;
 601
 602	if (*requested_mode & AGP3_RESERVED_MASK) {
 603		printk(KERN_INFO PFX "reserved bits set (%x) in mode 0x%x. Fixed.\n",
 604			*requested_mode & AGP3_RESERVED_MASK, *requested_mode);
 605		*requested_mode &= ~AGP3_RESERVED_MASK;
 606	}
 607
 608	/* Check the speed bits make sense. */
 609	tmp = *requested_mode & 7;
 610	if (tmp == 0) {
 611		printk(KERN_INFO PFX "%s tried to set rate=x0. Setting to AGP3 x4 mode.\n", current->comm);
 612		*requested_mode |= AGPSTAT3_4X;
 613	}
 614	if (tmp >= 3) {
 615		printk(KERN_INFO PFX "%s tried to set rate=x%d. Setting to AGP3 x8 mode.\n", current->comm, tmp * 4);
 616		*requested_mode = (*requested_mode & ~7) | AGPSTAT3_8X;
 617	}
 618
 619	/* ARQSZ - Set the value to the maximum one.
 620	 * Don't allow the mode register to override values. */
 621	*bridge_agpstat = ((*bridge_agpstat & ~AGPSTAT_ARQSZ) |
 622		max_t(u32,(*bridge_agpstat & AGPSTAT_ARQSZ),(*vga_agpstat & AGPSTAT_ARQSZ)));
 623
 624	/* Calibration cycle.
 625	 * Don't allow the mode register to override values. */
 626	*bridge_agpstat = ((*bridge_agpstat & ~AGPSTAT_CAL_MASK) |
 627		min_t(u32,(*bridge_agpstat & AGPSTAT_CAL_MASK),(*vga_agpstat & AGPSTAT_CAL_MASK)));
 628
 629	/* SBA *must* be supported for AGP v3 */
 630	*bridge_agpstat |= AGPSTAT_SBA;
 631
 632	/*
 633	 * Set speed.
 634	 * Check for invalid speeds. This can happen when applications
 635	 * written before the AGP 3.0 standard pass AGP2.x modes to AGP3 hardware
 636	 */
 637	if (*requested_mode & AGPSTAT_MODE_3_0) {
 638		/*
 639		 * Caller hasn't a clue what it is doing. Bridge is in 3.0 mode,
 640		 * have been passed a 3.0 mode, but with 2.x speed bits set.
 641		 * AGP2.x 4x -> AGP3.0 4x.
 642		 */
 643		if (*requested_mode & AGPSTAT2_4X) {
 644			printk(KERN_INFO PFX "%s passes broken AGP3 flags (%x). Fixed.\n",
 645						current->comm, *requested_mode);
 646			*requested_mode &= ~AGPSTAT2_4X;
 647			*requested_mode |= AGPSTAT3_4X;
 648		}
 649	} else {
 650		/*
 651		 * The caller doesn't know what they are doing. We are in 3.0 mode,
 652		 * but have been passed an AGP 2.x mode.
 653		 * Convert AGP 1x,2x,4x -> AGP 3.0 4x.
 654		 */
 655		printk(KERN_INFO PFX "%s passes broken AGP2 flags (%x) in AGP3 mode. Fixed.\n",
 656					current->comm, *requested_mode);
 657		*requested_mode &= ~(AGPSTAT2_4X | AGPSTAT2_2X | AGPSTAT2_1X);
 658		*requested_mode |= AGPSTAT3_4X;
 659	}
 660
 661	if (*requested_mode & AGPSTAT3_8X) {
 662		if (!(*bridge_agpstat & AGPSTAT3_8X)) {
 663			*bridge_agpstat &= ~(AGPSTAT3_8X | AGPSTAT3_RSVD);
 664			*bridge_agpstat |= AGPSTAT3_4X;
 665			printk(KERN_INFO PFX "%s requested AGPx8 but bridge not capable.\n", current->comm);
 666			return;
 667		}
 668		if (!(*vga_agpstat & AGPSTAT3_8X)) {
 669			*bridge_agpstat &= ~(AGPSTAT3_8X | AGPSTAT3_RSVD);
 670			*bridge_agpstat |= AGPSTAT3_4X;
 671			printk(KERN_INFO PFX "%s requested AGPx8 but graphic card not capable.\n", current->comm);
 672			return;
 673		}
 674		/* All set, bridge & device can do AGP x8*/
 675		*bridge_agpstat &= ~(AGPSTAT3_4X | AGPSTAT3_RSVD);
 676		goto done;
 677
 678	} else if (*requested_mode & AGPSTAT3_4X) {
 679		*bridge_agpstat &= ~(AGPSTAT3_8X | AGPSTAT3_RSVD);
 680		*bridge_agpstat |= AGPSTAT3_4X;
 681		goto done;
 682
 683	} else {
 684
 685		/*
 686		 * If we didn't specify an AGP mode, we see if both
 687		 * the graphics card, and the bridge can do x8, and use if so.
 688		 * If not, we fall back to x4 mode.
 689		 */
 690		if ((*bridge_agpstat & AGPSTAT3_8X) && (*vga_agpstat & AGPSTAT3_8X)) {
 691			printk(KERN_INFO PFX "No AGP mode specified. Setting to highest mode "
 692				"supported by bridge & card (x8).\n");
 693			*bridge_agpstat &= ~(AGPSTAT3_4X | AGPSTAT3_RSVD);
 694			*vga_agpstat &= ~(AGPSTAT3_4X | AGPSTAT3_RSVD);
 695		} else {
 696			printk(KERN_INFO PFX "Fell back to AGPx4 mode because ");
 697			if (!(*bridge_agpstat & AGPSTAT3_8X)) {
 698				printk(KERN_INFO PFX "bridge couldn't do x8. bridge_agpstat:%x (orig=%x)\n",
 699					*bridge_agpstat, origbridge);
 700				*bridge_agpstat &= ~(AGPSTAT3_8X | AGPSTAT3_RSVD);
 701				*bridge_agpstat |= AGPSTAT3_4X;
 702			}
 703			if (!(*vga_agpstat & AGPSTAT3_8X)) {
 704				printk(KERN_INFO PFX "graphics card couldn't do x8. vga_agpstat:%x (orig=%x)\n",
 705					*vga_agpstat, origvga);
 706				*vga_agpstat &= ~(AGPSTAT3_8X | AGPSTAT3_RSVD);
 707				*vga_agpstat |= AGPSTAT3_4X;
 708			}
 709		}
 710	}
 711
 712done:
 713	/* Apply any errata. */
 714	if (agp_bridge->flags & AGP_ERRATA_FASTWRITES)
 715		*bridge_agpstat &= ~AGPSTAT_FW;
 716
 717	if (agp_bridge->flags & AGP_ERRATA_SBA)
 718		*bridge_agpstat &= ~AGPSTAT_SBA;
 719
 720	if (agp_bridge->flags & AGP_ERRATA_1X) {
 721		*bridge_agpstat &= ~(AGPSTAT2_2X | AGPSTAT2_4X);
 722		*bridge_agpstat |= AGPSTAT2_1X;
 723	}
 724}
 725
 726
 727/**
 728 * agp_collect_device_status - determine correct agp_cmd from various agp_stat's
 729 * @bridge: an agp_bridge_data struct allocated for the AGP host bridge.
 730 * @requested_mode: requested agp_stat from userspace (Typically from X)
 731 * @bridge_agpstat: current agp_stat from AGP bridge.
 732 *
 733 * This function will hunt for an AGP graphics card, and try to match
 734 * the requested mode to the capabilities of both the bridge and the card.
 735 */
 736u32 agp_collect_device_status(struct agp_bridge_data *bridge, u32 requested_mode, u32 bridge_agpstat)
 737{
 738	struct pci_dev *device = NULL;
 739	u32 vga_agpstat;
 740	u8 cap_ptr;
 741
 742	for (;;) {
 743		device = pci_get_class(PCI_CLASS_DISPLAY_VGA << 8, device);
 744		if (!device) {
 745			printk(KERN_INFO PFX "Couldn't find an AGP VGA controller.\n");
 746			return 0;
 747		}
 748		cap_ptr = pci_find_capability(device, PCI_CAP_ID_AGP);
 749		if (cap_ptr)
 750			break;
 751	}
 752
 753	/*
 754	 * Ok, here we have a AGP device. Disable impossible
 755	 * settings, and adjust the readqueue to the minimum.
 756	 */
 757	pci_read_config_dword(device, cap_ptr+PCI_AGP_STATUS, &vga_agpstat);
 758
 759	/* adjust RQ depth */
 760	bridge_agpstat = ((bridge_agpstat & ~AGPSTAT_RQ_DEPTH) |
 761	     min_t(u32, (requested_mode & AGPSTAT_RQ_DEPTH),
 762		 min_t(u32, (bridge_agpstat & AGPSTAT_RQ_DEPTH), (vga_agpstat & AGPSTAT_RQ_DEPTH))));
 763
 764	/* disable FW if it's not supported */
 765	if (!((bridge_agpstat & AGPSTAT_FW) &&
 766		 (vga_agpstat & AGPSTAT_FW) &&
 767		 (requested_mode & AGPSTAT_FW)))
 768		bridge_agpstat &= ~AGPSTAT_FW;
 769
 770	/* Check to see if we are operating in 3.0 mode */
 771	if (agp_bridge->mode & AGPSTAT_MODE_3_0)
 772		agp_v3_parse_one(&requested_mode, &bridge_agpstat, &vga_agpstat);
 773	else
 774		agp_v2_parse_one(&requested_mode, &bridge_agpstat, &vga_agpstat);
 775
 776	pci_dev_put(device);
 777	return bridge_agpstat;
 778}
 779EXPORT_SYMBOL(agp_collect_device_status);
 780
 781
 782void agp_device_command(u32 bridge_agpstat, bool agp_v3)
 783{
 784	struct pci_dev *device = NULL;
 785	int mode;
 786
 787	mode = bridge_agpstat & 0x7;
 788	if (agp_v3)
 789		mode *= 4;
 790
 791	for_each_pci_dev(device) {
 792		u8 agp = pci_find_capability(device, PCI_CAP_ID_AGP);
 793		if (!agp)
 794			continue;
 795
 796		dev_info(&device->dev, "putting AGP V%d device into %dx mode\n",
 797			 agp_v3 ? 3 : 2, mode);
 798		pci_write_config_dword(device, agp + PCI_AGP_COMMAND, bridge_agpstat);
 799	}
 800}
 801EXPORT_SYMBOL(agp_device_command);
 802
 803
 804void get_agp_version(struct agp_bridge_data *bridge)
 805{
 806	u32 ncapid;
 807
 808	/* Exit early if already set by errata workarounds. */
 809	if (bridge->major_version != 0)
 810		return;
 811
 812	pci_read_config_dword(bridge->dev, bridge->capndx, &ncapid);
 813	bridge->major_version = (ncapid >> AGP_MAJOR_VERSION_SHIFT) & 0xf;
 814	bridge->minor_version = (ncapid >> AGP_MINOR_VERSION_SHIFT) & 0xf;
 815}
 816EXPORT_SYMBOL(get_agp_version);
 817
 818
 819void agp_generic_enable(struct agp_bridge_data *bridge, u32 requested_mode)
 820{
 821	u32 bridge_agpstat, temp;
 822
 823	get_agp_version(agp_bridge);
 824
 825	dev_info(&agp_bridge->dev->dev, "AGP %d.%d bridge\n",
 826		 agp_bridge->major_version, agp_bridge->minor_version);
 827
 828	pci_read_config_dword(agp_bridge->dev,
 829		      agp_bridge->capndx + PCI_AGP_STATUS, &bridge_agpstat);
 830
 831	bridge_agpstat = agp_collect_device_status(agp_bridge, requested_mode, bridge_agpstat);
 832	if (bridge_agpstat == 0)
 833		/* Something bad happened. FIXME: Return error code? */
 834		return;
 835
 836	bridge_agpstat |= AGPSTAT_AGP_ENABLE;
 837
 838	/* Do AGP version specific frobbing. */
 839	if (bridge->major_version >= 3) {
 840		if (bridge->mode & AGPSTAT_MODE_3_0) {
 841			/* If we have 3.5, we can do the isoch stuff. */
 842			if (bridge->minor_version >= 5)
 843				agp_3_5_enable(bridge);
 844			agp_device_command(bridge_agpstat, true);
 845			return;
 846		} else {
 847		    /* Disable calibration cycle in RX91<1> when not in AGP3.0 mode of operation.*/
 848		    bridge_agpstat &= ~(7<<10) ;
 849		    pci_read_config_dword(bridge->dev,
 850					bridge->capndx+AGPCTRL, &temp);
 851		    temp |= (1<<9);
 852		    pci_write_config_dword(bridge->dev,
 853					bridge->capndx+AGPCTRL, temp);
 854
 855		    dev_info(&bridge->dev->dev, "bridge is in legacy mode, falling back to 2.x\n");
 856		}
 857	}
 858
 859	/* AGP v<3 */
 860	agp_device_command(bridge_agpstat, false);
 861}
 862EXPORT_SYMBOL(agp_generic_enable);
 863
 864
 865int agp_generic_create_gatt_table(struct agp_bridge_data *bridge)
 866{
 867	char *table;
 868	char *table_end;
 869	int size;
 870	int page_order;
 871	int num_entries;
 872	int i;
 873	void *temp;
 874	struct page *page;
 875
 876	/* The generic routines can't handle 2 level gatt's */
 877	if (bridge->driver->size_type == LVL2_APER_SIZE)
 878		return -EINVAL;
 879
 880	table = NULL;
 881	i = bridge->aperture_size_idx;
 882	temp = bridge->current_size;
 883	size = page_order = num_entries = 0;
 884
 885	if (bridge->driver->size_type != FIXED_APER_SIZE) {
 886		do {
 887			switch (bridge->driver->size_type) {
 888			case U8_APER_SIZE:
 889				size = A_SIZE_8(temp)->size;
 890				page_order =
 891				    A_SIZE_8(temp)->page_order;
 892				num_entries =
 893				    A_SIZE_8(temp)->num_entries;
 894				break;
 895			case U16_APER_SIZE:
 896				size = A_SIZE_16(temp)->size;
 897				page_order = A_SIZE_16(temp)->page_order;
 898				num_entries = A_SIZE_16(temp)->num_entries;
 899				break;
 900			case U32_APER_SIZE:
 901				size = A_SIZE_32(temp)->size;
 902				page_order = A_SIZE_32(temp)->page_order;
 903				num_entries = A_SIZE_32(temp)->num_entries;
 904				break;
 905				/* This case will never really happen. */
 906			case FIXED_APER_SIZE:
 907			case LVL2_APER_SIZE:
 908			default:
 909				size = page_order = num_entries = 0;
 910				break;
 911			}
 912
 913			table = alloc_gatt_pages(page_order);
 914
 915			if (table == NULL) {
 916				i++;
 917				switch (bridge->driver->size_type) {
 918				case U8_APER_SIZE:
 919					bridge->current_size = A_IDX8(bridge);
 920					break;
 921				case U16_APER_SIZE:
 922					bridge->current_size = A_IDX16(bridge);
 923					break;
 924				case U32_APER_SIZE:
 925					bridge->current_size = A_IDX32(bridge);
 926					break;
 927				/* These cases will never really happen. */
 928				case FIXED_APER_SIZE:
 929				case LVL2_APER_SIZE:
 930				default:
 931					break;
 932				}
 933				temp = bridge->current_size;
 934			} else {
 935				bridge->aperture_size_idx = i;
 936			}
 937		} while (!table && (i < bridge->driver->num_aperture_sizes));
 938	} else {
 939		size = ((struct aper_size_info_fixed *) temp)->size;
 940		page_order = ((struct aper_size_info_fixed *) temp)->page_order;
 941		num_entries = ((struct aper_size_info_fixed *) temp)->num_entries;
 942		table = alloc_gatt_pages(page_order);
 943	}
 944
 945	if (table == NULL)
 946		return -ENOMEM;
 947
 948	table_end = table + ((PAGE_SIZE * (1 << page_order)) - 1);
 949
 950	for (page = virt_to_page(table); page <= virt_to_page(table_end); page++)
 951		SetPageReserved(page);
 952
 953	bridge->gatt_table_real = (u32 *) table;
 954	agp_gatt_table = (void *)table;
 955
 956	bridge->driver->cache_flush();
 957#ifdef CONFIG_X86
 958	if (set_memory_uc((unsigned long)table, 1 << page_order))
 959		printk(KERN_WARNING "Could not set GATT table memory to UC!\n");
 960
 961	bridge->gatt_table = (u32 __iomem *)table;
 962#else
 963	bridge->gatt_table = ioremap_nocache(virt_to_phys(table),
 964					(PAGE_SIZE * (1 << page_order)));
 965	bridge->driver->cache_flush();
 966#endif
 967
 968	if (bridge->gatt_table == NULL) {
 969		for (page = virt_to_page(table); page <= virt_to_page(table_end); page++)
 970			ClearPageReserved(page);
 971
 972		free_gatt_pages(table, page_order);
 973
 974		return -ENOMEM;
 975	}
 976	bridge->gatt_bus_addr = virt_to_phys(bridge->gatt_table_real);
 977
 978	/* AK: bogus, should encode addresses > 4GB */
 979	for (i = 0; i < num_entries; i++) {
 980		writel(bridge->scratch_page, bridge->gatt_table+i);
 981		readl(bridge->gatt_table+i);	/* PCI Posting. */
 982	}
 983
 984	return 0;
 985}
 986EXPORT_SYMBOL(agp_generic_create_gatt_table);
 987
 988int agp_generic_free_gatt_table(struct agp_bridge_data *bridge)
 989{
 990	int page_order;
 991	char *table, *table_end;
 992	void *temp;
 993	struct page *page;
 994
 995	temp = bridge->current_size;
 996
 997	switch (bridge->driver->size_type) {
 998	case U8_APER_SIZE:
 999		page_order = A_SIZE_8(temp)->page_order;
1000		break;
1001	case U16_APER_SIZE:
1002		page_order = A_SIZE_16(temp)->page_order;
1003		break;
1004	case U32_APER_SIZE:
1005		page_order = A_SIZE_32(temp)->page_order;
1006		break;
1007	case FIXED_APER_SIZE:
1008		page_order = A_SIZE_FIX(temp)->page_order;
1009		break;
1010	case LVL2_APER_SIZE:
1011		/* The generic routines can't deal with 2 level gatt's */
1012		return -EINVAL;
1013	default:
1014		page_order = 0;
1015		break;
1016	}
1017
1018	/* Do not worry about freeing memory, because if this is
1019	 * called, then all agp memory is deallocated and removed
1020	 * from the table. */
1021
1022#ifdef CONFIG_X86
1023	set_memory_wb((unsigned long)bridge->gatt_table, 1 << page_order);
1024#else
1025	iounmap(bridge->gatt_table);
1026#endif
1027	table = (char *) bridge->gatt_table_real;
1028	table_end = table + ((PAGE_SIZE * (1 << page_order)) - 1);
1029
1030	for (page = virt_to_page(table); page <= virt_to_page(table_end); page++)
1031		ClearPageReserved(page);
1032
1033	free_gatt_pages(bridge->gatt_table_real, page_order);
1034
1035	agp_gatt_table = NULL;
1036	bridge->gatt_table = NULL;
1037	bridge->gatt_table_real = NULL;
1038	bridge->gatt_bus_addr = 0;
1039
1040	return 0;
1041}
1042EXPORT_SYMBOL(agp_generic_free_gatt_table);
1043
1044
1045int agp_generic_insert_memory(struct agp_memory * mem, off_t pg_start, int type)
1046{
1047	int num_entries;
1048	size_t i;
1049	off_t j;
1050	void *temp;
1051	struct agp_bridge_data *bridge;
1052	int mask_type;
1053
1054	bridge = mem->bridge;
1055	if (!bridge)
1056		return -EINVAL;
1057
1058	if (mem->page_count == 0)
1059		return 0;
1060
1061	temp = bridge->current_size;
1062
1063	switch (bridge->driver->size_type) {
1064	case U8_APER_SIZE:
1065		num_entries = A_SIZE_8(temp)->num_entries;
1066		break;
1067	case U16_APER_SIZE:
1068		num_entries = A_SIZE_16(temp)->num_entries;
1069		break;
1070	case U32_APER_SIZE:
1071		num_entries = A_SIZE_32(temp)->num_entries;
1072		break;
1073	case FIXED_APER_SIZE:
1074		num_entries = A_SIZE_FIX(temp)->num_entries;
1075		break;
1076	case LVL2_APER_SIZE:
1077		/* The generic routines can't deal with 2 level gatt's */
1078		return -EINVAL;
1079	default:
1080		num_entries = 0;
1081		break;
1082	}
1083
1084	num_entries -= agp_memory_reserved/PAGE_SIZE;
1085	if (num_entries < 0) num_entries = 0;
1086
1087	if (type != mem->type)
1088		return -EINVAL;
1089
1090	mask_type = bridge->driver->agp_type_to_mask_type(bridge, type);
1091	if (mask_type != 0) {
1092		/* The generic routines know nothing of memory types */
1093		return -EINVAL;
1094	}
1095
1096	if (((pg_start + mem->page_count) > num_entries) ||
1097	    ((pg_start + mem->page_count) < pg_start))
1098		return -EINVAL;
1099
1100	j = pg_start;
1101
1102	while (j < (pg_start + mem->page_count)) {
1103		if (!PGE_EMPTY(bridge, readl(bridge->gatt_table+j)))
1104			return -EBUSY;
1105		j++;
1106	}
1107
1108	if (!mem->is_flushed) {
1109		bridge->driver->cache_flush();
1110		mem->is_flushed = true;
1111	}
1112
1113	for (i = 0, j = pg_start; i < mem->page_count; i++, j++) {
1114		writel(bridge->driver->mask_memory(bridge,
1115						   page_to_phys(mem->pages[i]),
1116						   mask_type),
1117		       bridge->gatt_table+j);
1118	}
1119	readl(bridge->gatt_table+j-1);	/* PCI Posting. */
1120
1121	bridge->driver->tlb_flush(mem);
1122	return 0;
1123}
1124EXPORT_SYMBOL(agp_generic_insert_memory);
1125
1126
1127int agp_generic_remove_memory(struct agp_memory *mem, off_t pg_start, int type)
1128{
1129	size_t i;
1130	struct agp_bridge_data *bridge;
1131	int mask_type, num_entries;
1132
1133	bridge = mem->bridge;
1134	if (!bridge)
1135		return -EINVAL;
1136
1137	if (mem->page_count == 0)
1138		return 0;
1139
1140	if (type != mem->type)
1141		return -EINVAL;
1142
1143	num_entries = agp_num_entries();
1144	if (((pg_start + mem->page_count) > num_entries) ||
1145	    ((pg_start + mem->page_count) < pg_start))
1146		return -EINVAL;
1147
1148	mask_type = bridge->driver->agp_type_to_mask_type(bridge, type);
1149	if (mask_type != 0) {
1150		/* The generic routines know nothing of memory types */
1151		return -EINVAL;
1152	}
1153
1154	/* AK: bogus, should encode addresses > 4GB */
1155	for (i = pg_start; i < (mem->page_count + pg_start); i++) {
1156		writel(bridge->scratch_page, bridge->gatt_table+i);
1157	}
1158	readl(bridge->gatt_table+i-1);	/* PCI Posting. */
1159
1160	bridge->driver->tlb_flush(mem);
1161	return 0;
1162}
1163EXPORT_SYMBOL(agp_generic_remove_memory);
1164
1165struct agp_memory *agp_generic_alloc_by_type(size_t page_count, int type)
1166{
1167	return NULL;
1168}
1169EXPORT_SYMBOL(agp_generic_alloc_by_type);
1170
1171void agp_generic_free_by_type(struct agp_memory *curr)
1172{
1173	agp_free_page_array(curr);
1174	agp_free_key(curr->key);
1175	kfree(curr);
1176}
1177EXPORT_SYMBOL(agp_generic_free_by_type);
1178
1179struct agp_memory *agp_generic_alloc_user(size_t page_count, int type)
1180{
1181	struct agp_memory *new;
1182	int i;
1183	int pages;
1184
1185	pages = (page_count + ENTRIES_PER_PAGE - 1) / ENTRIES_PER_PAGE;
1186	new = agp_create_user_memory(page_count);
1187	if (new == NULL)
1188		return NULL;
1189
1190	for (i = 0; i < page_count; i++)
1191		new->pages[i] = NULL;
1192	new->page_count = 0;
1193	new->type = type;
1194	new->num_scratch_pages = pages;
1195
1196	return new;
1197}
1198EXPORT_SYMBOL(agp_generic_alloc_user);
1199
1200/*
1201 * Basic Page Allocation Routines -
1202 * These routines handle page allocation and by default they reserve the allocated
1203 * memory.  They also handle incrementing the current_memory_agp value, Which is checked
1204 * against a maximum value.
1205 */
1206
1207int agp_generic_alloc_pages(struct agp_bridge_data *bridge, struct agp_memory *mem, size_t num_pages)
1208{
1209	struct page * page;
1210	int i, ret = -ENOMEM;
1211
1212	for (i = 0; i < num_pages; i++) {
1213		page = alloc_page(GFP_KERNEL | GFP_DMA32 | __GFP_ZERO);
1214		/* agp_free_memory() needs gart address */
1215		if (page == NULL)
1216			goto out;
1217
1218#ifndef CONFIG_X86
1219		map_page_into_agp(page);
1220#endif
1221		get_page(page);
1222		atomic_inc(&agp_bridge->current_memory_agp);
1223
1224		mem->pages[i] = page;
1225		mem->page_count++;
1226	}
1227
1228#ifdef CONFIG_X86
1229	set_pages_array_uc(mem->pages, num_pages);
1230#endif
1231	ret = 0;
1232out:
1233	return ret;
1234}
1235EXPORT_SYMBOL(agp_generic_alloc_pages);
1236
1237struct page *agp_generic_alloc_page(struct agp_bridge_data *bridge)
1238{
1239	struct page * page;
1240
1241	page = alloc_page(GFP_KERNEL | GFP_DMA32 | __GFP_ZERO);
1242	if (page == NULL)
1243		return NULL;
1244
1245	map_page_into_agp(page);
1246
1247	get_page(page);
1248	atomic_inc(&agp_bridge->current_memory_agp);
1249	return page;
1250}
1251EXPORT_SYMBOL(agp_generic_alloc_page);
1252
1253void agp_generic_destroy_pages(struct agp_memory *mem)
1254{
1255	int i;
1256	struct page *page;
1257
1258	if (!mem)
1259		return;
1260
1261#ifdef CONFIG_X86
1262	set_pages_array_wb(mem->pages, mem->page_count);
1263#endif
1264
1265	for (i = 0; i < mem->page_count; i++) {
1266		page = mem->pages[i];
1267
1268#ifndef CONFIG_X86
1269		unmap_page_from_agp(page);
1270#endif
1271		put_page(page);
1272		__free_page(page);
1273		atomic_dec(&agp_bridge->current_memory_agp);
1274		mem->pages[i] = NULL;
1275	}
1276}
1277EXPORT_SYMBOL(agp_generic_destroy_pages);
1278
1279void agp_generic_destroy_page(struct page *page, int flags)
1280{
1281	if (page == NULL)
1282		return;
1283
1284	if (flags & AGP_PAGE_DESTROY_UNMAP)
1285		unmap_page_from_agp(page);
1286
1287	if (flags & AGP_PAGE_DESTROY_FREE) {
1288		put_page(page);
1289		__free_page(page);
1290		atomic_dec(&agp_bridge->current_memory_agp);
1291	}
1292}
1293EXPORT_SYMBOL(agp_generic_destroy_page);
1294
1295/* End Basic Page Allocation Routines */
1296
1297
1298/**
1299 * agp_enable  -  initialise the agp point-to-point connection.
1300 *
 
1301 * @mode:	agp mode register value to configure with.
1302 */
1303void agp_enable(struct agp_bridge_data *bridge, u32 mode)
1304{
1305	if (!bridge)
1306		return;
1307	bridge->driver->agp_enable(bridge, mode);
1308}
1309EXPORT_SYMBOL(agp_enable);
1310
1311/* When we remove the global variable agp_bridge from all drivers
1312 * then agp_alloc_bridge and agp_generic_find_bridge need to be updated
1313 */
1314
1315struct agp_bridge_data *agp_generic_find_bridge(struct pci_dev *pdev)
1316{
1317	if (list_empty(&agp_bridges))
1318		return NULL;
1319
1320	return agp_bridge;
1321}
1322
1323static void ipi_handler(void *null)
1324{
1325	flush_agp_cache();
1326}
1327
1328void global_cache_flush(void)
1329{
1330	if (on_each_cpu(ipi_handler, NULL, 1) != 0)
1331		panic(PFX "timed out waiting for the other CPUs!\n");
1332}
1333EXPORT_SYMBOL(global_cache_flush);
1334
1335unsigned long agp_generic_mask_memory(struct agp_bridge_data *bridge,
1336				      dma_addr_t addr, int type)
1337{
1338	/* memory type is ignored in the generic routine */
1339	if (bridge->driver->masks)
1340		return addr | bridge->driver->masks[0].mask;
1341	else
1342		return addr;
1343}
1344EXPORT_SYMBOL(agp_generic_mask_memory);
1345
1346int agp_generic_type_to_mask_type(struct agp_bridge_data *bridge,
1347				  int type)
1348{
1349	if (type >= AGP_USER_TYPES)
1350		return 0;
1351	return type;
1352}
1353EXPORT_SYMBOL(agp_generic_type_to_mask_type);
1354
1355/*
1356 * These functions are implemented according to the AGPv3 spec,
1357 * which covers implementation details that had previously been
1358 * left open.
1359 */
1360
1361int agp3_generic_fetch_size(void)
1362{
1363	u16 temp_size;
1364	int i;
1365	struct aper_size_info_16 *values;
1366
1367	pci_read_config_word(agp_bridge->dev, agp_bridge->capndx+AGPAPSIZE, &temp_size);
1368	values = A_SIZE_16(agp_bridge->driver->aperture_sizes);
1369
1370	for (i = 0; i < agp_bridge->driver->num_aperture_sizes; i++) {
1371		if (temp_size == values[i].size_value) {
1372			agp_bridge->previous_size =
1373				agp_bridge->current_size = (void *) (values + i);
1374
1375			agp_bridge->aperture_size_idx = i;
1376			return values[i].size;
1377		}
1378	}
1379	return 0;
1380}
1381EXPORT_SYMBOL(agp3_generic_fetch_size);
1382
1383void agp3_generic_tlbflush(struct agp_memory *mem)
1384{
1385	u32 ctrl;
1386	pci_read_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, &ctrl);
1387	pci_write_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, ctrl & ~AGPCTRL_GTLBEN);
1388	pci_write_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, ctrl);
1389}
1390EXPORT_SYMBOL(agp3_generic_tlbflush);
1391
1392int agp3_generic_configure(void)
1393{
1394	u32 temp;
1395	struct aper_size_info_16 *current_size;
1396
1397	current_size = A_SIZE_16(agp_bridge->current_size);
1398
1399	pci_read_config_dword(agp_bridge->dev, AGP_APBASE, &temp);
1400	agp_bridge->gart_bus_addr = (temp & PCI_BASE_ADDRESS_MEM_MASK);
1401
1402	/* set aperture size */
1403	pci_write_config_word(agp_bridge->dev, agp_bridge->capndx+AGPAPSIZE, current_size->size_value);
1404	/* set gart pointer */
1405	pci_write_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPGARTLO, agp_bridge->gatt_bus_addr);
1406	/* enable aperture and GTLB */
1407	pci_read_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, &temp);
1408	pci_write_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, temp | AGPCTRL_APERENB | AGPCTRL_GTLBEN);
1409	return 0;
1410}
1411EXPORT_SYMBOL(agp3_generic_configure);
1412
1413void agp3_generic_cleanup(void)
1414{
1415	u32 ctrl;
1416	pci_read_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, &ctrl);
1417	pci_write_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, ctrl & ~AGPCTRL_APERENB);
1418}
1419EXPORT_SYMBOL(agp3_generic_cleanup);
1420
1421const struct aper_size_info_16 agp3_generic_sizes[AGP_GENERIC_SIZES_ENTRIES] =
1422{
1423	{4096, 1048576, 10,0x000},
1424	{2048,  524288, 9, 0x800},
1425	{1024,  262144, 8, 0xc00},
1426	{ 512,  131072, 7, 0xe00},
1427	{ 256,   65536, 6, 0xf00},
1428	{ 128,   32768, 5, 0xf20},
1429	{  64,   16384, 4, 0xf30},
1430	{  32,    8192, 3, 0xf38},
1431	{  16,    4096, 2, 0xf3c},
1432	{   8,    2048, 1, 0xf3e},
1433	{   4,    1024, 0, 0xf3f}
1434};
1435EXPORT_SYMBOL(agp3_generic_sizes);
1436