pci-gart_64.c 21.9 KB
Newer Older
L
Linus Torvalds 已提交
1 2
/*
 * Dynamic DMA mapping support for AMD Hammer.
3
 *
L
Linus Torvalds 已提交
4 5
 * Use the integrated AGP GART in the Hammer northbridge as an IOMMU for PCI.
 * This allows to use PCI devices that only support 32bit addresses on systems
6
 * with more than 4GB.
L
Linus Torvalds 已提交
7 8
 *
 * See Documentation/DMA-mapping.txt for the interface specification.
9
 *
L
Linus Torvalds 已提交
10
 * Copyright 2002 Andi Kleen, SuSE Labs.
A
Andi Kleen 已提交
11
 * Subject to the GNU General Public License v2 only.
L
Linus Torvalds 已提交
12 13 14 15 16 17 18 19 20 21 22 23 24 25
 */

#include <linux/types.h>
#include <linux/ctype.h>
#include <linux/agp_backend.h>
#include <linux/init.h>
#include <linux/mm.h>
#include <linux/string.h>
#include <linux/spinlock.h>
#include <linux/pci.h>
#include <linux/module.h>
#include <linux/topology.h>
#include <linux/interrupt.h>
#include <linux/bitops.h>
26
#include <linux/kdebug.h>
27
#include <linux/scatterlist.h>
28
#include <linux/iommu-helper.h>
29
#include <linux/sysdev.h>
L
Linus Torvalds 已提交
30 31 32 33 34
#include <asm/atomic.h>
#include <asm/io.h>
#include <asm/mtrr.h>
#include <asm/pgtable.h>
#include <asm/proto.h>
35
#include <asm/iommu.h>
J
Joerg Roedel 已提交
36
#include <asm/gart.h>
L
Linus Torvalds 已提交
37
#include <asm/cacheflush.h>
38 39
#include <asm/swiotlb.h>
#include <asm/dma.h>
40
#include <asm/k8.h>
L
Linus Torvalds 已提交
41

42
static unsigned long iommu_bus_base;	/* GART remapping area (physical) */
43
static unsigned long iommu_size;	/* size of remapping area bytes */
L
Linus Torvalds 已提交
44 45
static unsigned long iommu_pages;	/* .. and in pages */

46
static u32 *iommu_gatt_base;		/* Remapping table */
L
Linus Torvalds 已提交
47

48 49 50 51 52 53 54
/*
 * If this is disabled the IOMMU will use an optimized flushing strategy
 * of only flushing when an mapping is reused. With it true the GART is
 * flushed for every mapping. Problem is that doing the lazy flush seems
 * to trigger bugs with some popular PCI cards, in particular 3ware (but
 * has been also also seen with Qlogic at least).
 */
L
Linus Torvalds 已提交
55 56
int iommu_fullflush = 1;

57
/* Allocation bitmap for the remapping area: */
L
Linus Torvalds 已提交
58
static DEFINE_SPINLOCK(iommu_bitmap_lock);
59 60
/* Guarded by iommu_bitmap_lock: */
static unsigned long *iommu_gart_bitmap;
L
Linus Torvalds 已提交
61

62
static u32 gart_unmapped_entry;
L
Linus Torvalds 已提交
63 64 65 66 67 68 69

#define GPTE_VALID    1
#define GPTE_COHERENT 2
#define GPTE_ENCODE(x) \
	(((x) & 0xfffff000) | (((x) >> 32) << 4) | GPTE_VALID | GPTE_COHERENT)
#define GPTE_DECODE(x) (((x) & 0xfffff000) | (((u64)(x) & 0xff0) << 28))

70
#define to_pages(addr, size) \
L
Linus Torvalds 已提交
71 72
	(round_up(((addr) & ~PAGE_MASK) + (size), PAGE_SIZE) >> PAGE_SHIFT)

73
#define EMERGENCY_PAGES 32 /* = 128KB */
L
Linus Torvalds 已提交
74 75 76 77 78 79 80 81 82 83 84 85

#ifdef CONFIG_AGP
#define AGPEXTERN extern
#else
#define AGPEXTERN
#endif

/* backdoor interface to AGP driver */
AGPEXTERN int agp_memory_reserved;
AGPEXTERN __u32 *agp_gatt_table;

static unsigned long next_bit;  /* protected by iommu_bitmap_lock */
86
static int need_flush;		/* global flush state. set for each gart wrap */
L
Linus Torvalds 已提交
87

