pci-gart_64.c 22.0 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/PCI/PCI-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>
30
#include <linux/io.h>
L
Linus Torvalds 已提交
31 32 33 34
#include <asm/atomic.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).
 */
55
static int iommu_fullflush = 1;
L
Linus Torvalds 已提交
56

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 EMERGENCY_PAGES 32 /* = 128KB */
L
Linus Torvalds 已提交
71 72 73 74 75 76 77 78 79 80 81 82

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

85 86
static unsigned long alloc_iommu(struct device *dev, int size,
				 unsigned long align_mask)
87
{
L
Linus Torvalds 已提交
88
	unsigned long offset, flags;
89 90 91 92 93
	unsigned long boundary_size;
	unsigned long base_index;

	base_index = ALIGN(iommu_bus_base & dma_get_seg_boundary(dev),
			   PAGE_SIZE) >> PAGE_SHIFT;
94
	boundary_size = ALIGN((unsigned long long)dma_get_seg_boundary(dev) + 1,
95
			      PAGE_SIZE) >> PAGE_SHIFT;
L
Linus Torvalds 已提交
96

97
	spin_lock_irqsave(&iommu_bitmap_lock, flags);
98
	offset = iommu_area_alloc(iommu_gart_bitmap, iommu_pages, next_bit,
99
				  size, base_index, boundary_size, align_mask);
L
Linus Torvalds 已提交
100
	if (offset == -1) {
101
		need_flush = true;
102
		offset = iommu_area_alloc(iommu_gart_bitmap, iommu_pages, 0,
103 104
					  size, base_index, boundary_size,
					  align_mask);
L
Linus Torvalds 已提交
105
	}
106 107 108
	if (offset != -1) {
		next_bit = offset+size;
		if (next_bit >= iommu_pages) {
L
Linus Torvalds 已提交
109
			next_bit = 0;
110
			need_flush = true;
111 112
		}
	}
L
Linus Torvalds 已提交
113
	if (iommu_fullflush)
114
		need_flush = true;
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);
126 127
	if (offset >= next_bit)
		next_bit = offset + size;
L
Linus Torvalds 已提交
128
	spin_unlock_irqrestore(&iommu_bitmap_lock, flags);
129
}
L
Linus Torvalds 已提交
130

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

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

#ifdef CONFIG_IOMMU_LEAK
/* Debugging aid for drivers that don't free their IOMMU tables */
static int leak_trace;
149
static int iommu_leak_pages = 20;
150

151
static void dump_leak(void)
L
Linus Torvalds 已提交
152
{
153 154
	static int dump;

155
	if (dump)
156
		return;
L
Linus Torvalds 已提交
157
	dump = 1;
158

159 160
	show_stack(NULL, NULL);
	debug_dma_dump_mappings(NULL);
L
Linus Torvalds 已提交
161 162 163
}
#endif

164
static void iommu_full(struct device *dev, size_t size, int dir)
L
Linus Torvalds 已提交
165
{
166
	/*
L
Linus Torvalds 已提交
167 168
	 * Ran out of IOMMU space for this operation. This is very bad.
	 * Unfortunately the drivers cannot handle this operation properly.
169
	 * Return some non mapped prereserved space in the aperture and
L
Linus Torvalds 已提交
170 171
	 * let the Northbridge deal with it. This will result in garbage
	 * in the IO operation. When the size exceeds the prereserved space
172
	 * memory corruption will occur or random memory will be DMAed
L
Linus Torvalds 已提交
173
	 * out. Hopefully no network devices use single mappings that big.
174 175
	 */

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

178
	if (size > PAGE_SIZE*EMERGENCY_PAGES) {
L
Linus Torvalds 已提交
179 180
		if (dir == PCI_DMA_FROMDEVICE || dir == PCI_DMA_BIDIRECTIONAL)
			panic("PCI-DMA: Memory would be corrupted\n");
181 182 183 184
		if (dir == PCI_DMA_TODEVICE || dir == PCI_DMA_BIDIRECTIONAL)
			panic(KERN_ERR
				"PCI-DMA: Random memory would be DMAed\n");
	}
L
Linus Torvalds 已提交
185
#ifdef CONFIG_IOMMU_LEAK
186
	dump_leak();
L
Linus Torvalds 已提交
187
#endif
188
}
L
Linus Torvalds 已提交
189

190 191 192
static inline int
need_iommu(struct device *dev, unsigned long addr, size_t size)
{
193 194
	return force_iommu ||
		!is_buffer_dma_capable(*dev->dma_mask, addr, size);
L
Linus Torvalds 已提交
195 196
}

