blob: 10d6cbd7c05e59126f175eb1d8217cc95113d826 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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 */
Linus Torvalds1da177e2005-04-16 15:20:36 -070030#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>
Alexey Dobriyane8edc6e2007-05-21 01:22:52 +040040#include <linux/sched.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070041#include <asm/io.h>
42#include <asm/cacheflush.h>
43#include <asm/pgtable.h>
44#include "agp.h"
45
46__u32 *agp_gatt_table;
47int agp_memory_reserved;
48
49/*
50 * Needed by the Nforce GART driver for the time being. Would be
51 * nice to do this some other way instead of needing this export.
52 */
53EXPORT_SYMBOL_GPL(agp_memory_reserved);
54
Linus Torvalds1da177e2005-04-16 15:20:36 -070055/*
56 * Generic routines for handling agp_memory structures -
57 * They use the basic page allocation routines to do the brunt of the work.
58 */
59
60void agp_free_key(int key)
61{
62 if (key < 0)
63 return;
64
65 if (key < MAXKEY)
66 clear_bit(key, agp_bridge->key_list);
67}
68EXPORT_SYMBOL(agp_free_key);
69
70
71static int agp_get_key(void)
72{
73 int bit;
74
75 bit = find_first_zero_bit(agp_bridge->key_list, MAXKEY);
76 if (bit < MAXKEY) {
77 set_bit(bit, agp_bridge->key_list);
78 return bit;
79 }
80 return -1;
81}
82
Dave Airliea13af4b2007-10-29 15:14:03 +100083void agp_flush_chipset(struct agp_bridge_data *bridge)
84{
85 if (bridge->driver->chipset_flush)
86 bridge->driver->chipset_flush(bridge);
87}
88EXPORT_SYMBOL(agp_flush_chipset);
89
Thomas Hellstroma030ce42007-01-23 10:33:43 +010090/*
91 * Use kmalloc if possible for the page list. Otherwise fall back to
92 * vmalloc. This speeds things up and also saves memory for small AGP
93 * regions.
94 */
95
96void agp_alloc_page_array(size_t size, struct agp_memory *mem)
97{
98 mem->memory = NULL;
Dave Airlie9516b032008-06-19 10:42:17 +100099 mem->vmalloc_flag = false;
Thomas Hellstroma030ce42007-01-23 10:33:43 +0100100
Andrew Morton1c14cfb2007-02-05 16:09:35 -0800101 if (size <= 2*PAGE_SIZE)
Thomas Hellstroma030ce42007-01-23 10:33:43 +0100102 mem->memory = kmalloc(size, GFP_KERNEL | __GFP_NORETRY);
Thomas Hellstroma030ce42007-01-23 10:33:43 +0100103 if (mem->memory == NULL) {
104 mem->memory = vmalloc(size);
Dave Airlie9516b032008-06-19 10:42:17 +1000105 mem->vmalloc_flag = true;
Thomas Hellstroma030ce42007-01-23 10:33:43 +0100106 }
107}
108EXPORT_SYMBOL(agp_alloc_page_array);
109
110void agp_free_page_array(struct agp_memory *mem)
111{
112 if (mem->vmalloc_flag) {
113 vfree(mem->memory);
114 } else {
115 kfree(mem->memory);
116 }
117}
118EXPORT_SYMBOL(agp_free_page_array);
119
120
121static struct agp_memory *agp_create_user_memory(unsigned long num_agp_pages)
122{
123 struct agp_memory *new;
124 unsigned long alloc_size = num_agp_pages*sizeof(struct page *);
125
Andrew Morton1c14cfb2007-02-05 16:09:35 -0800126 new = kzalloc(sizeof(struct agp_memory), GFP_KERNEL);
Thomas Hellstroma030ce42007-01-23 10:33:43 +0100127 if (new == NULL)
128 return NULL;
129
Thomas Hellstroma030ce42007-01-23 10:33:43 +0100130 new->key = agp_get_key();
131
132 if (new->key < 0) {
133 kfree(new);
134 return NULL;
135 }
136
137 agp_alloc_page_array(alloc_size, new);
138
139 if (new->memory == NULL) {
140 agp_free_key(new->key);
141 kfree(new);
142 return NULL;
143 }
144 new->num_scratch_pages = 0;
145 return new;
146}
147
Linus Torvalds1da177e2005-04-16 15:20:36 -0700148struct agp_memory *agp_create_memory(int scratch_pages)
149{
150 struct agp_memory *new;
151
Dave Jones0ea27d92005-10-20 15:12:16 -0700152 new = kzalloc(sizeof(struct agp_memory), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700153 if (new == NULL)
154 return NULL;
155
Linus Torvalds1da177e2005-04-16 15:20:36 -0700156 new->key = agp_get_key();
157
158 if (new->key < 0) {
159 kfree(new);
160 return NULL;
161 }
Thomas Hellstroma030ce42007-01-23 10:33:43 +0100162
163 agp_alloc_page_array(PAGE_SIZE * scratch_pages, new);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700164
165 if (new->memory == NULL) {
166 agp_free_key(new->key);
167 kfree(new);
168 return NULL;
169 }
170 new->num_scratch_pages = scratch_pages;
Thomas Hellstroma030ce42007-01-23 10:33:43 +0100171 new->type = AGP_NORMAL_MEMORY;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700172 return new;
173}
174EXPORT_SYMBOL(agp_create_memory);
175
176/**
177 * agp_free_memory - free memory associated with an agp_memory pointer.
178 *
179 * @curr: agp_memory pointer to be freed.
180 *
181 * It is the only function that can be called when the backend is not owned
182 * by the caller. (So it can free memory on client death.)
183 */
184void agp_free_memory(struct agp_memory *curr)
185{
186 size_t i;
187
188 if (curr == NULL)
189 return;
190
Joe Perchesc7258012008-03-26 14:10:02 -0700191 if (curr->is_bound)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700192 agp_unbind_memory(curr);
193
Thomas Hellstroma030ce42007-01-23 10:33:43 +0100194 if (curr->type >= AGP_USER_TYPES) {
195 agp_generic_free_by_type(curr);
196 return;
197 }
198
Linus Torvalds1da177e2005-04-16 15:20:36 -0700199 if (curr->type != 0) {
200 curr->bridge->driver->free_by_type(curr);
201 return;
202 }
203 if (curr->page_count != 0) {
Shaohua Libd079282008-08-21 10:46:17 +0800204 if (curr->bridge->driver->agp_destroy_pages) {
205 curr->bridge->driver->agp_destroy_pages(curr);
206 } else {
207
208 for (i = 0; i < curr->page_count; i++) {
209 curr->memory[i] = (unsigned long)gart_to_virt(
210 curr->memory[i]);
211 curr->bridge->driver->agp_destroy_page(
212 (void *)curr->memory[i],
213 AGP_PAGE_DESTROY_UNMAP);
214 }
215 for (i = 0; i < curr->page_count; i++) {
216 curr->bridge->driver->agp_destroy_page(
217 (void *)curr->memory[i],
218 AGP_PAGE_DESTROY_FREE);
219 }
Dave Airliea2721e92007-10-15 10:19:16 +1000220 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700221 }
222 agp_free_key(curr->key);
Thomas Hellstroma030ce42007-01-23 10:33:43 +0100223 agp_free_page_array(curr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700224 kfree(curr);
225}
226EXPORT_SYMBOL(agp_free_memory);
227
228#define ENTRIES_PER_PAGE (PAGE_SIZE / sizeof(unsigned long))
229
230/**
231 * agp_allocate_memory - allocate a group of pages of a certain type.
232 *
233 * @page_count: size_t argument of the number of pages
234 * @type: u32 argument of the type of memory to be allocated.
235 *
236 * Every agp bridge device will allow you to allocate AGP_NORMAL_MEMORY which
237 * maps to physical ram. Any other type is device dependent.
238 *
239 * It returns NULL whenever memory is unavailable.
240 */
241struct agp_memory *agp_allocate_memory(struct agp_bridge_data *bridge,
242 size_t page_count, u32 type)
243{
244 int scratch_pages;
245 struct agp_memory *new;
246 size_t i;
247
248 if (!bridge)
249 return NULL;
250
251 if ((atomic_read(&bridge->current_memory_agp) + page_count) > bridge->max_memory_agp)
252 return NULL;
253
Thomas Hellstroma030ce42007-01-23 10:33:43 +0100254 if (type >= AGP_USER_TYPES) {
255 new = agp_generic_alloc_user(page_count, type);
256 if (new)
257 new->bridge = bridge;
258 return new;
259 }
260
Linus Torvalds1da177e2005-04-16 15:20:36 -0700261 if (type != 0) {
262 new = bridge->driver->alloc_by_type(page_count, type);
263 if (new)
264 new->bridge = bridge;
265 return new;
266 }
267
268 scratch_pages = (page_count + ENTRIES_PER_PAGE - 1) / ENTRIES_PER_PAGE;
269
270 new = agp_create_memory(scratch_pages);
271
272 if (new == NULL)
273 return NULL;
274
Shaohua Li37acee12008-08-21 10:46:11 +0800275 if (bridge->driver->agp_alloc_pages) {
276 if (bridge->driver->agp_alloc_pages(bridge, new, page_count)) {
277 agp_free_memory(new);
278 return NULL;
279 }
280 new->bridge = bridge;
281 return new;
282 }
283
Linus Torvalds1da177e2005-04-16 15:20:36 -0700284 for (i = 0; i < page_count; i++) {
285 void *addr = bridge->driver->agp_alloc_page(bridge);
286
287 if (addr == NULL) {
288 agp_free_memory(new);
289 return NULL;
290 }
Keir Fraser07eee782005-03-30 13:17:04 -0800291 new->memory[i] = virt_to_gart(addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292 new->page_count++;
293 }
Alan Hourihane88d51962005-11-06 23:35:34 -0800294 new->bridge = bridge;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700295
Linus Torvalds1da177e2005-04-16 15:20:36 -0700296 return new;
297}
298EXPORT_SYMBOL(agp_allocate_memory);
299
300
301/* End - Generic routines for handling agp_memory structures */
302
303
304static int agp_return_size(void)
305{
306 int current_size;
307 void *temp;
308
309 temp = agp_bridge->current_size;
310
311 switch (agp_bridge->driver->size_type) {
312 case U8_APER_SIZE:
313 current_size = A_SIZE_8(temp)->size;
314 break;
315 case U16_APER_SIZE:
316 current_size = A_SIZE_16(temp)->size;
317 break;
318 case U32_APER_SIZE:
319 current_size = A_SIZE_32(temp)->size;
320 break;
321 case LVL2_APER_SIZE:
322 current_size = A_SIZE_LVL2(temp)->size;
323 break;
324 case FIXED_APER_SIZE:
325 current_size = A_SIZE_FIX(temp)->size;
326 break;
327 default:
328 current_size = 0;
329 break;
330 }
331
332 current_size -= (agp_memory_reserved / (1024*1024));
333 if (current_size <0)
334 current_size = 0;
335 return current_size;
336}
337
338
339int agp_num_entries(void)
340{
341 int num_entries;
342 void *temp;
343
344 temp = agp_bridge->current_size;
345
346 switch (agp_bridge->driver->size_type) {
347 case U8_APER_SIZE:
348 num_entries = A_SIZE_8(temp)->num_entries;
349 break;
350 case U16_APER_SIZE:
351 num_entries = A_SIZE_16(temp)->num_entries;
352 break;
353 case U32_APER_SIZE:
354 num_entries = A_SIZE_32(temp)->num_entries;
355 break;
356 case LVL2_APER_SIZE:
357 num_entries = A_SIZE_LVL2(temp)->num_entries;
358 break;
359 case FIXED_APER_SIZE:
360 num_entries = A_SIZE_FIX(temp)->num_entries;
361 break;
362 default:
363 num_entries = 0;
364 break;
365 }
366
367 num_entries -= agp_memory_reserved>>PAGE_SHIFT;
368 if (num_entries<0)
369 num_entries = 0;
370 return num_entries;
371}
372EXPORT_SYMBOL_GPL(agp_num_entries);
373
374
Linus Torvalds1da177e2005-04-16 15:20:36 -0700375/**
376 * agp_copy_info - copy bridge state information
377 *
Dave Jones6a92a4e2006-02-28 00:54:25 -0500378 * @info: agp_kern_info pointer. The caller should insure that this pointer is valid.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700379 *
380 * This function copies information about the agp bridge device and the state of
381 * the agp backend into an agp_kern_info pointer.
382 */
383int agp_copy_info(struct agp_bridge_data *bridge, struct agp_kern_info *info)
384{
385 memset(info, 0, sizeof(struct agp_kern_info));
386 if (!bridge) {
387 info->chipset = NOT_SUPPORTED;
388 return -EIO;
389 }
390
391 info->version.major = bridge->version->major;
392 info->version.minor = bridge->version->minor;
393 info->chipset = SUPPORTED;
394 info->device = bridge->dev;
David Mosberger66bb8bf2005-04-04 13:29:43 -0700395 if (bridge->mode & AGPSTAT_MODE_3_0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396 info->mode = bridge->mode & ~AGP3_RESERVED_MASK;
397 else
398 info->mode = bridge->mode & ~AGP2_RESERVED_MASK;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399 info->aper_base = bridge->gart_bus_addr;
400 info->aper_size = agp_return_size();
401 info->max_memory = bridge->max_memory_agp;
402 info->current_memory = atomic_read(&bridge->current_memory_agp);
403 info->cant_use_aperture = bridge->driver->cant_use_aperture;
404 info->vm_ops = bridge->vm_ops;
405 info->page_mask = ~0UL;
406 return 0;
407}
408EXPORT_SYMBOL(agp_copy_info);
409
410/* End - Routine to copy over information structure */
411
412/*
413 * Routines for handling swapping of agp_memory into the GATT -
414 * These routines take agp_memory and insert them into the GATT.
415 * They call device specific routines to actually write to the GATT.
416 */
417
418/**
419 * agp_bind_memory - Bind an agp_memory structure into the GATT.
420 *
421 * @curr: agp_memory pointer
422 * @pg_start: an offset into the graphics aperture translation table
423 *
424 * It returns -EINVAL if the pointer == NULL.
425 * It returns -EBUSY if the area of the table requested is already in use.
426 */
427int agp_bind_memory(struct agp_memory *curr, off_t pg_start)
428{
429 int ret_val;
430
431 if (curr == NULL)
432 return -EINVAL;
433
Joe Perchesc7258012008-03-26 14:10:02 -0700434 if (curr->is_bound) {
Dave Jones8c8b8382005-08-17 23:08:11 -0700435 printk(KERN_INFO PFX "memory %p is already bound!\n", curr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700436 return -EINVAL;
437 }
Joe Perchesc7258012008-03-26 14:10:02 -0700438 if (!curr->is_flushed) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700439 curr->bridge->driver->cache_flush();
Joe Perchesc7258012008-03-26 14:10:02 -0700440 curr->is_flushed = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700441 }
442 ret_val = curr->bridge->driver->insert_memory(curr, pg_start, curr->type);
443
444 if (ret_val != 0)
445 return ret_val;
446
Joe Perchesc7258012008-03-26 14:10:02 -0700447 curr->is_bound = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700448 curr->pg_start = pg_start;
Keith Packarda8c84df2008-07-31 15:48:07 +1000449 spin_lock(&agp_bridge->mapped_lock);
450 list_add(&curr->mapped_list, &agp_bridge->mapped_list);
451 spin_unlock(&agp_bridge->mapped_lock);
452
Linus Torvalds1da177e2005-04-16 15:20:36 -0700453 return 0;
454}
455EXPORT_SYMBOL(agp_bind_memory);
456
457
458/**
459 * agp_unbind_memory - Removes an agp_memory structure from the GATT
460 *
461 * @curr: agp_memory pointer to be removed from the GATT.
462 *
463 * It returns -EINVAL if this piece of agp_memory is not currently bound to
464 * the graphics aperture translation table or if the agp_memory pointer == NULL
465 */
466int agp_unbind_memory(struct agp_memory *curr)
467{
468 int ret_val;
469
470 if (curr == NULL)
471 return -EINVAL;
472
Joe Perchesc7258012008-03-26 14:10:02 -0700473 if (!curr->is_bound) {
Dave Jones8c8b8382005-08-17 23:08:11 -0700474 printk(KERN_INFO PFX "memory %p was not bound!\n", curr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700475 return -EINVAL;
476 }
477
478 ret_val = curr->bridge->driver->remove_memory(curr, curr->pg_start, curr->type);
479
480 if (ret_val != 0)
481 return ret_val;
482
Joe Perchesc7258012008-03-26 14:10:02 -0700483 curr->is_bound = false;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700484 curr->pg_start = 0;
Keith Packarda8c84df2008-07-31 15:48:07 +1000485 spin_lock(&curr->bridge->mapped_lock);
486 list_del(&curr->mapped_list);
487 spin_unlock(&curr->bridge->mapped_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700488 return 0;
489}
490EXPORT_SYMBOL(agp_unbind_memory);
491
Keith Packarda8c84df2008-07-31 15:48:07 +1000492/**
493 * agp_rebind_emmory - Rewrite the entire GATT, useful on resume
494 */
495int agp_rebind_memory(void)
496{
497 struct agp_memory *curr;
498 int ret_val = 0;
499
500 spin_lock(&agp_bridge->mapped_lock);
501 list_for_each_entry(curr, &agp_bridge->mapped_list, mapped_list) {
502 ret_val = curr->bridge->driver->insert_memory(curr,
503 curr->pg_start,
504 curr->type);
505 if (ret_val != 0)
506 break;
507 }
508 spin_unlock(&agp_bridge->mapped_lock);
509 return ret_val;
510}
511EXPORT_SYMBOL(agp_rebind_memory);
512
Linus Torvalds1da177e2005-04-16 15:20:36 -0700513/* End - Routines for handling swapping of agp_memory into the GATT */
514
515
516/* Generic Agp routines - Start */
517static void agp_v2_parse_one(u32 *requested_mode, u32 *bridge_agpstat, u32 *vga_agpstat)
518{
519 u32 tmp;
520
521 if (*requested_mode & AGP2_RESERVED_MASK) {
Dave Jonesc4dd4582005-11-04 15:18:56 -0800522 printk(KERN_INFO PFX "reserved bits set (%x) in mode 0x%x. Fixed.\n",
523 *requested_mode & AGP2_RESERVED_MASK, *requested_mode);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700524 *requested_mode &= ~AGP2_RESERVED_MASK;
525 }
526
Dave Jones28af24b2006-11-03 15:13:27 -0500527 /*
528 * Some dumb bridges are programmed to disobey the AGP2 spec.
529 * This is likely a BIOS misprogramming rather than poweron default, or
530 * it would be a lot more common.
531 * https://bugs.freedesktop.org/show_bug.cgi?id=8816
532 * AGPv2 spec 6.1.9 states:
533 * The RATE field indicates the data transfer rates supported by this
534 * device. A.G.P. devices must report all that apply.
535 * Fix them up as best we can.
536 */
537 switch (*bridge_agpstat & 7) {
538 case 4:
539 *bridge_agpstat |= (AGPSTAT2_2X | AGPSTAT2_1X);
540 printk(KERN_INFO PFX "BIOS bug. AGP bridge claims to only support x4 rate"
541 "Fixing up support for x2 & x1\n");
542 break;
543 case 2:
544 *bridge_agpstat |= AGPSTAT2_1X;
545 printk(KERN_INFO PFX "BIOS bug. AGP bridge claims to only support x2 rate"
546 "Fixing up support for x1\n");
547 break;
548 default:
549 break;
550 }
551
Linus Torvalds1da177e2005-04-16 15:20:36 -0700552 /* Check the speed bits make sense. Only one should be set. */
553 tmp = *requested_mode & 7;
554 switch (tmp) {
555 case 0:
Dave Jones8c8b8382005-08-17 23:08:11 -0700556 printk(KERN_INFO PFX "%s tried to set rate=x0. Setting to x1 mode.\n", current->comm);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700557 *requested_mode |= AGPSTAT2_1X;
558 break;
559 case 1:
560 case 2:
561 break;
562 case 3:
563 *requested_mode &= ~(AGPSTAT2_1X); /* rate=2 */
564 break;
565 case 4:
566 break;
567 case 5:
568 case 6:
569 case 7:
570 *requested_mode &= ~(AGPSTAT2_1X|AGPSTAT2_2X); /* rate=4*/
571 break;
572 }
573
574 /* disable SBA if it's not supported */
575 if (!((*bridge_agpstat & AGPSTAT_SBA) && (*vga_agpstat & AGPSTAT_SBA) && (*requested_mode & AGPSTAT_SBA)))
576 *bridge_agpstat &= ~AGPSTAT_SBA;
577
578 /* Set rate */
579 if (!((*bridge_agpstat & AGPSTAT2_4X) && (*vga_agpstat & AGPSTAT2_4X) && (*requested_mode & AGPSTAT2_4X)))
580 *bridge_agpstat &= ~AGPSTAT2_4X;
581
582 if (!((*bridge_agpstat & AGPSTAT2_2X) && (*vga_agpstat & AGPSTAT2_2X) && (*requested_mode & AGPSTAT2_2X)))
583 *bridge_agpstat &= ~AGPSTAT2_2X;
584
585 if (!((*bridge_agpstat & AGPSTAT2_1X) && (*vga_agpstat & AGPSTAT2_1X) && (*requested_mode & AGPSTAT2_1X)))
586 *bridge_agpstat &= ~AGPSTAT2_1X;
587
588 /* Now we know what mode it should be, clear out the unwanted bits. */
589 if (*bridge_agpstat & AGPSTAT2_4X)
590 *bridge_agpstat &= ~(AGPSTAT2_1X | AGPSTAT2_2X); /* 4X */
591
592 if (*bridge_agpstat & AGPSTAT2_2X)
593 *bridge_agpstat &= ~(AGPSTAT2_1X | AGPSTAT2_4X); /* 2X */
594
595 if (*bridge_agpstat & AGPSTAT2_1X)
596 *bridge_agpstat &= ~(AGPSTAT2_2X | AGPSTAT2_4X); /* 1X */
597
598 /* Apply any errata. */
599 if (agp_bridge->flags & AGP_ERRATA_FASTWRITES)
600 *bridge_agpstat &= ~AGPSTAT_FW;
601
602 if (agp_bridge->flags & AGP_ERRATA_SBA)
603 *bridge_agpstat &= ~AGPSTAT_SBA;
604
605 if (agp_bridge->flags & AGP_ERRATA_1X) {
606 *bridge_agpstat &= ~(AGPSTAT2_2X | AGPSTAT2_4X);
607 *bridge_agpstat |= AGPSTAT2_1X;
608 }
609
610 /* If we've dropped down to 1X, disable fast writes. */
611 if (*bridge_agpstat & AGPSTAT2_1X)
612 *bridge_agpstat &= ~AGPSTAT_FW;
613}
614
615/*
616 * requested_mode = Mode requested by (typically) X.
617 * bridge_agpstat = PCI_AGP_STATUS from agp bridge.
618 * vga_agpstat = PCI_AGP_STATUS from graphic card.
619 */
620static void agp_v3_parse_one(u32 *requested_mode, u32 *bridge_agpstat, u32 *vga_agpstat)
621{
622 u32 origbridge=*bridge_agpstat, origvga=*vga_agpstat;
623 u32 tmp;
624
625 if (*requested_mode & AGP3_RESERVED_MASK) {
Dave Jonesc4dd4582005-11-04 15:18:56 -0800626 printk(KERN_INFO PFX "reserved bits set (%x) in mode 0x%x. Fixed.\n",
627 *requested_mode & AGP3_RESERVED_MASK, *requested_mode);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700628 *requested_mode &= ~AGP3_RESERVED_MASK;
629 }
630
631 /* Check the speed bits make sense. */
632 tmp = *requested_mode & 7;
633 if (tmp == 0) {
Dave Jones8c8b8382005-08-17 23:08:11 -0700634 printk(KERN_INFO PFX "%s tried to set rate=x0. Setting to AGP3 x4 mode.\n", current->comm);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700635 *requested_mode |= AGPSTAT3_4X;
636 }
637 if (tmp >= 3) {
Dave Jones8c8b8382005-08-17 23:08:11 -0700638 printk(KERN_INFO PFX "%s tried to set rate=x%d. Setting to AGP3 x8 mode.\n", current->comm, tmp * 4);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700639 *requested_mode = (*requested_mode & ~7) | AGPSTAT3_8X;
640 }
641
642 /* ARQSZ - Set the value to the maximum one.
643 * Don't allow the mode register to override values. */
644 *bridge_agpstat = ((*bridge_agpstat & ~AGPSTAT_ARQSZ) |
645 max_t(u32,(*bridge_agpstat & AGPSTAT_ARQSZ),(*vga_agpstat & AGPSTAT_ARQSZ)));
646
647 /* Calibration cycle.
648 * Don't allow the mode register to override values. */
649 *bridge_agpstat = ((*bridge_agpstat & ~AGPSTAT_CAL_MASK) |
650 min_t(u32,(*bridge_agpstat & AGPSTAT_CAL_MASK),(*vga_agpstat & AGPSTAT_CAL_MASK)));
651
652 /* SBA *must* be supported for AGP v3 */
653 *bridge_agpstat |= AGPSTAT_SBA;
654
655 /*
656 * Set speed.
657 * Check for invalid speeds. This can happen when applications
658 * written before the AGP 3.0 standard pass AGP2.x modes to AGP3 hardware
659 */
660 if (*requested_mode & AGPSTAT_MODE_3_0) {
661 /*
662 * Caller hasn't a clue what it is doing. Bridge is in 3.0 mode,
663 * have been passed a 3.0 mode, but with 2.x speed bits set.
664 * AGP2.x 4x -> AGP3.0 4x.
665 */
666 if (*requested_mode & AGPSTAT2_4X) {
Dave Jones8c8b8382005-08-17 23:08:11 -0700667 printk(KERN_INFO PFX "%s passes broken AGP3 flags (%x). Fixed.\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700668 current->comm, *requested_mode);
669 *requested_mode &= ~AGPSTAT2_4X;
670 *requested_mode |= AGPSTAT3_4X;
671 }
672 } else {
673 /*
674 * The caller doesn't know what they are doing. We are in 3.0 mode,
675 * but have been passed an AGP 2.x mode.
676 * Convert AGP 1x,2x,4x -> AGP 3.0 4x.
677 */
Dave Jones8c8b8382005-08-17 23:08:11 -0700678 printk(KERN_INFO PFX "%s passes broken AGP2 flags (%x) in AGP3 mode. Fixed.\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700679 current->comm, *requested_mode);
680 *requested_mode &= ~(AGPSTAT2_4X | AGPSTAT2_2X | AGPSTAT2_1X);
681 *requested_mode |= AGPSTAT3_4X;
682 }
683
684 if (*requested_mode & AGPSTAT3_8X) {
685 if (!(*bridge_agpstat & AGPSTAT3_8X)) {
686 *bridge_agpstat &= ~(AGPSTAT3_8X | AGPSTAT3_RSVD);
687 *bridge_agpstat |= AGPSTAT3_4X;
Dave Jones8c8b8382005-08-17 23:08:11 -0700688 printk(KERN_INFO PFX "%s requested AGPx8 but bridge not capable.\n", current->comm);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700689 return;
690 }
691 if (!(*vga_agpstat & AGPSTAT3_8X)) {
692 *bridge_agpstat &= ~(AGPSTAT3_8X | AGPSTAT3_RSVD);
693 *bridge_agpstat |= AGPSTAT3_4X;
Dave Jones8c8b8382005-08-17 23:08:11 -0700694 printk(KERN_INFO PFX "%s requested AGPx8 but graphic card not capable.\n", current->comm);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700695 return;
696 }
697 /* All set, bridge & device can do AGP x8*/
698 *bridge_agpstat &= ~(AGPSTAT3_4X | AGPSTAT3_RSVD);
699 goto done;
700
Dave Jonesedf03fb2006-09-10 21:12:20 -0400701 } else if (*requested_mode & AGPSTAT3_4X) {
702 *bridge_agpstat &= ~(AGPSTAT3_8X | AGPSTAT3_RSVD);
703 *bridge_agpstat |= AGPSTAT3_4X;
704 goto done;
705
Linus Torvalds1da177e2005-04-16 15:20:36 -0700706 } else {
707
708 /*
Dave Jonesedf03fb2006-09-10 21:12:20 -0400709 * If we didn't specify an AGP mode, we see if both
710 * the graphics card, and the bridge can do x8, and use if so.
711 * If not, we fall back to x4 mode.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700712 */
Dave Jonesedf03fb2006-09-10 21:12:20 -0400713 if ((*bridge_agpstat & AGPSTAT3_8X) && (*vga_agpstat & AGPSTAT3_8X)) {
Dave Jones2cc1a412006-09-28 19:50:07 -0400714 printk(KERN_INFO PFX "No AGP mode specified. Setting to highest mode "
715 "supported by bridge & card (x8).\n");
Dave Jonesedf03fb2006-09-10 21:12:20 -0400716 *bridge_agpstat &= ~(AGPSTAT3_4X | AGPSTAT3_RSVD);
717 *vga_agpstat &= ~(AGPSTAT3_4X | AGPSTAT3_RSVD);
718 } else {
719 printk(KERN_INFO PFX "Fell back to AGPx4 mode because");
720 if (!(*bridge_agpstat & AGPSTAT3_8X)) {
Dave Jones2cc1a412006-09-28 19:50:07 -0400721 printk(KERN_INFO PFX "bridge couldn't do x8. bridge_agpstat:%x (orig=%x)\n",
722 *bridge_agpstat, origbridge);
Dave Jonesedf03fb2006-09-10 21:12:20 -0400723 *bridge_agpstat &= ~(AGPSTAT3_8X | AGPSTAT3_RSVD);
724 *bridge_agpstat |= AGPSTAT3_4X;
725 }
726 if (!(*vga_agpstat & AGPSTAT3_8X)) {
Dave Jones2cc1a412006-09-28 19:50:07 -0400727 printk(KERN_INFO PFX "graphics card couldn't do x8. vga_agpstat:%x (orig=%x)\n",
728 *vga_agpstat, origvga);
Dave Jonesedf03fb2006-09-10 21:12:20 -0400729 *vga_agpstat &= ~(AGPSTAT3_8X | AGPSTAT3_RSVD);
730 *vga_agpstat |= AGPSTAT3_4X;
731 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700732 }
733 }
734
735done:
736 /* Apply any errata. */
737 if (agp_bridge->flags & AGP_ERRATA_FASTWRITES)
738 *bridge_agpstat &= ~AGPSTAT_FW;
739
740 if (agp_bridge->flags & AGP_ERRATA_SBA)
741 *bridge_agpstat &= ~AGPSTAT_SBA;
742
743 if (agp_bridge->flags & AGP_ERRATA_1X) {
744 *bridge_agpstat &= ~(AGPSTAT2_2X | AGPSTAT2_4X);
745 *bridge_agpstat |= AGPSTAT2_1X;
746 }
747}
748
749
750/**
751 * agp_collect_device_status - determine correct agp_cmd from various agp_stat's
752 * @bridge: an agp_bridge_data struct allocated for the AGP host bridge.
753 * @requested_mode: requested agp_stat from userspace (Typically from X)
754 * @bridge_agpstat: current agp_stat from AGP bridge.
755 *
756 * This function will hunt for an AGP graphics card, and try to match
757 * the requested mode to the capabilities of both the bridge and the card.
758 */
759u32 agp_collect_device_status(struct agp_bridge_data *bridge, u32 requested_mode, u32 bridge_agpstat)
760{
761 struct pci_dev *device = NULL;
762 u32 vga_agpstat;
763 u8 cap_ptr;
764
765 for (;;) {
766 device = pci_get_class(PCI_CLASS_DISPLAY_VGA << 8, device);
767 if (!device) {
Dave Jones8c8b8382005-08-17 23:08:11 -0700768 printk(KERN_INFO PFX "Couldn't find an AGP VGA controller.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700769 return 0;
770 }
771 cap_ptr = pci_find_capability(device, PCI_CAP_ID_AGP);
772 if (cap_ptr)
773 break;
774 }
775
776 /*
777 * Ok, here we have a AGP device. Disable impossible
778 * settings, and adjust the readqueue to the minimum.
779 */
780 pci_read_config_dword(device, cap_ptr+PCI_AGP_STATUS, &vga_agpstat);
781
782 /* adjust RQ depth */
783 bridge_agpstat = ((bridge_agpstat & ~AGPSTAT_RQ_DEPTH) |
784 min_t(u32, (requested_mode & AGPSTAT_RQ_DEPTH),
785 min_t(u32, (bridge_agpstat & AGPSTAT_RQ_DEPTH), (vga_agpstat & AGPSTAT_RQ_DEPTH))));
786
787 /* disable FW if it's not supported */
788 if (!((bridge_agpstat & AGPSTAT_FW) &&
789 (vga_agpstat & AGPSTAT_FW) &&
790 (requested_mode & AGPSTAT_FW)))
791 bridge_agpstat &= ~AGPSTAT_FW;
792
793 /* Check to see if we are operating in 3.0 mode */
David Mosberger66bb8bf2005-04-04 13:29:43 -0700794 if (agp_bridge->mode & AGPSTAT_MODE_3_0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700795 agp_v3_parse_one(&requested_mode, &bridge_agpstat, &vga_agpstat);
796 else
797 agp_v2_parse_one(&requested_mode, &bridge_agpstat, &vga_agpstat);
798
799 pci_dev_put(device);
800 return bridge_agpstat;
801}
802EXPORT_SYMBOL(agp_collect_device_status);
803
804
Joe Perchesc7258012008-03-26 14:10:02 -0700805void agp_device_command(u32 bridge_agpstat, bool agp_v3)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700806{
807 struct pci_dev *device = NULL;
808 int mode;
809
810 mode = bridge_agpstat & 0x7;
811 if (agp_v3)
812 mode *= 4;
813
814 for_each_pci_dev(device) {
815 u8 agp = pci_find_capability(device, PCI_CAP_ID_AGP);
816 if (!agp)
817 continue;
818
Bjorn Helgaase3cf6952008-07-30 12:26:51 -0700819 dev_info(&device->dev, "putting AGP V%d device into %dx mode\n",
820 agp_v3 ? 3 : 2, mode);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700821 pci_write_config_dword(device, agp + PCI_AGP_COMMAND, bridge_agpstat);
822 }
823}
824EXPORT_SYMBOL(agp_device_command);
825
826
827void get_agp_version(struct agp_bridge_data *bridge)
828{
829 u32 ncapid;
830
831 /* Exit early if already set by errata workarounds. */
832 if (bridge->major_version != 0)
833 return;
834
835 pci_read_config_dword(bridge->dev, bridge->capndx, &ncapid);
836 bridge->major_version = (ncapid >> AGP_MAJOR_VERSION_SHIFT) & 0xf;
837 bridge->minor_version = (ncapid >> AGP_MINOR_VERSION_SHIFT) & 0xf;
838}
839EXPORT_SYMBOL(get_agp_version);
840
841
842void agp_generic_enable(struct agp_bridge_data *bridge, u32 requested_mode)
843{
844 u32 bridge_agpstat, temp;
845
846 get_agp_version(agp_bridge);
847
Bjorn Helgaase3cf6952008-07-30 12:26:51 -0700848 dev_info(&agp_bridge->dev->dev, "AGP %d.%d bridge\n",
849 agp_bridge->major_version, agp_bridge->minor_version);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700850
851 pci_read_config_dword(agp_bridge->dev,
852 agp_bridge->capndx + PCI_AGP_STATUS, &bridge_agpstat);
853
854 bridge_agpstat = agp_collect_device_status(agp_bridge, requested_mode, bridge_agpstat);
855 if (bridge_agpstat == 0)
856 /* Something bad happened. FIXME: Return error code? */
857 return;
858
859 bridge_agpstat |= AGPSTAT_AGP_ENABLE;
860
861 /* Do AGP version specific frobbing. */
862 if (bridge->major_version >= 3) {
David Mosberger66bb8bf2005-04-04 13:29:43 -0700863 if (bridge->mode & AGPSTAT_MODE_3_0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700864 /* If we have 3.5, we can do the isoch stuff. */
865 if (bridge->minor_version >= 5)
866 agp_3_5_enable(bridge);
Joe Perchesc7258012008-03-26 14:10:02 -0700867 agp_device_command(bridge_agpstat, true);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700868 return;
869 } else {
870 /* Disable calibration cycle in RX91<1> when not in AGP3.0 mode of operation.*/
871 bridge_agpstat &= ~(7<<10) ;
872 pci_read_config_dword(bridge->dev,
873 bridge->capndx+AGPCTRL, &temp);
874 temp |= (1<<9);
875 pci_write_config_dword(bridge->dev,
876 bridge->capndx+AGPCTRL, temp);
877
Bjorn Helgaase3cf6952008-07-30 12:26:51 -0700878 dev_info(&bridge->dev->dev, "bridge is in legacy mode, falling back to 2.x\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700879 }
880 }
881
882 /* AGP v<3 */
Joe Perchesc7258012008-03-26 14:10:02 -0700883 agp_device_command(bridge_agpstat, false);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700884}
885EXPORT_SYMBOL(agp_generic_enable);
886
887
888int agp_generic_create_gatt_table(struct agp_bridge_data *bridge)
889{
890 char *table;
891 char *table_end;
892 int size;
893 int page_order;
894 int num_entries;
895 int i;
896 void *temp;
897 struct page *page;
898
899 /* The generic routines can't handle 2 level gatt's */
900 if (bridge->driver->size_type == LVL2_APER_SIZE)
901 return -EINVAL;
902
903 table = NULL;
904 i = bridge->aperture_size_idx;
905 temp = bridge->current_size;
906 size = page_order = num_entries = 0;
907
908 if (bridge->driver->size_type != FIXED_APER_SIZE) {
909 do {
910 switch (bridge->driver->size_type) {
911 case U8_APER_SIZE:
912 size = A_SIZE_8(temp)->size;
913 page_order =
914 A_SIZE_8(temp)->page_order;
915 num_entries =
916 A_SIZE_8(temp)->num_entries;
917 break;
918 case U16_APER_SIZE:
919 size = A_SIZE_16(temp)->size;
920 page_order = A_SIZE_16(temp)->page_order;
921 num_entries = A_SIZE_16(temp)->num_entries;
922 break;
923 case U32_APER_SIZE:
924 size = A_SIZE_32(temp)->size;
925 page_order = A_SIZE_32(temp)->page_order;
926 num_entries = A_SIZE_32(temp)->num_entries;
927 break;
928 /* This case will never really happen. */
929 case FIXED_APER_SIZE:
930 case LVL2_APER_SIZE:
931 default:
932 size = page_order = num_entries = 0;
933 break;
934 }
935
Keir Fraser07eee782005-03-30 13:17:04 -0800936 table = alloc_gatt_pages(page_order);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700937
938 if (table == NULL) {
939 i++;
940 switch (bridge->driver->size_type) {
941 case U8_APER_SIZE:
942 bridge->current_size = A_IDX8(bridge);
943 break;
944 case U16_APER_SIZE:
945 bridge->current_size = A_IDX16(bridge);
946 break;
947 case U32_APER_SIZE:
948 bridge->current_size = A_IDX32(bridge);
949 break;
Dave Jones89197e32006-05-30 18:19:39 -0400950 /* These cases will never really happen. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700951 case FIXED_APER_SIZE:
952 case LVL2_APER_SIZE:
953 default:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700954 break;
955 }
956 temp = bridge->current_size;
957 } else {
958 bridge->aperture_size_idx = i;
959 }
960 } while (!table && (i < bridge->driver->num_aperture_sizes));
961 } else {
962 size = ((struct aper_size_info_fixed *) temp)->size;
963 page_order = ((struct aper_size_info_fixed *) temp)->page_order;
964 num_entries = ((struct aper_size_info_fixed *) temp)->num_entries;
Keir Fraser07eee782005-03-30 13:17:04 -0800965 table = alloc_gatt_pages(page_order);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700966 }
967
968 if (table == NULL)
969 return -ENOMEM;
970
971 table_end = table + ((PAGE_SIZE * (1 << page_order)) - 1);
972
973 for (page = virt_to_page(table); page <= virt_to_page(table_end); page++)
974 SetPageReserved(page);
975
976 bridge->gatt_table_real = (u32 *) table;
977 agp_gatt_table = (void *)table;
978
979 bridge->driver->cache_flush();
Arjan van dev Venfcea4242008-02-06 05:16:00 +0100980#ifdef CONFIG_X86
981 set_memory_uc((unsigned long)table, 1 << page_order);
982 bridge->gatt_table = (void *)table;
983#else
Keir Fraser07eee782005-03-30 13:17:04 -0800984 bridge->gatt_table = ioremap_nocache(virt_to_gart(table),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700985 (PAGE_SIZE * (1 << page_order)));
986 bridge->driver->cache_flush();
Arjan van dev Venfcea4242008-02-06 05:16:00 +0100987#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700988
989 if (bridge->gatt_table == NULL) {
990 for (page = virt_to_page(table); page <= virt_to_page(table_end); page++)
991 ClearPageReserved(page);
992
Keir Fraser07eee782005-03-30 13:17:04 -0800993 free_gatt_pages(table, page_order);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700994
995 return -ENOMEM;
996 }
Keir Fraser07eee782005-03-30 13:17:04 -0800997 bridge->gatt_bus_addr = virt_to_gart(bridge->gatt_table_real);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700998
999 /* AK: bogus, should encode addresses > 4GB */
1000 for (i = 0; i < num_entries; i++) {
1001 writel(bridge->scratch_page, bridge->gatt_table+i);
1002 readl(bridge->gatt_table+i); /* PCI Posting. */
1003 }
1004
1005 return 0;
1006}
1007EXPORT_SYMBOL(agp_generic_create_gatt_table);
1008
1009int agp_generic_free_gatt_table(struct agp_bridge_data *bridge)
1010{
1011 int page_order;
1012 char *table, *table_end;
1013 void *temp;
1014 struct page *page;
1015
1016 temp = bridge->current_size;
1017
1018 switch (bridge->driver->size_type) {
1019 case U8_APER_SIZE:
1020 page_order = A_SIZE_8(temp)->page_order;
1021 break;
1022 case U16_APER_SIZE:
1023 page_order = A_SIZE_16(temp)->page_order;
1024 break;
1025 case U32_APER_SIZE:
1026 page_order = A_SIZE_32(temp)->page_order;
1027 break;
1028 case FIXED_APER_SIZE:
1029 page_order = A_SIZE_FIX(temp)->page_order;
1030 break;
1031 case LVL2_APER_SIZE:
1032 /* The generic routines can't deal with 2 level gatt's */
1033 return -EINVAL;
1034 break;
1035 default:
1036 page_order = 0;
1037 break;
1038 }
1039
1040 /* Do not worry about freeing memory, because if this is
1041 * called, then all agp memory is deallocated and removed
1042 * from the table. */
1043
Arjan van dev Venfcea4242008-02-06 05:16:00 +01001044#ifdef CONFIG_X86
1045 set_memory_wb((unsigned long)bridge->gatt_table, 1 << page_order);
1046#else
Linus Torvalds1da177e2005-04-16 15:20:36 -07001047 iounmap(bridge->gatt_table);
Arjan van dev Venfcea4242008-02-06 05:16:00 +01001048#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001049 table = (char *) bridge->gatt_table_real;
1050 table_end = table + ((PAGE_SIZE * (1 << page_order)) - 1);
1051
1052 for (page = virt_to_page(table); page <= virt_to_page(table_end); page++)
1053 ClearPageReserved(page);
1054
Keir Fraser07eee782005-03-30 13:17:04 -08001055 free_gatt_pages(bridge->gatt_table_real, page_order);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001056
1057 agp_gatt_table = NULL;
1058 bridge->gatt_table = NULL;
1059 bridge->gatt_table_real = NULL;
1060 bridge->gatt_bus_addr = 0;
1061
1062 return 0;
1063}
1064EXPORT_SYMBOL(agp_generic_free_gatt_table);
1065
1066
1067int agp_generic_insert_memory(struct agp_memory * mem, off_t pg_start, int type)
1068{
1069 int num_entries;
1070 size_t i;
1071 off_t j;
1072 void *temp;
1073 struct agp_bridge_data *bridge;
Thomas Hellstroma030ce42007-01-23 10:33:43 +01001074 int mask_type;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001075
1076 bridge = mem->bridge;
1077 if (!bridge)
1078 return -EINVAL;
1079
Thomas Hellstrom5aa80c72006-12-20 16:33:41 +01001080 if (mem->page_count == 0)
1081 return 0;
1082
Linus Torvalds1da177e2005-04-16 15:20:36 -07001083 temp = bridge->current_size;
1084
1085 switch (bridge->driver->size_type) {
1086 case U8_APER_SIZE:
1087 num_entries = A_SIZE_8(temp)->num_entries;
1088 break;
1089 case U16_APER_SIZE:
1090 num_entries = A_SIZE_16(temp)->num_entries;
1091 break;
1092 case U32_APER_SIZE:
1093 num_entries = A_SIZE_32(temp)->num_entries;
1094 break;
1095 case FIXED_APER_SIZE:
1096 num_entries = A_SIZE_FIX(temp)->num_entries;
1097 break;
1098 case LVL2_APER_SIZE:
1099 /* The generic routines can't deal with 2 level gatt's */
1100 return -EINVAL;
1101 break;
1102 default:
1103 num_entries = 0;
1104 break;
1105 }
1106
1107 num_entries -= agp_memory_reserved/PAGE_SIZE;
1108 if (num_entries < 0) num_entries = 0;
1109
Andrew Morton1c14cfb2007-02-05 16:09:35 -08001110 if (type != mem->type)
Thomas Hellstroma030ce42007-01-23 10:33:43 +01001111 return -EINVAL;
Thomas Hellstroma030ce42007-01-23 10:33:43 +01001112
1113 mask_type = bridge->driver->agp_type_to_mask_type(bridge, type);
1114 if (mask_type != 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001115 /* The generic routines know nothing of memory types */
1116 return -EINVAL;
1117 }
1118
1119 /* AK: could wrap */
1120 if ((pg_start + mem->page_count) > num_entries)
1121 return -EINVAL;
1122
1123 j = pg_start;
1124
1125 while (j < (pg_start + mem->page_count)) {
1126 if (!PGE_EMPTY(bridge, readl(bridge->gatt_table+j)))
1127 return -EBUSY;
1128 j++;
1129 }
1130
Joe Perchesc7258012008-03-26 14:10:02 -07001131 if (!mem->is_flushed) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001132 bridge->driver->cache_flush();
Joe Perchesc7258012008-03-26 14:10:02 -07001133 mem->is_flushed = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001134 }
1135
1136 for (i = 0, j = pg_start; i < mem->page_count; i++, j++) {
Thomas Hellstroma030ce42007-01-23 10:33:43 +01001137 writel(bridge->driver->mask_memory(bridge, mem->memory[i], mask_type),
1138 bridge->gatt_table+j);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001139 }
Thomas Hellstrom5aa80c72006-12-20 16:33:41 +01001140 readl(bridge->gatt_table+j-1); /* PCI Posting. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001141
1142 bridge->driver->tlb_flush(mem);
1143 return 0;
1144}
1145EXPORT_SYMBOL(agp_generic_insert_memory);
1146
1147
1148int agp_generic_remove_memory(struct agp_memory *mem, off_t pg_start, int type)
1149{
1150 size_t i;
1151 struct agp_bridge_data *bridge;
Thomas Hellstroma030ce42007-01-23 10:33:43 +01001152 int mask_type;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001153
1154 bridge = mem->bridge;
1155 if (!bridge)
1156 return -EINVAL;
1157
Thomas Hellstrom5aa80c72006-12-20 16:33:41 +01001158 if (mem->page_count == 0)
1159 return 0;
1160
Thomas Hellstroma030ce42007-01-23 10:33:43 +01001161 if (type != mem->type)
1162 return -EINVAL;
1163
1164 mask_type = bridge->driver->agp_type_to_mask_type(bridge, type);
1165 if (mask_type != 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001166 /* The generic routines know nothing of memory types */
1167 return -EINVAL;
1168 }
1169
1170 /* AK: bogus, should encode addresses > 4GB */
1171 for (i = pg_start; i < (mem->page_count + pg_start); i++) {
1172 writel(bridge->scratch_page, bridge->gatt_table+i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001173 }
Thomas Hellstrom5aa80c72006-12-20 16:33:41 +01001174 readl(bridge->gatt_table+i-1); /* PCI Posting. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001175
Linus Torvalds1da177e2005-04-16 15:20:36 -07001176 bridge->driver->tlb_flush(mem);
1177 return 0;
1178}
1179EXPORT_SYMBOL(agp_generic_remove_memory);
1180
Linus Torvalds1da177e2005-04-16 15:20:36 -07001181struct agp_memory *agp_generic_alloc_by_type(size_t page_count, int type)
1182{
1183 return NULL;
1184}
1185EXPORT_SYMBOL(agp_generic_alloc_by_type);
1186
Linus Torvalds1da177e2005-04-16 15:20:36 -07001187void agp_generic_free_by_type(struct agp_memory *curr)
1188{
Thomas Hellstroma030ce42007-01-23 10:33:43 +01001189 agp_free_page_array(curr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001190 agp_free_key(curr->key);
1191 kfree(curr);
1192}
1193EXPORT_SYMBOL(agp_generic_free_by_type);
1194
Thomas Hellstroma030ce42007-01-23 10:33:43 +01001195struct agp_memory *agp_generic_alloc_user(size_t page_count, int type)
1196{
1197 struct agp_memory *new;
1198 int i;
1199 int pages;
1200
1201 pages = (page_count + ENTRIES_PER_PAGE - 1) / ENTRIES_PER_PAGE;
1202 new = agp_create_user_memory(page_count);
1203 if (new == NULL)
1204 return NULL;
1205
Andrew Morton1c14cfb2007-02-05 16:09:35 -08001206 for (i = 0; i < page_count; i++)
Thomas Hellstroma030ce42007-01-23 10:33:43 +01001207 new->memory[i] = 0;
Thomas Hellstroma030ce42007-01-23 10:33:43 +01001208 new->page_count = 0;
1209 new->type = type;
1210 new->num_scratch_pages = pages;
1211
1212 return new;
1213}
1214EXPORT_SYMBOL(agp_generic_alloc_user);
1215
Linus Torvalds1da177e2005-04-16 15:20:36 -07001216/*
1217 * Basic Page Allocation Routines -
1218 * These routines handle page allocation and by default they reserve the allocated
1219 * memory. They also handle incrementing the current_memory_agp value, Which is checked
1220 * against a maximum value.
1221 */
1222
Shaohua Li37acee12008-08-21 10:46:11 +08001223int agp_generic_alloc_pages(struct agp_bridge_data *bridge, struct agp_memory *mem, size_t num_pages)
1224{
1225 struct page * page;
1226 int i, ret = -ENOMEM;
1227
1228 for (i = 0; i < num_pages; i++) {
1229 page = alloc_page(GFP_KERNEL | GFP_DMA32);
1230 /* agp_free_memory() needs gart address */
1231 if (page == NULL)
1232 goto out;
1233
1234#ifndef CONFIG_X86
1235 map_page_into_agp(page);
1236#endif
1237 get_page(page);
1238 atomic_inc(&agp_bridge->current_memory_agp);
1239
1240 /* set_memory_array_uc() needs virtual address */
1241 mem->memory[i] = (unsigned long)page_address(page);
1242 mem->page_count++;
1243 }
1244
1245#ifdef CONFIG_X86
1246 set_memory_array_uc(mem->memory, num_pages);
1247#endif
1248 ret = 0;
1249out:
1250 for (i = 0; i < mem->page_count; i++)
1251 mem->memory[i] = virt_to_gart((void *)mem->memory[i]);
1252 return ret;
1253}
1254EXPORT_SYMBOL(agp_generic_alloc_pages);
1255
Linus Torvalds1da177e2005-04-16 15:20:36 -07001256void *agp_generic_alloc_page(struct agp_bridge_data *bridge)
1257{
1258 struct page * page;
1259
Linus Torvalds66c669b2006-11-22 14:55:29 -08001260 page = alloc_page(GFP_KERNEL | GFP_DMA32);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001261 if (page == NULL)
1262 return NULL;
1263
Ingo Molnar9326d612008-08-21 13:46:25 +02001264 map_page_into_agp(page);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001265
1266 get_page(page);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001267 atomic_inc(&agp_bridge->current_memory_agp);
1268 return page_address(page);
1269}
1270EXPORT_SYMBOL(agp_generic_alloc_page);
1271
Shaohua Libd079282008-08-21 10:46:17 +08001272void agp_generic_destroy_pages(struct agp_memory *mem)
1273{
1274 int i;
1275 void *addr;
1276 struct page *page;
1277
1278 if (!mem)
1279 return;
1280
1281 for (i = 0; i < mem->page_count; i++)
1282 mem->memory[i] = (unsigned long)gart_to_virt(mem->memory[i]);
1283
1284#ifdef CONFIG_X86
1285 set_memory_array_wb(mem->memory, mem->page_count);
1286#endif
1287
1288 for (i = 0; i < mem->page_count; i++) {
1289 addr = (void *)mem->memory[i];
1290 page = virt_to_page(addr);
1291
1292#ifndef CONFIG_X86
1293 unmap_page_from_agp(page);
1294#endif
1295
1296 put_page(page);
1297 free_page((unsigned long)addr);
1298 atomic_dec(&agp_bridge->current_memory_agp);
1299 mem->memory[i] = 0;
1300 }
1301}
1302EXPORT_SYMBOL(agp_generic_destroy_pages);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001303
Dave Airliea2721e92007-10-15 10:19:16 +10001304void agp_generic_destroy_page(void *addr, int flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001305{
1306 struct page *page;
1307
1308 if (addr == NULL)
1309 return;
1310
1311 page = virt_to_page(addr);
Dave Airliea2721e92007-10-15 10:19:16 +10001312 if (flags & AGP_PAGE_DESTROY_UNMAP)
1313 unmap_page_from_agp(page);
1314
1315 if (flags & AGP_PAGE_DESTROY_FREE) {
1316 put_page(page);
1317 free_page((unsigned long)addr);
1318 atomic_dec(&agp_bridge->current_memory_agp);
1319 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001320}
1321EXPORT_SYMBOL(agp_generic_destroy_page);
1322
1323/* End Basic Page Allocation Routines */
1324
1325
1326/**
1327 * agp_enable - initialise the agp point-to-point connection.
1328 *
1329 * @mode: agp mode register value to configure with.
1330 */
1331void agp_enable(struct agp_bridge_data *bridge, u32 mode)
1332{
1333 if (!bridge)
1334 return;
1335 bridge->driver->agp_enable(bridge, mode);
1336}
1337EXPORT_SYMBOL(agp_enable);
1338
1339/* When we remove the global variable agp_bridge from all drivers
1340 * then agp_alloc_bridge and agp_generic_find_bridge need to be updated
1341 */
1342
1343struct agp_bridge_data *agp_generic_find_bridge(struct pci_dev *pdev)
1344{
1345 if (list_empty(&agp_bridges))
1346 return NULL;
1347
1348 return agp_bridge;
1349}
1350
1351static void ipi_handler(void *null)
1352{
1353 flush_agp_cache();
1354}
1355
1356void global_cache_flush(void)
1357{
Jens Axboe15c8b6c2008-05-09 09:39:44 +02001358 if (on_each_cpu(ipi_handler, NULL, 1) != 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001359 panic(PFX "timed out waiting for the other CPUs!\n");
1360}
1361EXPORT_SYMBOL(global_cache_flush);
1362
1363unsigned long agp_generic_mask_memory(struct agp_bridge_data *bridge,
1364 unsigned long addr, int type)
1365{
1366 /* memory type is ignored in the generic routine */
1367 if (bridge->driver->masks)
1368 return addr | bridge->driver->masks[0].mask;
1369 else
1370 return addr;
1371}
1372EXPORT_SYMBOL(agp_generic_mask_memory);
1373
Thomas Hellstroma030ce42007-01-23 10:33:43 +01001374int agp_generic_type_to_mask_type(struct agp_bridge_data *bridge,
1375 int type)
1376{
1377 if (type >= AGP_USER_TYPES)
1378 return 0;
1379 return type;
1380}
1381EXPORT_SYMBOL(agp_generic_type_to_mask_type);
1382
Linus Torvalds1da177e2005-04-16 15:20:36 -07001383/*
1384 * These functions are implemented according to the AGPv3 spec,
1385 * which covers implementation details that had previously been
1386 * left open.
1387 */
1388
1389int agp3_generic_fetch_size(void)
1390{
1391 u16 temp_size;
1392 int i;
1393 struct aper_size_info_16 *values;
1394
1395 pci_read_config_word(agp_bridge->dev, agp_bridge->capndx+AGPAPSIZE, &temp_size);
1396 values = A_SIZE_16(agp_bridge->driver->aperture_sizes);
1397
1398 for (i = 0; i < agp_bridge->driver->num_aperture_sizes; i++) {
1399 if (temp_size == values[i].size_value) {
1400 agp_bridge->previous_size =
1401 agp_bridge->current_size = (void *) (values + i);
1402
1403 agp_bridge->aperture_size_idx = i;
1404 return values[i].size;
1405 }
1406 }
1407 return 0;
1408}
1409EXPORT_SYMBOL(agp3_generic_fetch_size);
1410
1411void agp3_generic_tlbflush(struct agp_memory *mem)
1412{
1413 u32 ctrl;
1414 pci_read_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, &ctrl);
1415 pci_write_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, ctrl & ~AGPCTRL_GTLBEN);
1416 pci_write_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, ctrl);
1417}
1418EXPORT_SYMBOL(agp3_generic_tlbflush);
1419
1420int agp3_generic_configure(void)
1421{
1422 u32 temp;
1423 struct aper_size_info_16 *current_size;
1424
1425 current_size = A_SIZE_16(agp_bridge->current_size);
1426
1427 pci_read_config_dword(agp_bridge->dev, AGP_APBASE, &temp);
1428 agp_bridge->gart_bus_addr = (temp & PCI_BASE_ADDRESS_MEM_MASK);
1429
1430 /* set aperture size */
1431 pci_write_config_word(agp_bridge->dev, agp_bridge->capndx+AGPAPSIZE, current_size->size_value);
1432 /* set gart pointer */
1433 pci_write_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPGARTLO, agp_bridge->gatt_bus_addr);
1434 /* enable aperture and GTLB */
1435 pci_read_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, &temp);
1436 pci_write_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, temp | AGPCTRL_APERENB | AGPCTRL_GTLBEN);
1437 return 0;
1438}
1439EXPORT_SYMBOL(agp3_generic_configure);
1440
1441void agp3_generic_cleanup(void)
1442{
1443 u32 ctrl;
1444 pci_read_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, &ctrl);
1445 pci_write_config_dword(agp_bridge->dev, agp_bridge->capndx+AGPCTRL, ctrl & ~AGPCTRL_APERENB);
1446}
1447EXPORT_SYMBOL(agp3_generic_cleanup);
1448
Dave Jonese5524f32007-02-22 18:41:28 -05001449const struct aper_size_info_16 agp3_generic_sizes[AGP_GENERIC_SIZES_ENTRIES] =
Linus Torvalds1da177e2005-04-16 15:20:36 -07001450{
1451 {4096, 1048576, 10,0x000},
1452 {2048, 524288, 9, 0x800},
1453 {1024, 262144, 8, 0xc00},
1454 { 512, 131072, 7, 0xe00},
1455 { 256, 65536, 6, 0xf00},
1456 { 128, 32768, 5, 0xf20},
1457 { 64, 16384, 4, 0xf30},
1458 { 32, 8192, 3, 0xf38},
1459 { 16, 4096, 2, 0xf3c},
1460 { 8, 2048, 1, 0xf3e},
1461 { 4, 1024, 0, 0xf3f}
1462};
1463EXPORT_SYMBOL(agp3_generic_sizes);
1464