88
static unsigned long alloc_iommu(struct device *dev, int size)
89
{
L
Linus Torvalds 已提交
90
	unsigned long offset, flags;
91 92 93 94 95 96 97
	unsigned long boundary_size;
	unsigned long base_index;

	base_index = ALIGN(iommu_bus_base & dma_get_seg_boundary(dev),
			   PAGE_SIZE) >> PAGE_SHIFT;
	boundary_size = ALIGN(dma_get_seg_boundary(dev) + 1,
			      PAGE_SIZE) >> PAGE_SHIFT;
L
Linus Torvalds 已提交
98

99
	spin_lock_irqsave(&iommu_bitmap_lock, flags);
100 101
	offset = iommu_area_alloc(iommu_gart_bitmap, iommu_pages, next_bit,
				  size, base_index, boundary_size, 0);
L
Linus Torvalds 已提交
102 103
	if (offset == -1) {
		need_flush = 1;
104 105
		offset = iommu_area_alloc(iommu_gart_bitmap, iommu_pages, 0,
					  size, base_index, boundary_size, 0);
L
Linus Torvalds 已提交
106
	}
107 108 109
	if (offset != -1) {
		next_bit = offset+size;
		if (next_bit >= iommu_pages) {
L
Linus Torvalds 已提交
110 111
			next_bit = 0;
			need_flush = 1;
112 113
		}
	}
L
Linus Torvalds 已提交
114 115
	if (iommu_fullflush)
		need_flush = 1;
116 117
	spin_unlock_irqrestore(&iommu_bitmap_lock, flags);

L
Linus Torvalds 已提交
118
	return offset;
119
}
L
Linus Torvalds 已提交
120 121

static void free_iommu(unsigned long offset, int size)
122
{
L
Linus Torvalds 已提交
123
	unsigned long flags;
124

L
Linus Torvalds 已提交
125
	spin_lock_irqsave(&iommu_bitmap_lock, flags);
126
	iommu_area_free(iommu_gart_bitmap, offset, size);
L
Linus Torvalds 已提交
127
	spin_unlock_irqrestore(&iommu_bitmap_lock, flags);
128
}
L
Linus Torvalds 已提交
129

130
/*
L
Linus Torvalds 已提交
131 132
 * Use global flush state to avoid races with multiple flushers.
 */
133
static void flush_gart(void)
134
{
L
Linus Torvalds 已提交
135
	unsigned long flags;
136

L
Linus Torvalds 已提交
137
	spin_lock_irqsave(&iommu_bitmap_lock, flags);
138 139
	if (need_flush) {
		k8_flush_garts();
L
Linus Torvalds 已提交
140
		need_flush = 0;
141
	}
L
Linus Torvalds 已提交
142
	spin_unlock_irqrestore(&iommu_bitmap_lock, flags);
143
}
L
Linus Torvalds 已提交
144 145 146

#ifdef CONFIG_IOMMU_LEAK

147 148 149 150 151 152 153 154 155 156 157
#define SET_LEAK(x)							\
	do {								\
		if (iommu_leak_tab)					\
			iommu_leak_tab[x] = __builtin_return_address(0);\
	} while (0)

#define CLEAR_LEAK(x)							\
	do {								\
		if (iommu_leak_tab)					\
			iommu_leak_tab[x] = NULL;			\
	} while (0)
L
Linus Torvalds 已提交
158 159

/* Debugging aid for drivers that don't free their IOMMU tables */
160
static void **iommu_leak_tab;
L
Linus Torvalds 已提交
161
static int leak_trace;
162
static int iommu_leak_pages = 20;
163

164
static void dump_leak(void)
L
Linus Torvalds 已提交
165 166
{
	int i;
167 168 169 170
	static int dump;

	if (dump || !iommu_leak_tab)
		return;
L
Linus Torvalds 已提交
171
	dump = 1;
172 173 174 175 176 177 178
	show_stack(NULL, NULL);

	/* Very crude. dump some from the end of the table too */
	printk(KERN_DEBUG "Dumping %d pages from end of IOMMU:\n",
	       iommu_leak_pages);
	for (i = 0; i < iommu_leak_pages; i += 2) {
		printk(KERN_DEBUG "%lu: ", iommu_pages-i);
179
		printk_address((unsigned long) iommu_leak_tab[iommu_pages-i], 0);
180 181 182
		printk(KERN_CONT "%c", (i+1)%2 == 0 ? '\n' : ' ');
	}
	printk(KERN_DEBUG "\n");
L
Linus Torvalds 已提交
183 184
}
#else
185 186
# define SET_LEAK(x)
# define CLEAR_LEAK(x)
L
Linus Torvalds 已提交
187 188
#endif

189
static void iommu_full(struct device *dev, size_t size, int dir)
L
Linus Torvalds 已提交
190
{
191
	/*
L
Linus Torvalds 已提交
192 193
	 * Ran out of IOMMU space for this operation. This is very bad.
	 * Unfortunately the drivers cannot handle this operation properly.
194
	 * Return some non mapped prereserved space in the aperture and
L
Linus Torvalds 已提交
195 196
	 * let the Northbridge deal with it. This will result in garbage
	 * in the IO operation. When the size exceeds the prereserved space
197
	 * memory corruption will occur or random memory will be DMAed
L
Linus Torvalds 已提交
198
	 * out. Hopefully no network devices use single mappings that big.
199 200
	 */

201
	dev_err(dev, "PCI-DMA: Out of IOMMU space for %lu bytes\n", size);
L
Linus Torvalds 已提交
202

203
	if (size > PAGE_SIZE*EMERGENCY_PAGES) {
L
Linus Torvalds 已提交
204 205
		if (dir == PCI_DMA_FROMDEVICE || dir == PCI_DMA_BIDIRECTIONAL)
			panic("PCI-DMA: Memory would be corrupted\n");
206 207 208 209
		if (dir == PCI_DMA_TODEVICE || dir == PCI_DMA_BIDIRECTIONAL)
			panic(KERN_ERR
				"PCI-DMA: Random memory would be DMAed\n");
	}
L
Linus Torvalds 已提交
210
#ifdef CONFIG_IOMMU_LEAK
211
	dump_leak();
L
Linus Torvalds 已提交
212
#endif
213
}
L
Linus Torvalds 已提交
214