197 198 199
static inline int
nonforced_iommu(struct device *dev, unsigned long addr, size_t size)
{
200
	return !is_buffer_dma_capable(*dev->dma_mask, addr, size);
L
Linus Torvalds 已提交
201 202 203 204 205
}

/* Map a single continuous physical area into the IOMMU.
 * Caller needs to check if the iommu is needed and flush.
 */
206
static dma_addr_t dma_map_area(struct device *dev, dma_addr_t phys_mem,
207
				size_t size, int dir, unsigned long align_mask)
208
{
209
	unsigned long npages = iommu_num_pages(phys_mem, size, PAGE_SIZE);
210
	unsigned long iommu_page = alloc_iommu(dev, npages, align_mask);
L
Linus Torvalds 已提交
211
	int i;
212

L
Linus Torvalds 已提交
213 214
	if (iommu_page == -1) {
		if (!nonforced_iommu(dev, phys_mem, size))
215
			return phys_mem;
L
Linus Torvalds 已提交
216 217
		if (panic_on_overflow)
			panic("dma_map_area overflow %lu bytes\n", size);
218
		iommu_full(dev, size, dir);
L
Linus Torvalds 已提交
219 220 221 222 223 224 225 226 227 228 229
		return bad_dma_address;
	}

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

/* Map a single area into the IOMMU */
230 231 232 233
static dma_addr_t gart_map_page(struct device *dev, struct page *page,
				unsigned long offset, size_t size,
				enum dma_data_direction dir,
				struct dma_attrs *attrs)
L
Linus Torvalds 已提交
234
{
I
Ingo Molnar 已提交
235
	unsigned long bus;
236
	phys_addr_t paddr = page_to_phys(page) + offset;
L
Linus Torvalds 已提交
237 238

	if (!dev)
239
		dev = &x86_dma_fallback_dev;
L
Linus Torvalds 已提交
240

I
Ingo Molnar 已提交
241 242
	if (!need_iommu(dev, paddr, size))
		return paddr;
L
Linus Torvalds 已提交
243

244 245
	bus = dma_map_area(dev, paddr, size, dir, 0);
	flush_gart();
246 247

	return bus;
248 249
}

250 251 252
/*
 * Free a DMA mapping.
 */
253 254 255
static void gart_unmap_page(struct device *dev, dma_addr_t dma_addr,
			    size_t size, enum dma_data_direction dir,
			    struct dma_attrs *attrs)
256 257 258 259 260 261 262 263
{
	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;
264

265
	iommu_page = (dma_addr - iommu_bus_base)>>PAGE_SHIFT;
266
	npages = iommu_num_pages(dma_addr, size, PAGE_SIZE);
267 268 269 270 271 272
	for (i = 0; i < npages; i++) {
		iommu_gatt_base[iommu_page + i] = gart_unmapped_entry;
	}
	free_iommu(iommu_page, npages);
}

273 274 275
/*
 * Wrapper for pci_unmap_single working with scatterlists.
 */
276 277
static void gart_unmap_sg(struct device *dev, struct scatterlist *sg, int nents,
			  enum dma_data_direction dir, struct dma_attrs *attrs)
278
{
279
	struct scatterlist *s;
280 281
	int i;

282
	for_each_sg(sg, s, nents, i) {
283
		if (!s->dma_length || !s->length)
284
			break;
285
		gart_unmap_page(dev, s->dma_address, s->dma_length, dir, NULL);
286 287
	}
}
L
Linus Torvalds 已提交
288 289 290 291 292

/* 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)
{
293
	struct scatterlist *s;
L
Linus Torvalds 已提交
294 295 296 297 298 299
	int i;

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

300
	for_each_sg(sg, s, nents, i) {
J
Jens Axboe 已提交
301
		unsigned long addr = sg_phys(s);
302 303

		if (nonforced_iommu(dev, addr, s->length)) {
304
			addr = dma_map_area(dev, addr, s->length, dir, 0);
305 306
			if (addr == bad_dma_address) {
				if (i > 0)
307
					gart_unmap_sg(dev, sg, i, dir, NULL);
308
				nents = 0;
L
Linus Torvalds 已提交
309 310 311 312 313 314 315
				sg[0].dma_length = 0;
				break;
			}
		}
		s->dma_address = addr;
		s->dma_length = s->length;
	}
316
	flush_gart();
317

L
Linus Torvalds 已提交
318 319 320 321
	return nents;
}

/* Map multiple scatterlist entries continuous into the first. */
322 323 324
static int __dma_map_cont(struct device *dev, struct scatterlist *start,
			  int nelems, struct scatterlist *sout,
			  unsigned long pages)
L
Linus Torvalds 已提交
325
{
326
	unsigned long iommu_start = alloc_iommu(dev, pages, 0);
327
	unsigned long iommu_page = iommu_start;
328
	struct scatterlist *s;
L
Linus Torvalds 已提交
329 330 331 332
	int i;

	if (iommu_start == -1)
		return -1;
333 334

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

338 339
		BUG_ON(s != start && s->offset);
		if (s == start) {
L
Linus Torvalds 已提交
340 341 342
			sout->dma_address = iommu_bus_base;
			sout->dma_address += iommu_page*PAGE_SIZE + s->offset;
			sout->dma_length = s->length;
343 344
		} else {
			sout->dma_length += s->length;
L
Linus Torvalds 已提交
345 346 347
		}

		addr = phys_addr;
348
		pages = iommu_num_pages(s->offset, s->length, PAGE_SIZE);
349 350
		while (pages--) {
			iommu_gatt_base[iommu_page] = GPTE_ENCODE(addr);
L
Linus Torvalds 已提交
351 352
			addr += PAGE_SIZE;
			iommu_page++;
353
		}
354 355 356
	}
	BUG_ON(iommu_page - iommu_start != pages);

L
Linus Torvalds 已提交
357 358 359
	return 0;
}

