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 109
	if (offset != -1) {
		set_bit_string(iommu_gart_bitmap, offset, size);
		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 202 203
	 */

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

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

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

	if (force_iommu)
		mmu = 1;

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

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

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

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

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

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

272
	flush_gart();
273

274 275 276
	return map;
}

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

	if (!dev)
		dev = &fallback_dev;

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

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

	return bus;
292 293
}

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

	if (!dev)
		dev = &fallback_dev;

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

603 604 605 606 607
	return 0;
}

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

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

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

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

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

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

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

666
	enable_gart_translations();
667 668 669 670 671 672

	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");
673

674
	flush_gart();
675 676 677

	printk(KERN_INFO "PCI-DMA: aperture base @ %x size %u KB\n",
	       aper_base, aper_size>>10);
L
Linus Torvalds 已提交
678 679 680
	return 0;

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

extern int agp_amd64_init(void);

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

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

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

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

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

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

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

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

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

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

747
	if (swiotlb)
748
		return;
749

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

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

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

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

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

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

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

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

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

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

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

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