215 216 217
static inline int
need_iommu(struct device *dev, unsigned long addr, size_t size)
{
L
Linus Torvalds 已提交
218
	u64 mask = *dev->dma_mask;
219
	int high = addr + size > mask;
L
Linus Torvalds 已提交
220
	int mmu = high;
221 222 223 224 225

	if (force_iommu)
		mmu = 1;

	return mmu;
L
Linus Torvalds 已提交
226 227
}

228 229 230
static inline int
nonforced_iommu(struct device *dev, unsigned long addr, size_t size)
{
L
Linus Torvalds 已提交
231
	u64 mask = *dev->dma_mask;
232
	int high = addr + size > mask;
L
Linus Torvalds 已提交
233
	int mmu = high;
234 235

	return mmu;
L
Linus Torvalds 已提交
236 237 238 239 240
}

/* Map a single continuous physical area into the IOMMU.
 * Caller needs to check if the iommu is needed and flush.
 */
241 242
static dma_addr_t dma_map_area(struct device *dev, dma_addr_t phys_mem,
				size_t size, int dir)
243
{
L
Linus Torvalds 已提交
244
	unsigned long npages = to_pages(phys_mem, size);
245
	unsigned long iommu_page = alloc_iommu(dev, npages);
L
Linus Torvalds 已提交
246
	int i;
247

L
Linus Torvalds 已提交
248 249
	if (iommu_page == -1) {
		if (!nonforced_iommu(dev, phys_mem, size))
250
			return phys_mem;
L
Linus Torvalds 已提交
251 252
		if (panic_on_overflow)
			panic("dma_map_area overflow %lu bytes\n", size);
253
		iommu_full(dev, size, dir);
L
Linus Torvalds 已提交
254 255 256 257 258 259 260 261 262 263 264
		return bad_dma_address;
	}

	for (i = 0; i < npages; i++) {
		iommu_gatt_base[iommu_page + i] = GPTE_ENCODE(phys_mem);
		SET_LEAK(iommu_page + i);
		phys_mem += PAGE_SIZE;
	}
	return iommu_bus_base + iommu_page*PAGE_SIZE + (phys_mem & ~PAGE_MASK);
}

265
static dma_addr_t
I
Ingo Molnar 已提交
266
gart_map_simple(struct device *dev, phys_addr_t paddr, size_t size, int dir)
267
{
I
Ingo Molnar 已提交
268
	dma_addr_t map = dma_map_area(dev, paddr, size, dir);
269

270
	flush_gart();
271

272 273 274
	return map;
}

L
Linus Torvalds 已提交
275
/* Map a single area into the IOMMU */
276
static dma_addr_t
I
Ingo Molnar 已提交
277
gart_map_single(struct device *dev, phys_addr_t paddr, size_t size, int dir)
L
Linus Torvalds 已提交
278
{
I
Ingo Molnar 已提交
279
	unsigned long bus;
L
Linus Torvalds 已提交
280 281 282 283

	if (!dev)
		dev = &fallback_dev;

I
Ingo Molnar 已提交
284 285
	if (!need_iommu(dev, paddr, size))
		return paddr;
L
Linus Torvalds 已提交
286

I
Ingo Molnar 已提交
287
	bus = gart_map_simple(dev, paddr, size, dir);
288 289

	return bus;
290 291
}

292 293 294
/*
 * Free a DMA mapping.
 */
295
static void gart_unmap_single(struct device *dev, dma_addr_t dma_addr,
296
			      size_t size, int direction)
297 298 299 300 301 302 303 304
{
	unsigned long iommu_page;
	int npages;
	int i;

	if (dma_addr < iommu_bus_base + EMERGENCY_PAGES*PAGE_SIZE ||
	    dma_addr >= iommu_bus_base + iommu_size)
		return;
305

306 307 308 309 310 311 312 313 314
	iommu_page = (dma_addr - iommu_bus_base)>>PAGE_SHIFT;
	npages = to_pages(dma_addr, size);
	for (i = 0; i < npages; i++) {
		iommu_gatt_base[iommu_page + i] = gart_unmapped_entry;
		CLEAR_LEAK(iommu_page + i);
	}
	free_iommu(iommu_page, npages);
}