360
static inline int
361 362
dma_map_cont(struct device *dev, struct scatterlist *start, int nelems,
	     struct scatterlist *sout, unsigned long pages, int need)
L
Linus Torvalds 已提交
363
{
364 365
	if (!need) {
		BUG_ON(nelems != 1);
F
FUJITA Tomonori 已提交
366
		sout->dma_address = start->dma_address;
367
		sout->dma_length = start->length;
L
Linus Torvalds 已提交
368
		return 0;
369
	}
370
	return __dma_map_cont(dev, start, nelems, sout, pages);
L
Linus Torvalds 已提交
371
}
372

L
Linus Torvalds 已提交
373 374
/*
 * DMA map all entries in a scatterlist.
375
 * Merge chunks that have page aligned sizes into a continuous mapping.
L
Linus Torvalds 已提交
376
 */
377 378
static int gart_map_sg(struct device *dev, struct scatterlist *sg, int nents,
		       enum dma_data_direction dir, struct dma_attrs *attrs)
L
Linus Torvalds 已提交
379
{
380
	struct scatterlist *s, *ps, *start_sg, *sgmap;
381 382
	int need = 0, nextneed, i, out, start;
	unsigned long pages = 0;
383 384
	unsigned int seg_size;
	unsigned int max_seg_size;
L
Linus Torvalds 已提交
385

386
	if (nents == 0)
L
Linus Torvalds 已提交
387 388 389
		return 0;

	if (!dev)
390
		dev = &x86_dma_fallback_dev;
L
Linus Torvalds 已提交
391 392 393

	out = 0;
	start = 0;
394
	start_sg = sgmap = sg;
395 396
	seg_size = 0;
	max_seg_size = dma_get_max_seg_size(dev);
397 398
	ps = NULL; /* shut up gcc */
	for_each_sg(sg, s, nents, i) {
J
Jens Axboe 已提交
399
		dma_addr_t addr = sg_phys(s);
400

L
Linus Torvalds 已提交
401
		s->dma_address = addr;
402
		BUG_ON(s->length == 0);
L
Linus Torvalds 已提交
403

404
		nextneed = need_iommu(dev, addr, s->length);
L
Linus Torvalds 已提交
405 406 407

		/* Handle the previous not yet processed entries */
		if (i > start) {
408 409 410 411 412
			/*
			 * Can only merge when the last chunk ends on a
			 * page boundary and the new one doesn't have an
			 * offset.
			 */
L
Linus Torvalds 已提交
413
			if (!iommu_merge || !nextneed || !need || s->offset ||
414
			    (s->length + seg_size > max_seg_size) ||
415
			    (ps->offset + ps->length) % PAGE_SIZE) {
416 417
				if (dma_map_cont(dev, start_sg, i - start,
						 sgmap, pages, need) < 0)
L
Linus Torvalds 已提交
418 419
					goto error;
				out++;
420
				seg_size = 0;
421
				sgmap = sg_next(sgmap);
L
Linus Torvalds 已提交
422
				pages = 0;
423 424
				start = i;
				start_sg = s;
L
Linus Torvalds 已提交
425 426 427
			}
		}

428
		seg_size += s->length;
L
Linus Torvalds 已提交
429
		need = nextneed;
430
		pages += iommu_num_pages(s->offset, s->length, PAGE_SIZE);
431
		ps = s;
L
Linus Torvalds 已提交
432
	}
433
	if (dma_map_cont(dev, start_sg, i - start, sgmap, pages, need) < 0)
L
Linus Torvalds 已提交
434 435
		goto error;
	out++;
436
	flush_gart();
437 438 439 440
	if (out < nents) {
		sgmap = sg_next(sgmap);
		sgmap->dma_length = 0;
	}
L
Linus Torvalds 已提交
441 442 443
	return out;

error:
444
	flush_gart();
445
	gart_unmap_sg(dev, sg, out, dir, NULL);
446

447 448 449 450 451 452
	/* 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 已提交
453 454
	if (panic_on_overflow)
		panic("dma_map_sg: overflow on %lu pages\n", pages);
455

456
	iommu_full(dev, pages << PAGE_SHIFT, dir);
457 458
	for_each_sg(sg, s, nents, i)
		s->dma_address = bad_dma_address;
L
Linus Torvalds 已提交
459
	return 0;
460
}
L
Linus Torvalds 已提交
461

462 463 464 465 466
/* allocate and map a coherent mapping */
static void *
gart_alloc_coherent(struct device *dev, size_t size, dma_addr_t *dma_addr,
		    gfp_t flag)
{
467
	dma_addr_t paddr;
468
	unsigned long align_mask;
469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488
	struct page *page;

	if (force_iommu && !(flag & GFP_DMA)) {
		flag &= ~(__GFP_DMA | __GFP_HIGHMEM | __GFP_DMA32);
		page = alloc_pages(flag | __GFP_ZERO, get_order(size));
		if (!page)
			return NULL;

		align_mask = (1UL << get_order(size)) - 1;
		paddr = dma_map_area(dev, page_to_phys(page), size,
				     DMA_BIDIRECTIONAL, align_mask);

		flush_gart();
		if (paddr != bad_dma_address) {
			*dma_addr = paddr;
			return page_address(page);
		}
		__free_pages(page, get_order(size));
	} else
		return dma_generic_alloc_coherent(dev, size, dma_addr, flag);
489 490 491 492

	return NULL;
}

493 494 495 496 497
/* free a coherent mapping */
static void
gart_free_coherent(struct device *dev, size_t size, void *vaddr,
		   dma_addr_t dma_addr)
{
498
	gart_unmap_page(dev, dma_addr, size, DMA_BIDIRECTIONAL, NULL);
499 500 501
	free_pages((unsigned long)vaddr, get_order(size));
}

502
static int no_agp;
L
Linus Torvalds 已提交
503 504

static __init unsigned long check_iommu_size(unsigned long aper, u64 aper_size)
505 506 507 508 509 510 511 512 513 514
{
	unsigned long a;

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

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

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

L
Linus Torvalds 已提交
524
	return iommu_size;
525
}
L
Linus Torvalds 已提交
526

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

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

536
	aper_base = aper_base_32 & 0x7fff;
L
Linus Torvalds 已提交
537 538
	aper_base <<= 25;

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

	*size = aper_size;
	return aper_base;
545
}
L
Linus Torvalds 已提交
546

