pci-gart_64.c 22.2 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
 */

#include <linux/types.h>
#include <linux/ctype.h>
#include <linux/agp_backend.h>
#include <linux/init.h>
#include <linux/mm.h>
19
#include <linux/sched.h>
L
Linus Torvalds 已提交
20 21 22 23 24 25 26
#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>
27
#include <linux/kdebug.h>
28
#include <linux/scatterlist.h>
29
#include <linux/iommu-helper.h>
30
#include <linux/sysdev.h>
31
#include <linux/io.h>
L
Linus Torvalds 已提交
32 33 34 35
#include <asm/atomic.h>
#include <asm/mtrr.h>
#include <asm/pgtable.h>
#include <asm/proto.h>
36
#include <asm/iommu.h>
J
Joerg Roedel 已提交
37
#include <asm/gart.h>
L
Linus Torvalds 已提交
38
#include <asm/cacheflush.h>
39 40
#include <asm/swiotlb.h>
#include <asm/dma.h>
41
#include <asm/k8.h>
42
#include <asm/x86_init.h>
L
Linus Torvalds 已提交
43

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

48
static u32 *iommu_gatt_base;		/* Remapping table */
L
Linus Torvalds 已提交
49

50 51
static dma_addr_t bad_dma_addr;

52 53 54 55 56 57 58
/*
 * 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).
 */
59
static int iommu_fullflush = 1;
L
Linus Torvalds 已提交
60

61
/* Allocation bitmap for the remapping area: */
L
Linus Torvalds 已提交
62
static DEFINE_SPINLOCK(iommu_bitmap_lock);
63 64
/* Guarded by iommu_bitmap_lock: */
static unsigned long *iommu_gart_bitmap;
L
Linus Torvalds 已提交
65

66
static u32 gart_unmapped_entry;
L
Linus Torvalds 已提交
67 68 69 70 71 72 73

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

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

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

89 90
static unsigned long alloc_iommu(struct device *dev, int size,
				 unsigned long align_mask)
91
{
L
Linus Torvalds 已提交
92
	unsigned long offset, flags;
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;
I
Ingo Molnar 已提交
98
	boundary_size = ALIGN((u64)dma_get_seg_boundary(dev) + 1,
99
			      PAGE_SIZE) >> PAGE_SHIFT;
L
Linus Torvalds 已提交
100

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

L
Linus Torvalds 已提交
121
	return offset;
122
}
L
Linus Torvalds 已提交
123 124

static void free_iommu(unsigned long offset, int size)
125
{
L
Linus Torvalds 已提交
126
	unsigned long flags;
127

L
Linus Torvalds 已提交
128
	spin_lock_irqsave(&iommu_bitmap_lock, flags);
129
	iommu_area_free(iommu_gart_bitmap, offset, size);
130 131
	if (offset >= next_bit)
		next_bit = offset + size;
L
Linus Torvalds 已提交
132
	spin_unlock_irqrestore(&iommu_bitmap_lock, flags);
133
}
L
Linus Torvalds 已提交
134

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

L
Linus Torvalds 已提交
142
	spin_lock_irqsave(&iommu_bitmap_lock, flags);
143 144
	if (need_flush) {
		k8_flush_garts();
145
		need_flush = false;
146
	}
L
Linus Torvalds 已提交
147
	spin_unlock_irqrestore(&iommu_bitmap_lock, flags);
148
}
L
Linus Torvalds 已提交
149 150 151 152

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

155
static void dump_leak(void)
L
Linus Torvalds 已提交
156
{
157 158
	static int dump;

159
	if (dump)
160
		return;
L
Linus Torvalds 已提交
161
	dump = 1;
162

163 164
	show_stack(NULL, NULL);
	debug_dma_dump_mappings(NULL);
L
Linus Torvalds 已提交
165 166 167
}
#endif

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

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

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

194 195 196
static inline int
need_iommu(struct device *dev, unsigned long addr, size_t size)
{
197
	return force_iommu || !dma_capable(dev, addr, size);
L
Linus Torvalds 已提交
198 199
}

200 201 202
static inline int
nonforced_iommu(struct device *dev, unsigned long addr, size_t size)
{
203
	return !dma_capable(dev, addr, size);
L
Linus Torvalds 已提交
204 205 206 207 208
}

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

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

	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 */
233 234 235 236
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 已提交
237
{
I
Ingo Molnar 已提交
238
	unsigned long bus;
239
	phys_addr_t paddr = page_to_phys(page) + offset;
L
Linus Torvalds 已提交
240 241

	if (!dev)
242
		dev = &x86_dma_fallback_dev;
L
Linus Torvalds 已提交
243

I
Ingo Molnar 已提交
244 245
	if (!need_iommu(dev, paddr, size))
		return paddr;
L
Linus Torvalds 已提交
246

247 248
	bus = dma_map_area(dev, paddr, size, dir, 0);
	flush_gart();
249 250

	return bus;
251 252
}