315 316 317
/*
 * Wrapper for pci_unmap_single working with scatterlists.
 */
318 319
static void
gart_unmap_sg(struct device *dev, struct scatterlist *sg, int nents, int dir)
320
{
321
	struct scatterlist *s;
322 323
	int i;

324
	for_each_sg(sg, s, nents, i) {
325
		if (!s->dma_length || !s->length)
326
			break;
327
		gart_unmap_single(dev, s->dma_address, s->dma_length, dir);
328 329
	}
}
L
Linus Torvalds 已提交
330 331 332 333 334

/* Fallback for dma_map_sg in case of overflow */
static int dma_map_sg_nonforce(struct device *dev, struct scatterlist *sg,
			       int nents, int dir)
{
335
	struct scatterlist *s;
L
Linus Torvalds 已提交
336 337 338 339 340 341
	int i;

#ifdef CONFIG_IOMMU_DEBUG
	printk(KERN_DEBUG "dma_map_sg overflow\n");
#endif

342
	for_each_sg(sg, s, nents, i) {
J
Jens Axboe 已提交
343
		unsigned long addr = sg_phys(s);
344 345

		if (nonforced_iommu(dev, addr, s->length)) {
346
			addr = dma_map_area(dev, addr, s->length, dir);
347 348
			if (addr == bad_dma_address) {
				if (i > 0)
349
					gart_unmap_sg(dev, sg, i, dir);
350
				nents = 0;
L
Linus Torvalds 已提交
351 352 353 354 355 356 357
				sg[0].dma_length = 0;
				break;
			}
		}
		s->dma_address = addr;
		s->dma_length = s->length;
	}
358
	flush_gart();
359

L
Linus Torvalds 已提交
360 361 362 363
	return nents;
}

/* Map multiple scatterlist entries continuous into the first. */
364 365 366
static int __dma_map_cont(struct device *dev, struct scatterlist *start,
			  int nelems, struct scatterlist *sout,
			  unsigned long pages)
L
Linus Torvalds 已提交
367
{
368
	unsigned long iommu_start = alloc_iommu(dev, pages);
369
	unsigned long iommu_page = iommu_start;
370
	struct scatterlist *s;
L
Linus Torvalds 已提交
371 372 373 374
	int i;

	if (iommu_start == -1)
		return -1;
375 376

	for_each_sg(start, s, nelems, i) {
L
Linus Torvalds 已提交
377 378
		unsigned long pages, addr;
		unsigned long phys_addr = s->dma_address;
379

380 381
		BUG_ON(s != start && s->offset);
		if (s == start) {
L
Linus Torvalds 已提交
382 383 384
			sout->dma_address = iommu_bus_base;
			sout->dma_address += iommu_page*PAGE_SIZE + s->offset;
			sout->dma_length = s->length;
385 386
		} else {
			sout->dma_length += s->length;
L
Linus Torvalds 已提交
387 388 389
		}

		addr = phys_addr;
390 391 392
		pages = to_pages(s->offset, s->length);
		while (pages--) {
			iommu_gatt_base[iommu_page] = GPTE_ENCODE(addr);
L
Linus Torvalds 已提交
393 394 395
			SET_LEAK(iommu_page);
			addr += PAGE_SIZE;
			iommu_page++;
396
		}
397 398 399
	}
	BUG_ON(iommu_page - iommu_start != pages);

L
Linus Torvalds 已提交
400 401 402
	return 0;
}

403
static inline int
404 405
dma_map_cont(struct device *dev, struct scatterlist *start, int nelems,
	     struct scatterlist *sout, unsigned long pages, int need)
L
Linus Torvalds 已提交
406
{
407 408
	if (!need) {
		BUG_ON(nelems != 1);
F
FUJITA Tomonori 已提交
409
		sout->dma_address = start->dma_address;
410
		sout->dma_length = start->length;
L
Linus Torvalds 已提交
411
		return 0;
412
	}
413
	return __dma_map_cont(dev, start, nelems, sout, pages);
L
Linus Torvalds 已提交
414
}
415

L
Linus Torvalds 已提交
416 417
/*
 * DMA map all entries in a scatterlist.
418
 * Merge chunks that have page aligned sizes into a continuous mapping.
L
Linus Torvalds 已提交
419
 */