547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572
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;
}

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

598 599 600 601 602
	return 0;
}

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

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

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

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

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

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

L
Linus Torvalds 已提交
659
	agp_gatt_table = gatt;
660

661
	enable_gart_translations();
662 663 664 665 666

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

670
	flush_gart();
671 672 673

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

L
Linus Torvalds 已提交
675 676 677
	return 0;

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

684
static struct dma_map_ops gart_dma_ops = {
685 686
	.map_sg				= gart_map_sg,
	.unmap_sg			= gart_unmap_sg,
687 688
	.map_page			= gart_map_page,
	.unmap_page			= gart_unmap_page,
689
	.alloc_coherent			= gart_alloc_coherent,
690
	.free_coherent			= gart_free_coherent,
691 692
};

693 694 695 696 697 698 699 700
void gart_iommu_shutdown(void)
{
	struct pci_dev *dev;
	int i;

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

701 702
	for (i = 0; i < num_k8_northbridges; i++) {
		u32 ctl;
703

704
		dev = k8_northbridges[i];
P
Pavel Machek 已提交
705
		pci_read_config_dword(dev, AMD64_GARTAPERTURECTL, &ctl);
706

P
Pavel Machek 已提交
707
		ctl &= ~GARTEN;
708

P
Pavel Machek 已提交
709
		pci_write_config_dword(dev, AMD64_GARTAPERTURECTL, ctl);
710
	}
711 712
}

