1e64c8aa0SThomas Gleixner /* 2e64c8aa0SThomas Gleixner * Re-map IO memory to kernel address space so that we can access it. 3e64c8aa0SThomas Gleixner * This is needed for high PCI addresses that aren't mapped in the 4e64c8aa0SThomas Gleixner * 640k-1MB IO memory area on PC's 5e64c8aa0SThomas Gleixner * 6e64c8aa0SThomas Gleixner * (C) Copyright 1995 1996 Linus Torvalds 7e64c8aa0SThomas Gleixner */ 8e64c8aa0SThomas Gleixner 9e64c8aa0SThomas Gleixner #include <linux/bootmem.h> 10e64c8aa0SThomas Gleixner #include <linux/init.h> 11e64c8aa0SThomas Gleixner #include <linux/io.h> 12e64c8aa0SThomas Gleixner #include <linux/module.h> 13e64c8aa0SThomas Gleixner #include <linux/slab.h> 14e64c8aa0SThomas Gleixner #include <linux/vmalloc.h> 15e64c8aa0SThomas Gleixner 16e64c8aa0SThomas Gleixner #include <asm/cacheflush.h> 17e64c8aa0SThomas Gleixner #include <asm/e820.h> 18e64c8aa0SThomas Gleixner #include <asm/fixmap.h> 19e64c8aa0SThomas Gleixner #include <asm/pgtable.h> 20e64c8aa0SThomas Gleixner #include <asm/tlbflush.h> 21f6df72e7SJeremy Fitzhardinge #include <asm/pgalloc.h> 22d7677d40Svenkatesh.pallipadi@intel.com #include <asm/pat.h> 23e64c8aa0SThomas Gleixner 24e64c8aa0SThomas Gleixner #ifdef CONFIG_X86_64 25e64c8aa0SThomas Gleixner 26e64c8aa0SThomas Gleixner unsigned long __phys_addr(unsigned long x) 27e64c8aa0SThomas Gleixner { 28e64c8aa0SThomas Gleixner if (x >= __START_KERNEL_map) 29e64c8aa0SThomas Gleixner return x - __START_KERNEL_map + phys_base; 30e64c8aa0SThomas Gleixner return x - PAGE_OFFSET; 31e64c8aa0SThomas Gleixner } 32e64c8aa0SThomas Gleixner EXPORT_SYMBOL(__phys_addr); 33e64c8aa0SThomas Gleixner 34e3100c82SThomas Gleixner static inline int phys_addr_valid(unsigned long addr) 35e3100c82SThomas Gleixner { 36e3100c82SThomas Gleixner return addr < (1UL << boot_cpu_data.x86_phys_bits); 37e3100c82SThomas Gleixner } 38e3100c82SThomas Gleixner 39e3100c82SThomas Gleixner #else 40e3100c82SThomas Gleixner 41e3100c82SThomas Gleixner static inline int phys_addr_valid(unsigned long addr) 42e3100c82SThomas Gleixner { 43e3100c82SThomas Gleixner return 1; 44e3100c82SThomas Gleixner } 45e3100c82SThomas Gleixner 46e64c8aa0SThomas Gleixner #endif 47e64c8aa0SThomas Gleixner 485f5192b9SThomas Gleixner int page_is_ram(unsigned long pagenr) 495f5192b9SThomas Gleixner { 50756a6c68SIngo Molnar resource_size_t addr, end; 515f5192b9SThomas Gleixner int i; 525f5192b9SThomas Gleixner 53d8a9e6a5SArjan van de Ven /* 54d8a9e6a5SArjan van de Ven * A special case is the first 4Kb of memory; 55d8a9e6a5SArjan van de Ven * This is a BIOS owned area, not kernel ram, but generally 56d8a9e6a5SArjan van de Ven * not listed as such in the E820 table. 57d8a9e6a5SArjan van de Ven */ 58d8a9e6a5SArjan van de Ven if (pagenr == 0) 59d8a9e6a5SArjan van de Ven return 0; 60d8a9e6a5SArjan van de Ven 61156fbc3fSArjan van de Ven /* 62156fbc3fSArjan van de Ven * Second special case: Some BIOSen report the PC BIOS 63156fbc3fSArjan van de Ven * area (640->1Mb) as ram even though it is not. 64156fbc3fSArjan van de Ven */ 65156fbc3fSArjan van de Ven if (pagenr >= (BIOS_BEGIN >> PAGE_SHIFT) && 66156fbc3fSArjan van de Ven pagenr < (BIOS_END >> PAGE_SHIFT)) 67156fbc3fSArjan van de Ven return 0; 68d8a9e6a5SArjan van de Ven 695f5192b9SThomas Gleixner for (i = 0; i < e820.nr_map; i++) { 705f5192b9SThomas Gleixner /* 715f5192b9SThomas Gleixner * Not usable memory: 725f5192b9SThomas Gleixner */ 735f5192b9SThomas Gleixner if (e820.map[i].type != E820_RAM) 745f5192b9SThomas Gleixner continue; 755f5192b9SThomas Gleixner addr = (e820.map[i].addr + PAGE_SIZE-1) >> PAGE_SHIFT; 765f5192b9SThomas Gleixner end = (e820.map[i].addr + e820.map[i].size) >> PAGE_SHIFT; 77950f9d95SThomas Gleixner 78950f9d95SThomas Gleixner 795f5192b9SThomas Gleixner if ((pagenr >= addr) && (pagenr < end)) 805f5192b9SThomas Gleixner return 1; 815f5192b9SThomas Gleixner } 825f5192b9SThomas Gleixner return 0; 835f5192b9SThomas Gleixner } 845f5192b9SThomas Gleixner 85e64c8aa0SThomas Gleixner /* 86e64c8aa0SThomas Gleixner * Fix up the linear direct mapping of the kernel to avoid cache attribute 87e64c8aa0SThomas Gleixner * conflicts. 88e64c8aa0SThomas Gleixner */ 893a96ce8cSvenkatesh.pallipadi@intel.com int ioremap_change_attr(unsigned long vaddr, unsigned long size, 903a96ce8cSvenkatesh.pallipadi@intel.com unsigned long prot_val) 91e64c8aa0SThomas Gleixner { 92d806e5eeSThomas Gleixner unsigned long nrpages = size >> PAGE_SHIFT; 9393809be8SHarvey Harrison int err; 94e64c8aa0SThomas Gleixner 953a96ce8cSvenkatesh.pallipadi@intel.com switch (prot_val) { 963a96ce8cSvenkatesh.pallipadi@intel.com case _PAGE_CACHE_UC: 97d806e5eeSThomas Gleixner default: 981219333dSvenkatesh.pallipadi@intel.com err = _set_memory_uc(vaddr, nrpages); 99d806e5eeSThomas Gleixner break; 100b310f381Svenkatesh.pallipadi@intel.com case _PAGE_CACHE_WC: 101b310f381Svenkatesh.pallipadi@intel.com err = _set_memory_wc(vaddr, nrpages); 102b310f381Svenkatesh.pallipadi@intel.com break; 1033a96ce8cSvenkatesh.pallipadi@intel.com case _PAGE_CACHE_WB: 1041219333dSvenkatesh.pallipadi@intel.com err = _set_memory_wb(vaddr, nrpages); 105d806e5eeSThomas Gleixner break; 106d806e5eeSThomas Gleixner } 107e64c8aa0SThomas Gleixner 108e64c8aa0SThomas Gleixner return err; 109e64c8aa0SThomas Gleixner } 110e64c8aa0SThomas Gleixner 111e64c8aa0SThomas Gleixner /* 112e64c8aa0SThomas Gleixner * Remap an arbitrary physical address space into the kernel virtual 113e64c8aa0SThomas Gleixner * address space. Needed when the kernel wants to access high addresses 114e64c8aa0SThomas Gleixner * directly. 115e64c8aa0SThomas Gleixner * 116e64c8aa0SThomas Gleixner * NOTE! We need to allow non-page-aligned mappings too: we will obviously 117e64c8aa0SThomas Gleixner * have to convert them into an offset in a page-aligned mapping, but the 118e64c8aa0SThomas Gleixner * caller shouldn't need to know that small detail. 119e64c8aa0SThomas Gleixner */ 120b9e76a00SLinus Torvalds static void __iomem *__ioremap(resource_size_t phys_addr, unsigned long size, 1213a96ce8cSvenkatesh.pallipadi@intel.com unsigned long prot_val) 122e64c8aa0SThomas Gleixner { 123756a6c68SIngo Molnar unsigned long pfn, offset, vaddr; 124756a6c68SIngo Molnar resource_size_t last_addr; 125e64c8aa0SThomas Gleixner struct vm_struct *area; 126d7677d40Svenkatesh.pallipadi@intel.com unsigned long new_prot_val; 127d806e5eeSThomas Gleixner pgprot_t prot; 128dee7cbb2SVenki Pallipadi int retval; 129e64c8aa0SThomas Gleixner 130e64c8aa0SThomas Gleixner /* Don't allow wraparound or zero size */ 131e64c8aa0SThomas Gleixner last_addr = phys_addr + size - 1; 132e64c8aa0SThomas Gleixner if (!size || last_addr < phys_addr) 133e64c8aa0SThomas Gleixner return NULL; 134e64c8aa0SThomas Gleixner 135e3100c82SThomas Gleixner if (!phys_addr_valid(phys_addr)) { 1366997ab49Svenkatesh.pallipadi@intel.com printk(KERN_WARNING "ioremap: invalid physical address %llx\n", 1374c8337acSRandy Dunlap (unsigned long long)phys_addr); 138e3100c82SThomas Gleixner WARN_ON_ONCE(1); 139e3100c82SThomas Gleixner return NULL; 140e3100c82SThomas Gleixner } 141e3100c82SThomas Gleixner 142e64c8aa0SThomas Gleixner /* 143e64c8aa0SThomas Gleixner * Don't remap the low PCI/ISA area, it's always mapped.. 144e64c8aa0SThomas Gleixner */ 145e64c8aa0SThomas Gleixner if (phys_addr >= ISA_START_ADDRESS && last_addr < ISA_END_ADDRESS) 146e64c8aa0SThomas Gleixner return (__force void __iomem *)phys_to_virt(phys_addr); 147e64c8aa0SThomas Gleixner 148e64c8aa0SThomas Gleixner /* 149e64c8aa0SThomas Gleixner * Don't allow anybody to remap normal RAM that we're using.. 150e64c8aa0SThomas Gleixner */ 151bdd3cee2SIngo Molnar for (pfn = phys_addr >> PAGE_SHIFT; 15238cb47baSIngo Molnar (pfn << PAGE_SHIFT) < last_addr; pfn++) { 153bdd3cee2SIngo Molnar 154ba748d22SIngo Molnar int is_ram = page_is_ram(pfn); 155ba748d22SIngo Molnar 156ba748d22SIngo Molnar if (is_ram && pfn_valid(pfn) && !PageReserved(pfn_to_page(pfn))) 157e64c8aa0SThomas Gleixner return NULL; 158ba748d22SIngo Molnar WARN_ON_ONCE(is_ram); 159e64c8aa0SThomas Gleixner } 160e64c8aa0SThomas Gleixner 161d7677d40Svenkatesh.pallipadi@intel.com /* 162d7677d40Svenkatesh.pallipadi@intel.com * Mappings have to be page-aligned 163d7677d40Svenkatesh.pallipadi@intel.com */ 164d7677d40Svenkatesh.pallipadi@intel.com offset = phys_addr & ~PAGE_MASK; 165d7677d40Svenkatesh.pallipadi@intel.com phys_addr &= PAGE_MASK; 166d7677d40Svenkatesh.pallipadi@intel.com size = PAGE_ALIGN(last_addr+1) - phys_addr; 167d7677d40Svenkatesh.pallipadi@intel.com 168dee7cbb2SVenki Pallipadi retval = reserve_memtype(phys_addr, phys_addr + size, 169dee7cbb2SVenki Pallipadi prot_val, &new_prot_val); 170dee7cbb2SVenki Pallipadi if (retval) { 171b450e5e8SVenki Pallipadi pr_debug("Warning: reserve_memtype returned %d\n", retval); 172dee7cbb2SVenki Pallipadi return NULL; 173dee7cbb2SVenki Pallipadi } 174dee7cbb2SVenki Pallipadi 175dee7cbb2SVenki Pallipadi if (prot_val != new_prot_val) { 176d7677d40Svenkatesh.pallipadi@intel.com /* 177d7677d40Svenkatesh.pallipadi@intel.com * Do not fallback to certain memory types with certain 178d7677d40Svenkatesh.pallipadi@intel.com * requested type: 179d7677d40Svenkatesh.pallipadi@intel.com * - request is uncached, return cannot be write-back 180b310f381Svenkatesh.pallipadi@intel.com * - request is uncached, return cannot be write-combine 181b310f381Svenkatesh.pallipadi@intel.com * - request is write-combine, return cannot be write-back 182d7677d40Svenkatesh.pallipadi@intel.com */ 183d7677d40Svenkatesh.pallipadi@intel.com if ((prot_val == _PAGE_CACHE_UC && 184b310f381Svenkatesh.pallipadi@intel.com (new_prot_val == _PAGE_CACHE_WB || 185b310f381Svenkatesh.pallipadi@intel.com new_prot_val == _PAGE_CACHE_WC)) || 186b310f381Svenkatesh.pallipadi@intel.com (prot_val == _PAGE_CACHE_WC && 187d7677d40Svenkatesh.pallipadi@intel.com new_prot_val == _PAGE_CACHE_WB)) { 188b450e5e8SVenki Pallipadi pr_debug( 1896997ab49Svenkatesh.pallipadi@intel.com "ioremap error for 0x%llx-0x%llx, requested 0x%lx, got 0x%lx\n", 1904c8337acSRandy Dunlap (unsigned long long)phys_addr, 1914c8337acSRandy Dunlap (unsigned long long)(phys_addr + size), 1926997ab49Svenkatesh.pallipadi@intel.com prot_val, new_prot_val); 193d7677d40Svenkatesh.pallipadi@intel.com free_memtype(phys_addr, phys_addr + size); 194d7677d40Svenkatesh.pallipadi@intel.com return NULL; 195d7677d40Svenkatesh.pallipadi@intel.com } 196d7677d40Svenkatesh.pallipadi@intel.com prot_val = new_prot_val; 197d7677d40Svenkatesh.pallipadi@intel.com } 198d7677d40Svenkatesh.pallipadi@intel.com 1993a96ce8cSvenkatesh.pallipadi@intel.com switch (prot_val) { 2003a96ce8cSvenkatesh.pallipadi@intel.com case _PAGE_CACHE_UC: 201d806e5eeSThomas Gleixner default: 20255c62682SIngo Molnar prot = PAGE_KERNEL_NOCACHE; 203d806e5eeSThomas Gleixner break; 204b310f381Svenkatesh.pallipadi@intel.com case _PAGE_CACHE_WC: 205b310f381Svenkatesh.pallipadi@intel.com prot = PAGE_KERNEL_WC; 206b310f381Svenkatesh.pallipadi@intel.com break; 2073a96ce8cSvenkatesh.pallipadi@intel.com case _PAGE_CACHE_WB: 208d806e5eeSThomas Gleixner prot = PAGE_KERNEL; 209d806e5eeSThomas Gleixner break; 210d806e5eeSThomas Gleixner } 211e64c8aa0SThomas Gleixner 212e64c8aa0SThomas Gleixner /* 213e64c8aa0SThomas Gleixner * Ok, go for it.. 214e64c8aa0SThomas Gleixner */ 215e64c8aa0SThomas Gleixner area = get_vm_area(size, VM_IOREMAP); 216e64c8aa0SThomas Gleixner if (!area) 217e64c8aa0SThomas Gleixner return NULL; 218e64c8aa0SThomas Gleixner area->phys_addr = phys_addr; 219e66aadbeSThomas Gleixner vaddr = (unsigned long) area->addr; 220e66aadbeSThomas Gleixner if (ioremap_page_range(vaddr, vaddr + size, phys_addr, prot)) { 221d7677d40Svenkatesh.pallipadi@intel.com free_memtype(phys_addr, phys_addr + size); 222b16bf712SIngo Molnar free_vm_area(area); 223e64c8aa0SThomas Gleixner return NULL; 224e64c8aa0SThomas Gleixner } 225e64c8aa0SThomas Gleixner 2263a96ce8cSvenkatesh.pallipadi@intel.com if (ioremap_change_attr(vaddr, size, prot_val) < 0) { 227d7677d40Svenkatesh.pallipadi@intel.com free_memtype(phys_addr, phys_addr + size); 228e66aadbeSThomas Gleixner vunmap(area->addr); 229e64c8aa0SThomas Gleixner return NULL; 230e64c8aa0SThomas Gleixner } 231e64c8aa0SThomas Gleixner 232e66aadbeSThomas Gleixner return (void __iomem *) (vaddr + offset); 233e64c8aa0SThomas Gleixner } 234e64c8aa0SThomas Gleixner 235e64c8aa0SThomas Gleixner /** 236e64c8aa0SThomas Gleixner * ioremap_nocache - map bus memory into CPU space 237e64c8aa0SThomas Gleixner * @offset: bus address of the memory 238e64c8aa0SThomas Gleixner * @size: size of the resource to map 239e64c8aa0SThomas Gleixner * 240e64c8aa0SThomas Gleixner * ioremap_nocache performs a platform specific sequence of operations to 241e64c8aa0SThomas Gleixner * make bus memory CPU accessible via the readb/readw/readl/writeb/ 242e64c8aa0SThomas Gleixner * writew/writel functions and the other mmio helpers. The returned 243e64c8aa0SThomas Gleixner * address is not guaranteed to be usable directly as a virtual 244e64c8aa0SThomas Gleixner * address. 245e64c8aa0SThomas Gleixner * 246e64c8aa0SThomas Gleixner * This version of ioremap ensures that the memory is marked uncachable 247e64c8aa0SThomas Gleixner * on the CPU as well as honouring existing caching rules from things like 248e64c8aa0SThomas Gleixner * the PCI bus. Note that there are other caches and buffers on many 249e64c8aa0SThomas Gleixner * busses. In particular driver authors should read up on PCI writes 250e64c8aa0SThomas Gleixner * 251e64c8aa0SThomas Gleixner * It's useful if some control registers are in such an area and 252e64c8aa0SThomas Gleixner * write combining or read caching is not desirable: 253e64c8aa0SThomas Gleixner * 254e64c8aa0SThomas Gleixner * Must be freed with iounmap. 255e64c8aa0SThomas Gleixner */ 256b9e76a00SLinus Torvalds void __iomem *ioremap_nocache(resource_size_t phys_addr, unsigned long size) 257e64c8aa0SThomas Gleixner { 2583a96ce8cSvenkatesh.pallipadi@intel.com return __ioremap(phys_addr, size, _PAGE_CACHE_UC); 259e64c8aa0SThomas Gleixner } 260e64c8aa0SThomas Gleixner EXPORT_SYMBOL(ioremap_nocache); 261e64c8aa0SThomas Gleixner 262b310f381Svenkatesh.pallipadi@intel.com /** 263b310f381Svenkatesh.pallipadi@intel.com * ioremap_wc - map memory into CPU space write combined 264b310f381Svenkatesh.pallipadi@intel.com * @offset: bus address of the memory 265b310f381Svenkatesh.pallipadi@intel.com * @size: size of the resource to map 266b310f381Svenkatesh.pallipadi@intel.com * 267b310f381Svenkatesh.pallipadi@intel.com * This version of ioremap ensures that the memory is marked write combining. 268b310f381Svenkatesh.pallipadi@intel.com * Write combining allows faster writes to some hardware devices. 269b310f381Svenkatesh.pallipadi@intel.com * 270b310f381Svenkatesh.pallipadi@intel.com * Must be freed with iounmap. 271b310f381Svenkatesh.pallipadi@intel.com */ 272b310f381Svenkatesh.pallipadi@intel.com void __iomem *ioremap_wc(unsigned long phys_addr, unsigned long size) 273b310f381Svenkatesh.pallipadi@intel.com { 274b310f381Svenkatesh.pallipadi@intel.com if (pat_wc_enabled) 275b310f381Svenkatesh.pallipadi@intel.com return __ioremap(phys_addr, size, _PAGE_CACHE_WC); 276b310f381Svenkatesh.pallipadi@intel.com else 277b310f381Svenkatesh.pallipadi@intel.com return ioremap_nocache(phys_addr, size); 278b310f381Svenkatesh.pallipadi@intel.com } 279b310f381Svenkatesh.pallipadi@intel.com EXPORT_SYMBOL(ioremap_wc); 280b310f381Svenkatesh.pallipadi@intel.com 281b9e76a00SLinus Torvalds void __iomem *ioremap_cache(resource_size_t phys_addr, unsigned long size) 2825f868152SThomas Gleixner { 2833a96ce8cSvenkatesh.pallipadi@intel.com return __ioremap(phys_addr, size, _PAGE_CACHE_WB); 2845f868152SThomas Gleixner } 2855f868152SThomas Gleixner EXPORT_SYMBOL(ioremap_cache); 2865f868152SThomas Gleixner 287e64c8aa0SThomas Gleixner /** 288e64c8aa0SThomas Gleixner * iounmap - Free a IO remapping 289e64c8aa0SThomas Gleixner * @addr: virtual address from ioremap_* 290e64c8aa0SThomas Gleixner * 291e64c8aa0SThomas Gleixner * Caller must ensure there is only one unmapping for the same pointer. 292e64c8aa0SThomas Gleixner */ 293e64c8aa0SThomas Gleixner void iounmap(volatile void __iomem *addr) 294e64c8aa0SThomas Gleixner { 295e64c8aa0SThomas Gleixner struct vm_struct *p, *o; 296e64c8aa0SThomas Gleixner 297e64c8aa0SThomas Gleixner if ((void __force *)addr <= high_memory) 298e64c8aa0SThomas Gleixner return; 299e64c8aa0SThomas Gleixner 300e64c8aa0SThomas Gleixner /* 301e64c8aa0SThomas Gleixner * __ioremap special-cases the PCI/ISA range by not instantiating a 302e64c8aa0SThomas Gleixner * vm_area and by simply returning an address into the kernel mapping 303e64c8aa0SThomas Gleixner * of ISA space. So handle that here. 304e64c8aa0SThomas Gleixner */ 305e64c8aa0SThomas Gleixner if (addr >= phys_to_virt(ISA_START_ADDRESS) && 306e64c8aa0SThomas Gleixner addr < phys_to_virt(ISA_END_ADDRESS)) 307e64c8aa0SThomas Gleixner return; 308e64c8aa0SThomas Gleixner 309e64c8aa0SThomas Gleixner addr = (volatile void __iomem *) 310e64c8aa0SThomas Gleixner (PAGE_MASK & (unsigned long __force)addr); 311e64c8aa0SThomas Gleixner 312e64c8aa0SThomas Gleixner /* Use the vm area unlocked, assuming the caller 313e64c8aa0SThomas Gleixner ensures there isn't another iounmap for the same address 314e64c8aa0SThomas Gleixner in parallel. Reuse of the virtual address is prevented by 315e64c8aa0SThomas Gleixner leaving it in the global lists until we're done with it. 316e64c8aa0SThomas Gleixner cpa takes care of the direct mappings. */ 317e64c8aa0SThomas Gleixner read_lock(&vmlist_lock); 318e64c8aa0SThomas Gleixner for (p = vmlist; p; p = p->next) { 319e64c8aa0SThomas Gleixner if (p->addr == addr) 320e64c8aa0SThomas Gleixner break; 321e64c8aa0SThomas Gleixner } 322e64c8aa0SThomas Gleixner read_unlock(&vmlist_lock); 323e64c8aa0SThomas Gleixner 324e64c8aa0SThomas Gleixner if (!p) { 325e64c8aa0SThomas Gleixner printk(KERN_ERR "iounmap: bad address %p\n", addr); 326e64c8aa0SThomas Gleixner dump_stack(); 327e64c8aa0SThomas Gleixner return; 328e64c8aa0SThomas Gleixner } 329e64c8aa0SThomas Gleixner 330d7677d40Svenkatesh.pallipadi@intel.com free_memtype(p->phys_addr, p->phys_addr + get_vm_area_size(p)); 331d7677d40Svenkatesh.pallipadi@intel.com 332e64c8aa0SThomas Gleixner /* Finally remove it */ 333e64c8aa0SThomas Gleixner o = remove_vm_area((void *)addr); 334e64c8aa0SThomas Gleixner BUG_ON(p != o || o == NULL); 335e64c8aa0SThomas Gleixner kfree(p); 336e64c8aa0SThomas Gleixner } 337e64c8aa0SThomas Gleixner EXPORT_SYMBOL(iounmap); 338e64c8aa0SThomas Gleixner 339e64c8aa0SThomas Gleixner #ifdef CONFIG_X86_32 340e64c8aa0SThomas Gleixner 341e64c8aa0SThomas Gleixner int __initdata early_ioremap_debug; 342e64c8aa0SThomas Gleixner 343e64c8aa0SThomas Gleixner static int __init early_ioremap_debug_setup(char *str) 344e64c8aa0SThomas Gleixner { 345e64c8aa0SThomas Gleixner early_ioremap_debug = 1; 346e64c8aa0SThomas Gleixner 347e64c8aa0SThomas Gleixner return 0; 348e64c8aa0SThomas Gleixner } 349e64c8aa0SThomas Gleixner early_param("early_ioremap_debug", early_ioremap_debug_setup); 350e64c8aa0SThomas Gleixner 351e64c8aa0SThomas Gleixner static __initdata int after_paging_init; 352c92a7a54SIan Campbell static pte_t bm_pte[PAGE_SIZE/sizeof(pte_t)] 353c92a7a54SIan Campbell __section(.bss.page_aligned); 354e64c8aa0SThomas Gleixner 355551889a6SIan Campbell static inline pmd_t * __init early_ioremap_pmd(unsigned long addr) 356e64c8aa0SThomas Gleixner { 35737cc8d7fSJeremy Fitzhardinge /* Don't assume we're using swapper_pg_dir at this point */ 35837cc8d7fSJeremy Fitzhardinge pgd_t *base = __va(read_cr3()); 35937cc8d7fSJeremy Fitzhardinge pgd_t *pgd = &base[pgd_index(addr)]; 360551889a6SIan Campbell pud_t *pud = pud_offset(pgd, addr); 361551889a6SIan Campbell pmd_t *pmd = pmd_offset(pud, addr); 362551889a6SIan Campbell 363551889a6SIan Campbell return pmd; 364e64c8aa0SThomas Gleixner } 365e64c8aa0SThomas Gleixner 366551889a6SIan Campbell static inline pte_t * __init early_ioremap_pte(unsigned long addr) 367e64c8aa0SThomas Gleixner { 368551889a6SIan Campbell return &bm_pte[pte_index(addr)]; 369e64c8aa0SThomas Gleixner } 370e64c8aa0SThomas Gleixner 371e64c8aa0SThomas Gleixner void __init early_ioremap_init(void) 372e64c8aa0SThomas Gleixner { 373551889a6SIan Campbell pmd_t *pmd; 374e64c8aa0SThomas Gleixner 375e64c8aa0SThomas Gleixner if (early_ioremap_debug) 376adafdf6aSIngo Molnar printk(KERN_INFO "early_ioremap_init()\n"); 377e64c8aa0SThomas Gleixner 378551889a6SIan Campbell pmd = early_ioremap_pmd(fix_to_virt(FIX_BTMAP_BEGIN)); 379e64c8aa0SThomas Gleixner memset(bm_pte, 0, sizeof(bm_pte)); 380b6fbb669SIan Campbell pmd_populate_kernel(&init_mm, pmd, bm_pte); 381551889a6SIan Campbell 382e64c8aa0SThomas Gleixner /* 383551889a6SIan Campbell * The boot-ioremap range spans multiple pmds, for which 384e64c8aa0SThomas Gleixner * we are not prepared: 385e64c8aa0SThomas Gleixner */ 386551889a6SIan Campbell if (pmd != early_ioremap_pmd(fix_to_virt(FIX_BTMAP_END))) { 387e64c8aa0SThomas Gleixner WARN_ON(1); 388551889a6SIan Campbell printk(KERN_WARNING "pmd %p != %p\n", 389551889a6SIan Campbell pmd, early_ioremap_pmd(fix_to_virt(FIX_BTMAP_END))); 390e64c8aa0SThomas Gleixner printk(KERN_WARNING "fix_to_virt(FIX_BTMAP_BEGIN): %08lx\n", 391e64c8aa0SThomas Gleixner fix_to_virt(FIX_BTMAP_BEGIN)); 392e64c8aa0SThomas Gleixner printk(KERN_WARNING "fix_to_virt(FIX_BTMAP_END): %08lx\n", 393e64c8aa0SThomas Gleixner fix_to_virt(FIX_BTMAP_END)); 394e64c8aa0SThomas Gleixner 395e64c8aa0SThomas Gleixner printk(KERN_WARNING "FIX_BTMAP_END: %d\n", FIX_BTMAP_END); 396e64c8aa0SThomas Gleixner printk(KERN_WARNING "FIX_BTMAP_BEGIN: %d\n", 397e64c8aa0SThomas Gleixner FIX_BTMAP_BEGIN); 398e64c8aa0SThomas Gleixner } 399e64c8aa0SThomas Gleixner } 400e64c8aa0SThomas Gleixner 401e64c8aa0SThomas Gleixner void __init early_ioremap_clear(void) 402e64c8aa0SThomas Gleixner { 403551889a6SIan Campbell pmd_t *pmd; 404e64c8aa0SThomas Gleixner 405e64c8aa0SThomas Gleixner if (early_ioremap_debug) 406adafdf6aSIngo Molnar printk(KERN_INFO "early_ioremap_clear()\n"); 407e64c8aa0SThomas Gleixner 408551889a6SIan Campbell pmd = early_ioremap_pmd(fix_to_virt(FIX_BTMAP_BEGIN)); 409551889a6SIan Campbell pmd_clear(pmd); 410*6944a9c8SJeremy Fitzhardinge paravirt_release_pte(__pa(bm_pte) >> PAGE_SHIFT); 411e64c8aa0SThomas Gleixner __flush_tlb_all(); 412e64c8aa0SThomas Gleixner } 413e64c8aa0SThomas Gleixner 414e64c8aa0SThomas Gleixner void __init early_ioremap_reset(void) 415e64c8aa0SThomas Gleixner { 416e64c8aa0SThomas Gleixner enum fixed_addresses idx; 417551889a6SIan Campbell unsigned long addr, phys; 418551889a6SIan Campbell pte_t *pte; 419e64c8aa0SThomas Gleixner 420e64c8aa0SThomas Gleixner after_paging_init = 1; 421e64c8aa0SThomas Gleixner for (idx = FIX_BTMAP_BEGIN; idx >= FIX_BTMAP_END; idx--) { 422e64c8aa0SThomas Gleixner addr = fix_to_virt(idx); 423e64c8aa0SThomas Gleixner pte = early_ioremap_pte(addr); 424551889a6SIan Campbell if (pte_present(*pte)) { 425551889a6SIan Campbell phys = pte_val(*pte) & PAGE_MASK; 426e64c8aa0SThomas Gleixner set_fixmap(idx, phys); 427e64c8aa0SThomas Gleixner } 428e64c8aa0SThomas Gleixner } 429e64c8aa0SThomas Gleixner } 430e64c8aa0SThomas Gleixner 431e64c8aa0SThomas Gleixner static void __init __early_set_fixmap(enum fixed_addresses idx, 432e64c8aa0SThomas Gleixner unsigned long phys, pgprot_t flags) 433e64c8aa0SThomas Gleixner { 434551889a6SIan Campbell unsigned long addr = __fix_to_virt(idx); 435551889a6SIan Campbell pte_t *pte; 436e64c8aa0SThomas Gleixner 437e64c8aa0SThomas Gleixner if (idx >= __end_of_fixed_addresses) { 438e64c8aa0SThomas Gleixner BUG(); 439e64c8aa0SThomas Gleixner return; 440e64c8aa0SThomas Gleixner } 441e64c8aa0SThomas Gleixner pte = early_ioremap_pte(addr); 442e64c8aa0SThomas Gleixner if (pgprot_val(flags)) 443551889a6SIan Campbell set_pte(pte, pfn_pte(phys >> PAGE_SHIFT, flags)); 444e64c8aa0SThomas Gleixner else 445551889a6SIan Campbell pte_clear(NULL, addr, pte); 446e64c8aa0SThomas Gleixner __flush_tlb_one(addr); 447e64c8aa0SThomas Gleixner } 448e64c8aa0SThomas Gleixner 449e64c8aa0SThomas Gleixner static inline void __init early_set_fixmap(enum fixed_addresses idx, 450e64c8aa0SThomas Gleixner unsigned long phys) 451e64c8aa0SThomas Gleixner { 452e64c8aa0SThomas Gleixner if (after_paging_init) 453e64c8aa0SThomas Gleixner set_fixmap(idx, phys); 454e64c8aa0SThomas Gleixner else 455e64c8aa0SThomas Gleixner __early_set_fixmap(idx, phys, PAGE_KERNEL); 456e64c8aa0SThomas Gleixner } 457e64c8aa0SThomas Gleixner 458e64c8aa0SThomas Gleixner static inline void __init early_clear_fixmap(enum fixed_addresses idx) 459e64c8aa0SThomas Gleixner { 460e64c8aa0SThomas Gleixner if (after_paging_init) 461e64c8aa0SThomas Gleixner clear_fixmap(idx); 462e64c8aa0SThomas Gleixner else 463e64c8aa0SThomas Gleixner __early_set_fixmap(idx, 0, __pgprot(0)); 464e64c8aa0SThomas Gleixner } 465e64c8aa0SThomas Gleixner 466e64c8aa0SThomas Gleixner 467e64c8aa0SThomas Gleixner int __initdata early_ioremap_nested; 468e64c8aa0SThomas Gleixner 469e64c8aa0SThomas Gleixner static int __init check_early_ioremap_leak(void) 470e64c8aa0SThomas Gleixner { 471e64c8aa0SThomas Gleixner if (!early_ioremap_nested) 472e64c8aa0SThomas Gleixner return 0; 473e64c8aa0SThomas Gleixner 474e64c8aa0SThomas Gleixner printk(KERN_WARNING 475e64c8aa0SThomas Gleixner "Debug warning: early ioremap leak of %d areas detected.\n", 476e64c8aa0SThomas Gleixner early_ioremap_nested); 477e64c8aa0SThomas Gleixner printk(KERN_WARNING 478e64c8aa0SThomas Gleixner "please boot with early_ioremap_debug and report the dmesg.\n"); 479e64c8aa0SThomas Gleixner WARN_ON(1); 480e64c8aa0SThomas Gleixner 481e64c8aa0SThomas Gleixner return 1; 482e64c8aa0SThomas Gleixner } 483e64c8aa0SThomas Gleixner late_initcall(check_early_ioremap_leak); 484e64c8aa0SThomas Gleixner 485e64c8aa0SThomas Gleixner void __init *early_ioremap(unsigned long phys_addr, unsigned long size) 486e64c8aa0SThomas Gleixner { 487e64c8aa0SThomas Gleixner unsigned long offset, last_addr; 488e64c8aa0SThomas Gleixner unsigned int nrpages, nesting; 489e64c8aa0SThomas Gleixner enum fixed_addresses idx0, idx; 490e64c8aa0SThomas Gleixner 491e64c8aa0SThomas Gleixner WARN_ON(system_state != SYSTEM_BOOTING); 492e64c8aa0SThomas Gleixner 493e64c8aa0SThomas Gleixner nesting = early_ioremap_nested; 494e64c8aa0SThomas Gleixner if (early_ioremap_debug) { 495adafdf6aSIngo Molnar printk(KERN_INFO "early_ioremap(%08lx, %08lx) [%d] => ", 496e64c8aa0SThomas Gleixner phys_addr, size, nesting); 497e64c8aa0SThomas Gleixner dump_stack(); 498e64c8aa0SThomas Gleixner } 499e64c8aa0SThomas Gleixner 500e64c8aa0SThomas Gleixner /* Don't allow wraparound or zero size */ 501e64c8aa0SThomas Gleixner last_addr = phys_addr + size - 1; 502e64c8aa0SThomas Gleixner if (!size || last_addr < phys_addr) { 503e64c8aa0SThomas Gleixner WARN_ON(1); 504e64c8aa0SThomas Gleixner return NULL; 505e64c8aa0SThomas Gleixner } 506e64c8aa0SThomas Gleixner 507e64c8aa0SThomas Gleixner if (nesting >= FIX_BTMAPS_NESTING) { 508e64c8aa0SThomas Gleixner WARN_ON(1); 509e64c8aa0SThomas Gleixner return NULL; 510e64c8aa0SThomas Gleixner } 511e64c8aa0SThomas Gleixner early_ioremap_nested++; 512e64c8aa0SThomas Gleixner /* 513e64c8aa0SThomas Gleixner * Mappings have to be page-aligned 514e64c8aa0SThomas Gleixner */ 515e64c8aa0SThomas Gleixner offset = phys_addr & ~PAGE_MASK; 516e64c8aa0SThomas Gleixner phys_addr &= PAGE_MASK; 517e64c8aa0SThomas Gleixner size = PAGE_ALIGN(last_addr) - phys_addr; 518e64c8aa0SThomas Gleixner 519e64c8aa0SThomas Gleixner /* 520e64c8aa0SThomas Gleixner * Mappings have to fit in the FIX_BTMAP area. 521e64c8aa0SThomas Gleixner */ 522e64c8aa0SThomas Gleixner nrpages = size >> PAGE_SHIFT; 523e64c8aa0SThomas Gleixner if (nrpages > NR_FIX_BTMAPS) { 524e64c8aa0SThomas Gleixner WARN_ON(1); 525e64c8aa0SThomas Gleixner return NULL; 526e64c8aa0SThomas Gleixner } 527e64c8aa0SThomas Gleixner 528e64c8aa0SThomas Gleixner /* 529e64c8aa0SThomas Gleixner * Ok, go for it.. 530e64c8aa0SThomas Gleixner */ 531e64c8aa0SThomas Gleixner idx0 = FIX_BTMAP_BEGIN - NR_FIX_BTMAPS*nesting; 532e64c8aa0SThomas Gleixner idx = idx0; 533e64c8aa0SThomas Gleixner while (nrpages > 0) { 534e64c8aa0SThomas Gleixner early_set_fixmap(idx, phys_addr); 535e64c8aa0SThomas Gleixner phys_addr += PAGE_SIZE; 536e64c8aa0SThomas Gleixner --idx; 537e64c8aa0SThomas Gleixner --nrpages; 538e64c8aa0SThomas Gleixner } 539e64c8aa0SThomas Gleixner if (early_ioremap_debug) 540e64c8aa0SThomas Gleixner printk(KERN_CONT "%08lx + %08lx\n", offset, fix_to_virt(idx0)); 541e64c8aa0SThomas Gleixner 542e64c8aa0SThomas Gleixner return (void *) (offset + fix_to_virt(idx0)); 543e64c8aa0SThomas Gleixner } 544e64c8aa0SThomas Gleixner 545e64c8aa0SThomas Gleixner void __init early_iounmap(void *addr, unsigned long size) 546e64c8aa0SThomas Gleixner { 547e64c8aa0SThomas Gleixner unsigned long virt_addr; 548e64c8aa0SThomas Gleixner unsigned long offset; 549e64c8aa0SThomas Gleixner unsigned int nrpages; 550e64c8aa0SThomas Gleixner enum fixed_addresses idx; 551e64c8aa0SThomas Gleixner unsigned int nesting; 552e64c8aa0SThomas Gleixner 553e64c8aa0SThomas Gleixner nesting = --early_ioremap_nested; 554e64c8aa0SThomas Gleixner WARN_ON(nesting < 0); 555e64c8aa0SThomas Gleixner 556e64c8aa0SThomas Gleixner if (early_ioremap_debug) { 557adafdf6aSIngo Molnar printk(KERN_INFO "early_iounmap(%p, %08lx) [%d]\n", addr, 558e64c8aa0SThomas Gleixner size, nesting); 559e64c8aa0SThomas Gleixner dump_stack(); 560e64c8aa0SThomas Gleixner } 561e64c8aa0SThomas Gleixner 562e64c8aa0SThomas Gleixner virt_addr = (unsigned long)addr; 563e64c8aa0SThomas Gleixner if (virt_addr < fix_to_virt(FIX_BTMAP_BEGIN)) { 564e64c8aa0SThomas Gleixner WARN_ON(1); 565e64c8aa0SThomas Gleixner return; 566e64c8aa0SThomas Gleixner } 567e64c8aa0SThomas Gleixner offset = virt_addr & ~PAGE_MASK; 568e64c8aa0SThomas Gleixner nrpages = PAGE_ALIGN(offset + size - 1) >> PAGE_SHIFT; 569e64c8aa0SThomas Gleixner 570e64c8aa0SThomas Gleixner idx = FIX_BTMAP_BEGIN - NR_FIX_BTMAPS*nesting; 571e64c8aa0SThomas Gleixner while (nrpages > 0) { 572e64c8aa0SThomas Gleixner early_clear_fixmap(idx); 573e64c8aa0SThomas Gleixner --idx; 574e64c8aa0SThomas Gleixner --nrpages; 575e64c8aa0SThomas Gleixner } 576e64c8aa0SThomas Gleixner } 577e64c8aa0SThomas Gleixner 578e64c8aa0SThomas Gleixner void __this_fixmap_does_not_exist(void) 579e64c8aa0SThomas Gleixner { 580e64c8aa0SThomas Gleixner WARN_ON(1); 581e64c8aa0SThomas Gleixner } 582e64c8aa0SThomas Gleixner 583e64c8aa0SThomas Gleixner #endif /* CONFIG_X86_32 */ 584