420 421
static int
gart_map_sg(struct device *dev, struct scatterlist *sg, int nents, int dir)
L
Linus Torvalds 已提交
422
{
423
	struct scatterlist *s, *ps, *start_sg, *sgmap;
424 425
	int need = 0, nextneed, i, out, start;
	unsigned long pages = 0;
426 427
	unsigned int seg_size;
	unsigned int max_seg_size;
L
Linus Torvalds 已提交
428

429
	if (nents == 0)
L
Linus Torvalds 已提交
430 431 432 433 434 435 436
		return 0;

	if (!dev)
		dev = &fallback_dev;

	out = 0;
	start = 0;
437
	start_sg = sgmap = sg;
438 439
	seg_size = 0;
	max_seg_size = dma_get_max_seg_size(dev);
440 441
	ps = NULL; /* shut up gcc */
	for_each_sg(sg, s, nents, i) {
J
Jens Axboe 已提交
442
		dma_addr_t addr = sg_phys(s);
443

L
Linus Torvalds 已提交
444
		s->dma_address = addr;
445
		BUG_ON(s->length == 0);
L
Linus Torvalds 已提交
446

447
		nextneed = need_iommu(dev, addr, s->length);
L
Linus Torvalds 已提交
448 449 450

		/* Handle the previous not yet processed entries */
		if (i > start) {
451 452 453 454 455
			/*
			 * Can only merge when the last chunk ends on a
			 * page boundary and the new one doesn't have an
			 * offset.
			 */
L
Linus Torvalds 已提交
456
			if (!iommu_merge || !nextneed || !need || s->offset ||
457
			    (s->length + seg_size > max_seg_size) ||
458
			    (ps->offset + ps->length) % PAGE_SIZE) {
459 460
				if (dma_map_cont(dev, start_sg, i - start,
						 sgmap, pages, need) < 0)
L
Linus Torvalds 已提交
461 462
					goto error;
				out++;
463
				seg_size = 0;
464
				sgmap = sg_next(sgmap);
L
Linus Torvalds 已提交
465
				pages = 0;
466 467
				start = i;
				start_sg = s;
L
Linus Torvalds 已提交
468 469 470
			}
		}

471
		seg_size += s->length;
L
Linus Torvalds 已提交
472 473
		need = nextneed;
		pages += to_pages(s->offset, s->length);
474
		ps = s;
L
Linus Torvalds 已提交
475
	}
476
	if (dma_map_cont(dev, start_sg, i - start, sgmap, pages, need) < 0)
L
Linus Torvalds 已提交
477 478
		goto error;
	out++;
479
	flush_gart();
480 481 482 483
	if (out < nents) {
		sgmap = sg_next(sgmap);
		sgmap->dma_length = 0;
	}
L
Linus Torvalds 已提交
484 485 486
	return out;

error:
487
	flush_gart();
488
	gart_unmap_sg(dev, sg, out, dir);
489

490 491 492 493 494 495
	/* When it was forced or merged try again in a dumb way */
	if (force_iommu || iommu_merge) {
		out = dma_map_sg_nonforce(dev, sg, nents, dir);
		if (out > 0)
			return out;
	}
L
Linus Torvalds 已提交
496 497
	if (panic_on_overflow)
		panic("dma_map_sg: overflow on %lu pages\n", pages);
498

499
	iommu_full(dev, pages << PAGE_SHIFT, dir);
500 501
	for_each_sg(sg, s, nents, i)
		s->dma_address = bad_dma_address;
L
Linus Torvalds 已提交
502
	return 0;
503
}
L
Linus Torvalds 已提交
504

505
static int no_agp;
L
Linus Torvalds 已提交
506 507

static __init unsigned long check_iommu_size(unsigned long aper, u64 aper_size)
508 509 510 511 512 513 514 515 516 517
{
	unsigned long a;

	if (!iommu_size) {
		iommu_size = aper_size;
		if (!no_agp)
			iommu_size /= 2;
	}

	a = aper + iommu_size;
518
	iommu_size -= round_up(a, PMD_PAGE_SIZE) - a;
L
Linus Torvalds 已提交
519

520
	if (iommu_size < 64*1024*1024) {
L
Linus Torvalds 已提交
521
		printk(KERN_WARNING
522 523 524 525 526
			"PCI-DMA: Warning: Small IOMMU %luMB."
			" Consider increasing the AGP aperture in BIOS\n",
				iommu_size >> 20);
	}

L
Linus Torvalds 已提交
527
	return iommu_size;
528
}
L
Linus Torvalds 已提交
529

530 531 532
static __init unsigned read_aperture(struct pci_dev *dev, u32 *size)
{
	unsigned aper_size = 0, aper_base_32, aper_order;
L
Linus Torvalds 已提交
533 534
	u64 aper_base;

P
Pavel Machek 已提交
535 536
	pci_read_config_dword(dev, AMD64_GARTAPERTUREBASE, &aper_base_32);
	pci_read_config_dword(dev, AMD64_GARTAPERTURECTL, &aper_order);
537
	aper_order = (aper_order >> 1) & 7;
L
Linus Torvalds 已提交
538

539
	aper_base = aper_base_32 & 0x7fff;
L
Linus Torvalds 已提交
540 541
	aper_base <<= 25;

542 543
	aper_size = (32 * 1024 * 1024) << aper_order;
	if (aper_base + aper_size > 0x100000000UL || !aper_size)
L
Linus Torvalds 已提交
544 545 546 547
		aper_base = 0;

	*size = aper_size;
	return aper_base;
548
}
L
Linus Torvalds 已提交
549