713
void __init gart_iommu_init(void)
714
{
L
Linus Torvalds 已提交
715 716
	struct agp_kern_info info;
	unsigned long iommu_start;
717 718
	unsigned long aper_base, aper_size;
	unsigned long start_pfn, end_pfn;
L
Linus Torvalds 已提交
719 720 721
	unsigned long scratch;
	long i;

722
	if (cache_k8_northbridges() < 0 || num_k8_northbridges == 0)
723
		return;
724

L
Linus Torvalds 已提交
725
#ifndef CONFIG_AGP_AMD64
726
	no_agp = 1;
L
Linus Torvalds 已提交
727 728 729
#else
	/* Makefile puts PCI initialization via subsys_initcall first. */
	/* Add other K8 AGP bridge drivers here */
730 731
	no_agp = no_agp ||
		(agp_amd64_init() < 0) ||
L
Linus Torvalds 已提交
732
		(agp_copy_info(agp_bridge, &info) < 0);
733
#endif
L
Linus Torvalds 已提交
734

735
	if (swiotlb)
736
		return;
737

738
	/* Did we detect a different HW IOMMU? */
739
	if (iommu_detected && !gart_iommu_aperture)
740
		return;
741

L
Linus Torvalds 已提交
742
	if (no_iommu ||
Y
Yinghai Lu 已提交
743
	    (!force_iommu && max_pfn <= MAX_DMA32_PFN) ||
744
	    !gart_iommu_aperture ||
L
Linus Torvalds 已提交
745
	    (no_agp && init_k8_gatt(&info) < 0)) {
Y
Yinghai Lu 已提交
746
		if (max_pfn > MAX_DMA32_PFN) {
747
			printk(KERN_WARNING "More than 4GB of memory "
748 749
			       "but GART IOMMU not available.\n");
			printk(KERN_WARNING "falling back to iommu=soft.\n");
J
Jon Mason 已提交
750
		}
751
		return;
L
Linus Torvalds 已提交
752 753
	}

754 755 756 757 758 759 760 761 762
	/* need to map that range */
	aper_size = info.aper_size << 20;
	aper_base = info.aper_base;
	end_pfn = (aper_base>>PAGE_SHIFT) + (aper_size>>PAGE_SHIFT);
	if (end_pfn > max_low_pfn_mapped) {
		start_pfn = (aper_base>>PAGE_SHIFT);
		init_memory_mapping(start_pfn<<PAGE_SHIFT, end_pfn<<PAGE_SHIFT);
	}

J
Jon Mason 已提交
763
	printk(KERN_INFO "PCI-DMA: using GART IOMMU.\n");
764 765 766
	iommu_size = check_iommu_size(info.aper_base, aper_size);
	iommu_pages = iommu_size >> PAGE_SHIFT;

767
	iommu_gart_bitmap = (void *) __get_free_pages(GFP_KERNEL | __GFP_ZERO,
768 769 770
						      get_order(iommu_pages/8));
	if (!iommu_gart_bitmap)
		panic("Cannot allocate iommu bitmap\n");
L
Linus Torvalds 已提交
771 772

#ifdef CONFIG_IOMMU_LEAK
773
	if (leak_trace) {
774 775 776 777
		int ret;

		ret = dma_debug_resize_entries(iommu_pages);
		if (ret)
778
			printk(KERN_DEBUG
779
			       "PCI-DMA: Cannot trace all the entries\n");
780
	}
L
Linus Torvalds 已提交
781 782
#endif

783
	/*
L
Linus Torvalds 已提交
784
	 * Out of IOMMU space handling.
785 786
	 * Reserve some invalid pages at the beginning of the GART.
	 */
787
	iommu_area_reserve(iommu_gart_bitmap, 0, EMERGENCY_PAGES);
L
Linus Torvalds 已提交
788

789
	agp_memory_reserved = iommu_size;
L
Linus Torvalds 已提交
790 791
	printk(KERN_INFO
	       "PCI-DMA: Reserving %luMB of IOMMU area in the AGP aperture\n",
792
	       iommu_size >> 20);
L
Linus Torvalds 已提交
793

794 795
	iommu_start = aper_size - iommu_size;
	iommu_bus_base = info.aper_base + iommu_start;
L
Linus Torvalds 已提交
796 797 798
	bad_dma_address = iommu_bus_base;
	iommu_gatt_base = agp_gatt_table + (iommu_start>>PAGE_SHIFT);

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

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

833
	flush_gart();
834
	dma_ops = &gart_dma_ops;
835
}
L
Linus Torvalds 已提交
836

837
void __init gart_parse_options(char *p)
838 839 840
{
	int arg;

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