| /* | 
 |  * Dynamic DMA mapping support for AMD Hammer. | 
 |  * | 
 |  * 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 | 
 |  * with more than 4GB. | 
 |  * | 
 |  * See Documentation/DMA-API-HOWTO.txt for the interface specification. | 
 |  * | 
 |  * Copyright 2002 Andi Kleen, SuSE Labs. | 
 |  * Subject to the GNU General Public License v2 only. | 
 |  */ | 
 |  | 
 | #include <linux/types.h> | 
 | #include <linux/ctype.h> | 
 | #include <linux/agp_backend.h> | 
 | #include <linux/init.h> | 
 | #include <linux/mm.h> | 
 | #include <linux/sched.h> | 
 | #include <linux/sched/debug.h> | 
 | #include <linux/string.h> | 
 | #include <linux/spinlock.h> | 
 | #include <linux/pci.h> | 
 | #include <linux/topology.h> | 
 | #include <linux/interrupt.h> | 
 | #include <linux/bitmap.h> | 
 | #include <linux/kdebug.h> | 
 | #include <linux/scatterlist.h> | 
 | #include <linux/iommu-helper.h> | 
 | #include <linux/syscore_ops.h> | 
 | #include <linux/io.h> | 
 | #include <linux/gfp.h> | 
 | #include <linux/atomic.h> | 
 | #include <asm/mtrr.h> | 
 | #include <asm/pgtable.h> | 
 | #include <asm/proto.h> | 
 | #include <asm/iommu.h> | 
 | #include <asm/gart.h> | 
 | #include <asm/set_memory.h> | 
 | #include <asm/swiotlb.h> | 
 | #include <asm/dma.h> | 
 | #include <asm/amd_nb.h> | 
 | #include <asm/x86_init.h> | 
 | #include <asm/iommu_table.h> | 
 |  | 
 | static unsigned long iommu_bus_base;	/* GART remapping area (physical) */ | 
 | static unsigned long iommu_size;	/* size of remapping area bytes */ | 
 | static unsigned long iommu_pages;	/* .. and in pages */ | 
 |  | 
 | static u32 *iommu_gatt_base;		/* Remapping table */ | 
 |  | 
 | static dma_addr_t bad_dma_addr; | 
 |  | 
 | /* | 
 |  * 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). | 
 |  */ | 
 | static int iommu_fullflush = 1; | 
 |  | 
 | /* Allocation bitmap for the remapping area: */ | 
 | static DEFINE_SPINLOCK(iommu_bitmap_lock); | 
 | /* Guarded by iommu_bitmap_lock: */ | 
 | static unsigned long *iommu_gart_bitmap; | 
 |  | 
 | static u32 gart_unmapped_entry; | 
 |  | 
 | #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)) | 
 |  | 
 | #define EMERGENCY_PAGES 32 /* = 128KB */ | 
 |  | 
 | #ifdef CONFIG_AGP | 
 | #define AGPEXTERN extern | 
 | #else | 
 | #define AGPEXTERN | 
 | #endif | 
 |  | 
 | /* GART can only remap to physical addresses < 1TB */ | 
 | #define GART_MAX_PHYS_ADDR	(1ULL << 40) | 
 |  | 
 | /* 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 */ | 
 | static bool need_flush;		/* global flush state. set for each gart wrap */ | 
 |  | 
 | static unsigned long alloc_iommu(struct device *dev, int size, | 
 | 				 unsigned long align_mask) | 
 | { | 
 | 	unsigned long offset, flags; | 
 | 	unsigned long boundary_size; | 
 | 	unsigned long base_index; | 
 |  | 
 | 	base_index = ALIGN(iommu_bus_base & dma_get_seg_boundary(dev), | 
 | 			   PAGE_SIZE) >> PAGE_SHIFT; | 
 | 	boundary_size = ALIGN((u64)dma_get_seg_boundary(dev) + 1, | 
 | 			      PAGE_SIZE) >> PAGE_SHIFT; | 
 |  | 
 | 	spin_lock_irqsave(&iommu_bitmap_lock, flags); | 
 | 	offset = iommu_area_alloc(iommu_gart_bitmap, iommu_pages, next_bit, | 
 | 				  size, base_index, boundary_size, align_mask); | 
 | 	if (offset == -1) { | 
 | 		need_flush = true; | 
 | 		offset = iommu_area_alloc(iommu_gart_bitmap, iommu_pages, 0, | 
 | 					  size, base_index, boundary_size, | 
 | 					  align_mask); | 
 | 	} | 
 | 	if (offset != -1) { | 
 | 		next_bit = offset+size; | 
 | 		if (next_bit >= iommu_pages) { | 
 | 			next_bit = 0; | 
 | 			need_flush = true; | 
 | 		} | 
 | 	} | 
 | 	if (iommu_fullflush) | 
 | 		need_flush = true; | 
 | 	spin_unlock_irqrestore(&iommu_bitmap_lock, flags); | 
 |  | 
 | 	return offset; | 
 | } | 
 |  | 
 | static void free_iommu(unsigned long offset, int size) | 
 | { | 
 | 	unsigned long flags; | 
 |  | 
 | 	spin_lock_irqsave(&iommu_bitmap_lock, flags); | 
 | 	bitmap_clear(iommu_gart_bitmap, offset, size); | 
 | 	if (offset >= next_bit) | 
 | 		next_bit = offset + size; | 
 | 	spin_unlock_irqrestore(&iommu_bitmap_lock, flags); | 
 | } | 
 |  | 
 | /* | 
 |  * Use global flush state to avoid races with multiple flushers. | 
 |  */ | 
 | static void flush_gart(void) | 
 | { | 
 | 	unsigned long flags; | 
 |  | 
 | 	spin_lock_irqsave(&iommu_bitmap_lock, flags); | 
 | 	if (need_flush) { | 
 | 		amd_flush_garts(); | 
 | 		need_flush = false; | 
 | 	} | 
 | 	spin_unlock_irqrestore(&iommu_bitmap_lock, flags); | 
 | } | 
 |  | 
 | #ifdef CONFIG_IOMMU_LEAK | 
 | /* Debugging aid for drivers that don't free their IOMMU tables */ | 
 | static int leak_trace; | 
 | static int iommu_leak_pages = 20; | 
 |  | 
 | static void dump_leak(void) | 
 | { | 
 | 	static int dump; | 
 |  | 
 | 	if (dump) | 
 | 		return; | 
 | 	dump = 1; | 
 |  | 
 | 	show_stack(NULL, NULL); | 
 | 	debug_dma_dump_mappings(NULL); | 
 | } | 
 | #endif | 
 |  | 
 | static void iommu_full(struct device *dev, size_t size, int dir) | 
 | { | 
 | 	/* | 
 | 	 * Ran out of IOMMU space for this operation. This is very bad. | 
 | 	 * Unfortunately the drivers cannot handle this operation properly. | 
 | 	 * Return some non mapped prereserved space in the aperture and | 
 | 	 * let the Northbridge deal with it. This will result in garbage | 
 | 	 * in the IO operation. When the size exceeds the prereserved space | 
 | 	 * memory corruption will occur or random memory will be DMAed | 
 | 	 * out. Hopefully no network devices use single mappings that big. | 
 | 	 */ | 
 |  | 
 | 	dev_err(dev, "PCI-DMA: Out of IOMMU space for %lu bytes\n", size); | 
 |  | 
 | 	if (size > PAGE_SIZE*EMERGENCY_PAGES) { | 
 | 		if (dir == PCI_DMA_FROMDEVICE || dir == PCI_DMA_BIDIRECTIONAL) | 
 | 			panic("PCI-DMA: Memory would be corrupted\n"); | 
 | 		if (dir == PCI_DMA_TODEVICE || dir == PCI_DMA_BIDIRECTIONAL) | 
 | 			panic(KERN_ERR | 
 | 				"PCI-DMA: Random memory would be DMAed\n"); | 
 | 	} | 
 | #ifdef CONFIG_IOMMU_LEAK | 
 | 	dump_leak(); | 
 | #endif | 
 | } | 
 |  | 
 | static inline int | 
 | need_iommu(struct device *dev, unsigned long addr, size_t size) | 
 | { | 
 | 	return force_iommu || !dma_capable(dev, addr, size); | 
 | } | 
 |  | 
 | static inline int | 
 | nonforced_iommu(struct device *dev, unsigned long addr, size_t size) | 
 | { | 
 | 	return !dma_capable(dev, addr, size); | 
 | } | 
 |  | 
 | /* Map a single continuous physical area into the IOMMU. | 
 |  * Caller needs to check if the iommu is needed and flush. | 
 |  */ | 
 | static dma_addr_t dma_map_area(struct device *dev, dma_addr_t phys_mem, | 
 | 				size_t size, int dir, unsigned long align_mask) | 
 | { | 
 | 	unsigned long npages = iommu_num_pages(phys_mem, size, PAGE_SIZE); | 
 | 	unsigned long iommu_page; | 
 | 	int i; | 
 |  | 
 | 	if (unlikely(phys_mem + size > GART_MAX_PHYS_ADDR)) | 
 | 		return bad_dma_addr; | 
 |  | 
 | 	iommu_page = alloc_iommu(dev, npages, align_mask); | 
 | 	if (iommu_page == -1) { | 
 | 		if (!nonforced_iommu(dev, phys_mem, size)) | 
 | 			return phys_mem; | 
 | 		if (panic_on_overflow) | 
 | 			panic("dma_map_area overflow %lu bytes\n", size); | 
 | 		iommu_full(dev, size, dir); | 
 | 		return bad_dma_addr; | 
 | 	} | 
 |  | 
 | 	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 */ | 
 | static dma_addr_t gart_map_page(struct device *dev, struct page *page, | 
 | 				unsigned long offset, size_t size, | 
 | 				enum dma_data_direction dir, | 
 | 				unsigned long attrs) | 
 | { | 
 | 	unsigned long bus; | 
 | 	phys_addr_t paddr = page_to_phys(page) + offset; | 
 |  | 
 | 	if (!dev) | 
 | 		dev = &x86_dma_fallback_dev; | 
 |  | 
 | 	if (!need_iommu(dev, paddr, size)) | 
 | 		return paddr; | 
 |  | 
 | 	bus = dma_map_area(dev, paddr, size, dir, 0); | 
 | 	flush_gart(); | 
 |  | 
 | 	return bus; | 
 | } | 
 |  | 
 | /* | 
 |  * Free a DMA mapping. | 
 |  */ | 
 | static void gart_unmap_page(struct device *dev, dma_addr_t dma_addr, | 
 | 			    size_t size, enum dma_data_direction dir, | 
 | 			    unsigned long attrs) | 
 | { | 
 | 	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; | 
 |  | 
 | 	iommu_page = (dma_addr - iommu_bus_base)>>PAGE_SHIFT; | 
 | 	npages = iommu_num_pages(dma_addr, size, PAGE_SIZE); | 
 | 	for (i = 0; i < npages; i++) { | 
 | 		iommu_gatt_base[iommu_page + i] = gart_unmapped_entry; | 
 | 	} | 
 | 	free_iommu(iommu_page, npages); | 
 | } | 
 |  | 
 | /* | 
 |  * Wrapper for pci_unmap_single working with scatterlists. | 
 |  */ | 
 | static void gart_unmap_sg(struct device *dev, struct scatterlist *sg, int nents, | 
 | 			  enum dma_data_direction dir, unsigned long attrs) | 
 | { | 
 | 	struct scatterlist *s; | 
 | 	int i; | 
 |  | 
 | 	for_each_sg(sg, s, nents, i) { | 
 | 		if (!s->dma_length || !s->length) | 
 | 			break; | 
 | 		gart_unmap_page(dev, s->dma_address, s->dma_length, dir, 0); | 
 | 	} | 
 | } | 
 |  | 
 | /* 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) | 
 | { | 
 | 	struct scatterlist *s; | 
 | 	int i; | 
 |  | 
 | #ifdef CONFIG_IOMMU_DEBUG | 
 | 	pr_debug("dma_map_sg overflow\n"); | 
 | #endif | 
 |  | 
 | 	for_each_sg(sg, s, nents, i) { | 
 | 		unsigned long addr = sg_phys(s); | 
 |  | 
 | 		if (nonforced_iommu(dev, addr, s->length)) { | 
 | 			addr = dma_map_area(dev, addr, s->length, dir, 0); | 
 | 			if (addr == bad_dma_addr) { | 
 | 				if (i > 0) | 
 | 					gart_unmap_sg(dev, sg, i, dir, 0); | 
 | 				nents = 0; | 
 | 				sg[0].dma_length = 0; | 
 | 				break; | 
 | 			} | 
 | 		} | 
 | 		s->dma_address = addr; | 
 | 		s->dma_length = s->length; | 
 | 	} | 
 | 	flush_gart(); | 
 |  | 
 | 	return nents; | 
 | } | 
 |  | 
 | /* Map multiple scatterlist entries continuous into the first. */ | 
 | static int __dma_map_cont(struct device *dev, struct scatterlist *start, | 
 | 			  int nelems, struct scatterlist *sout, | 
 | 			  unsigned long pages) | 
 | { | 
 | 	unsigned long iommu_start = alloc_iommu(dev, pages, 0); | 
 | 	unsigned long iommu_page = iommu_start; | 
 | 	struct scatterlist *s; | 
 | 	int i; | 
 |  | 
 | 	if (iommu_start == -1) | 
 | 		return -1; | 
 |  | 
 | 	for_each_sg(start, s, nelems, i) { | 
 | 		unsigned long pages, addr; | 
 | 		unsigned long phys_addr = s->dma_address; | 
 |  | 
 | 		BUG_ON(s != start && s->offset); | 
 | 		if (s == start) { | 
 | 			sout->dma_address = iommu_bus_base; | 
 | 			sout->dma_address += iommu_page*PAGE_SIZE + s->offset; | 
 | 			sout->dma_length = s->length; | 
 | 		} else { | 
 | 			sout->dma_length += s->length; | 
 | 		} | 
 |  | 
 | 		addr = phys_addr; | 
 | 		pages = iommu_num_pages(s->offset, s->length, PAGE_SIZE); | 
 | 		while (pages--) { | 
 | 			iommu_gatt_base[iommu_page] = GPTE_ENCODE(addr); | 
 | 			addr += PAGE_SIZE; | 
 | 			iommu_page++; | 
 | 		} | 
 | 	} | 
 | 	BUG_ON(iommu_page - iommu_start != pages); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static inline int | 
 | dma_map_cont(struct device *dev, struct scatterlist *start, int nelems, | 
 | 	     struct scatterlist *sout, unsigned long pages, int need) | 
 | { | 
 | 	if (!need) { | 
 | 		BUG_ON(nelems != 1); | 
 | 		sout->dma_address = start->dma_address; | 
 | 		sout->dma_length = start->length; | 
 | 		return 0; | 
 | 	} | 
 | 	return __dma_map_cont(dev, start, nelems, sout, pages); | 
 | } | 
 |  | 
 | /* | 
 |  * DMA map all entries in a scatterlist. | 
 |  * Merge chunks that have page aligned sizes into a continuous mapping. | 
 |  */ | 
 | static int gart_map_sg(struct device *dev, struct scatterlist *sg, int nents, | 
 | 		       enum dma_data_direction dir, unsigned long attrs) | 
 | { | 
 | 	struct scatterlist *s, *ps, *start_sg, *sgmap; | 
 | 	int need = 0, nextneed, i, out, start; | 
 | 	unsigned long pages = 0; | 
 | 	unsigned int seg_size; | 
 | 	unsigned int max_seg_size; | 
 |  | 
 | 	if (nents == 0) | 
 | 		return 0; | 
 |  | 
 | 	if (!dev) | 
 | 		dev = &x86_dma_fallback_dev; | 
 |  | 
 | 	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 */ | 
 |  | 
 | 	for_each_sg(sg, s, nents, i) { | 
 | 		dma_addr_t addr = sg_phys(s); | 
 |  | 
 | 		s->dma_address = addr; | 
 | 		BUG_ON(s->length == 0); | 
 |  | 
 | 		nextneed = need_iommu(dev, addr, s->length); | 
 |  | 
 | 		/* Handle the previous not yet processed entries */ | 
 | 		if (i > start) { | 
 | 			/* | 
 | 			 * Can only merge when the last chunk ends on a | 
 | 			 * page boundary and the new one doesn't have an | 
 | 			 * offset. | 
 | 			 */ | 
 | 			if (!iommu_merge || !nextneed || !need || s->offset || | 
 | 			    (s->length + seg_size > max_seg_size) || | 
 | 			    (ps->offset + ps->length) % PAGE_SIZE) { | 
 | 				if (dma_map_cont(dev, start_sg, i - start, | 
 | 						 sgmap, pages, need) < 0) | 
 | 					goto error; | 
 | 				out++; | 
 |  | 
 | 				seg_size	= 0; | 
 | 				sgmap		= sg_next(sgmap); | 
 | 				pages		= 0; | 
 | 				start		= i; | 
 | 				start_sg	= s; | 
 | 			} | 
 | 		} | 
 |  | 
 | 		seg_size += s->length; | 
 | 		need = nextneed; | 
 | 		pages += iommu_num_pages(s->offset, s->length, PAGE_SIZE); | 
 | 		ps = s; | 
 | 	} | 
 | 	if (dma_map_cont(dev, start_sg, i - start, sgmap, pages, need) < 0) | 
 | 		goto error; | 
 | 	out++; | 
 | 	flush_gart(); | 
 | 	if (out < nents) { | 
 | 		sgmap = sg_next(sgmap); | 
 | 		sgmap->dma_length = 0; | 
 | 	} | 
 | 	return out; | 
 |  | 
 | error: | 
 | 	flush_gart(); | 
 | 	gart_unmap_sg(dev, sg, out, dir, 0); | 
 |  | 
 | 	/* 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; | 
 | 	} | 
 | 	if (panic_on_overflow) | 
 | 		panic("dma_map_sg: overflow on %lu pages\n", pages); | 
 |  | 
 | 	iommu_full(dev, pages << PAGE_SHIFT, dir); | 
 | 	for_each_sg(sg, s, nents, i) | 
 | 		s->dma_address = bad_dma_addr; | 
 | 	return 0; | 
 | } | 
 |  | 
 | /* 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, unsigned long attrs) | 
 | { | 
 | 	dma_addr_t paddr; | 
 | 	unsigned long align_mask; | 
 | 	struct page *page; | 
 |  | 
 | 	if (force_iommu && !(flag & GFP_DMA)) { | 
 | 		flag &= ~(__GFP_DMA | __GFP_HIGHMEM | __GFP_DMA32); | 
 | 		page = alloc_pages(flag | __GFP_ZERO, get_order(size)); | 
 | 		if (!page) | 
 | 			return NULL; | 
 |  | 
 | 		align_mask = (1UL << get_order(size)) - 1; | 
 | 		paddr = dma_map_area(dev, page_to_phys(page), size, | 
 | 				     DMA_BIDIRECTIONAL, align_mask); | 
 |  | 
 | 		flush_gart(); | 
 | 		if (paddr != bad_dma_addr) { | 
 | 			*dma_addr = paddr; | 
 | 			return page_address(page); | 
 | 		} | 
 | 		__free_pages(page, get_order(size)); | 
 | 	} else | 
 | 		return dma_generic_alloc_coherent(dev, size, dma_addr, flag, | 
 | 						  attrs); | 
 |  | 
 | 	return NULL; | 
 | } | 
 |  | 
 | /* free a coherent mapping */ | 
 | static void | 
 | gart_free_coherent(struct device *dev, size_t size, void *vaddr, | 
 | 		   dma_addr_t dma_addr, unsigned long attrs) | 
 | { | 
 | 	gart_unmap_page(dev, dma_addr, size, DMA_BIDIRECTIONAL, 0); | 
 | 	dma_generic_free_coherent(dev, size, vaddr, dma_addr, attrs); | 
 | } | 
 |  | 
 | static int gart_mapping_error(struct device *dev, dma_addr_t dma_addr) | 
 | { | 
 | 	return (dma_addr == bad_dma_addr); | 
 | } | 
 |  | 
 | static int no_agp; | 
 |  | 
 | static __init unsigned long check_iommu_size(unsigned long aper, u64 aper_size) | 
 | { | 
 | 	unsigned long a; | 
 |  | 
 | 	if (!iommu_size) { | 
 | 		iommu_size = aper_size; | 
 | 		if (!no_agp) | 
 | 			iommu_size /= 2; | 
 | 	} | 
 |  | 
 | 	a = aper + iommu_size; | 
 | 	iommu_size -= round_up(a, PMD_PAGE_SIZE) - a; | 
 |  | 
 | 	if (iommu_size < 64*1024*1024) { | 
 | 		pr_warning( | 
 | 			"PCI-DMA: Warning: Small IOMMU %luMB." | 
 | 			" Consider increasing the AGP aperture in BIOS\n", | 
 | 				iommu_size >> 20); | 
 | 	} | 
 |  | 
 | 	return iommu_size; | 
 | } | 
 |  | 
 | static __init unsigned read_aperture(struct pci_dev *dev, u32 *size) | 
 | { | 
 | 	unsigned aper_size = 0, aper_base_32, aper_order; | 
 | 	u64 aper_base; | 
 |  | 
 | 	pci_read_config_dword(dev, AMD64_GARTAPERTUREBASE, &aper_base_32); | 
 | 	pci_read_config_dword(dev, AMD64_GARTAPERTURECTL, &aper_order); | 
 | 	aper_order = (aper_order >> 1) & 7; | 
 |  | 
 | 	aper_base = aper_base_32 & 0x7fff; | 
 | 	aper_base <<= 25; | 
 |  | 
 | 	aper_size = (32 * 1024 * 1024) << aper_order; | 
 | 	if (aper_base + aper_size > 0x100000000UL || !aper_size) | 
 | 		aper_base = 0; | 
 |  | 
 | 	*size = aper_size; | 
 | 	return aper_base; | 
 | } | 
 |  | 
 | static void enable_gart_translations(void) | 
 | { | 
 | 	int i; | 
 |  | 
 | 	if (!amd_nb_has_feature(AMD_NB_GART)) | 
 | 		return; | 
 |  | 
 | 	for (i = 0; i < amd_nb_num(); i++) { | 
 | 		struct pci_dev *dev = node_to_amd_nb(i)->misc; | 
 |  | 
 | 		enable_gart_translation(dev, __pa(agp_gatt_table)); | 
 | 	} | 
 |  | 
 | 	/* Flush the GART-TLB to remove stale entries */ | 
 | 	amd_flush_garts(); | 
 | } | 
 |  | 
 | /* | 
 |  * 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; | 
 | } | 
 |  | 
 | static void gart_fixup_northbridges(void) | 
 | { | 
 | 	int i; | 
 |  | 
 | 	if (!fix_up_north_bridges) | 
 | 		return; | 
 |  | 
 | 	if (!amd_nb_has_feature(AMD_NB_GART)) | 
 | 		return; | 
 |  | 
 | 	pr_info("PCI-DMA: Restoring GART aperture settings\n"); | 
 |  | 
 | 	for (i = 0; i < amd_nb_num(); i++) { | 
 | 		struct pci_dev *dev = node_to_amd_nb(i)->misc; | 
 |  | 
 | 		/* | 
 | 		 * Don't enable translations just yet.  That is the next | 
 | 		 * step.  Restore the pre-suspend aperture settings. | 
 | 		 */ | 
 | 		gart_set_size_and_enable(dev, aperture_order); | 
 | 		pci_write_config_dword(dev, AMD64_GARTAPERTUREBASE, aperture_alloc >> 25); | 
 | 	} | 
 | } | 
 |  | 
 | static void gart_resume(void) | 
 | { | 
 | 	pr_info("PCI-DMA: Resuming GART IOMMU\n"); | 
 |  | 
 | 	gart_fixup_northbridges(); | 
 |  | 
 | 	enable_gart_translations(); | 
 | } | 
 |  | 
 | static struct syscore_ops gart_syscore_ops = { | 
 | 	.resume		= gart_resume, | 
 |  | 
 | }; | 
 |  | 
 | /* | 
 |  * Private Northbridge GATT initialization in case we cannot use the | 
 |  * AGP driver for some reason. | 
 |  */ | 
 | static __init int init_amd_gatt(struct agp_kern_info *info) | 
 | { | 
 | 	unsigned aper_size, gatt_size, new_aper_size; | 
 | 	unsigned aper_base, new_aper_base; | 
 | 	struct pci_dev *dev; | 
 | 	void *gatt; | 
 | 	int i; | 
 |  | 
 | 	pr_info("PCI-DMA: Disabling AGP.\n"); | 
 |  | 
 | 	aper_size = aper_base = info->aper_size = 0; | 
 | 	dev = NULL; | 
 | 	for (i = 0; i < amd_nb_num(); i++) { | 
 | 		dev = node_to_amd_nb(i)->misc; | 
 | 		new_aper_base = read_aperture(dev, &new_aper_size); | 
 | 		if (!new_aper_base) | 
 | 			goto nommu; | 
 |  | 
 | 		if (!aper_base) { | 
 | 			aper_size = new_aper_size; | 
 | 			aper_base = new_aper_base; | 
 | 		} | 
 | 		if (aper_size != new_aper_size || aper_base != new_aper_base) | 
 | 			goto nommu; | 
 | 	} | 
 | 	if (!aper_base) | 
 | 		goto nommu; | 
 |  | 
 | 	info->aper_base = aper_base; | 
 | 	info->aper_size = aper_size >> 20; | 
 |  | 
 | 	gatt_size = (aper_size >> PAGE_SHIFT) * sizeof(u32); | 
 | 	gatt = (void *)__get_free_pages(GFP_KERNEL | __GFP_ZERO, | 
 | 					get_order(gatt_size)); | 
 | 	if (!gatt) | 
 | 		panic("Cannot allocate GATT table"); | 
 | 	if (set_memory_uc((unsigned long)gatt, gatt_size >> PAGE_SHIFT)) | 
 | 		panic("Could not set GART PTEs to uncacheable pages"); | 
 |  | 
 | 	agp_gatt_table = gatt; | 
 |  | 
 | 	register_syscore_ops(&gart_syscore_ops); | 
 |  | 
 | 	flush_gart(); | 
 |  | 
 | 	pr_info("PCI-DMA: aperture base @ %x size %u KB\n", | 
 | 	       aper_base, aper_size>>10); | 
 |  | 
 | 	return 0; | 
 |  | 
 |  nommu: | 
 | 	/* Should not happen anymore */ | 
 | 	pr_warning("PCI-DMA: More than 4GB of RAM and no IOMMU\n" | 
 | 	       "falling back to iommu=soft.\n"); | 
 | 	return -1; | 
 | } | 
 |  | 
 | static const struct dma_map_ops gart_dma_ops = { | 
 | 	.map_sg				= gart_map_sg, | 
 | 	.unmap_sg			= gart_unmap_sg, | 
 | 	.map_page			= gart_map_page, | 
 | 	.unmap_page			= gart_unmap_page, | 
 | 	.alloc				= gart_alloc_coherent, | 
 | 	.free				= gart_free_coherent, | 
 | 	.mapping_error			= gart_mapping_error, | 
 | 	.dma_supported			= x86_dma_supported, | 
 | }; | 
 |  | 
 | static void gart_iommu_shutdown(void) | 
 | { | 
 | 	struct pci_dev *dev; | 
 | 	int i; | 
 |  | 
 | 	/* don't shutdown it if there is AGP installed */ | 
 | 	if (!no_agp) | 
 | 		return; | 
 |  | 
 | 	if (!amd_nb_has_feature(AMD_NB_GART)) | 
 | 		return; | 
 |  | 
 | 	for (i = 0; i < amd_nb_num(); i++) { | 
 | 		u32 ctl; | 
 |  | 
 | 		dev = node_to_amd_nb(i)->misc; | 
 | 		pci_read_config_dword(dev, AMD64_GARTAPERTURECTL, &ctl); | 
 |  | 
 | 		ctl &= ~GARTEN; | 
 |  | 
 | 		pci_write_config_dword(dev, AMD64_GARTAPERTURECTL, ctl); | 
 | 	} | 
 | } | 
 |  | 
 | int __init gart_iommu_init(void) | 
 | { | 
 | 	struct agp_kern_info info; | 
 | 	unsigned long iommu_start; | 
 | 	unsigned long aper_base, aper_size; | 
 | 	unsigned long start_pfn, end_pfn; | 
 | 	unsigned long scratch; | 
 | 	long i; | 
 |  | 
 | 	if (!amd_nb_has_feature(AMD_NB_GART)) | 
 | 		return 0; | 
 |  | 
 | #ifndef CONFIG_AGP_AMD64 | 
 | 	no_agp = 1; | 
 | #else | 
 | 	/* Makefile puts PCI initialization via subsys_initcall first. */ | 
 | 	/* Add other AMD AGP bridge drivers here */ | 
 | 	no_agp = no_agp || | 
 | 		(agp_amd64_init() < 0) || | 
 | 		(agp_copy_info(agp_bridge, &info) < 0); | 
 | #endif | 
 |  | 
 | 	if (no_iommu || | 
 | 	    (!force_iommu && max_pfn <= MAX_DMA32_PFN) || | 
 | 	    !gart_iommu_aperture || | 
 | 	    (no_agp && init_amd_gatt(&info) < 0)) { | 
 | 		if (max_pfn > MAX_DMA32_PFN) { | 
 | 			pr_warning("More than 4GB of memory but GART IOMMU not available.\n"); | 
 | 			pr_warning("falling back to iommu=soft.\n"); | 
 | 		} | 
 | 		return 0; | 
 | 	} | 
 |  | 
 | 	/* need to map that range */ | 
 | 	aper_size	= info.aper_size << 20; | 
 | 	aper_base	= info.aper_base; | 
 | 	end_pfn		= (aper_base>>PAGE_SHIFT) + (aper_size>>PAGE_SHIFT); | 
 |  | 
 | 	start_pfn = PFN_DOWN(aper_base); | 
 | 	if (!pfn_range_is_mapped(start_pfn, end_pfn)) | 
 | 		init_memory_mapping(start_pfn<<PAGE_SHIFT, end_pfn<<PAGE_SHIFT); | 
 |  | 
 | 	pr_info("PCI-DMA: using GART IOMMU.\n"); | 
 | 	iommu_size = check_iommu_size(info.aper_base, aper_size); | 
 | 	iommu_pages = iommu_size >> PAGE_SHIFT; | 
 |  | 
 | 	iommu_gart_bitmap = (void *) __get_free_pages(GFP_KERNEL | __GFP_ZERO, | 
 | 						      get_order(iommu_pages/8)); | 
 | 	if (!iommu_gart_bitmap) | 
 | 		panic("Cannot allocate iommu bitmap\n"); | 
 |  | 
 | #ifdef CONFIG_IOMMU_LEAK | 
 | 	if (leak_trace) { | 
 | 		int ret; | 
 |  | 
 | 		ret = dma_debug_resize_entries(iommu_pages); | 
 | 		if (ret) | 
 | 			pr_debug("PCI-DMA: Cannot trace all the entries\n"); | 
 | 	} | 
 | #endif | 
 |  | 
 | 	/* | 
 | 	 * Out of IOMMU space handling. | 
 | 	 * Reserve some invalid pages at the beginning of the GART. | 
 | 	 */ | 
 | 	bitmap_set(iommu_gart_bitmap, 0, EMERGENCY_PAGES); | 
 |  | 
 | 	pr_info("PCI-DMA: Reserving %luMB of IOMMU area in the AGP aperture\n", | 
 | 	       iommu_size >> 20); | 
 |  | 
 | 	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); | 
 |  | 
 | 	/* | 
 | 	 * 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 | 
 | 	 * devices. | 
 | 	 */ | 
 | 	set_memory_np((unsigned long)__va(iommu_bus_base), | 
 | 				iommu_size >> PAGE_SHIFT); | 
 | 	/* | 
 | 	 * 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(); | 
 |  | 
 | 	/* | 
 | 	 * 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(); | 
 |  | 
 | 	/* | 
 | 	 * Try to workaround a bug (thanks to BenH): | 
 | 	 * Set unmapped entries to a scratch page instead of 0. | 
 | 	 * Any prefetches that hit unmapped entries won't get an bus abort | 
 | 	 * then. (P2P bridge may be prefetching on DMA reads). | 
 | 	 */ | 
 | 	scratch = get_zeroed_page(GFP_KERNEL); | 
 | 	if (!scratch) | 
 | 		panic("Cannot allocate iommu scratch page"); | 
 | 	gart_unmapped_entry = GPTE_ENCODE(__pa(scratch)); | 
 | 	for (i = EMERGENCY_PAGES; i < iommu_pages; i++) | 
 | 		iommu_gatt_base[i] = gart_unmapped_entry; | 
 |  | 
 | 	flush_gart(); | 
 | 	dma_ops = &gart_dma_ops; | 
 | 	x86_platform.iommu_shutdown = gart_iommu_shutdown; | 
 | 	swiotlb = 0; | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | void __init gart_parse_options(char *p) | 
 | { | 
 | 	int arg; | 
 |  | 
 | #ifdef CONFIG_IOMMU_LEAK | 
 | 	if (!strncmp(p, "leak", 4)) { | 
 | 		leak_trace = 1; | 
 | 		p += 4; | 
 | 		if (*p == '=') | 
 | 			++p; | 
 | 		if (isdigit(*p) && get_option(&p, &arg)) | 
 | 			iommu_leak_pages = arg; | 
 | 	} | 
 | #endif | 
 | 	if (isdigit(*p) && get_option(&p, &arg)) | 
 | 		iommu_size = arg; | 
 | 	if (!strncmp(p, "fullflush", 9)) | 
 | 		iommu_fullflush = 1; | 
 | 	if (!strncmp(p, "nofullflush", 11)) | 
 | 		iommu_fullflush = 0; | 
 | 	if (!strncmp(p, "noagp", 5)) | 
 | 		no_agp = 1; | 
 | 	if (!strncmp(p, "noaperture", 10)) | 
 | 		fix_aperture = 0; | 
 | 	/* duplicated from pci-dma.c */ | 
 | 	if (!strncmp(p, "force", 5)) | 
 | 		gart_iommu_aperture_allowed = 1; | 
 | 	if (!strncmp(p, "allowed", 7)) | 
 | 		gart_iommu_aperture_allowed = 1; | 
 | 	if (!strncmp(p, "memaper", 7)) { | 
 | 		fallback_aper_force = 1; | 
 | 		p += 7; | 
 | 		if (*p == '=') { | 
 | 			++p; | 
 | 			if (get_option(&p, &arg)) | 
 | 				fallback_aper_order = arg; | 
 | 		} | 
 | 	} | 
 | } | 
 | IOMMU_INIT_POST(gart_iommu_hole_init); |