pci-gart_64.c 21.6 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>
J
Joerg Roedel 已提交
35
#include <asm/gart.h>
L
Linus Torvalds 已提交
36
#include <asm/cacheflush.h>
37 38
#include <asm/swiotlb.h>
#include <asm/dma.h>
39
#include <asm/k8.h>
L
Linus Torvalds 已提交
40

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

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

47 48 49 50 51 52 53
/*
 * 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 已提交
54 55
int iommu_fullflush = 1;

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

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

#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))

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

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

#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 */
85
static int need_flush;		/* global flush state. set for each gart wrap */
L
Linus Torvalds 已提交
86

87
static unsigned long alloc_iommu(struct device *dev, int size)
88
{
L
Linus Torvalds 已提交
89
	unsigned long offset, flags;
90 91 92 93 94 95 96
	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 已提交
97

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

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

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

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

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

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

#ifdef CONFIG_IOMMU_LEAK

146 147 148 149 150 151 152 153 154 155 156
#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 已提交
157 158

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

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

	if (dump || !iommu_leak_tab)
		return;
L
Linus Torvalds 已提交
170
	dump = 1;
171 172 173 174 175 176 177
	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);
178
		printk_address((unsigned long) iommu_leak_tab[iommu_pages-i], 0);
179 180 181
		printk(KERN_CONT "%c", (i+1)%2 == 0 ? '\n' : ' ');
	}
	printk(KERN_DEBUG "\n");
L
Linus Torvalds 已提交
182 183
}
#else
184 185
# define SET_LEAK(x)
# define CLEAR_LEAK(x)
L
Linus Torvalds 已提交
186 187
#endif

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

	printk(KERN_ERR
		"PCI-DMA: Out of IOMMU space for %lu bytes at device %s\n",
		size, dev->bus_id);
L
Linus Torvalds 已提交
203

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

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

	if (force_iommu)
		mmu = 1;

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

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

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

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

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

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

271
	flush_gart();
272

273 274 275
	return map;
}

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

	if (!dev)
		dev = &fallback_dev;

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

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

	return bus;
291 292
}

293 294 295
/*
 * Free a DMA mapping.
 */
296
static void gart_unmap_single(struct device *dev, dma_addr_t dma_addr,
297
			      size_t size, int direction)
298 299 300 301 302 303 304 305
{
	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;
306

307 308 309 310 311 312 313 314 315
	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);
}

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

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

/* 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)
{
336
	struct scatterlist *s;
L
Linus Torvalds 已提交
337 338 339 340 341 342
	int i;

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

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

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

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

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

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

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

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

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

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

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

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

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

	if (!dev)
		dev = &fallback_dev;

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

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

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

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

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

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

491 492 493 494 495 496
	/* 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 已提交
497 498
	if (panic_on_overflow)
		panic("dma_map_sg: overflow on %lu pages\n", pages);
499

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

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

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

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

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

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

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

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

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

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

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

	*size = aper_size;
	return aper_base;
549
}
L
Linus Torvalds 已提交
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 576
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;
}

577 578
static int gart_resume(struct sys_device *dev)
{
579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601
	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();

602 603 604 605 606
	return 0;
}

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

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,
};

622
/*
L
Linus Torvalds 已提交
623
 * Private Northbridge GATT initialization in case we cannot use the
624
 * AGP driver for some reason.
L
Linus Torvalds 已提交
625 626
 */
static __init int init_k8_gatt(struct agp_kern_info *info)
627 628 629
{
	unsigned aper_size, gatt_size, new_aper_size;
	unsigned aper_base, new_aper_base;
L
Linus Torvalds 已提交
630 631
	struct pci_dev *dev;
	void *gatt;
632
	int i, error;
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);
L
Linus Torvalds 已提交
677 678 679
	return 0;

 nommu:
680
	/* Should not happen anymore */
681 682
	printk(KERN_WARNING "PCI-DMA: More than 4GB of RAM and no IOMMU\n"
	       KERN_WARNING "falling back to iommu=soft.\n");
683 684
	return -1;
}
L
Linus Torvalds 已提交
685 686 687

extern int agp_amd64_init(void);

688
static const struct dma_mapping_ops gart_dma_ops = {
689 690 691 692 693 694 695 696 697 698 699 700
	.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,
701 702
};

703 704 705 706 707 708 709 710
void gart_iommu_shutdown(void)
{
	struct pci_dev *dev;
	int i;

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

711 712
	for (i = 0; i < num_k8_northbridges; i++) {
		u32 ctl;
713

714
		dev = k8_northbridges[i];
P
Pavel Machek 已提交
715
		pci_read_config_dword(dev, AMD64_GARTAPERTURECTL, &ctl);
716

P
Pavel Machek 已提交
717
		ctl &= ~GARTEN;
718

P
Pavel Machek 已提交
719
		pci_write_config_dword(dev, AMD64_GARTAPERTURECTL, ctl);
720
	}
721 722
}

