1b2441318SGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0 21da177e4SLinus Torvalds /* 31da177e4SLinus Torvalds * iommu.c: IOMMU specific routines for memory management. 41da177e4SLinus Torvalds * 51da177e4SLinus Torvalds * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu) 61da177e4SLinus Torvalds * Copyright (C) 1995,2002 Pete Zaitcev (zaitcev@yahoo.com) 71da177e4SLinus Torvalds * Copyright (C) 1996 Eddie C. Dost (ecd@skynet.be) 81da177e4SLinus Torvalds * Copyright (C) 1997,1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz) 91da177e4SLinus Torvalds */ 101da177e4SLinus Torvalds 111da177e4SLinus Torvalds #include <linux/kernel.h> 121da177e4SLinus Torvalds #include <linux/init.h> 131da177e4SLinus Torvalds #include <linux/mm.h> 141da177e4SLinus Torvalds #include <linux/slab.h> 151da177e4SLinus Torvalds #include <linux/highmem.h> /* pte_offset_map => kmap_atomic */ 16ce65d36fSChristoph Hellwig #include <linux/dma-mapping.h> 179dc69230SDavid S. Miller #include <linux/of.h> 189dc69230SDavid S. Miller #include <linux/of_device.h> 191da177e4SLinus Torvalds 201da177e4SLinus Torvalds #include <asm/pgalloc.h> 211da177e4SLinus Torvalds #include <asm/pgtable.h> 221da177e4SLinus Torvalds #include <asm/io.h> 231da177e4SLinus Torvalds #include <asm/mxcc.h> 241da177e4SLinus Torvalds #include <asm/mbus.h> 251da177e4SLinus Torvalds #include <asm/cacheflush.h> 261da177e4SLinus Torvalds #include <asm/tlbflush.h> 271da177e4SLinus Torvalds #include <asm/bitext.h> 281da177e4SLinus Torvalds #include <asm/iommu.h> 291da177e4SLinus Torvalds #include <asm/dma.h> 301da177e4SLinus Torvalds 31e8c29c83SSam Ravnborg #include "mm_32.h" 32e8c29c83SSam Ravnborg 331da177e4SLinus Torvalds /* 341da177e4SLinus Torvalds * This can be sized dynamically, but we will do this 351da177e4SLinus Torvalds * only when we have a guidance about actual I/O pressures. 361da177e4SLinus Torvalds */ 371da177e4SLinus Torvalds #define IOMMU_RNGE IOMMU_RNGE_256MB 381da177e4SLinus Torvalds #define IOMMU_START 0xF0000000 391da177e4SLinus Torvalds #define IOMMU_WINSIZE (256*1024*1024U) 409a0ac1b6SAkinobu Mita #define IOMMU_NPTES (IOMMU_WINSIZE/PAGE_SIZE) /* 64K PTEs, 256KB */ 411da177e4SLinus Torvalds #define IOMMU_ORDER 6 /* 4096 * (1<<6) */ 421da177e4SLinus Torvalds 431da177e4SLinus Torvalds static int viking_flush; 441da177e4SLinus Torvalds /* viking.S */ 451da177e4SLinus Torvalds extern void viking_flush_page(unsigned long page); 461da177e4SLinus Torvalds extern void viking_mxcc_flush_page(unsigned long page); 471da177e4SLinus Torvalds 481da177e4SLinus Torvalds /* 491da177e4SLinus Torvalds * Values precomputed according to CPU type. 501da177e4SLinus Torvalds */ 511da177e4SLinus Torvalds static unsigned int ioperm_noc; /* Consistent mapping iopte flags */ 521da177e4SLinus Torvalds static pgprot_t dvma_prot; /* Consistent mapping pte flags */ 531da177e4SLinus Torvalds 541da177e4SLinus Torvalds #define IOPERM (IOPTE_CACHE | IOPTE_WRITE | IOPTE_VALID) 551da177e4SLinus Torvalds #define MKIOPTE(pfn, perm) (((((pfn)<<8) & IOPTE_PAGE) | (perm)) & ~IOPTE_WAZ) 561da177e4SLinus Torvalds 57cd4cd730SGrant Likely static void __init sbus_iommu_init(struct platform_device *op) 581da177e4SLinus Torvalds { 591da177e4SLinus Torvalds struct iommu_struct *iommu; 60e0039348SDavid S. Miller unsigned int impl, vers; 611da177e4SLinus Torvalds unsigned long *bitmap; 62f977ea49SSam Ravnborg unsigned long control; 63f977ea49SSam Ravnborg unsigned long base; 64e0039348SDavid S. Miller unsigned long tmp; 65e0039348SDavid S. Miller 6671cd03b0SJulia Lawall iommu = kmalloc(sizeof(struct iommu_struct), GFP_KERNEL); 671da177e4SLinus Torvalds if (!iommu) { 681da177e4SLinus Torvalds prom_printf("Unable to allocate iommu structure\n"); 691da177e4SLinus Torvalds prom_halt(); 701da177e4SLinus Torvalds } 71e0039348SDavid S. Miller 72046e26a8SDavid S. Miller iommu->regs = of_ioremap(&op->resource[0], 0, PAGE_SIZE * 3, 73e0039348SDavid S. Miller "iommu_regs"); 741da177e4SLinus Torvalds if (!iommu->regs) { 751da177e4SLinus Torvalds prom_printf("Cannot map IOMMU registers\n"); 761da177e4SLinus Torvalds prom_halt(); 771da177e4SLinus Torvalds } 78f977ea49SSam Ravnborg 79f977ea49SSam Ravnborg control = sbus_readl(&iommu->regs->control); 80f977ea49SSam Ravnborg impl = (control & IOMMU_CTRL_IMPL) >> 28; 81f977ea49SSam Ravnborg vers = (control & IOMMU_CTRL_VERS) >> 24; 82f977ea49SSam Ravnborg control &= ~(IOMMU_CTRL_RNGE); 83f977ea49SSam Ravnborg control |= (IOMMU_RNGE_256MB | IOMMU_CTRL_ENAB); 84f977ea49SSam Ravnborg sbus_writel(control, &iommu->regs->control); 85f977ea49SSam Ravnborg 861da177e4SLinus Torvalds iommu_invalidate(iommu->regs); 871da177e4SLinus Torvalds iommu->start = IOMMU_START; 881da177e4SLinus Torvalds iommu->end = 0xffffffff; 891da177e4SLinus Torvalds 901da177e4SLinus Torvalds /* Allocate IOMMU page table */ 911da177e4SLinus Torvalds /* Stupid alignment constraints give me a headache. 921da177e4SLinus Torvalds We need 256K or 512K or 1M or 2M area aligned to 931da177e4SLinus Torvalds its size and current gfp will fortunately give 941da177e4SLinus Torvalds it to us. */ 951da177e4SLinus Torvalds tmp = __get_free_pages(GFP_KERNEL, IOMMU_ORDER); 961da177e4SLinus Torvalds if (!tmp) { 975da444aaSAkinobu Mita prom_printf("Unable to allocate iommu table [0x%lx]\n", 981da177e4SLinus Torvalds IOMMU_NPTES * sizeof(iopte_t)); 991da177e4SLinus Torvalds prom_halt(); 1001da177e4SLinus Torvalds } 1011da177e4SLinus Torvalds iommu->page_table = (iopte_t *)tmp; 1021da177e4SLinus Torvalds 1031da177e4SLinus Torvalds /* Initialize new table. */ 1041da177e4SLinus Torvalds memset(iommu->page_table, 0, IOMMU_NPTES*sizeof(iopte_t)); 1051da177e4SLinus Torvalds flush_cache_all(); 1061da177e4SLinus Torvalds flush_tlb_all(); 107f977ea49SSam Ravnborg 108f977ea49SSam Ravnborg base = __pa((unsigned long)iommu->page_table) >> 4; 109f977ea49SSam Ravnborg sbus_writel(base, &iommu->regs->base); 1101da177e4SLinus Torvalds iommu_invalidate(iommu->regs); 1111da177e4SLinus Torvalds 1121da177e4SLinus Torvalds bitmap = kmalloc(IOMMU_NPTES>>3, GFP_KERNEL); 1131da177e4SLinus Torvalds if (!bitmap) { 1141da177e4SLinus Torvalds prom_printf("Unable to allocate iommu bitmap [%d]\n", 1151da177e4SLinus Torvalds (int)(IOMMU_NPTES>>3)); 1161da177e4SLinus Torvalds prom_halt(); 1171da177e4SLinus Torvalds } 1181da177e4SLinus Torvalds bit_map_init(&iommu->usemap, bitmap, IOMMU_NPTES); 1191da177e4SLinus Torvalds /* To be coherent on HyperSparc, the page color of DVMA 1201da177e4SLinus Torvalds * and physical addresses must match. 1211da177e4SLinus Torvalds */ 1221da177e4SLinus Torvalds if (srmmu_modtype == HyperSparc) 1231da177e4SLinus Torvalds iommu->usemap.num_colors = vac_cache_size >> PAGE_SHIFT; 1241da177e4SLinus Torvalds else 1251da177e4SLinus Torvalds iommu->usemap.num_colors = 1; 1261da177e4SLinus Torvalds 127046e26a8SDavid S. Miller printk(KERN_INFO "IOMMU: impl %d vers %d table 0x%p[%d B] map [%d b]\n", 1281da177e4SLinus Torvalds impl, vers, iommu->page_table, 1291da177e4SLinus Torvalds (int)(IOMMU_NPTES*sizeof(iopte_t)), (int)IOMMU_NPTES); 1301da177e4SLinus Torvalds 131e0039348SDavid S. Miller op->dev.archdata.iommu = iommu; 1321da177e4SLinus Torvalds } 1331da177e4SLinus Torvalds 134046e26a8SDavid S. Miller static int __init iommu_init(void) 135046e26a8SDavid S. Miller { 136046e26a8SDavid S. Miller struct device_node *dp; 137046e26a8SDavid S. Miller 138046e26a8SDavid S. Miller for_each_node_by_name(dp, "iommu") { 139cd4cd730SGrant Likely struct platform_device *op = of_find_device_by_node(dp); 140046e26a8SDavid S. Miller 141046e26a8SDavid S. Miller sbus_iommu_init(op); 142046e26a8SDavid S. Miller of_propagate_archdata(op); 143046e26a8SDavid S. Miller } 144046e26a8SDavid S. Miller 145046e26a8SDavid S. Miller return 0; 146046e26a8SDavid S. Miller } 147046e26a8SDavid S. Miller 148046e26a8SDavid S. Miller subsys_initcall(iommu_init); 149046e26a8SDavid S. Miller 1501da177e4SLinus Torvalds /* Flush the iotlb entries to ram. */ 1511da177e4SLinus Torvalds /* This could be better if we didn't have to flush whole pages. */ 1521da177e4SLinus Torvalds static void iommu_flush_iotlb(iopte_t *iopte, unsigned int niopte) 1531da177e4SLinus Torvalds { 1541da177e4SLinus Torvalds unsigned long start; 1551da177e4SLinus Torvalds unsigned long end; 1561da177e4SLinus Torvalds 1573185d4d2SBob Breuer start = (unsigned long)iopte; 1581da177e4SLinus Torvalds end = PAGE_ALIGN(start + niopte*sizeof(iopte_t)); 1593185d4d2SBob Breuer start &= PAGE_MASK; 1601da177e4SLinus Torvalds if (viking_mxcc_present) { 1611da177e4SLinus Torvalds while(start < end) { 1621da177e4SLinus Torvalds viking_mxcc_flush_page(start); 1631da177e4SLinus Torvalds start += PAGE_SIZE; 1641da177e4SLinus Torvalds } 1651da177e4SLinus Torvalds } else if (viking_flush) { 1661da177e4SLinus Torvalds while(start < end) { 1671da177e4SLinus Torvalds viking_flush_page(start); 1681da177e4SLinus Torvalds start += PAGE_SIZE; 1691da177e4SLinus Torvalds } 1701da177e4SLinus Torvalds } else { 1711da177e4SLinus Torvalds while(start < end) { 1721da177e4SLinus Torvalds __flush_page_to_ram(start); 1731da177e4SLinus Torvalds start += PAGE_SIZE; 1741da177e4SLinus Torvalds } 1751da177e4SLinus Torvalds } 1761da177e4SLinus Torvalds } 1771da177e4SLinus Torvalds 178*b8205942SChristoph Hellwig static u32 iommu_get_one(struct device *dev, phys_addr_t paddr, int npages) 1791da177e4SLinus Torvalds { 180260489faSDavid S. Miller struct iommu_struct *iommu = dev->archdata.iommu; 1811da177e4SLinus Torvalds int ioptex; 1821da177e4SLinus Torvalds iopte_t *iopte, *iopte0; 1831da177e4SLinus Torvalds unsigned int busa, busa0; 184*b8205942SChristoph Hellwig unsigned long pfn = __phys_to_pfn(paddr); 1851da177e4SLinus Torvalds int i; 1861da177e4SLinus Torvalds 1871da177e4SLinus Torvalds /* page color = pfn of page */ 188*b8205942SChristoph Hellwig ioptex = bit_map_string_get(&iommu->usemap, npages, pfn); 1891da177e4SLinus Torvalds if (ioptex < 0) 1901da177e4SLinus Torvalds panic("iommu out"); 1911da177e4SLinus Torvalds busa0 = iommu->start + (ioptex << PAGE_SHIFT); 1921da177e4SLinus Torvalds iopte0 = &iommu->page_table[ioptex]; 1931da177e4SLinus Torvalds 1941da177e4SLinus Torvalds busa = busa0; 1951da177e4SLinus Torvalds iopte = iopte0; 1961da177e4SLinus Torvalds for (i = 0; i < npages; i++) { 197*b8205942SChristoph Hellwig iopte_val(*iopte) = MKIOPTE(pfn, IOPERM); 1981da177e4SLinus Torvalds iommu_invalidate_page(iommu->regs, busa); 1991da177e4SLinus Torvalds busa += PAGE_SIZE; 2001da177e4SLinus Torvalds iopte++; 201*b8205942SChristoph Hellwig pfn++; 2021da177e4SLinus Torvalds } 2031da177e4SLinus Torvalds 2041da177e4SLinus Torvalds iommu_flush_iotlb(iopte0, npages); 2051da177e4SLinus Torvalds 2061da177e4SLinus Torvalds return busa0; 2071da177e4SLinus Torvalds } 2081da177e4SLinus Torvalds 209ce65d36fSChristoph Hellwig static dma_addr_t __sbus_iommu_map_page(struct device *dev, struct page *page, 210ce65d36fSChristoph Hellwig unsigned long offset, size_t len) 2111da177e4SLinus Torvalds { 212ce65d36fSChristoph Hellwig void *vaddr = page_address(page) + offset; 213ce65d36fSChristoph Hellwig unsigned long off = (unsigned long)vaddr & ~PAGE_MASK; 214ce65d36fSChristoph Hellwig unsigned long npages = (off + len + PAGE_SIZE - 1) >> PAGE_SHIFT; 2151da177e4SLinus Torvalds 216ce65d36fSChristoph Hellwig /* XXX So what is maxphys for us and how do drivers know it? */ 217ce65d36fSChristoph Hellwig if (!len || len > 256 * 1024) 218ce65d36fSChristoph Hellwig return DMA_MAPPING_ERROR; 219*b8205942SChristoph Hellwig return iommu_get_one(dev, virt_to_phys(vaddr), npages) + off; 2201da177e4SLinus Torvalds } 2211da177e4SLinus Torvalds 222ce65d36fSChristoph Hellwig static dma_addr_t sbus_iommu_map_page_gflush(struct device *dev, 223ce65d36fSChristoph Hellwig struct page *page, unsigned long offset, size_t len, 224ce65d36fSChristoph Hellwig enum dma_data_direction dir, unsigned long attrs) 2251da177e4SLinus Torvalds { 2261da177e4SLinus Torvalds flush_page_for_dma(0); 227ce65d36fSChristoph Hellwig return __sbus_iommu_map_page(dev, page, offset, len); 2281da177e4SLinus Torvalds } 2291da177e4SLinus Torvalds 230ce65d36fSChristoph Hellwig static dma_addr_t sbus_iommu_map_page_pflush(struct device *dev, 231ce65d36fSChristoph Hellwig struct page *page, unsigned long offset, size_t len, 232ce65d36fSChristoph Hellwig enum dma_data_direction dir, unsigned long attrs) 2331da177e4SLinus Torvalds { 234ce65d36fSChristoph Hellwig void *vaddr = page_address(page) + offset; 235ce65d36fSChristoph Hellwig unsigned long p = ((unsigned long)vaddr) & PAGE_MASK; 2361da177e4SLinus Torvalds 237ce65d36fSChristoph Hellwig while (p < (unsigned long)vaddr + len) { 238ce65d36fSChristoph Hellwig flush_page_for_dma(p); 239ce65d36fSChristoph Hellwig p += PAGE_SIZE; 2401da177e4SLinus Torvalds } 2411da177e4SLinus Torvalds 242ce65d36fSChristoph Hellwig return __sbus_iommu_map_page(dev, page, offset, len); 243ce65d36fSChristoph Hellwig } 244ce65d36fSChristoph Hellwig 245ff5cbec0SChristoph Hellwig static int __sbus_iommu_map_sg(struct device *dev, struct scatterlist *sgl, 246ff5cbec0SChristoph Hellwig int nents, enum dma_data_direction dir, unsigned long attrs, 247ff5cbec0SChristoph Hellwig bool per_page_flush) 2481da177e4SLinus Torvalds { 2491da177e4SLinus Torvalds unsigned long page, oldpage = 0; 2506c503d0dSChristoph Hellwig struct scatterlist *sg; 2516c503d0dSChristoph Hellwig int i, j, n; 2521da177e4SLinus Torvalds 2536c503d0dSChristoph Hellwig for_each_sg(sgl, sg, nents, j) { 2541da177e4SLinus Torvalds n = (sg->length + sg->offset + PAGE_SIZE-1) >> PAGE_SHIFT; 2551da177e4SLinus Torvalds 2561da177e4SLinus Torvalds /* 2571da177e4SLinus Torvalds * We expect unmapped highmem pages to be not in the cache. 2581da177e4SLinus Torvalds * XXX Is this a good assumption? 2591da177e4SLinus Torvalds * XXX What if someone else unmaps it here and races us? 2601da177e4SLinus Torvalds */ 261ff5cbec0SChristoph Hellwig if (per_page_flush && !PageHighMem(sg_page(sg))) { 262031abf0bSChristoph Hellwig page = (unsigned long)page_address(sg_page(sg)); 2631da177e4SLinus Torvalds for (i = 0; i < n; i++) { 2641da177e4SLinus Torvalds if (page != oldpage) { /* Already flushed? */ 2651da177e4SLinus Torvalds flush_page_for_dma(page); 2661da177e4SLinus Torvalds oldpage = page; 2671da177e4SLinus Torvalds } 2681da177e4SLinus Torvalds page += PAGE_SIZE; 2691da177e4SLinus Torvalds } 2701da177e4SLinus Torvalds } 2711da177e4SLinus Torvalds 272*b8205942SChristoph Hellwig sg->dma_address = iommu_get_one(dev, sg_phys(sg), n) + sg->offset; 273aa83a26aSRobert Reif sg->dma_length = sg->length; 2741da177e4SLinus Torvalds } 275ce65d36fSChristoph Hellwig 2766c503d0dSChristoph Hellwig return nents; 2771da177e4SLinus Torvalds } 2781da177e4SLinus Torvalds 279ff5cbec0SChristoph Hellwig static int sbus_iommu_map_sg_gflush(struct device *dev, struct scatterlist *sgl, 280ff5cbec0SChristoph Hellwig int nents, enum dma_data_direction dir, unsigned long attrs) 281ff5cbec0SChristoph Hellwig { 282ff5cbec0SChristoph Hellwig flush_page_for_dma(0); 283ff5cbec0SChristoph Hellwig return __sbus_iommu_map_sg(dev, sgl, nents, dir, attrs, false); 284ff5cbec0SChristoph Hellwig } 285ff5cbec0SChristoph Hellwig 286ff5cbec0SChristoph Hellwig static int sbus_iommu_map_sg_pflush(struct device *dev, struct scatterlist *sgl, 287ff5cbec0SChristoph Hellwig int nents, enum dma_data_direction dir, unsigned long attrs) 288ff5cbec0SChristoph Hellwig { 289ff5cbec0SChristoph Hellwig return __sbus_iommu_map_sg(dev, sgl, nents, dir, attrs, true); 290ff5cbec0SChristoph Hellwig } 291ff5cbec0SChristoph Hellwig 292f25b23bcSChristoph Hellwig static void sbus_iommu_unmap_page(struct device *dev, dma_addr_t dma_addr, 293f25b23bcSChristoph Hellwig size_t len, enum dma_data_direction dir, unsigned long attrs) 2941da177e4SLinus Torvalds { 295260489faSDavid S. Miller struct iommu_struct *iommu = dev->archdata.iommu; 296f25b23bcSChristoph Hellwig unsigned int busa = dma_addr & PAGE_MASK; 297f25b23bcSChristoph Hellwig unsigned long off = dma_addr & ~PAGE_MASK; 298f25b23bcSChristoph Hellwig unsigned int npages = (off + len + PAGE_SIZE-1) >> PAGE_SHIFT; 299f25b23bcSChristoph Hellwig unsigned int ioptex = (busa - iommu->start) >> PAGE_SHIFT; 300f25b23bcSChristoph Hellwig unsigned int i; 3011da177e4SLinus Torvalds 3021ae61388SEric Sesterhenn BUG_ON(busa < iommu->start); 3031da177e4SLinus Torvalds for (i = 0; i < npages; i++) { 3041da177e4SLinus Torvalds iopte_val(iommu->page_table[ioptex + i]) = 0; 3051da177e4SLinus Torvalds iommu_invalidate_page(iommu->regs, busa); 3061da177e4SLinus Torvalds busa += PAGE_SIZE; 3071da177e4SLinus Torvalds } 3081da177e4SLinus Torvalds bit_map_clear(&iommu->usemap, ioptex, npages); 3091da177e4SLinus Torvalds } 3101da177e4SLinus Torvalds 3116c503d0dSChristoph Hellwig static void sbus_iommu_unmap_sg(struct device *dev, struct scatterlist *sgl, 3126c503d0dSChristoph Hellwig int nents, enum dma_data_direction dir, unsigned long attrs) 3131da177e4SLinus Torvalds { 3146c503d0dSChristoph Hellwig struct scatterlist *sg; 315a7fce1f7SChristoph Hellwig int i; 3161da177e4SLinus Torvalds 3176c503d0dSChristoph Hellwig for_each_sg(sgl, sg, nents, i) { 318a7fce1f7SChristoph Hellwig sbus_iommu_unmap_page(dev, sg->dma_address, sg->length, dir, 319a7fce1f7SChristoph Hellwig attrs); 320aa83a26aSRobert Reif sg->dma_address = 0x21212121; 3211da177e4SLinus Torvalds } 3221da177e4SLinus Torvalds } 3231da177e4SLinus Torvalds 3241da177e4SLinus Torvalds #ifdef CONFIG_SBUS 325ce65d36fSChristoph Hellwig static void *sbus_iommu_alloc(struct device *dev, size_t len, 326ce65d36fSChristoph Hellwig dma_addr_t *dma_handle, gfp_t gfp, unsigned long attrs) 3271da177e4SLinus Torvalds { 3284b1c5df2SDavid S. Miller struct iommu_struct *iommu = dev->archdata.iommu; 329ce65d36fSChristoph Hellwig unsigned long va, addr, page, end, ret; 3301da177e4SLinus Torvalds iopte_t *iopte = iommu->page_table; 3311da177e4SLinus Torvalds iopte_t *first; 3321da177e4SLinus Torvalds int ioptex; 3331da177e4SLinus Torvalds 334ce65d36fSChristoph Hellwig /* XXX So what is maxphys for us and how do drivers know it? */ 335ce65d36fSChristoph Hellwig if (!len || len > 256 * 1024) 336ce65d36fSChristoph Hellwig return NULL; 337ce65d36fSChristoph Hellwig 338ce65d36fSChristoph Hellwig len = PAGE_ALIGN(len); 339518a2f19SChristoph Hellwig va = __get_free_pages(gfp | __GFP_ZERO, get_order(len)); 340ce65d36fSChristoph Hellwig if (va == 0) 341ce65d36fSChristoph Hellwig return NULL; 342ce65d36fSChristoph Hellwig 343ce65d36fSChristoph Hellwig addr = ret = sparc_dma_alloc_resource(dev, len); 344ce65d36fSChristoph Hellwig if (!addr) 345ce65d36fSChristoph Hellwig goto out_free_pages; 346ce65d36fSChristoph Hellwig 3471ae61388SEric Sesterhenn BUG_ON((va & ~PAGE_MASK) != 0); 3481ae61388SEric Sesterhenn BUG_ON((addr & ~PAGE_MASK) != 0); 3491ae61388SEric Sesterhenn BUG_ON((len & ~PAGE_MASK) != 0); 3501da177e4SLinus Torvalds 3511da177e4SLinus Torvalds /* page color = physical address */ 3521da177e4SLinus Torvalds ioptex = bit_map_string_get(&iommu->usemap, len >> PAGE_SHIFT, 3531da177e4SLinus Torvalds addr >> PAGE_SHIFT); 3541da177e4SLinus Torvalds if (ioptex < 0) 3551da177e4SLinus Torvalds panic("iommu out"); 3561da177e4SLinus Torvalds 3571da177e4SLinus Torvalds iopte += ioptex; 3581da177e4SLinus Torvalds first = iopte; 3591da177e4SLinus Torvalds end = addr + len; 3601da177e4SLinus Torvalds while(addr < end) { 3611da177e4SLinus Torvalds page = va; 3621da177e4SLinus Torvalds { 3631da177e4SLinus Torvalds pgd_t *pgdp; 3641da177e4SLinus Torvalds pmd_t *pmdp; 3651da177e4SLinus Torvalds pte_t *ptep; 3661da177e4SLinus Torvalds 3671da177e4SLinus Torvalds if (viking_mxcc_present) 3681da177e4SLinus Torvalds viking_mxcc_flush_page(page); 3691da177e4SLinus Torvalds else if (viking_flush) 3701da177e4SLinus Torvalds viking_flush_page(page); 3711da177e4SLinus Torvalds else 3721da177e4SLinus Torvalds __flush_page_to_ram(page); 3731da177e4SLinus Torvalds 3741da177e4SLinus Torvalds pgdp = pgd_offset(&init_mm, addr); 3751da177e4SLinus Torvalds pmdp = pmd_offset(pgdp, addr); 3761da177e4SLinus Torvalds ptep = pte_offset_map(pmdp, addr); 3771da177e4SLinus Torvalds 3781da177e4SLinus Torvalds set_pte(ptep, mk_pte(virt_to_page(page), dvma_prot)); 3791da177e4SLinus Torvalds } 3801da177e4SLinus Torvalds iopte_val(*iopte++) = 3811da177e4SLinus Torvalds MKIOPTE(page_to_pfn(virt_to_page(page)), ioperm_noc); 3821da177e4SLinus Torvalds addr += PAGE_SIZE; 3831da177e4SLinus Torvalds va += PAGE_SIZE; 3841da177e4SLinus Torvalds } 3851da177e4SLinus Torvalds /* P3: why do we need this? 3861da177e4SLinus Torvalds * 3871da177e4SLinus Torvalds * DAVEM: Because there are several aspects, none of which 3881da177e4SLinus Torvalds * are handled by a single interface. Some cpus are 3891da177e4SLinus Torvalds * completely not I/O DMA coherent, and some have 3901da177e4SLinus Torvalds * virtually indexed caches. The driver DMA flushing 3911da177e4SLinus Torvalds * methods handle the former case, but here during 3921da177e4SLinus Torvalds * IOMMU page table modifications, and usage of non-cacheable 3931da177e4SLinus Torvalds * cpu mappings of pages potentially in the cpu caches, we have 3941da177e4SLinus Torvalds * to handle the latter case as well. 3951da177e4SLinus Torvalds */ 3961da177e4SLinus Torvalds flush_cache_all(); 3971da177e4SLinus Torvalds iommu_flush_iotlb(first, len >> PAGE_SHIFT); 3981da177e4SLinus Torvalds flush_tlb_all(); 3991da177e4SLinus Torvalds iommu_invalidate(iommu->regs); 4001da177e4SLinus Torvalds 401ce65d36fSChristoph Hellwig *dma_handle = iommu->start + (ioptex << PAGE_SHIFT); 402ce65d36fSChristoph Hellwig return (void *)ret; 403ce65d36fSChristoph Hellwig 404ce65d36fSChristoph Hellwig out_free_pages: 405ce65d36fSChristoph Hellwig free_pages(va, get_order(len)); 406ce65d36fSChristoph Hellwig return NULL; 4071da177e4SLinus Torvalds } 4081da177e4SLinus Torvalds 409ce65d36fSChristoph Hellwig static void sbus_iommu_free(struct device *dev, size_t len, void *cpu_addr, 410ce65d36fSChristoph Hellwig dma_addr_t busa, unsigned long attrs) 4111da177e4SLinus Torvalds { 4124b1c5df2SDavid S. Miller struct iommu_struct *iommu = dev->archdata.iommu; 4131da177e4SLinus Torvalds iopte_t *iopte = iommu->page_table; 414ce65d36fSChristoph Hellwig struct page *page = virt_to_page(cpu_addr); 4151da177e4SLinus Torvalds int ioptex = (busa - iommu->start) >> PAGE_SHIFT; 416ce65d36fSChristoph Hellwig unsigned long end; 417ce65d36fSChristoph Hellwig 418ce65d36fSChristoph Hellwig if (!sparc_dma_free_resource(cpu_addr, len)) 419ce65d36fSChristoph Hellwig return; 4201da177e4SLinus Torvalds 4211ae61388SEric Sesterhenn BUG_ON((busa & ~PAGE_MASK) != 0); 4221ae61388SEric Sesterhenn BUG_ON((len & ~PAGE_MASK) != 0); 4231da177e4SLinus Torvalds 4241da177e4SLinus Torvalds iopte += ioptex; 4251da177e4SLinus Torvalds end = busa + len; 4261da177e4SLinus Torvalds while (busa < end) { 4271da177e4SLinus Torvalds iopte_val(*iopte++) = 0; 4281da177e4SLinus Torvalds busa += PAGE_SIZE; 4291da177e4SLinus Torvalds } 4301da177e4SLinus Torvalds flush_tlb_all(); 4311da177e4SLinus Torvalds iommu_invalidate(iommu->regs); 4321da177e4SLinus Torvalds bit_map_clear(&iommu->usemap, ioptex, len >> PAGE_SHIFT); 433ce65d36fSChristoph Hellwig 434ce65d36fSChristoph Hellwig __free_pages(page, get_order(len)); 4351da177e4SLinus Torvalds } 4361da177e4SLinus Torvalds #endif 4371da177e4SLinus Torvalds 438ce65d36fSChristoph Hellwig static const struct dma_map_ops sbus_iommu_dma_gflush_ops = { 439d894d964SDavid S. Miller #ifdef CONFIG_SBUS 440ce65d36fSChristoph Hellwig .alloc = sbus_iommu_alloc, 441ce65d36fSChristoph Hellwig .free = sbus_iommu_free, 442d894d964SDavid S. Miller #endif 443ce65d36fSChristoph Hellwig .map_page = sbus_iommu_map_page_gflush, 444ce65d36fSChristoph Hellwig .unmap_page = sbus_iommu_unmap_page, 445ce65d36fSChristoph Hellwig .map_sg = sbus_iommu_map_sg_gflush, 446ce65d36fSChristoph Hellwig .unmap_sg = sbus_iommu_unmap_sg, 447d894d964SDavid S. Miller }; 448d894d964SDavid S. Miller 449ce65d36fSChristoph Hellwig static const struct dma_map_ops sbus_iommu_dma_pflush_ops = { 450d894d964SDavid S. Miller #ifdef CONFIG_SBUS 451ce65d36fSChristoph Hellwig .alloc = sbus_iommu_alloc, 452ce65d36fSChristoph Hellwig .free = sbus_iommu_free, 453d894d964SDavid S. Miller #endif 454ce65d36fSChristoph Hellwig .map_page = sbus_iommu_map_page_pflush, 455ce65d36fSChristoph Hellwig .unmap_page = sbus_iommu_unmap_page, 456ce65d36fSChristoph Hellwig .map_sg = sbus_iommu_map_sg_pflush, 457ce65d36fSChristoph Hellwig .unmap_sg = sbus_iommu_unmap_sg, 458d894d964SDavid S. Miller }; 459d894d964SDavid S. Miller 4601da177e4SLinus Torvalds void __init ld_mmu_iommu(void) 4611da177e4SLinus Torvalds { 4625d83d666SDavid S. Miller if (flush_page_for_dma_global) { 4631da177e4SLinus Torvalds /* flush_page_for_dma flushes everything, no matter of what page is it */ 464ce65d36fSChristoph Hellwig dma_ops = &sbus_iommu_dma_gflush_ops; 4651da177e4SLinus Torvalds } else { 466ce65d36fSChristoph Hellwig dma_ops = &sbus_iommu_dma_pflush_ops; 4671da177e4SLinus Torvalds } 4681da177e4SLinus Torvalds 4691da177e4SLinus Torvalds if (viking_mxcc_present || srmmu_modtype == HyperSparc) { 4701da177e4SLinus Torvalds dvma_prot = __pgprot(SRMMU_CACHE | SRMMU_ET_PTE | SRMMU_PRIV); 4711da177e4SLinus Torvalds ioperm_noc = IOPTE_CACHE | IOPTE_WRITE | IOPTE_VALID; 4721da177e4SLinus Torvalds } else { 4731da177e4SLinus Torvalds dvma_prot = __pgprot(SRMMU_ET_PTE | SRMMU_PRIV); 4741da177e4SLinus Torvalds ioperm_noc = IOPTE_WRITE | IOPTE_VALID; 4751da177e4SLinus Torvalds } 4761da177e4SLinus Torvalds } 477