Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * arch/parisc/mm/ioremap.c |
| 3 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4 | * (C) Copyright 1995 1996 Linus Torvalds |
| 5 | * (C) Copyright 2001 Helge Deller <deller@gmx.de> |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 6 | * (C) Copyright 2005 Kyle McMartin <kyle@parisc-linux.org> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 7 | */ |
| 8 | |
| 9 | #include <linux/vmalloc.h> |
| 10 | #include <linux/errno.h> |
| 11 | #include <linux/module.h> |
| 12 | #include <asm/io.h> |
| 13 | #include <asm/pgalloc.h> |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 14 | #include <asm/tlbflush.h> |
| 15 | #include <asm/cacheflush.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 | |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 17 | static inline void |
| 18 | remap_area_pte(pte_t *pte, unsigned long address, unsigned long size, |
| 19 | unsigned long phys_addr, unsigned long flags) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 20 | { |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 21 | unsigned long end, pfn; |
| 22 | pgprot_t pgprot = __pgprot(_PAGE_PRESENT | _PAGE_RW | _PAGE_DIRTY | |
| 23 | _PAGE_ACCESSED | flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 24 | |
| 25 | address &= ~PMD_MASK; |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 26 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 27 | end = address + size; |
| 28 | if (end > PMD_SIZE) |
| 29 | end = PMD_SIZE; |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 30 | |
| 31 | BUG_ON(address >= end); |
| 32 | |
| 33 | pfn = phys_addr >> PAGE_SHIFT; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 34 | do { |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 35 | BUG_ON(!pte_none(*pte)); |
| 36 | |
| 37 | set_pte(pte, pfn_pte(pfn, pgprot)); |
| 38 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 39 | address += PAGE_SIZE; |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 40 | pfn++; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 41 | pte++; |
| 42 | } while (address && (address < end)); |
| 43 | } |
| 44 | |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 45 | static inline int |
| 46 | remap_area_pmd(pmd_t *pmd, unsigned long address, unsigned long size, |
| 47 | unsigned long phys_addr, unsigned long flags) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 48 | { |
| 49 | unsigned long end; |
| 50 | |
| 51 | address &= ~PGDIR_MASK; |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 52 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 | end = address + size; |
| 54 | if (end > PGDIR_SIZE) |
| 55 | end = PGDIR_SIZE; |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 56 | |
| 57 | BUG_ON(address >= end); |
| 58 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 59 | phys_addr -= address; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 60 | do { |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 61 | pte_t *pte = pte_alloc_kernel(pmd, address); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 62 | if (!pte) |
| 63 | return -ENOMEM; |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 64 | |
| 65 | remap_area_pte(pte, address, end - address, |
| 66 | address + phys_addr, flags); |
| 67 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 68 | address = (address + PMD_SIZE) & PMD_MASK; |
| 69 | pmd++; |
| 70 | } while (address && (address < end)); |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 71 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 72 | return 0; |
| 73 | } |
| 74 | |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 75 | static int |
| 76 | remap_area_pages(unsigned long address, unsigned long phys_addr, |
| 77 | unsigned long size, unsigned long flags) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 78 | { |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 79 | pgd_t *dir; |
| 80 | int error = 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 81 | unsigned long end = address + size; |
| 82 | |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 83 | BUG_ON(address >= end); |
| 84 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 85 | phys_addr -= address; |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 86 | dir = pgd_offset_k(address); |
| 87 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 88 | flush_cache_all(); |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 89 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 90 | do { |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 91 | pud_t *pud; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 92 | pmd_t *pmd; |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 93 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 94 | error = -ENOMEM; |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 95 | pud = pud_alloc(&init_mm, dir, address); |
| 96 | if (!pud) |
| 97 | break; |
| 98 | |
| 99 | pmd = pmd_alloc(&init_mm, pud, address); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 100 | if (!pmd) |
| 101 | break; |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 102 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 103 | if (remap_area_pmd(pmd, address, end - address, |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 104 | phys_addr + address, flags)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 105 | break; |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 106 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 107 | error = 0; |
| 108 | address = (address + PGDIR_SIZE) & PGDIR_MASK; |
| 109 | dir++; |
| 110 | } while (address && (address < end)); |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 111 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 112 | flush_tlb_all(); |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 113 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 114 | return error; |
| 115 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 116 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 117 | /* |
| 118 | * Generic mapping function (not visible outside): |
| 119 | */ |
| 120 | |
| 121 | /* |
| 122 | * Remap an arbitrary physical address space into the kernel virtual |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 123 | * address space. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 124 | * |
| 125 | * NOTE! We need to allow non-page-aligned mappings too: we will obviously |
| 126 | * have to convert them into an offset in a page-aligned mapping, but the |
| 127 | * caller shouldn't need to know that small detail. |
| 128 | */ |
| 129 | void __iomem * __ioremap(unsigned long phys_addr, unsigned long size, unsigned long flags) |
| 130 | { |
Helge Deller | cb4ab59 | 2006-03-23 00:40:10 -0700 | [diff] [blame] | 131 | void *addr; |
| 132 | struct vm_struct *area; |
| 133 | unsigned long offset, last_addr; |
| 134 | |
Helge Deller | 29ef8295 | 2006-03-23 00:32:46 -0700 | [diff] [blame] | 135 | #ifdef CONFIG_EISA |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 136 | unsigned long end = phys_addr + size - 1; |
| 137 | /* Support EISA addresses */ |
Helge Deller | 10267cd | 2006-03-26 01:54:16 -0700 | [diff] [blame] | 138 | if ((phys_addr >= 0x00080000 && end < 0x000fffff) || |
| 139 | (phys_addr >= 0x00500000 && end < 0x03bfffff)) { |
| 140 | phys_addr |= F_EXTEND(0xfc000000); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 141 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 142 | #endif |
| 143 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 144 | /* Don't allow wraparound or zero size */ |
| 145 | last_addr = phys_addr + size - 1; |
| 146 | if (!size || last_addr < phys_addr) |
| 147 | return NULL; |
| 148 | |
| 149 | /* |
| 150 | * Don't allow anybody to remap normal RAM that we're using.. |
| 151 | */ |
| 152 | if (phys_addr < virt_to_phys(high_memory)) { |
| 153 | char *t_addr, *t_end; |
| 154 | struct page *page; |
| 155 | |
| 156 | t_addr = __va(phys_addr); |
| 157 | t_end = t_addr + (size - 1); |
| 158 | |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 159 | for (page = virt_to_page(t_addr); |
| 160 | page <= virt_to_page(t_end); page++) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 161 | if(!PageReserved(page)) |
| 162 | return NULL; |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 163 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 164 | } |
| 165 | |
| 166 | /* |
| 167 | * Mappings have to be page-aligned |
| 168 | */ |
| 169 | offset = phys_addr & ~PAGE_MASK; |
| 170 | phys_addr &= PAGE_MASK; |
| 171 | size = PAGE_ALIGN(last_addr) - phys_addr; |
| 172 | |
| 173 | /* |
| 174 | * Ok, go for it.. |
| 175 | */ |
| 176 | area = get_vm_area(size, VM_IOREMAP); |
| 177 | if (!area) |
| 178 | return NULL; |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 179 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 180 | addr = area->addr; |
| 181 | if (remap_area_pages((unsigned long) addr, phys_addr, size, flags)) { |
| 182 | vfree(addr); |
| 183 | return NULL; |
| 184 | } |
Kyle McMartin | e0565a1 | 2006-01-10 20:47:52 -0500 | [diff] [blame] | 185 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 186 | return (void __iomem *) (offset + (char *)addr); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 187 | } |
Kyle McMartin | d345fd3 | 2006-03-29 15:18:32 -0700 | [diff] [blame] | 188 | EXPORT_SYMBOL(__ioremap); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 189 | |
| 190 | void iounmap(void __iomem *addr) |
| 191 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 192 | if (addr > high_memory) |
| 193 | return vfree((void *) (PAGE_MASK & (unsigned long __force) addr)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 194 | } |
Kyle McMartin | d345fd3 | 2006-03-29 15:18:32 -0700 | [diff] [blame] | 195 | EXPORT_SYMBOL(iounmap); |