550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575
static void enable_gart_translations(void)
{
	int i;

	for (i = 0; i < num_k8_northbridges; i++) {
		struct pci_dev *dev = k8_northbridges[i];

		enable_gart_translation(dev, __pa(agp_gatt_table));
	}
}

/*
 * If fix_up_north_bridges is set, the north bridges have to be fixed up on
 * resume in the same way as they are handled in gart_iommu_hole_init().
 */
static bool fix_up_north_bridges;
static u32 aperture_order;
static u32 aperture_alloc;

void set_up_gart_resume(u32 aper_order, u32 aper_alloc)
{
	fix_up_north_bridges = true;
	aperture_order = aper_order;
	aperture_alloc = aper_alloc;
}

576 577
static int gart_resume(struct sys_device *dev)
{
578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600
	printk(KERN_INFO "PCI-DMA: Resuming GART IOMMU\n");

	if (fix_up_north_bridges) {
		int i;

		printk(KERN_INFO "PCI-DMA: Restoring GART aperture settings\n");

		for (i = 0; i < num_k8_northbridges; i++) {
			struct pci_dev *dev = k8_northbridges[i];

			/*
			 * Don't enable translations just yet.  That is the next
			 * step.  Restore the pre-suspend aperture settings.
			 */
			pci_write_config_dword(dev, AMD64_GARTAPERTURECTL,
						aperture_order << 1);
			pci_write_config_dword(dev, AMD64_GARTAPERTUREBASE,
						aperture_alloc >> 25);
		}
	}

	enable_gart_translations();

601 602 603 604 605
	return 0;
}

static int gart_suspend(struct sys_device *dev, pm_message_t state)
{
606
	return 0;
607 608 609 610 611 612 613 614 615 616 617 618 619 620
}

static struct sysdev_class gart_sysdev_class = {
	.name = "gart",
	.suspend = gart_suspend,
	.resume = gart_resume,

};

static struct sys_device device_gart = {
	.id	= 0,
	.cls	= &gart_sysdev_class,
};

621
/*
L
Linus Torvalds 已提交
622
 * Private Northbridge GATT initialization in case we cannot use the
623
 * AGP driver for some reason.
L
Linus Torvalds 已提交
624 625
 */
static __init int init_k8_gatt(struct agp_kern_info *info)
626 627 628
{
	unsigned aper_size, gatt_size, new_aper_size;
	unsigned aper_base, new_aper_base;
L
Linus Torvalds 已提交
629 630
	struct pci_dev *dev;
	void *gatt;
631
	int i, error;
Y
Yinghai Lu 已提交
632
	unsigned long start_pfn, end_pfn;
633

L
Linus Torvalds 已提交
634 635
	printk(KERN_INFO "PCI-DMA: Disabling AGP.\n");
	aper_size = aper_base = info->aper_size = 0;
636 637 638
	dev = NULL;
	for (i = 0; i < num_k8_northbridges; i++) {
		dev = k8_northbridges[i];
639 640 641 642 643
		new_aper_base = read_aperture(dev, &new_aper_size);
		if (!new_aper_base)
			goto nommu;

		if (!aper_base) {
L
Linus Torvalds 已提交
644 645
			aper_size = new_aper_size;
			aper_base = new_aper_base;
646 647
		}
		if (aper_size != new_aper_size || aper_base != new_aper_base)
L
Linus Torvalds 已提交
648 649 650
			goto nommu;
	}
	if (!aper_base)
651
		goto nommu;
L
Linus Torvalds 已提交
652
	info->aper_base = aper_base;
653
	info->aper_size = aper_size >> 20;
L
Linus Torvalds 已提交
654

655 656 657
	gatt_size = (aper_size >> PAGE_SHIFT) * sizeof(u32);
	gatt = (void *)__get_free_pages(GFP_KERNEL, get_order(gatt_size));
	if (!gatt)
658
		panic("Cannot allocate GATT table");
659
	if (set_memory_uc((unsigned long)gatt, gatt_size >> PAGE_SHIFT))
660 661
		panic("Could not set GART PTEs to uncacheable pages");

662
	memset(gatt, 0, gatt_size);
L
Linus Torvalds 已提交
663
	agp_gatt_table = gatt;
664

665
	enable_gart_translations();
666 667 668 669 670 671

	error = sysdev_class_register(&gart_sysdev_class);
	if (!error)
		error = sysdev_register(&device_gart);
	if (error)
		panic("Could not register gart_sysdev -- would corrupt data on next suspend");
672

673
	flush_gart();
674 675 676

	printk(KERN_INFO "PCI-DMA: aperture base @ %x size %u KB\n",
	       aper_base, aper_size>>10);
Y
Yinghai Lu 已提交
677 678 679 680

	/* need to map that range */
	end_pfn = (aper_base>>PAGE_SHIFT) + (aper_size>>PAGE_SHIFT);
	if (end_pfn > max_low_pfn_mapped) {
Y
Yinghai Lu 已提交
681 682
		start_pfn = (aper_base>>PAGE_SHIFT);
		init_memory_mapping(start_pfn<<PAGE_SHIFT, end_pfn<<PAGE_SHIFT);
Y
Yinghai Lu 已提交
683
	}
L
Linus Torvalds 已提交
684 685 686
	return 0;

 nommu:
687
	/* Should not happen anymore */
688 689
	printk(KERN_WARNING "PCI-DMA: More than 4GB of RAM and no IOMMU\n"
	       KERN_WARNING "falling back to iommu=soft.\n");
690 691
	return -1;
}
L
Linus Torvalds 已提交
692 693 694