253 254 255
/*
 * Free a DMA mapping.
 */
256 257 258
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)
259 260 261 262 263 264 265 266
{
	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;
267

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

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

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

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

#ifdef CONFIG_IOMMU_DEBUG
I
Ingo Molnar 已提交
300
	pr_debug("dma_map_sg overflow\n");
L
Linus Torvalds 已提交
301 302
#endif

303
	for_each_sg(sg, s, nents, i) {
J
Jens Axboe 已提交
304
		unsigned long addr = sg_phys(s);
305 306

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

L
Linus Torvalds 已提交
321 322 323 324
	return nents;
}

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

	if (iommu_start == -1)
		return -1;
336 337

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

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

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

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

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

L
Linus Torvalds 已提交
376 377
/*
 * DMA map all entries in a scatterlist.
378
 * Merge chunks that have page aligned sizes into a continuous mapping.
L
Linus Torvalds 已提交
379
 */
380 381
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 已提交
382
{
383
	struct scatterlist *s, *ps, *start_sg, *sgmap;
384 385
	int need = 0, nextneed, i, out, start;
	unsigned long pages = 0;
386 387
	unsigned int seg_size;
	unsigned int max_seg_size;
L
Linus Torvalds 已提交
388

389
	if (nents == 0)
L
Linus Torvalds 已提交
390 391 392
		return 0;

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

I
Ingo Molnar 已提交
395 396 397 398 399 400 401 402
	out		= 0;
	start		= 0;
	start_sg	= sg;
	sgmap		= sg;
	seg_size	= 0;
	max_seg_size	= dma_get_max_seg_size(dev);
	ps		= NULL; /* shut up gcc */

403
	for_each_sg(sg, s, nents, i) {
J
Jens Axboe 已提交
404
		dma_addr_t addr = sg_phys(s);
405

L
Linus Torvalds 已提交
406
		s->dma_address = addr;
407
		BUG_ON(s->length == 0);
L
Linus Torvalds 已提交
408

409
		nextneed = need_iommu(dev, addr, s->length);
L
Linus Torvalds 已提交
410 411 412

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

				seg_size	= 0;
				sgmap		= sg_next(sgmap);
				pages		= 0;
				start		= i;
				start_sg	= s;
L
Linus Torvalds 已提交
431 432 433
			}
		}

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

error:
450
	flush_gart();
451
	gart_unmap_sg(dev, sg, out, dir, NULL);
452

453 454 455 456 457 458
	/* 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 已提交
459 460
	if (panic_on_overflow)
		panic("dma_map_sg: overflow on %lu pages\n", pages);
461

462
	iommu_full(dev, pages << PAGE_SHIFT, dir);
463
	for_each_sg(sg, s, nents, i)
464
		s->dma_address = bad_dma_addr;
L
Linus Torvalds 已提交
465
	return 0;
466
}
L
Linus Torvalds 已提交
467

468 469 470 471 472
/* 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)
{
473
	dma_addr_t paddr;
474
	unsigned long align_mask;
475 476 477 478 479 480 481 482 483 484 485 486 487
	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();
488
		if (paddr != bad_dma_addr) {
489 490 491 492 493 494
			*dma_addr = paddr;
			return page_address(page);
		}
		__free_pages(page, get_order(size));
	} else
		return dma_generic_alloc_coherent(dev, size, dma_addr, flag);
495 496 497 498

	return NULL;
}

499 500 501 502 503
/* free a coherent mapping */
static void
gart_free_coherent(struct device *dev, size_t size, void *vaddr,
		   dma_addr_t dma_addr)
{
504
	gart_unmap_page(dev, dma_addr, size, DMA_BIDIRECTIONAL, NULL);
505 506 507
	free_pages((unsigned long)vaddr, get_order(size));
}

508 509 510 511 512
static int gart_mapping_error(struct device *dev, dma_addr_t dma_addr)
{
	return (dma_addr == bad_dma_addr);
}

513
static int no_agp;
L
Linus Torvalds 已提交
514 515

static __init unsigned long check_iommu_size(unsigned long aper, u64 aper_size)
516 517 518 519 520 521 522 523 524 525
{
	unsigned long a;

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

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

528
	if (iommu_size < 64*1024*1024) {
I
Ingo Molnar 已提交
529
		pr_warning(
530 531 532 533 534
			"PCI-DMA: Warning: Small IOMMU %luMB."
			" Consider increasing the AGP aperture in BIOS\n",
				iommu_size >> 20);
	}

L
Linus Torvalds 已提交
535
	return iommu_size;
536
}
L
Linus Torvalds 已提交
537

538 539 540
static __init unsigned read_aperture(struct pci_dev *dev, u32 *size)
{
	unsigned aper_size = 0, aper_base_32, aper_order;
L
Linus Torvalds 已提交
541 542
	u64 aper_base;

P
Pavel Machek 已提交
543 544
	pci_read_config_dword(dev, AMD64_GARTAPERTUREBASE, &aper_base_32);
	pci_read_config_dword(dev, AMD64_GARTAPERTURECTL, &aper_order);
545
	aper_order = (aper_order >> 1) & 7;
L
Linus Torvalds 已提交
546

547
	aper_base = aper_base_32 & 0x7fff;
L
Linus Torvalds 已提交
548 549
	aper_base <<= 25;

550 551
	aper_size = (32 * 1024 * 1024) << aper_order;
	if (aper_base + aper_size > 0x100000000UL || !aper_size)
L
Linus Torvalds 已提交
552 553 554 555
		aper_base = 0;

	*size = aper_size;
	return aper_base;
556
}
L
Linus Torvalds 已提交
557

558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583
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;
}

