| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
|  | 2 | * Dynamic DMA mapping support for AMD Hammer. | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 3 | * | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4 | * Use the integrated AGP GART in the Hammer northbridge as an IOMMU for PCI. | 
|  | 5 | * This allows to use PCI devices that only support 32bit addresses on systems | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 6 | * with more than 4GB. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 7 | * | 
|  | 8 | * See Documentation/DMA-mapping.txt for the interface specification. | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 9 | * | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 10 | * Copyright 2002 Andi Kleen, SuSE Labs. | 
| Andi Kleen | ff7f364 | 2007-10-17 18:04:37 +0200 | [diff] [blame] | 11 | * Subject to the GNU General Public License v2 only. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 12 | */ | 
|  | 13 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 14 | #include <linux/types.h> | 
|  | 15 | #include <linux/ctype.h> | 
|  | 16 | #include <linux/agp_backend.h> | 
|  | 17 | #include <linux/init.h> | 
|  | 18 | #include <linux/mm.h> | 
|  | 19 | #include <linux/string.h> | 
|  | 20 | #include <linux/spinlock.h> | 
|  | 21 | #include <linux/pci.h> | 
|  | 22 | #include <linux/module.h> | 
|  | 23 | #include <linux/topology.h> | 
|  | 24 | #include <linux/interrupt.h> | 
|  | 25 | #include <linux/bitops.h> | 
| Christoph Hellwig | 1eeb66a | 2007-05-08 00:27:03 -0700 | [diff] [blame] | 26 | #include <linux/kdebug.h> | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 27 | #include <linux/scatterlist.h> | 
| FUJITA Tomonori | fde9a10 | 2008-02-04 22:28:11 -0800 | [diff] [blame] | 28 | #include <linux/iommu-helper.h> | 
| Pavel Machek | cd76374 | 2008-05-29 00:30:21 -0700 | [diff] [blame] | 29 | #include <linux/sysdev.h> | 
| Joerg Roedel | 237a622 | 2008-09-25 12:13:53 +0200 | [diff] [blame] | 30 | #include <linux/io.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 31 | #include <asm/atomic.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 32 | #include <asm/mtrr.h> | 
|  | 33 | #include <asm/pgtable.h> | 
|  | 34 | #include <asm/proto.h> | 
| FUJITA Tomonori | 46a7fa2 | 2008-07-11 10:23:42 +0900 | [diff] [blame] | 35 | #include <asm/iommu.h> | 
| Joerg Roedel | 395624f | 2007-10-24 12:49:47 +0200 | [diff] [blame] | 36 | #include <asm/gart.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 37 | #include <asm/cacheflush.h> | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 38 | #include <asm/swiotlb.h> | 
|  | 39 | #include <asm/dma.h> | 
| Andi Kleen | a32073b | 2006-06-26 13:56:40 +0200 | [diff] [blame] | 40 | #include <asm/k8.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 41 |  | 
| Joerg Roedel | 79da087 | 2007-10-24 12:49:49 +0200 | [diff] [blame] | 42 | static unsigned long iommu_bus_base;	/* GART remapping area (physical) */ | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 43 | static unsigned long iommu_size;	/* size of remapping area bytes */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 44 | static unsigned long iommu_pages;	/* .. and in pages */ | 
|  | 45 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 46 | static u32 *iommu_gatt_base;		/* Remapping table */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 47 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 48 | /* | 
|  | 49 | * If this is disabled the IOMMU will use an optimized flushing strategy | 
|  | 50 | * of only flushing when an mapping is reused. With it true the GART is | 
|  | 51 | * flushed for every mapping. Problem is that doing the lazy flush seems | 
|  | 52 | * to trigger bugs with some popular PCI cards, in particular 3ware (but | 
|  | 53 | * has been also also seen with Qlogic at least). | 
|  | 54 | */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 55 | int iommu_fullflush = 1; | 
|  | 56 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 57 | /* Allocation bitmap for the remapping area: */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 58 | static DEFINE_SPINLOCK(iommu_bitmap_lock); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 59 | /* Guarded by iommu_bitmap_lock: */ | 
|  | 60 | static unsigned long *iommu_gart_bitmap; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 61 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 62 | static u32 gart_unmapped_entry; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 63 |  | 
|  | 64 | #define GPTE_VALID    1 | 
|  | 65 | #define GPTE_COHERENT 2 | 
|  | 66 | #define GPTE_ENCODE(x) \ | 
|  | 67 | (((x) & 0xfffff000) | (((x) >> 32) << 4) | GPTE_VALID | GPTE_COHERENT) | 
|  | 68 | #define GPTE_DECODE(x) (((x) & 0xfffff000) | (((u64)(x) & 0xff0) << 28)) | 
|  | 69 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 70 | #define EMERGENCY_PAGES 32 /* = 128KB */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 71 |  | 
|  | 72 | #ifdef CONFIG_AGP | 
|  | 73 | #define AGPEXTERN extern | 
|  | 74 | #else | 
|  | 75 | #define AGPEXTERN | 
|  | 76 | #endif | 
|  | 77 |  | 
|  | 78 | /* backdoor interface to AGP driver */ | 
|  | 79 | AGPEXTERN int agp_memory_reserved; | 
|  | 80 | AGPEXTERN __u32 *agp_gatt_table; | 
|  | 81 |  | 
|  | 82 | static unsigned long next_bit;  /* protected by iommu_bitmap_lock */ | 
| Joerg Roedel | 3610f21 | 2008-09-25 12:13:54 +0200 | [diff] [blame] | 83 | static bool need_flush;		/* global flush state. set for each gart wrap */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 84 |  | 
| FUJITA Tomonori | 7b22ff5 | 2008-08-18 00:36:18 +0900 | [diff] [blame] | 85 | static unsigned long alloc_iommu(struct device *dev, int size, | 
|  | 86 | unsigned long align_mask) | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 87 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 88 | unsigned long offset, flags; | 
| FUJITA Tomonori | fde9a10 | 2008-02-04 22:28:11 -0800 | [diff] [blame] | 89 | unsigned long boundary_size; | 
|  | 90 | unsigned long base_index; | 
|  | 91 |  | 
|  | 92 | base_index = ALIGN(iommu_bus_base & dma_get_seg_boundary(dev), | 
|  | 93 | PAGE_SIZE) >> PAGE_SHIFT; | 
| Prarit Bhargava | 05d3ed0 | 2008-07-21 10:15:22 -0400 | [diff] [blame] | 94 | boundary_size = ALIGN((unsigned long long)dma_get_seg_boundary(dev) + 1, | 
| FUJITA Tomonori | fde9a10 | 2008-02-04 22:28:11 -0800 | [diff] [blame] | 95 | PAGE_SIZE) >> PAGE_SHIFT; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 96 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 97 | spin_lock_irqsave(&iommu_bitmap_lock, flags); | 
| FUJITA Tomonori | fde9a10 | 2008-02-04 22:28:11 -0800 | [diff] [blame] | 98 | offset = iommu_area_alloc(iommu_gart_bitmap, iommu_pages, next_bit, | 
| FUJITA Tomonori | 7b22ff5 | 2008-08-18 00:36:18 +0900 | [diff] [blame] | 99 | size, base_index, boundary_size, align_mask); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 100 | if (offset == -1) { | 
| Joerg Roedel | 3610f21 | 2008-09-25 12:13:54 +0200 | [diff] [blame] | 101 | need_flush = true; | 
| FUJITA Tomonori | fde9a10 | 2008-02-04 22:28:11 -0800 | [diff] [blame] | 102 | offset = iommu_area_alloc(iommu_gart_bitmap, iommu_pages, 0, | 
| FUJITA Tomonori | 7b22ff5 | 2008-08-18 00:36:18 +0900 | [diff] [blame] | 103 | size, base_index, boundary_size, | 
|  | 104 | align_mask); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 105 | } | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 106 | if (offset != -1) { | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 107 | next_bit = offset+size; | 
|  | 108 | if (next_bit >= iommu_pages) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 109 | next_bit = 0; | 
| Joerg Roedel | 3610f21 | 2008-09-25 12:13:54 +0200 | [diff] [blame] | 110 | need_flush = true; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 111 | } | 
|  | 112 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 113 | if (iommu_fullflush) | 
| Joerg Roedel | 3610f21 | 2008-09-25 12:13:54 +0200 | [diff] [blame] | 114 | need_flush = true; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 115 | spin_unlock_irqrestore(&iommu_bitmap_lock, flags); | 
|  | 116 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 117 | return offset; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 118 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 119 |  | 
|  | 120 | static void free_iommu(unsigned long offset, int size) | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 121 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 122 | unsigned long flags; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 123 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 124 | spin_lock_irqsave(&iommu_bitmap_lock, flags); | 
| FUJITA Tomonori | fde9a10 | 2008-02-04 22:28:11 -0800 | [diff] [blame] | 125 | iommu_area_free(iommu_gart_bitmap, offset, size); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 126 | spin_unlock_irqrestore(&iommu_bitmap_lock, flags); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 127 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 128 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 129 | /* | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 130 | * Use global flush state to avoid races with multiple flushers. | 
|  | 131 | */ | 
| Andi Kleen | a32073b | 2006-06-26 13:56:40 +0200 | [diff] [blame] | 132 | static void flush_gart(void) | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 133 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 134 | unsigned long flags; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 135 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 136 | spin_lock_irqsave(&iommu_bitmap_lock, flags); | 
| Andi Kleen | a32073b | 2006-06-26 13:56:40 +0200 | [diff] [blame] | 137 | if (need_flush) { | 
|  | 138 | k8_flush_garts(); | 
| Joerg Roedel | 3610f21 | 2008-09-25 12:13:54 +0200 | [diff] [blame] | 139 | need_flush = false; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 140 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 141 | spin_unlock_irqrestore(&iommu_bitmap_lock, flags); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 142 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 143 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 144 | #ifdef CONFIG_IOMMU_LEAK | 
|  | 145 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 146 | #define SET_LEAK(x)							\ | 
|  | 147 | do {								\ | 
|  | 148 | if (iommu_leak_tab)					\ | 
|  | 149 | iommu_leak_tab[x] = __builtin_return_address(0);\ | 
|  | 150 | } while (0) | 
|  | 151 |  | 
|  | 152 | #define CLEAR_LEAK(x)							\ | 
|  | 153 | do {								\ | 
|  | 154 | if (iommu_leak_tab)					\ | 
|  | 155 | iommu_leak_tab[x] = NULL;			\ | 
|  | 156 | } while (0) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 157 |  | 
|  | 158 | /* Debugging aid for drivers that don't free their IOMMU tables */ | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 159 | static void **iommu_leak_tab; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 160 | static int leak_trace; | 
| Joerg Roedel | 79da087 | 2007-10-24 12:49:49 +0200 | [diff] [blame] | 161 | static int iommu_leak_pages = 20; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 162 |  | 
| Joerg Roedel | 79da087 | 2007-10-24 12:49:49 +0200 | [diff] [blame] | 163 | static void dump_leak(void) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 164 | { | 
|  | 165 | int i; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 166 | static int dump; | 
|  | 167 |  | 
|  | 168 | if (dump || !iommu_leak_tab) | 
|  | 169 | return; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 170 | dump = 1; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 171 | show_stack(NULL, NULL); | 
|  | 172 |  | 
|  | 173 | /* Very crude. dump some from the end of the table too */ | 
|  | 174 | printk(KERN_DEBUG "Dumping %d pages from end of IOMMU:\n", | 
|  | 175 | iommu_leak_pages); | 
|  | 176 | for (i = 0; i < iommu_leak_pages; i += 2) { | 
|  | 177 | printk(KERN_DEBUG "%lu: ", iommu_pages-i); | 
| Joerg Roedel | 237a622 | 2008-09-25 12:13:53 +0200 | [diff] [blame] | 178 | printk_address((unsigned long) iommu_leak_tab[iommu_pages-i], | 
|  | 179 | 0); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 180 | printk(KERN_CONT "%c", (i+1)%2 == 0 ? '\n' : ' '); | 
|  | 181 | } | 
|  | 182 | printk(KERN_DEBUG "\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 183 | } | 
|  | 184 | #else | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 185 | # define SET_LEAK(x) | 
|  | 186 | # define CLEAR_LEAK(x) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 187 | #endif | 
|  | 188 |  | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 189 | static void iommu_full(struct device *dev, size_t size, int dir) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 190 | { | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 191 | /* | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 192 | * Ran out of IOMMU space for this operation. This is very bad. | 
|  | 193 | * Unfortunately the drivers cannot handle this operation properly. | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 194 | * Return some non mapped prereserved space in the aperture and | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 195 | * let the Northbridge deal with it. This will result in garbage | 
|  | 196 | * in the IO operation. When the size exceeds the prereserved space | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 197 | * memory corruption will occur or random memory will be DMAed | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 198 | * out. Hopefully no network devices use single mappings that big. | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 199 | */ | 
|  | 200 |  | 
| Greg Kroah-Hartman | fc3a882 | 2008-05-02 06:02:41 +0200 | [diff] [blame] | 201 | dev_err(dev, "PCI-DMA: Out of IOMMU space for %lu bytes\n", size); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 202 |  | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 203 | if (size > PAGE_SIZE*EMERGENCY_PAGES) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 204 | if (dir == PCI_DMA_FROMDEVICE || dir == PCI_DMA_BIDIRECTIONAL) | 
|  | 205 | panic("PCI-DMA: Memory would be corrupted\n"); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 206 | if (dir == PCI_DMA_TODEVICE || dir == PCI_DMA_BIDIRECTIONAL) | 
|  | 207 | panic(KERN_ERR | 
|  | 208 | "PCI-DMA: Random memory would be DMAed\n"); | 
|  | 209 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 210 | #ifdef CONFIG_IOMMU_LEAK | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 211 | dump_leak(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 212 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 213 | } | 
|  | 214 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 215 | static inline int | 
|  | 216 | need_iommu(struct device *dev, unsigned long addr, size_t size) | 
|  | 217 | { | 
| FUJITA Tomonori | ac4ff65 | 2008-09-10 01:06:47 +0900 | [diff] [blame] | 218 | return force_iommu || | 
|  | 219 | !is_buffer_dma_capable(*dev->dma_mask, addr, size); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 220 | } | 
|  | 221 |  | 
|  | 222 | static inline int | 
|  | 223 | nonforced_iommu(struct device *dev, unsigned long addr, size_t size) | 
|  | 224 | { | 
| FUJITA Tomonori | ac4ff65 | 2008-09-10 01:06:47 +0900 | [diff] [blame] | 225 | return !is_buffer_dma_capable(*dev->dma_mask, addr, size); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 226 | } | 
|  | 227 |  | 
|  | 228 | /* Map a single continuous physical area into the IOMMU. | 
|  | 229 | * Caller needs to check if the iommu is needed and flush. | 
|  | 230 | */ | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 231 | static dma_addr_t dma_map_area(struct device *dev, dma_addr_t phys_mem, | 
| FUJITA Tomonori | 7b22ff5 | 2008-08-18 00:36:18 +0900 | [diff] [blame] | 232 | size_t size, int dir, unsigned long align_mask) | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 233 | { | 
| Joerg Roedel | 1477b8e | 2008-10-15 22:02:11 -0700 | [diff] [blame] | 234 | unsigned long npages = iommu_num_pages(phys_mem, size, PAGE_SIZE); | 
| FUJITA Tomonori | 7b22ff5 | 2008-08-18 00:36:18 +0900 | [diff] [blame] | 235 | unsigned long iommu_page = alloc_iommu(dev, npages, align_mask); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 236 | int i; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 237 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 238 | if (iommu_page == -1) { | 
|  | 239 | if (!nonforced_iommu(dev, phys_mem, size)) | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 240 | return phys_mem; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 241 | if (panic_on_overflow) | 
|  | 242 | panic("dma_map_area overflow %lu bytes\n", size); | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 243 | iommu_full(dev, size, dir); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 244 | return bad_dma_address; | 
|  | 245 | } | 
|  | 246 |  | 
|  | 247 | for (i = 0; i < npages; i++) { | 
|  | 248 | iommu_gatt_base[iommu_page + i] = GPTE_ENCODE(phys_mem); | 
|  | 249 | SET_LEAK(iommu_page + i); | 
|  | 250 | phys_mem += PAGE_SIZE; | 
|  | 251 | } | 
|  | 252 | return iommu_bus_base + iommu_page*PAGE_SIZE + (phys_mem & ~PAGE_MASK); | 
|  | 253 | } | 
|  | 254 |  | 
|  | 255 | /* Map a single area into the IOMMU */ | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 256 | static dma_addr_t | 
| Ingo Molnar | 2be6214 | 2008-04-19 19:19:56 +0200 | [diff] [blame] | 257 | gart_map_single(struct device *dev, phys_addr_t paddr, size_t size, int dir) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 258 | { | 
| Ingo Molnar | 2be6214 | 2008-04-19 19:19:56 +0200 | [diff] [blame] | 259 | unsigned long bus; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 260 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 261 | if (!dev) | 
| Joerg Roedel | 6c505ce | 2008-08-19 16:32:45 +0200 | [diff] [blame] | 262 | dev = &x86_dma_fallback_dev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 263 |  | 
| Ingo Molnar | 2be6214 | 2008-04-19 19:19:56 +0200 | [diff] [blame] | 264 | if (!need_iommu(dev, paddr, size)) | 
|  | 265 | return paddr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 266 |  | 
| FUJITA Tomonori | 7b22ff5 | 2008-08-18 00:36:18 +0900 | [diff] [blame] | 267 | bus = dma_map_area(dev, paddr, size, dir, 0); | 
|  | 268 | flush_gart(); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 269 |  | 
|  | 270 | return bus; | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 271 | } | 
|  | 272 |  | 
|  | 273 | /* | 
| Jon Mason | 7c2d9cd | 2006-06-26 13:56:37 +0200 | [diff] [blame] | 274 | * Free a DMA mapping. | 
|  | 275 | */ | 
| Yinghai Lu | 1048fa5 | 2007-07-21 17:11:23 +0200 | [diff] [blame] | 276 | static void gart_unmap_single(struct device *dev, dma_addr_t dma_addr, | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 277 | size_t size, int direction) | 
| Jon Mason | 7c2d9cd | 2006-06-26 13:56:37 +0200 | [diff] [blame] | 278 | { | 
|  | 279 | unsigned long iommu_page; | 
|  | 280 | int npages; | 
|  | 281 | int i; | 
|  | 282 |  | 
|  | 283 | if (dma_addr < iommu_bus_base + EMERGENCY_PAGES*PAGE_SIZE || | 
|  | 284 | dma_addr >= iommu_bus_base + iommu_size) | 
|  | 285 | return; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 286 |  | 
| Jon Mason | 7c2d9cd | 2006-06-26 13:56:37 +0200 | [diff] [blame] | 287 | iommu_page = (dma_addr - iommu_bus_base)>>PAGE_SHIFT; | 
| Joerg Roedel | 1477b8e | 2008-10-15 22:02:11 -0700 | [diff] [blame] | 288 | npages = iommu_num_pages(dma_addr, size, PAGE_SIZE); | 
| Jon Mason | 7c2d9cd | 2006-06-26 13:56:37 +0200 | [diff] [blame] | 289 | for (i = 0; i < npages; i++) { | 
|  | 290 | iommu_gatt_base[iommu_page + i] = gart_unmapped_entry; | 
|  | 291 | CLEAR_LEAK(iommu_page + i); | 
|  | 292 | } | 
|  | 293 | free_iommu(iommu_page, npages); | 
|  | 294 | } | 
|  | 295 |  | 
|  | 296 | /* | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 297 | * Wrapper for pci_unmap_single working with scatterlists. | 
|  | 298 | */ | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 299 | static void | 
|  | 300 | gart_unmap_sg(struct device *dev, struct scatterlist *sg, int nents, int dir) | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 301 | { | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 302 | struct scatterlist *s; | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 303 | int i; | 
|  | 304 |  | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 305 | for_each_sg(sg, s, nents, i) { | 
| Jon Mason | 60b08c6 | 2006-02-26 04:18:22 +0100 | [diff] [blame] | 306 | if (!s->dma_length || !s->length) | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 307 | break; | 
| Jon Mason | 7c2d9cd | 2006-06-26 13:56:37 +0200 | [diff] [blame] | 308 | gart_unmap_single(dev, s->dma_address, s->dma_length, dir); | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 309 | } | 
|  | 310 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 311 |  | 
|  | 312 | /* Fallback for dma_map_sg in case of overflow */ | 
|  | 313 | static int dma_map_sg_nonforce(struct device *dev, struct scatterlist *sg, | 
|  | 314 | int nents, int dir) | 
|  | 315 | { | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 316 | struct scatterlist *s; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 317 | int i; | 
|  | 318 |  | 
|  | 319 | #ifdef CONFIG_IOMMU_DEBUG | 
|  | 320 | printk(KERN_DEBUG "dma_map_sg overflow\n"); | 
|  | 321 | #endif | 
|  | 322 |  | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 323 | for_each_sg(sg, s, nents, i) { | 
| Jens Axboe | 58b053e | 2007-10-22 20:02:46 +0200 | [diff] [blame] | 324 | unsigned long addr = sg_phys(s); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 325 |  | 
|  | 326 | if (nonforced_iommu(dev, addr, s->length)) { | 
| FUJITA Tomonori | 7b22ff5 | 2008-08-18 00:36:18 +0900 | [diff] [blame] | 327 | addr = dma_map_area(dev, addr, s->length, dir, 0); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 328 | if (addr == bad_dma_address) { | 
|  | 329 | if (i > 0) | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 330 | gart_unmap_sg(dev, sg, i, dir); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 331 | nents = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 332 | sg[0].dma_length = 0; | 
|  | 333 | break; | 
|  | 334 | } | 
|  | 335 | } | 
|  | 336 | s->dma_address = addr; | 
|  | 337 | s->dma_length = s->length; | 
|  | 338 | } | 
| Andi Kleen | a32073b | 2006-06-26 13:56:40 +0200 | [diff] [blame] | 339 | flush_gart(); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 340 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 341 | return nents; | 
|  | 342 | } | 
|  | 343 |  | 
|  | 344 | /* Map multiple scatterlist entries continuous into the first. */ | 
| FUJITA Tomonori | fde9a10 | 2008-02-04 22:28:11 -0800 | [diff] [blame] | 345 | static int __dma_map_cont(struct device *dev, struct scatterlist *start, | 
|  | 346 | int nelems, struct scatterlist *sout, | 
|  | 347 | unsigned long pages) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 348 | { | 
| FUJITA Tomonori | 7b22ff5 | 2008-08-18 00:36:18 +0900 | [diff] [blame] | 349 | unsigned long iommu_start = alloc_iommu(dev, pages, 0); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 350 | unsigned long iommu_page = iommu_start; | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 351 | struct scatterlist *s; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 352 | int i; | 
|  | 353 |  | 
|  | 354 | if (iommu_start == -1) | 
|  | 355 | return -1; | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 356 |  | 
|  | 357 | for_each_sg(start, s, nelems, i) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 358 | unsigned long pages, addr; | 
|  | 359 | unsigned long phys_addr = s->dma_address; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 360 |  | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 361 | BUG_ON(s != start && s->offset); | 
|  | 362 | if (s == start) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 363 | sout->dma_address = iommu_bus_base; | 
|  | 364 | sout->dma_address += iommu_page*PAGE_SIZE + s->offset; | 
|  | 365 | sout->dma_length = s->length; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 366 | } else { | 
|  | 367 | sout->dma_length += s->length; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 368 | } | 
|  | 369 |  | 
|  | 370 | addr = phys_addr; | 
| Joerg Roedel | 1477b8e | 2008-10-15 22:02:11 -0700 | [diff] [blame] | 371 | pages = iommu_num_pages(s->offset, s->length, PAGE_SIZE); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 372 | while (pages--) { | 
|  | 373 | iommu_gatt_base[iommu_page] = GPTE_ENCODE(addr); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 374 | SET_LEAK(iommu_page); | 
|  | 375 | addr += PAGE_SIZE; | 
|  | 376 | iommu_page++; | 
| Andi Kleen | 0d541064 | 2006-02-12 14:34:59 -0800 | [diff] [blame] | 377 | } | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 378 | } | 
|  | 379 | BUG_ON(iommu_page - iommu_start != pages); | 
|  | 380 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 381 | return 0; | 
|  | 382 | } | 
|  | 383 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 384 | static inline int | 
| FUJITA Tomonori | fde9a10 | 2008-02-04 22:28:11 -0800 | [diff] [blame] | 385 | dma_map_cont(struct device *dev, struct scatterlist *start, int nelems, | 
|  | 386 | struct scatterlist *sout, unsigned long pages, int need) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 387 | { | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 388 | if (!need) { | 
|  | 389 | BUG_ON(nelems != 1); | 
| FUJITA Tomonori | e88a39d | 2007-10-25 09:13:32 +0200 | [diff] [blame] | 390 | sout->dma_address = start->dma_address; | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 391 | sout->dma_length = start->length; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 392 | return 0; | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 393 | } | 
| FUJITA Tomonori | fde9a10 | 2008-02-04 22:28:11 -0800 | [diff] [blame] | 394 | return __dma_map_cont(dev, start, nelems, sout, pages); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 395 | } | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 396 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 397 | /* | 
|  | 398 | * DMA map all entries in a scatterlist. | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 399 | * Merge chunks that have page aligned sizes into a continuous mapping. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 400 | */ | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 401 | static int | 
|  | 402 | gart_map_sg(struct device *dev, struct scatterlist *sg, int nents, int dir) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 403 | { | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 404 | struct scatterlist *s, *ps, *start_sg, *sgmap; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 405 | int need = 0, nextneed, i, out, start; | 
|  | 406 | unsigned long pages = 0; | 
| FUJITA Tomonori | 42d0028 | 2008-02-04 22:27:56 -0800 | [diff] [blame] | 407 | unsigned int seg_size; | 
|  | 408 | unsigned int max_seg_size; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 409 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 410 | if (nents == 0) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 411 | return 0; | 
|  | 412 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 413 | if (!dev) | 
| Joerg Roedel | 6c505ce | 2008-08-19 16:32:45 +0200 | [diff] [blame] | 414 | dev = &x86_dma_fallback_dev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 415 |  | 
|  | 416 | out = 0; | 
|  | 417 | start = 0; | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 418 | start_sg = sgmap = sg; | 
| FUJITA Tomonori | 42d0028 | 2008-02-04 22:27:56 -0800 | [diff] [blame] | 419 | seg_size = 0; | 
|  | 420 | max_seg_size = dma_get_max_seg_size(dev); | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 421 | ps = NULL; /* shut up gcc */ | 
|  | 422 | for_each_sg(sg, s, nents, i) { | 
| Jens Axboe | 58b053e | 2007-10-22 20:02:46 +0200 | [diff] [blame] | 423 | dma_addr_t addr = sg_phys(s); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 424 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 425 | s->dma_address = addr; | 
|  | 426 | BUG_ON(s->length == 0); | 
|  | 427 |  | 
|  | 428 | nextneed = need_iommu(dev, addr, s->length); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 429 |  | 
|  | 430 | /* Handle the previous not yet processed entries */ | 
|  | 431 | if (i > start) { | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 432 | /* | 
|  | 433 | * Can only merge when the last chunk ends on a | 
|  | 434 | * page boundary and the new one doesn't have an | 
|  | 435 | * offset. | 
|  | 436 | */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 437 | if (!iommu_merge || !nextneed || !need || s->offset || | 
| FUJITA Tomonori | 42d0028 | 2008-02-04 22:27:56 -0800 | [diff] [blame] | 438 | (s->length + seg_size > max_seg_size) || | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 439 | (ps->offset + ps->length) % PAGE_SIZE) { | 
| FUJITA Tomonori | fde9a10 | 2008-02-04 22:28:11 -0800 | [diff] [blame] | 440 | if (dma_map_cont(dev, start_sg, i - start, | 
|  | 441 | sgmap, pages, need) < 0) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 442 | goto error; | 
|  | 443 | out++; | 
| FUJITA Tomonori | 42d0028 | 2008-02-04 22:27:56 -0800 | [diff] [blame] | 444 | seg_size = 0; | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 445 | sgmap = sg_next(sgmap); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 446 | pages = 0; | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 447 | start = i; | 
|  | 448 | start_sg = s; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 449 | } | 
|  | 450 | } | 
|  | 451 |  | 
| FUJITA Tomonori | 42d0028 | 2008-02-04 22:27:56 -0800 | [diff] [blame] | 452 | seg_size += s->length; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 453 | need = nextneed; | 
| Joerg Roedel | 1477b8e | 2008-10-15 22:02:11 -0700 | [diff] [blame] | 454 | pages += iommu_num_pages(s->offset, s->length, PAGE_SIZE); | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 455 | ps = s; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 456 | } | 
| FUJITA Tomonori | fde9a10 | 2008-02-04 22:28:11 -0800 | [diff] [blame] | 457 | if (dma_map_cont(dev, start_sg, i - start, sgmap, pages, need) < 0) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 458 | goto error; | 
|  | 459 | out++; | 
| Andi Kleen | a32073b | 2006-06-26 13:56:40 +0200 | [diff] [blame] | 460 | flush_gart(); | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 461 | if (out < nents) { | 
|  | 462 | sgmap = sg_next(sgmap); | 
|  | 463 | sgmap->dma_length = 0; | 
|  | 464 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 465 | return out; | 
|  | 466 |  | 
|  | 467 | error: | 
| Andi Kleen | a32073b | 2006-06-26 13:56:40 +0200 | [diff] [blame] | 468 | flush_gart(); | 
| FUJITA Tomonori | 5336940 | 2007-10-26 13:56:24 +0200 | [diff] [blame] | 469 | gart_unmap_sg(dev, sg, out, dir); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 470 |  | 
| Kevin VanMaren | a1002a4 | 2006-02-03 21:51:32 +0100 | [diff] [blame] | 471 | /* When it was forced or merged try again in a dumb way */ | 
|  | 472 | if (force_iommu || iommu_merge) { | 
|  | 473 | out = dma_map_sg_nonforce(dev, sg, nents, dir); | 
|  | 474 | if (out > 0) | 
|  | 475 | return out; | 
|  | 476 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 477 | if (panic_on_overflow) | 
|  | 478 | panic("dma_map_sg: overflow on %lu pages\n", pages); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 479 |  | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 480 | iommu_full(dev, pages << PAGE_SHIFT, dir); | 
| Jens Axboe | 9ee1bea | 2007-10-04 09:35:37 +0200 | [diff] [blame] | 481 | for_each_sg(sg, s, nents, i) | 
|  | 482 | s->dma_address = bad_dma_address; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 483 | return 0; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 484 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 485 |  | 
| Joerg Roedel | 9458109 | 2008-08-19 16:32:39 +0200 | [diff] [blame] | 486 | /* allocate and map a coherent mapping */ | 
|  | 487 | static void * | 
|  | 488 | gart_alloc_coherent(struct device *dev, size_t size, dma_addr_t *dma_addr, | 
|  | 489 | gfp_t flag) | 
|  | 490 | { | 
| FUJITA Tomonori | f6a32a3 | 2008-09-11 23:08:48 +0900 | [diff] [blame] | 491 | dma_addr_t paddr; | 
| FUJITA Tomonori | 421076e | 2008-08-22 16:29:10 +0900 | [diff] [blame] | 492 | unsigned long align_mask; | 
| FUJITA Tomonori | 1d99088 | 2008-09-24 20:48:37 +0900 | [diff] [blame] | 493 | struct page *page; | 
| Joerg Roedel | 9458109 | 2008-08-19 16:32:39 +0200 | [diff] [blame] | 494 |  | 
| FUJITA Tomonori | 1d99088 | 2008-09-24 20:48:37 +0900 | [diff] [blame] | 495 | if (force_iommu && !(flag & GFP_DMA)) { | 
|  | 496 | flag &= ~(__GFP_DMA | __GFP_HIGHMEM | __GFP_DMA32); | 
|  | 497 | page = alloc_pages(flag | __GFP_ZERO, get_order(size)); | 
|  | 498 | if (!page) | 
|  | 499 | return NULL; | 
| Joerg Roedel | 9458109 | 2008-08-19 16:32:39 +0200 | [diff] [blame] | 500 |  | 
| FUJITA Tomonori | 1d99088 | 2008-09-24 20:48:37 +0900 | [diff] [blame] | 501 | align_mask = (1UL << get_order(size)) - 1; | 
|  | 502 | paddr = dma_map_area(dev, page_to_phys(page), size, | 
|  | 503 | DMA_BIDIRECTIONAL, align_mask); | 
| FUJITA Tomonori | f6a32a3 | 2008-09-11 23:08:48 +0900 | [diff] [blame] | 504 |  | 
| FUJITA Tomonori | 1d99088 | 2008-09-24 20:48:37 +0900 | [diff] [blame] | 505 | flush_gart(); | 
|  | 506 | if (paddr != bad_dma_address) { | 
|  | 507 | *dma_addr = paddr; | 
|  | 508 | return page_address(page); | 
|  | 509 | } | 
|  | 510 | __free_pages(page, get_order(size)); | 
|  | 511 | } else | 
|  | 512 | return dma_generic_alloc_coherent(dev, size, dma_addr, flag); | 
| Joerg Roedel | 9458109 | 2008-08-19 16:32:39 +0200 | [diff] [blame] | 513 |  | 
|  | 514 | return NULL; | 
|  | 515 | } | 
|  | 516 |  | 
| Joerg Roedel | 43a5a5a | 2008-08-19 16:32:40 +0200 | [diff] [blame] | 517 | /* free a coherent mapping */ | 
|  | 518 | static void | 
|  | 519 | gart_free_coherent(struct device *dev, size_t size, void *vaddr, | 
|  | 520 | dma_addr_t dma_addr) | 
|  | 521 | { | 
|  | 522 | gart_unmap_single(dev, dma_addr, size, DMA_BIDIRECTIONAL); | 
|  | 523 | free_pages((unsigned long)vaddr, get_order(size)); | 
|  | 524 | } | 
|  | 525 |  | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 526 | static int no_agp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 527 |  | 
|  | 528 | static __init unsigned long check_iommu_size(unsigned long aper, u64 aper_size) | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 529 | { | 
|  | 530 | unsigned long a; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 531 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 532 | if (!iommu_size) { | 
|  | 533 | iommu_size = aper_size; | 
|  | 534 | if (!no_agp) | 
|  | 535 | iommu_size /= 2; | 
|  | 536 | } | 
|  | 537 |  | 
|  | 538 | a = aper + iommu_size; | 
| Andi Kleen | 31422c5 | 2008-02-04 16:48:08 +0100 | [diff] [blame] | 539 | iommu_size -= round_up(a, PMD_PAGE_SIZE) - a; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 540 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 541 | if (iommu_size < 64*1024*1024) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 542 | printk(KERN_WARNING | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 543 | "PCI-DMA: Warning: Small IOMMU %luMB." | 
|  | 544 | " Consider increasing the AGP aperture in BIOS\n", | 
|  | 545 | iommu_size >> 20); | 
|  | 546 | } | 
|  | 547 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 548 | return iommu_size; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 549 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 550 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 551 | static __init unsigned read_aperture(struct pci_dev *dev, u32 *size) | 
|  | 552 | { | 
|  | 553 | unsigned aper_size = 0, aper_base_32, aper_order; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 554 | u64 aper_base; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 555 |  | 
| Pavel Machek | 3bb6fbf | 2008-04-15 12:43:57 +0200 | [diff] [blame] | 556 | pci_read_config_dword(dev, AMD64_GARTAPERTUREBASE, &aper_base_32); | 
|  | 557 | pci_read_config_dword(dev, AMD64_GARTAPERTURECTL, &aper_order); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 558 | aper_order = (aper_order >> 1) & 7; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 559 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 560 | aper_base = aper_base_32 & 0x7fff; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 561 | aper_base <<= 25; | 
|  | 562 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 563 | aper_size = (32 * 1024 * 1024) << aper_order; | 
|  | 564 | if (aper_base + aper_size > 0x100000000UL || !aper_size) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 565 | aper_base = 0; | 
|  | 566 |  | 
|  | 567 | *size = aper_size; | 
|  | 568 | return aper_base; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 569 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 570 |  | 
| Rafael J. Wysocki | 6703f6d | 2008-06-10 00:10:48 +0200 | [diff] [blame] | 571 | static void enable_gart_translations(void) | 
|  | 572 | { | 
|  | 573 | int i; | 
|  | 574 |  | 
|  | 575 | for (i = 0; i < num_k8_northbridges; i++) { | 
|  | 576 | struct pci_dev *dev = k8_northbridges[i]; | 
|  | 577 |  | 
|  | 578 | enable_gart_translation(dev, __pa(agp_gatt_table)); | 
|  | 579 | } | 
|  | 580 | } | 
|  | 581 |  | 
|  | 582 | /* | 
|  | 583 | * If fix_up_north_bridges is set, the north bridges have to be fixed up on | 
|  | 584 | * resume in the same way as they are handled in gart_iommu_hole_init(). | 
|  | 585 | */ | 
|  | 586 | static bool fix_up_north_bridges; | 
|  | 587 | static u32 aperture_order; | 
|  | 588 | static u32 aperture_alloc; | 
|  | 589 |  | 
|  | 590 | void set_up_gart_resume(u32 aper_order, u32 aper_alloc) | 
|  | 591 | { | 
|  | 592 | fix_up_north_bridges = true; | 
|  | 593 | aperture_order = aper_order; | 
|  | 594 | aperture_alloc = aper_alloc; | 
|  | 595 | } | 
|  | 596 |  | 
| Pavel Machek | cd76374 | 2008-05-29 00:30:21 -0700 | [diff] [blame] | 597 | static int gart_resume(struct sys_device *dev) | 
|  | 598 | { | 
| Rafael J. Wysocki | 6703f6d | 2008-06-10 00:10:48 +0200 | [diff] [blame] | 599 | printk(KERN_INFO "PCI-DMA: Resuming GART IOMMU\n"); | 
|  | 600 |  | 
|  | 601 | if (fix_up_north_bridges) { | 
|  | 602 | int i; | 
|  | 603 |  | 
|  | 604 | printk(KERN_INFO "PCI-DMA: Restoring GART aperture settings\n"); | 
|  | 605 |  | 
|  | 606 | for (i = 0; i < num_k8_northbridges; i++) { | 
|  | 607 | struct pci_dev *dev = k8_northbridges[i]; | 
|  | 608 |  | 
|  | 609 | /* | 
|  | 610 | * Don't enable translations just yet.  That is the next | 
|  | 611 | * step.  Restore the pre-suspend aperture settings. | 
|  | 612 | */ | 
|  | 613 | pci_write_config_dword(dev, AMD64_GARTAPERTURECTL, | 
|  | 614 | aperture_order << 1); | 
|  | 615 | pci_write_config_dword(dev, AMD64_GARTAPERTUREBASE, | 
|  | 616 | aperture_alloc >> 25); | 
|  | 617 | } | 
|  | 618 | } | 
|  | 619 |  | 
|  | 620 | enable_gart_translations(); | 
|  | 621 |  | 
| Pavel Machek | cd76374 | 2008-05-29 00:30:21 -0700 | [diff] [blame] | 622 | return 0; | 
|  | 623 | } | 
|  | 624 |  | 
|  | 625 | static int gart_suspend(struct sys_device *dev, pm_message_t state) | 
|  | 626 | { | 
| Rafael J. Wysocki | 6703f6d | 2008-06-10 00:10:48 +0200 | [diff] [blame] | 627 | return 0; | 
| Pavel Machek | cd76374 | 2008-05-29 00:30:21 -0700 | [diff] [blame] | 628 | } | 
|  | 629 |  | 
|  | 630 | static struct sysdev_class gart_sysdev_class = { | 
|  | 631 | .name = "gart", | 
|  | 632 | .suspend = gart_suspend, | 
|  | 633 | .resume = gart_resume, | 
|  | 634 |  | 
|  | 635 | }; | 
|  | 636 |  | 
|  | 637 | static struct sys_device device_gart = { | 
|  | 638 | .id	= 0, | 
|  | 639 | .cls	= &gart_sysdev_class, | 
|  | 640 | }; | 
|  | 641 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 642 | /* | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 643 | * Private Northbridge GATT initialization in case we cannot use the | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 644 | * AGP driver for some reason. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 645 | */ | 
|  | 646 | static __init int init_k8_gatt(struct agp_kern_info *info) | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 647 | { | 
|  | 648 | unsigned aper_size, gatt_size, new_aper_size; | 
|  | 649 | unsigned aper_base, new_aper_base; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 650 | struct pci_dev *dev; | 
|  | 651 | void *gatt; | 
| Pavel Machek | cd76374 | 2008-05-29 00:30:21 -0700 | [diff] [blame] | 652 | int i, error; | 
| Andi Kleen | a32073b | 2006-06-26 13:56:40 +0200 | [diff] [blame] | 653 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 654 | printk(KERN_INFO "PCI-DMA: Disabling AGP.\n"); | 
|  | 655 | aper_size = aper_base = info->aper_size = 0; | 
| Andi Kleen | a32073b | 2006-06-26 13:56:40 +0200 | [diff] [blame] | 656 | dev = NULL; | 
|  | 657 | for (i = 0; i < num_k8_northbridges; i++) { | 
|  | 658 | dev = k8_northbridges[i]; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 659 | new_aper_base = read_aperture(dev, &new_aper_size); | 
|  | 660 | if (!new_aper_base) | 
|  | 661 | goto nommu; | 
|  | 662 |  | 
|  | 663 | if (!aper_base) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 664 | aper_size = new_aper_size; | 
|  | 665 | aper_base = new_aper_base; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 666 | } | 
|  | 667 | if (aper_size != new_aper_size || aper_base != new_aper_base) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 668 | goto nommu; | 
|  | 669 | } | 
|  | 670 | if (!aper_base) | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 671 | goto nommu; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 672 | info->aper_base = aper_base; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 673 | info->aper_size = aper_size >> 20; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 674 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 675 | gatt_size = (aper_size >> PAGE_SHIFT) * sizeof(u32); | 
| Joerg Roedel | 0114267 | 2008-09-25 12:42:12 +0200 | [diff] [blame] | 676 | gatt = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, | 
|  | 677 | get_order(gatt_size)); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 678 | if (!gatt) | 
| Joachim Deguara | cf6387d | 2007-04-24 13:05:36 +0200 | [diff] [blame] | 679 | panic("Cannot allocate GATT table"); | 
| Arjan van de Ven | 6d238cc | 2008-01-30 13:34:06 +0100 | [diff] [blame] | 680 | if (set_memory_uc((unsigned long)gatt, gatt_size >> PAGE_SHIFT)) | 
| Joachim Deguara | cf6387d | 2007-04-24 13:05:36 +0200 | [diff] [blame] | 681 | panic("Could not set GART PTEs to uncacheable pages"); | 
| Joachim Deguara | cf6387d | 2007-04-24 13:05:36 +0200 | [diff] [blame] | 682 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 683 | agp_gatt_table = gatt; | 
| Andi Kleen | a32073b | 2006-06-26 13:56:40 +0200 | [diff] [blame] | 684 |  | 
| Rafael J. Wysocki | 6703f6d | 2008-06-10 00:10:48 +0200 | [diff] [blame] | 685 | enable_gart_translations(); | 
| Pavel Machek | cd76374 | 2008-05-29 00:30:21 -0700 | [diff] [blame] | 686 |  | 
|  | 687 | error = sysdev_class_register(&gart_sysdev_class); | 
|  | 688 | if (!error) | 
|  | 689 | error = sysdev_register(&device_gart); | 
|  | 690 | if (error) | 
| Joerg Roedel | 237a622 | 2008-09-25 12:13:53 +0200 | [diff] [blame] | 691 | panic("Could not register gart_sysdev -- " | 
|  | 692 | "would corrupt data on next suspend"); | 
| Rafael J. Wysocki | 6703f6d | 2008-06-10 00:10:48 +0200 | [diff] [blame] | 693 |  | 
| Andi Kleen | a32073b | 2006-06-26 13:56:40 +0200 | [diff] [blame] | 694 | flush_gart(); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 695 |  | 
|  | 696 | printk(KERN_INFO "PCI-DMA: aperture base @ %x size %u KB\n", | 
|  | 697 | aper_base, aper_size>>10); | 
| Yinghai Lu | 7ab073b | 2008-07-12 14:30:35 -0700 | [diff] [blame] | 698 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 699 | return 0; | 
|  | 700 |  | 
|  | 701 | nommu: | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 702 | /* Should not happen anymore */ | 
| Pavel Machek | 8f59610 | 2008-04-01 14:24:03 +0200 | [diff] [blame] | 703 | printk(KERN_WARNING "PCI-DMA: More than 4GB of RAM and no IOMMU\n" | 
|  | 704 | KERN_WARNING "falling back to iommu=soft.\n"); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 705 | return -1; | 
|  | 706 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 707 |  | 
| FUJITA Tomonori | 8d8bb39 | 2008-07-25 19:44:49 -0700 | [diff] [blame] | 708 | static struct dma_mapping_ops gart_dma_ops = { | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 709 | .map_single			= gart_map_single, | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 710 | .unmap_single			= gart_unmap_single, | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 711 | .map_sg				= gart_map_sg, | 
|  | 712 | .unmap_sg			= gart_unmap_sg, | 
| Joerg Roedel | 9458109 | 2008-08-19 16:32:39 +0200 | [diff] [blame] | 713 | .alloc_coherent			= gart_alloc_coherent, | 
| Joerg Roedel | 43a5a5a | 2008-08-19 16:32:40 +0200 | [diff] [blame] | 714 | .free_coherent			= gart_free_coherent, | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 715 | }; | 
|  | 716 |  | 
| Yinghai Lu | bc2cea6 | 2007-07-21 17:11:28 +0200 | [diff] [blame] | 717 | void gart_iommu_shutdown(void) | 
|  | 718 | { | 
|  | 719 | struct pci_dev *dev; | 
|  | 720 | int i; | 
|  | 721 |  | 
|  | 722 | if (no_agp && (dma_ops != &gart_dma_ops)) | 
|  | 723 | return; | 
|  | 724 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 725 | for (i = 0; i < num_k8_northbridges; i++) { | 
|  | 726 | u32 ctl; | 
| Yinghai Lu | bc2cea6 | 2007-07-21 17:11:28 +0200 | [diff] [blame] | 727 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 728 | dev = k8_northbridges[i]; | 
| Pavel Machek | 3bb6fbf | 2008-04-15 12:43:57 +0200 | [diff] [blame] | 729 | pci_read_config_dword(dev, AMD64_GARTAPERTURECTL, &ctl); | 
| Yinghai Lu | bc2cea6 | 2007-07-21 17:11:28 +0200 | [diff] [blame] | 730 |  | 
| Pavel Machek | 3bb6fbf | 2008-04-15 12:43:57 +0200 | [diff] [blame] | 731 | ctl &= ~GARTEN; | 
| Yinghai Lu | bc2cea6 | 2007-07-21 17:11:28 +0200 | [diff] [blame] | 732 |  | 
| Pavel Machek | 3bb6fbf | 2008-04-15 12:43:57 +0200 | [diff] [blame] | 733 | pci_write_config_dword(dev, AMD64_GARTAPERTURECTL, ctl); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 734 | } | 
| Yinghai Lu | bc2cea6 | 2007-07-21 17:11:28 +0200 | [diff] [blame] | 735 | } | 
|  | 736 |  | 
| Jon Mason | 0dc243a | 2006-06-26 13:58:11 +0200 | [diff] [blame] | 737 | void __init gart_iommu_init(void) | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 738 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 739 | struct agp_kern_info info; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 740 | unsigned long iommu_start; | 
| Yinghai Lu | d99e901 | 2008-10-04 15:55:12 -0700 | [diff] [blame] | 741 | unsigned long aper_base, aper_size; | 
|  | 742 | unsigned long start_pfn, end_pfn; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 743 | unsigned long scratch; | 
|  | 744 | long i; | 
|  | 745 |  | 
| Andi Kleen | a32073b | 2006-06-26 13:56:40 +0200 | [diff] [blame] | 746 | if (cache_k8_northbridges() < 0 || num_k8_northbridges == 0) { | 
|  | 747 | printk(KERN_INFO "PCI-GART: No AMD northbridge found.\n"); | 
| Jon Mason | 0dc243a | 2006-06-26 13:58:11 +0200 | [diff] [blame] | 748 | return; | 
| Andi Kleen | a32073b | 2006-06-26 13:56:40 +0200 | [diff] [blame] | 749 | } | 
|  | 750 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 751 | #ifndef CONFIG_AGP_AMD64 | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 752 | no_agp = 1; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 753 | #else | 
|  | 754 | /* Makefile puts PCI initialization via subsys_initcall first. */ | 
|  | 755 | /* Add other K8 AGP bridge drivers here */ | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 756 | no_agp = no_agp || | 
|  | 757 | (agp_amd64_init() < 0) || | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 758 | (agp_copy_info(agp_bridge, &info) < 0); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 759 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 760 |  | 
| Jon Mason | 60b08c6 | 2006-02-26 04:18:22 +0100 | [diff] [blame] | 761 | if (swiotlb) | 
| Jon Mason | 0dc243a | 2006-06-26 13:58:11 +0200 | [diff] [blame] | 762 | return; | 
| Jon Mason | 60b08c6 | 2006-02-26 04:18:22 +0100 | [diff] [blame] | 763 |  | 
| Jon Mason | 8d4f6b9 | 2006-06-26 13:58:05 +0200 | [diff] [blame] | 764 | /* Did we detect a different HW IOMMU? */ | 
| Joerg Roedel | 0440d4c | 2007-10-24 12:49:50 +0200 | [diff] [blame] | 765 | if (iommu_detected && !gart_iommu_aperture) | 
| Jon Mason | 0dc243a | 2006-06-26 13:58:11 +0200 | [diff] [blame] | 766 | return; | 
| Jon Mason | 8d4f6b9 | 2006-06-26 13:58:05 +0200 | [diff] [blame] | 767 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 768 | if (no_iommu || | 
| Yinghai Lu | c987d12 | 2008-06-24 22:14:09 -0700 | [diff] [blame] | 769 | (!force_iommu && max_pfn <= MAX_DMA32_PFN) || | 
| Joerg Roedel | 0440d4c | 2007-10-24 12:49:50 +0200 | [diff] [blame] | 770 | !gart_iommu_aperture || | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 771 | (no_agp && init_k8_gatt(&info) < 0)) { | 
| Yinghai Lu | c987d12 | 2008-06-24 22:14:09 -0700 | [diff] [blame] | 772 | if (max_pfn > MAX_DMA32_PFN) { | 
| Pavel Machek | 8f59610 | 2008-04-01 14:24:03 +0200 | [diff] [blame] | 773 | printk(KERN_WARNING "More than 4GB of memory " | 
| Joerg Roedel | 237a622 | 2008-09-25 12:13:53 +0200 | [diff] [blame] | 774 | "but GART IOMMU not available.\n"); | 
|  | 775 | printk(KERN_WARNING "falling back to iommu=soft.\n"); | 
| Jon Mason | 5b7b644 | 2006-02-03 21:51:59 +0100 | [diff] [blame] | 776 | } | 
| Jon Mason | 0dc243a | 2006-06-26 13:58:11 +0200 | [diff] [blame] | 777 | return; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 778 | } | 
|  | 779 |  | 
| Yinghai Lu | d99e901 | 2008-10-04 15:55:12 -0700 | [diff] [blame] | 780 | /* need to map that range */ | 
|  | 781 | aper_size = info.aper_size << 20; | 
|  | 782 | aper_base = info.aper_base; | 
|  | 783 | end_pfn = (aper_base>>PAGE_SHIFT) + (aper_size>>PAGE_SHIFT); | 
|  | 784 | if (end_pfn > max_low_pfn_mapped) { | 
|  | 785 | start_pfn = (aper_base>>PAGE_SHIFT); | 
|  | 786 | init_memory_mapping(start_pfn<<PAGE_SHIFT, end_pfn<<PAGE_SHIFT); | 
|  | 787 | } | 
|  | 788 |  | 
| Jon Mason | 5b7b644 | 2006-02-03 21:51:59 +0100 | [diff] [blame] | 789 | printk(KERN_INFO "PCI-DMA: using GART IOMMU.\n"); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 790 | iommu_size = check_iommu_size(info.aper_base, aper_size); | 
|  | 791 | iommu_pages = iommu_size >> PAGE_SHIFT; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 792 |  | 
| Joerg Roedel | 0114267 | 2008-09-25 12:42:12 +0200 | [diff] [blame] | 793 | iommu_gart_bitmap = (void *) __get_free_pages(GFP_KERNEL | __GFP_ZERO, | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 794 | get_order(iommu_pages/8)); | 
|  | 795 | if (!iommu_gart_bitmap) | 
|  | 796 | panic("Cannot allocate iommu bitmap\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 797 |  | 
|  | 798 | #ifdef CONFIG_IOMMU_LEAK | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 799 | if (leak_trace) { | 
| Joerg Roedel | 0114267 | 2008-09-25 12:42:12 +0200 | [diff] [blame] | 800 | iommu_leak_tab = (void *)__get_free_pages(GFP_KERNEL|__GFP_ZERO, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 801 | get_order(iommu_pages*sizeof(void *))); | 
| Joerg Roedel | 0114267 | 2008-09-25 12:42:12 +0200 | [diff] [blame] | 802 | if (!iommu_leak_tab) | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 803 | printk(KERN_DEBUG | 
|  | 804 | "PCI-DMA: Cannot allocate leak trace area\n"); | 
|  | 805 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 806 | #endif | 
|  | 807 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 808 | /* | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 809 | * Out of IOMMU space handling. | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 810 | * Reserve some invalid pages at the beginning of the GART. | 
|  | 811 | */ | 
| FUJITA Tomonori | d26dbc5 | 2008-09-22 22:35:07 +0900 | [diff] [blame] | 812 | iommu_area_reserve(iommu_gart_bitmap, 0, EMERGENCY_PAGES); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 813 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 814 | agp_memory_reserved = iommu_size; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 815 | printk(KERN_INFO | 
|  | 816 | "PCI-DMA: Reserving %luMB of IOMMU area in the AGP aperture\n", | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 817 | iommu_size >> 20); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 818 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 819 | iommu_start = aper_size - iommu_size; | 
|  | 820 | iommu_bus_base = info.aper_base + iommu_start; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 821 | bad_dma_address = iommu_bus_base; | 
|  | 822 | iommu_gatt_base = agp_gatt_table + (iommu_start>>PAGE_SHIFT); | 
|  | 823 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 824 | /* | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 825 | * Unmap the IOMMU part of the GART. The alias of the page is | 
|  | 826 | * always mapped with cache enabled and there is no full cache | 
|  | 827 | * coherency across the GART remapping. The unmapping avoids | 
|  | 828 | * automatic prefetches from the CPU allocating cache lines in | 
|  | 829 | * there. All CPU accesses are done via the direct mapping to | 
|  | 830 | * the backing memory. The GART address is only used by PCI | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 831 | * devices. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 832 | */ | 
| Andi Kleen | 28d6ee4 | 2008-02-04 16:48:08 +0100 | [diff] [blame] | 833 | set_memory_np((unsigned long)__va(iommu_bus_base), | 
|  | 834 | iommu_size >> PAGE_SHIFT); | 
| Ingo Molnar | 184652e | 2008-02-14 23:30:20 +0100 | [diff] [blame] | 835 | /* | 
|  | 836 | * Tricky. The GART table remaps the physical memory range, | 
|  | 837 | * so the CPU wont notice potential aliases and if the memory | 
|  | 838 | * is remapped to UC later on, we might surprise the PCI devices | 
|  | 839 | * with a stray writeout of a cacheline. So play it sure and | 
|  | 840 | * do an explicit, full-scale wbinvd() _after_ having marked all | 
|  | 841 | * the pages as Not-Present: | 
|  | 842 | */ | 
|  | 843 | wbinvd(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 844 |  | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 845 | /* | 
| Pavel Machek | fa3d319 | 2008-06-26 00:25:43 +0200 | [diff] [blame] | 846 | * Try to workaround a bug (thanks to BenH): | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 847 | * Set unmapped entries to a scratch page instead of 0. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 848 | * Any prefetches that hit unmapped entries won't get an bus abort | 
| Pavel Machek | fa3d319 | 2008-06-26 00:25:43 +0200 | [diff] [blame] | 849 | * then. (P2P bridge may be prefetching on DMA reads). | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 850 | */ | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 851 | scratch = get_zeroed_page(GFP_KERNEL); | 
|  | 852 | if (!scratch) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 853 | panic("Cannot allocate iommu scratch page"); | 
|  | 854 | gart_unmapped_entry = GPTE_ENCODE(__pa(scratch)); | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 855 | for (i = EMERGENCY_PAGES; i < iommu_pages; i++) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 856 | iommu_gatt_base[i] = gart_unmapped_entry; | 
|  | 857 |  | 
| Andi Kleen | a32073b | 2006-06-26 13:56:40 +0200 | [diff] [blame] | 858 | flush_gart(); | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 859 | dma_ops = &gart_dma_ops; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 860 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 861 |  | 
| Sam Ravnborg | 43999d9 | 2007-03-16 21:07:36 +0100 | [diff] [blame] | 862 | void __init gart_parse_options(char *p) | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 863 | { | 
|  | 864 | int arg; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 865 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 866 | #ifdef CONFIG_IOMMU_LEAK | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 867 | if (!strncmp(p, "leak", 4)) { | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 868 | leak_trace = 1; | 
|  | 869 | p += 4; | 
| Joerg Roedel | 237a622 | 2008-09-25 12:13:53 +0200 | [diff] [blame] | 870 | if (*p == '=') | 
|  | 871 | ++p; | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 872 | if (isdigit(*p) && get_option(&p, &arg)) | 
|  | 873 | iommu_leak_pages = arg; | 
|  | 874 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 875 | #endif | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 876 | if (isdigit(*p) && get_option(&p, &arg)) | 
|  | 877 | iommu_size = arg; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 878 | if (!strncmp(p, "fullflush", 8)) | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 879 | iommu_fullflush = 1; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 880 | if (!strncmp(p, "nofullflush", 11)) | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 881 | iommu_fullflush = 0; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 882 | if (!strncmp(p, "noagp", 5)) | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 883 | no_agp = 1; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 884 | if (!strncmp(p, "noaperture", 10)) | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 885 | fix_aperture = 0; | 
|  | 886 | /* duplicated from pci-dma.c */ | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 887 | if (!strncmp(p, "force", 5)) | 
| Joerg Roedel | 0440d4c | 2007-10-24 12:49:50 +0200 | [diff] [blame] | 888 | gart_iommu_aperture_allowed = 1; | 
| Ingo Molnar | 05fccb0 | 2008-01-30 13:30:12 +0100 | [diff] [blame] | 889 | if (!strncmp(p, "allowed", 7)) | 
| Joerg Roedel | 0440d4c | 2007-10-24 12:49:50 +0200 | [diff] [blame] | 890 | gart_iommu_aperture_allowed = 1; | 
| Muli Ben-Yehuda | 17a941d | 2006-01-11 22:44:42 +0100 | [diff] [blame] | 891 | if (!strncmp(p, "memaper", 7)) { | 
|  | 892 | fallback_aper_force = 1; | 
|  | 893 | p += 7; | 
|  | 894 | if (*p == '=') { | 
|  | 895 | ++p; | 
|  | 896 | if (get_option(&p, &arg)) | 
|  | 897 | fallback_aper_order = arg; | 
|  | 898 | } | 
|  | 899 | } | 
|  | 900 | } |