extern int agp_amd64_init(void);

695
static const struct dma_mapping_ops gart_dma_ops = {
696 697 698 699 700 701 702 703 704 705 706 707
	.mapping_error			= NULL,
	.map_single			= gart_map_single,
	.map_simple			= gart_map_simple,
	.unmap_single			= gart_unmap_single,
	.sync_single_for_cpu		= NULL,
	.sync_single_for_device		= NULL,
	.sync_single_range_for_cpu	= NULL,
	.sync_single_range_for_device	= NULL,
	.sync_sg_for_cpu		= NULL,
	.sync_sg_for_device		= NULL,
	.map_sg				= gart_map_sg,
	.unmap_sg			= gart_unmap_sg,
708 709
};

710 711 712 713 714 715 716 717
void gart_iommu_shutdown(void)
{
	struct pci_dev *dev;
	int i;

	if (no_agp && (dma_ops != &gart_dma_ops))
		return;

718 719
	for (i = 0; i < num_k8_northbridges; i++) {
		u32 ctl;
720

721
		dev = k8_northbridges[i];
P
Pavel Machek 已提交
722
		pci_read_config_dword(dev, AMD64_GARTAPERTURECTL, &ctl);
723

P
Pavel Machek 已提交
724
		ctl &= ~GARTEN;
725

P
Pavel Machek 已提交
726
		pci_write_config_dword(dev, AMD64_GARTAPERTURECTL, ctl);
727
	}
728 729
}