723
void __init gart_iommu_init(void)
724
{
L
Linus Torvalds 已提交
725 726
	struct agp_kern_info info;
	unsigned long iommu_start;
727
	unsigned long aper_size;
L
Linus Torvalds 已提交
728 729 730
	unsigned long scratch;
	long i;

731 732
	if (cache_k8_northbridges() < 0 || num_k8_northbridges == 0) {
		printk(KERN_INFO "PCI-GART: No AMD northbridge found.\n");
733
		return;
734 735
	}

L
Linus Torvalds 已提交
736
#ifndef CONFIG_AGP_AMD64
737
	no_agp = 1;
L
Linus Torvalds 已提交
738 739 740
#else
	/* Makefile puts PCI initialization via subsys_initcall first. */
	/* Add other K8 AGP bridge drivers here */
741 742
	no_agp = no_agp ||
		(agp_amd64_init() < 0) ||
L
Linus Torvalds 已提交
743
		(agp_copy_info(agp_bridge, &info) < 0);
744
#endif
L
Linus Torvalds 已提交
745

746
	if (swiotlb)
747
		return;
748

749
	/* Did we detect a different HW IOMMU? */
750
	if (iommu_detected && !gart_iommu_aperture)
751
		return;
752

L
Linus Torvalds 已提交
753
	if (no_iommu ||
Y
Yinghai Lu 已提交
754
	    (!force_iommu && max_pfn <= MAX_DMA32_PFN) ||
755
	    !gart_iommu_aperture ||
L
Linus Torvalds 已提交
756
	    (no_agp && init_k8_gatt(&info) < 0)) {
Y
Yinghai Lu 已提交
757
		if (max_pfn > MAX_DMA32_PFN) {
758 759 760
			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 已提交
761
		}
762
		return;
L
Linus Torvalds 已提交
763 764
	}

J
Jon Mason 已提交
765
	printk(KERN_INFO "PCI-DMA: using GART IOMMU.\n");
766 767 768 769 770 771 772 773
	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 已提交
774 775 776
	memset(iommu_gart_bitmap, 0, iommu_pages/8);

#ifdef CONFIG_IOMMU_LEAK
777 778
	if (leak_trace) {
		iommu_leak_tab = (void *)__get_free_pages(GFP_KERNEL,
L
Linus Torvalds 已提交
779
				  get_order(iommu_pages*sizeof(void *)));
780 781
		if (iommu_leak_tab)
			memset(iommu_leak_tab, 0, iommu_pages * 8);
L
Linus Torvalds 已提交
782
		else
783 784 785
			printk(KERN_DEBUG
			       "PCI-DMA: Cannot allocate leak trace area\n");
	}
L
Linus Torvalds 已提交
786 787
#endif

788
	/*
L
Linus Torvalds 已提交
789
	 * Out of IOMMU space handling.
790 791 792
	 * Reserve some invalid pages at the beginning of the GART.
	 */
	set_bit_string(iommu_gart_bitmap, 0, EMERGENCY_PAGES);
L
Linus Torvalds 已提交
793

794
	agp_memory_reserved = iommu_size;
L
Linus Torvalds 已提交
795 796
	printk(KERN_INFO
	       "PCI-DMA: Reserving %luMB of IOMMU area in the AGP aperture\n",
797
	       iommu_size >> 20);
L
Linus Torvalds 已提交
798

799 800
	iommu_start = aper_size - iommu_size;
	iommu_bus_base = info.aper_base + iommu_start;
L
Linus Torvalds 已提交
801 802 803
	bad_dma_address = iommu_bus_base;
	iommu_gatt_base = agp_gatt_table + (iommu_start>>PAGE_SHIFT);

804
	/*
L
Linus Torvalds 已提交
805 806 807 808 809 810
	 * 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
811
	 * devices.
L
Linus Torvalds 已提交
812
	 */
813 814
	set_memory_np((unsigned long)__va(iommu_bus_base),
				iommu_size >> PAGE_SHIFT);
I
Ingo Molnar 已提交
815 816 817 818 819 820 821 822 823
	/*
	 * 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 已提交
824

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

838
	flush_gart();
839
	dma_ops = &gart_dma_ops;
840
}
L
Linus Torvalds 已提交
841

842
void __init gart_parse_options(char *p)
843 844 845
{
	int arg;

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