I
Ingo Molnar 已提交
584
static void gart_fixup_northbridges(struct sys_device *dev)
585
{
I
Ingo Molnar 已提交
586
	int i;
587

I
Ingo Molnar 已提交
588 589
	if (!fix_up_north_bridges)
		return;
590

I
Ingo Molnar 已提交
591
	pr_info("PCI-DMA: Restoring GART aperture settings\n");
592

I
Ingo Molnar 已提交
593 594
	for (i = 0; i < num_k8_northbridges; i++) {
		struct pci_dev *dev = k8_northbridges[i];
595

I
Ingo Molnar 已提交
596 597 598 599 600 601
		/*
		 * 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);
602
	}
I
Ingo Molnar 已提交
603 604 605 606 607 608 609
}

static int gart_resume(struct sys_device *dev)
{
	pr_info("PCI-DMA: Resuming GART IOMMU\n");

	gart_fixup_northbridges(dev);
610 611 612

	enable_gart_translations();

613 614 615 616 617
	return 0;
}

static int gart_suspend(struct sys_device *dev, pm_message_t state)
{
618
	return 0;
619 620 621
}

static struct sysdev_class gart_sysdev_class = {
I
Ingo Molnar 已提交
622 623 624
	.name		= "gart",
	.suspend	= gart_suspend,
	.resume		= gart_resume,
625 626 627 628

};

static struct sys_device device_gart = {
I
Ingo Molnar 已提交
629
	.cls		= &gart_sysdev_class,
630 631
};

632
/*
L
Linus Torvalds 已提交
633
 * Private Northbridge GATT initialization in case we cannot use the
634
 * AGP driver for some reason.
L
Linus Torvalds 已提交
635 636
 */
static __init int init_k8_gatt(struct agp_kern_info *info)
637 638 639
{
	unsigned aper_size, gatt_size, new_aper_size;
	unsigned aper_base, new_aper_base;
L
Linus Torvalds 已提交
640 641
	struct pci_dev *dev;
	void *gatt;
642
	int i, error;
643

I
Ingo Molnar 已提交
644 645
	pr_info("PCI-DMA: Disabling AGP.\n");

L
Linus Torvalds 已提交
646
	aper_size = aper_base = info->aper_size = 0;
647 648 649
	dev = NULL;
	for (i = 0; i < num_k8_northbridges; i++) {
		dev = k8_northbridges[i];
650 651 652 653 654
		new_aper_base = read_aperture(dev, &new_aper_size);
		if (!new_aper_base)
			goto nommu;

		if (!aper_base) {
L
Linus Torvalds 已提交
655 656
			aper_size = new_aper_size;
			aper_base = new_aper_base;
657 658
		}
		if (aper_size != new_aper_size || aper_base != new_aper_base)
L
Linus Torvalds 已提交
659 660 661
			goto nommu;
	}
	if (!aper_base)
662
		goto nommu;
I
Ingo Molnar 已提交
663

L
Linus Torvalds 已提交
664
	info->aper_base = aper_base;
665
	info->aper_size = aper_size >> 20;
L
Linus Torvalds 已提交
666

667
	gatt_size = (aper_size >> PAGE_SHIFT) * sizeof(u32);
668 669
	gatt = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO,
					get_order(gatt_size));
670
	if (!gatt)
671
		panic("Cannot allocate GATT table");
672
	if (set_memory_uc((unsigned long)gatt, gatt_size >> PAGE_SHIFT))
673 674
		panic("Could not set GART PTEs to uncacheable pages");

L
Linus Torvalds 已提交
675
	agp_gatt_table = gatt;
676

677 678 679 680
	error = sysdev_class_register(&gart_sysdev_class);
	if (!error)
		error = sysdev_register(&device_gart);
	if (error)
681 682
		panic("Could not register gart_sysdev -- "
		      "would corrupt data on next suspend");
683

684
	flush_gart();
685

I
Ingo Molnar 已提交
686
	pr_info("PCI-DMA: aperture base @ %x size %u KB\n",
687
	       aper_base, aper_size>>10);
Y
Yinghai Lu 已提交
688

L
Linus Torvalds 已提交
689 690 691
	return 0;

 nommu:
692
	/* Should not happen anymore */
I
Ingo Molnar 已提交
693
	pr_warning("PCI-DMA: More than 4GB of RAM and no IOMMU\n"
694
	       "falling back to iommu=soft.\n");
695 696
	return -1;
}
L
Linus Torvalds 已提交
697

698
static struct dma_map_ops gart_dma_ops = {
699 700
	.map_sg				= gart_map_sg,
	.unmap_sg			= gart_unmap_sg,
701 702
	.map_page			= gart_map_page,
	.unmap_page			= gart_unmap_page,
703
	.alloc_coherent			= gart_alloc_coherent,
704
	.free_coherent			= gart_free_coherent,
705
	.mapping_error			= gart_mapping_error,
706 707
};

708
static void gart_iommu_shutdown(void)
709 710 711 712
{
	struct pci_dev *dev;
	int i;

713 714
	/* don't shutdown it if there is AGP installed */
	if (!no_agp)
715 716
		return;

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

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

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

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

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

738
	if (cache_k8_northbridges() < 0 || num_k8_northbridges == 0)
739
		return 0;
740

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

	if (no_iommu ||
Y
Yinghai Lu 已提交
752
	    (!force_iommu && max_pfn <= MAX_DMA32_PFN) ||
753
	    !gart_iommu_aperture ||
L
Linus Torvalds 已提交
754
	    (no_agp && init_k8_gatt(&info) < 0)) {
Y
Yinghai Lu 已提交
755
		if (max_pfn > MAX_DMA32_PFN) {
I
Ingo Molnar 已提交
756 757
			pr_warning("More than 4GB of memory but GART IOMMU not available.\n");
			pr_warning("falling back to iommu=soft.\n");
J
Jon Mason 已提交
758
		}
759
		return 0;
L
Linus Torvalds 已提交
760 761
	}

762
	/* need to map that range */
I
Ingo Molnar 已提交
763 764 765 766
	aper_size	= info.aper_size << 20;
	aper_base	= info.aper_base;
	end_pfn		= (aper_base>>PAGE_SHIFT) + (aper_size>>PAGE_SHIFT);

767 768 769 770 771
	if (end_pfn > max_low_pfn_mapped) {
		start_pfn = (aper_base>>PAGE_SHIFT);
		init_memory_mapping(start_pfn<<PAGE_SHIFT, end_pfn<<PAGE_SHIFT);
	}

I
Ingo Molnar 已提交
772
	pr_info("PCI-DMA: using GART IOMMU.\n");
773 774 775
	iommu_size = check_iommu_size(info.aper_base, aper_size);
	iommu_pages = iommu_size >> PAGE_SHIFT;

776
	iommu_gart_bitmap = (void *) __get_free_pages(GFP_KERNEL | __GFP_ZERO,
777 778 779
						      get_order(iommu_pages/8));
	if (!iommu_gart_bitmap)
		panic("Cannot allocate iommu bitmap\n");
L
Linus Torvalds 已提交
780 781

#ifdef CONFIG_IOMMU_LEAK
782
	if (leak_trace) {
783 784 785 786
		int ret;

		ret = dma_debug_resize_entries(iommu_pages);
		if (ret)
I
Ingo Molnar 已提交
787
			pr_debug("PCI-DMA: Cannot trace all the entries\n");
788
	}
L
Linus Torvalds 已提交
789 790
#endif

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

I
Ingo Molnar 已提交
797
	pr_info("PCI-DMA: Reserving %luMB of IOMMU area in the AGP aperture\n",
798
	       iommu_size >> 20);
L
Linus Torvalds 已提交
799

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

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

827 828 829 830 831 832 833
	/*
	 * Now all caches are flushed and we can safely enable
	 * GART hardware.  Doing it early leaves the possibility
	 * of stale cache entries that can lead to GART PTE
	 * errors.
	 */
	enable_gart_translations();
L
Linus Torvalds 已提交
834

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

848
	flush_gart();
849
	dma_ops = &gart_dma_ops;
850
	x86_platform.iommu_shutdown = gart_iommu_shutdown;
851
	swiotlb = 0;
852 853

	return 0;
854
}
L
Linus Torvalds 已提交
855

856
void __init gart_parse_options(char *p)
857 858 859
{
	int arg;

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