730
void __init gart_iommu_init(void)
731
{
L
Linus Torvalds 已提交
732 733
	struct agp_kern_info info;
	unsigned long iommu_start;
734
	unsigned long aper_size;
L
Linus Torvalds 已提交
735 736 737
	unsigned long scratch;
	long i;

738 739
	if (cache_k8_northbridges() < 0 || num_k8_northbridges == 0) {
		printk(KERN_INFO "PCI-GART: No AMD northbridge found.\n");
740
		return;
741 742
	}

L
Linus Torvalds 已提交
743
#ifndef CONFIG_AGP_AMD64
744
	no_agp = 1;
L
Linus Torvalds 已提交
745 746 747
#else
	/* Makefile puts PCI initialization via subsys_initcall first. */
	/* Add other K8 AGP bridge drivers here */
748 749
	no_agp = no_agp ||
		(agp_amd64_init() < 0) ||
L
Linus Torvalds 已提交
750
		(agp_copy_info(agp_bridge, &info) < 0);
751
#endif
L
Linus Torvalds 已提交
752

753
	if (swiotlb)
754
		return;
755

756
	/* Did we detect a different HW IOMMU? */
757
	if (iommu_detected && !gart_iommu_aperture)
758
		return;
759

L
Linus Torvalds 已提交
760
	if (no_iommu ||
Y
Yinghai Lu 已提交
761
	    (!force_iommu && max_pfn <= MAX_DMA32_PFN) ||
762
	    !gart_iommu_aperture ||
L
Linus Torvalds 已提交
763
	    (no_agp && init_k8_gatt(&info) < 0)) {
Y
Yinghai Lu 已提交
764
		if (max_pfn > MAX_DMA32_PFN) {
765 766 767
			printk(KERN_WARNING "More than 4GB of memory "
			       	          "but GART IOMMU not available.\n"
			       KERN_WARNING "falling back to iommu=soft.\n");
J
Jon Mason 已提交
768
		}
769
		return;
L
Linus Torvalds 已提交
770 771
	}

J
Jon Mason 已提交
772
	printk(KERN_INFO "PCI-DMA: using GART IOMMU.\n");
773 774 775 776 777 778 779 780
	aper_size = info.aper_size * 1024 * 1024;
	iommu_size = check_iommu_size(info.aper_base, aper_size);
	iommu_pages = iommu_size >> PAGE_SHIFT;

	iommu_gart_bitmap = (void *) __get_free_pages(GFP_KERNEL,
						      get_order(iommu_pages/8));
	if (!iommu_gart_bitmap)
		panic("Cannot allocate iommu bitmap\n");
L
Linus Torvalds 已提交
781 782 783
	memset(iommu_gart_bitmap, 0, iommu_pages/8);

#ifdef CONFIG_IOMMU_LEAK
784 785
	if (leak_trace) {
		iommu_leak_tab = (void *)__get_free_pages(GFP_KERNEL,
L
Linus Torvalds 已提交
786
				  get_order(iommu_pages*sizeof(void *)));
787 788
		if (iommu_leak_tab)
			memset(iommu_leak_tab, 0, iommu_pages * 8);
L
Linus Torvalds 已提交
789
		else
790 791 792
			printk(KERN_DEBUG
			       "PCI-DMA: Cannot allocate leak trace area\n");
	}
L
Linus Torvalds 已提交
793 794
#endif

795
	/*
L
Linus Torvalds 已提交
796
	 * Out of IOMMU space handling.
797 798 799
	 * Reserve some invalid pages at the beginning of the GART.
	 */
	set_bit_string(iommu_gart_bitmap, 0, EMERGENCY_PAGES);
L
Linus Torvalds 已提交
800

801
	agp_memory_reserved = iommu_size;
L
Linus Torvalds 已提交
802 803
	printk(KERN_INFO
	       "PCI-DMA: Reserving %luMB of IOMMU area in the AGP aperture\n",
804
	       iommu_size >> 20);
L
Linus Torvalds 已提交
805

806 807
	iommu_start = aper_size - iommu_size;
	iommu_bus_base = info.aper_base + iommu_start;
L
Linus Torvalds 已提交
808 809 810
	bad_dma_address = iommu_bus_base;
	iommu_gatt_base = agp_gatt_table + (iommu_start>>PAGE_SHIFT);

811
	/*
L
Linus Torvalds 已提交
812 813 814 815 816 817
	 * Unmap the IOMMU part of the GART. The alias of the page is
	 * always mapped with cache enabled and there is no full cache
	 * coherency across the GART remapping. The unmapping avoids
	 * automatic prefetches from the CPU allocating cache lines in
	 * there. All CPU accesses are done via the direct mapping to
	 * the backing memory. The GART address is only used by PCI
818
	 * devices.
L
Linus Torvalds 已提交
819
	 */
820 821
	set_memory_np((unsigned long)__va(iommu_bus_base),
				iommu_size >> PAGE_SHIFT);
I
Ingo Molnar 已提交
822 823 824 825 826 827 828 829 830
	/*
	 * Tricky. The GART table remaps the physical memory range,
	 * so the CPU wont notice potential aliases and if the memory
	 * is remapped to UC later on, we might surprise the PCI devices
	 * with a stray writeout of a cacheline. So play it sure and
	 * do an explicit, full-scale wbinvd() _after_ having marked all
	 * the pages as Not-Present:
	 */
	wbinvd();
L
Linus Torvalds 已提交
831

832
	/*
833
	 * Try to workaround a bug (thanks to BenH):
834
	 * Set unmapped entries to a scratch page instead of 0.
L
Linus Torvalds 已提交
835
	 * Any prefetches that hit unmapped entries won't get an bus abort
836
	 * then. (P2P bridge may be prefetching on DMA reads).
L
Linus Torvalds 已提交
837
	 */
838 839
	scratch = get_zeroed_page(GFP_KERNEL);
	if (!scratch)
L
Linus Torvalds 已提交
840 841
		panic("Cannot allocate iommu scratch page");
	gart_unmapped_entry = GPTE_ENCODE(__pa(scratch));
842
	for (i = EMERGENCY_PAGES; i < iommu_pages; i++)
L
Linus Torvalds 已提交
843 844
		iommu_gatt_base[i] = gart_unmapped_entry;

845
	flush_gart();
846
	dma_ops = &gart_dma_ops;
847
}
L
Linus Torvalds 已提交
848

849
void __init gart_parse_options(char *p)
850 851 852
{
	int arg;

L
Linus Torvalds 已提交
853
#ifdef CONFIG_IOMMU_LEAK
854
	if (!strncmp(p, "leak", 4)) {
855 856 857 858 859 860
		leak_trace = 1;
		p += 4;
		if (*p == '=') ++p;
		if (isdigit(*p) && get_option(&p, &arg))
			iommu_leak_pages = arg;
	}
L
Linus Torvalds 已提交
861
#endif
862 863
	if (isdigit(*p) && get_option(&p, &arg))
		iommu_size = arg;
864
	if (!strncmp(p, "fullflush", 8))
865
		iommu_fullflush = 1;
866
	if (!strncmp(p, "nofullflush", 11))
867
		iommu_fullflush = 0;
868
	if (!strncmp(p, "noagp", 5))
869
		no_agp = 1;
870
	if (!strncmp(p, "noaperture", 10))
871 872
		fix_aperture = 0;
	/* duplicated from pci-dma.c */
873
	if (!strncmp(p, "force", 5))
874
		gart_iommu_aperture_allowed = 1;
875
	if (!strncmp(p, "allowed", 7))
876
		gart_iommu_aperture_allowed = 1;
877 878 879 880 881 882 883 884 885 886
	if (!strncmp(p, "memaper", 7)) {
		fallback_aper_force = 1;
		p += 7;
		if (*p == '=') {
			++p;
			if (get_option(&p, &arg))
				fallback_aper_order = arg;
		}
	}
}