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> 22e64c8aa0SThomas Gleixner 23d806e5eeSThomas Gleixner enum ioremap_mode { 24d806e5eeSThomas Gleixner IOR_MODE_UNCACHED, 25d806e5eeSThomas Gleixner IOR_MODE_CACHED, 26d806e5eeSThomas Gleixner }; 27d806e5eeSThomas Gleixner 28e64c8aa0SThomas Gleixner #ifdef CONFIG_X86_64 29e64c8aa0SThomas Gleixner 30e64c8aa0SThomas Gleixner unsigned long __phys_addr(unsigned long x) 31e64c8aa0SThomas Gleixner { 32e64c8aa0SThomas Gleixner if (x >= __START_KERNEL_map) 33e64c8aa0SThomas Gleixner return x - __START_KERNEL_map + phys_base; 34e64c8aa0SThomas Gleixner return x - PAGE_OFFSET; 35e64c8aa0SThomas Gleixner } 36e64c8aa0SThomas Gleixner EXPORT_SYMBOL(__phys_addr); 37e64c8aa0SThomas Gleixner 38e64c8aa0SThomas Gleixner #endif 39e64c8aa0SThomas Gleixner 405f5192b9SThomas Gleixner int page_is_ram(unsigned long pagenr) 415f5192b9SThomas Gleixner { 425f5192b9SThomas Gleixner unsigned long addr, end; 435f5192b9SThomas Gleixner int i; 445f5192b9SThomas Gleixner 45d8a9e6a5SArjan van de Ven /* 46d8a9e6a5SArjan van de Ven * A special case is the first 4Kb of memory; 47d8a9e6a5SArjan van de Ven * This is a BIOS owned area, not kernel ram, but generally 48d8a9e6a5SArjan van de Ven * not listed as such in the E820 table. 49d8a9e6a5SArjan van de Ven */ 50d8a9e6a5SArjan van de Ven if (pagenr == 0) 51d8a9e6a5SArjan van de Ven return 0; 52d8a9e6a5SArjan van de Ven 53*156fbc3fSArjan van de Ven /* 54*156fbc3fSArjan van de Ven * Second special case: Some BIOSen report the PC BIOS 55*156fbc3fSArjan van de Ven * area (640->1Mb) as ram even though it is not. 56*156fbc3fSArjan van de Ven */ 57*156fbc3fSArjan van de Ven if (pagenr >= (BIOS_BEGIN >> PAGE_SHIFT) && 58*156fbc3fSArjan van de Ven pagenr < (BIOS_END >> PAGE_SHIFT)) 59*156fbc3fSArjan van de Ven return 0; 60d8a9e6a5SArjan van de Ven 615f5192b9SThomas Gleixner for (i = 0; i < e820.nr_map; i++) { 625f5192b9SThomas Gleixner /* 635f5192b9SThomas Gleixner * Not usable memory: 645f5192b9SThomas Gleixner */ 655f5192b9SThomas Gleixner if (e820.map[i].type != E820_RAM) 665f5192b9SThomas Gleixner continue; 675f5192b9SThomas Gleixner addr = (e820.map[i].addr + PAGE_SIZE-1) >> PAGE_SHIFT; 685f5192b9SThomas Gleixner end = (e820.map[i].addr + e820.map[i].size) >> PAGE_SHIFT; 69950f9d95SThomas Gleixner 70950f9d95SThomas Gleixner 715f5192b9SThomas Gleixner if ((pagenr >= addr) && (pagenr < end)) 725f5192b9SThomas Gleixner return 1; 735f5192b9SThomas Gleixner } 745f5192b9SThomas Gleixner return 0; 755f5192b9SThomas Gleixner } 765f5192b9SThomas Gleixner 77e64c8aa0SThomas Gleixner /* 78e64c8aa0SThomas Gleixner * Fix up the linear direct mapping of the kernel to avoid cache attribute 79e64c8aa0SThomas Gleixner * conflicts. 80e64c8aa0SThomas Gleixner */ 8175ab43bfSThomas Gleixner static int ioremap_change_attr(unsigned long vaddr, unsigned long size, 82d806e5eeSThomas Gleixner enum ioremap_mode mode) 83e64c8aa0SThomas Gleixner { 84d806e5eeSThomas Gleixner unsigned long nrpages = size >> PAGE_SHIFT; 8593809be8SHarvey Harrison int err; 86e64c8aa0SThomas Gleixner 87d806e5eeSThomas Gleixner switch (mode) { 88d806e5eeSThomas Gleixner case IOR_MODE_UNCACHED: 89d806e5eeSThomas Gleixner default: 90d806e5eeSThomas Gleixner err = set_memory_uc(vaddr, nrpages); 91d806e5eeSThomas Gleixner break; 92d806e5eeSThomas Gleixner case IOR_MODE_CACHED: 93d806e5eeSThomas Gleixner err = set_memory_wb(vaddr, nrpages); 94d806e5eeSThomas Gleixner break; 95d806e5eeSThomas Gleixner } 96e64c8aa0SThomas Gleixner 97e64c8aa0SThomas Gleixner return err; 98e64c8aa0SThomas Gleixner } 99e64c8aa0SThomas Gleixner 100e64c8aa0SThomas Gleixner /* 101e64c8aa0SThomas Gleixner * Remap an arbitrary physical address space into the kernel virtual 102e64c8aa0SThomas Gleixner * address space. Needed when the kernel wants to access high addresses 103e64c8aa0SThomas Gleixner * directly. 104e64c8aa0SThomas Gleixner * 105e64c8aa0SThomas Gleixner * NOTE! We need to allow non-page-aligned mappings too: we will obviously 106e64c8aa0SThomas Gleixner * have to convert them into an offset in a page-aligned mapping, but the 107e64c8aa0SThomas Gleixner * caller shouldn't need to know that small detail. 108e64c8aa0SThomas Gleixner */ 1095f868152SThomas Gleixner static void __iomem *__ioremap(unsigned long phys_addr, unsigned long size, 110d806e5eeSThomas Gleixner enum ioremap_mode mode) 111e64c8aa0SThomas Gleixner { 112e66aadbeSThomas Gleixner unsigned long pfn, offset, last_addr, vaddr; 113e64c8aa0SThomas Gleixner struct vm_struct *area; 114d806e5eeSThomas Gleixner pgprot_t prot; 115e64c8aa0SThomas Gleixner 116e64c8aa0SThomas Gleixner /* Don't allow wraparound or zero size */ 117e64c8aa0SThomas Gleixner last_addr = phys_addr + size - 1; 118e64c8aa0SThomas Gleixner if (!size || last_addr < phys_addr) 119e64c8aa0SThomas Gleixner return NULL; 120e64c8aa0SThomas Gleixner 121e64c8aa0SThomas Gleixner /* 122e64c8aa0SThomas Gleixner * Don't remap the low PCI/ISA area, it's always mapped.. 123e64c8aa0SThomas Gleixner */ 124e64c8aa0SThomas Gleixner if (phys_addr >= ISA_START_ADDRESS && last_addr < ISA_END_ADDRESS) 125e64c8aa0SThomas Gleixner return (__force void __iomem *)phys_to_virt(phys_addr); 126e64c8aa0SThomas Gleixner 127e64c8aa0SThomas Gleixner /* 128e64c8aa0SThomas Gleixner * Don't allow anybody to remap normal RAM that we're using.. 129e64c8aa0SThomas Gleixner */ 13038cb47baSIngo Molnar for (pfn = phys_addr >> PAGE_SHIFT; pfn < max_pfn_mapped && 13138cb47baSIngo Molnar (pfn << PAGE_SHIFT) < last_addr; pfn++) { 13238cb47baSIngo Molnar if (page_is_ram(pfn) && pfn_valid(pfn) && 13338cb47baSIngo Molnar !PageReserved(pfn_to_page(pfn))) 134e64c8aa0SThomas Gleixner return NULL; 135e64c8aa0SThomas Gleixner } 136e64c8aa0SThomas Gleixner 137d806e5eeSThomas Gleixner switch (mode) { 138d806e5eeSThomas Gleixner case IOR_MODE_UNCACHED: 139d806e5eeSThomas Gleixner default: 140d806e5eeSThomas Gleixner prot = PAGE_KERNEL_NOCACHE; 141d806e5eeSThomas Gleixner break; 142d806e5eeSThomas Gleixner case IOR_MODE_CACHED: 143d806e5eeSThomas Gleixner prot = PAGE_KERNEL; 144d806e5eeSThomas Gleixner break; 145d806e5eeSThomas Gleixner } 146e64c8aa0SThomas Gleixner 147e64c8aa0SThomas Gleixner /* 148e64c8aa0SThomas Gleixner * Mappings have to be page-aligned 149e64c8aa0SThomas Gleixner */ 150e64c8aa0SThomas Gleixner offset = phys_addr & ~PAGE_MASK; 151e64c8aa0SThomas Gleixner phys_addr &= PAGE_MASK; 152e64c8aa0SThomas Gleixner size = PAGE_ALIGN(last_addr+1) - phys_addr; 153e64c8aa0SThomas Gleixner 154e64c8aa0SThomas Gleixner /* 155e64c8aa0SThomas Gleixner * Ok, go for it.. 156e64c8aa0SThomas Gleixner */ 157e64c8aa0SThomas Gleixner area = get_vm_area(size, VM_IOREMAP); 158e64c8aa0SThomas Gleixner if (!area) 159e64c8aa0SThomas Gleixner return NULL; 160e64c8aa0SThomas Gleixner area->phys_addr = phys_addr; 161e66aadbeSThomas Gleixner vaddr = (unsigned long) area->addr; 162e66aadbeSThomas Gleixner if (ioremap_page_range(vaddr, vaddr + size, phys_addr, prot)) { 163e66aadbeSThomas Gleixner remove_vm_area((void *)(vaddr & PAGE_MASK)); 164e64c8aa0SThomas Gleixner return NULL; 165e64c8aa0SThomas Gleixner } 166e64c8aa0SThomas Gleixner 16775ab43bfSThomas Gleixner if (ioremap_change_attr(vaddr, size, mode) < 0) { 168e66aadbeSThomas Gleixner vunmap(area->addr); 169e64c8aa0SThomas Gleixner return NULL; 170e64c8aa0SThomas Gleixner } 171e64c8aa0SThomas Gleixner 172e66aadbeSThomas Gleixner return (void __iomem *) (vaddr + offset); 173e64c8aa0SThomas Gleixner } 174e64c8aa0SThomas Gleixner 175e64c8aa0SThomas Gleixner /** 176e64c8aa0SThomas Gleixner * ioremap_nocache - map bus memory into CPU space 177e64c8aa0SThomas Gleixner * @offset: bus address of the memory 178e64c8aa0SThomas Gleixner * @size: size of the resource to map 179e64c8aa0SThomas Gleixner * 180e64c8aa0SThomas Gleixner * ioremap_nocache performs a platform specific sequence of operations to 181e64c8aa0SThomas Gleixner * make bus memory CPU accessible via the readb/readw/readl/writeb/ 182e64c8aa0SThomas Gleixner * writew/writel functions and the other mmio helpers. The returned 183e64c8aa0SThomas Gleixner * address is not guaranteed to be usable directly as a virtual 184e64c8aa0SThomas Gleixner * address. 185e64c8aa0SThomas Gleixner * 186e64c8aa0SThomas Gleixner * This version of ioremap ensures that the memory is marked uncachable 187e64c8aa0SThomas Gleixner * on the CPU as well as honouring existing caching rules from things like 188e64c8aa0SThomas Gleixner * the PCI bus. Note that there are other caches and buffers on many 189e64c8aa0SThomas Gleixner * busses. In particular driver authors should read up on PCI writes 190e64c8aa0SThomas Gleixner * 191e64c8aa0SThomas Gleixner * It's useful if some control registers are in such an area and 192e64c8aa0SThomas Gleixner * write combining or read caching is not desirable: 193e64c8aa0SThomas Gleixner * 194e64c8aa0SThomas Gleixner * Must be freed with iounmap. 195e64c8aa0SThomas Gleixner */ 196e64c8aa0SThomas Gleixner void __iomem *ioremap_nocache(unsigned long phys_addr, unsigned long size) 197e64c8aa0SThomas Gleixner { 198d806e5eeSThomas Gleixner return __ioremap(phys_addr, size, IOR_MODE_UNCACHED); 199e64c8aa0SThomas Gleixner } 200e64c8aa0SThomas Gleixner EXPORT_SYMBOL(ioremap_nocache); 201e64c8aa0SThomas Gleixner 2025f868152SThomas Gleixner void __iomem *ioremap_cache(unsigned long phys_addr, unsigned long size) 2035f868152SThomas Gleixner { 204d806e5eeSThomas Gleixner return __ioremap(phys_addr, size, IOR_MODE_CACHED); 2055f868152SThomas Gleixner } 2065f868152SThomas Gleixner EXPORT_SYMBOL(ioremap_cache); 2075f868152SThomas Gleixner 208e64c8aa0SThomas Gleixner /** 209e64c8aa0SThomas Gleixner * iounmap - Free a IO remapping 210e64c8aa0SThomas Gleixner * @addr: virtual address from ioremap_* 211e64c8aa0SThomas Gleixner * 212e64c8aa0SThomas Gleixner * Caller must ensure there is only one unmapping for the same pointer. 213e64c8aa0SThomas Gleixner */ 214e64c8aa0SThomas Gleixner void iounmap(volatile void __iomem *addr) 215e64c8aa0SThomas Gleixner { 216e64c8aa0SThomas Gleixner struct vm_struct *p, *o; 217e64c8aa0SThomas Gleixner 218e64c8aa0SThomas Gleixner if ((void __force *)addr <= high_memory) 219e64c8aa0SThomas Gleixner return; 220e64c8aa0SThomas Gleixner 221e64c8aa0SThomas Gleixner /* 222e64c8aa0SThomas Gleixner * __ioremap special-cases the PCI/ISA range by not instantiating a 223e64c8aa0SThomas Gleixner * vm_area and by simply returning an address into the kernel mapping 224e64c8aa0SThomas Gleixner * of ISA space. So handle that here. 225e64c8aa0SThomas Gleixner */ 226e64c8aa0SThomas Gleixner if (addr >= phys_to_virt(ISA_START_ADDRESS) && 227e64c8aa0SThomas Gleixner addr < phys_to_virt(ISA_END_ADDRESS)) 228e64c8aa0SThomas Gleixner return; 229e64c8aa0SThomas Gleixner 230e64c8aa0SThomas Gleixner addr = (volatile void __iomem *) 231e64c8aa0SThomas Gleixner (PAGE_MASK & (unsigned long __force)addr); 232e64c8aa0SThomas Gleixner 233e64c8aa0SThomas Gleixner /* Use the vm area unlocked, assuming the caller 234e64c8aa0SThomas Gleixner ensures there isn't another iounmap for the same address 235e64c8aa0SThomas Gleixner in parallel. Reuse of the virtual address is prevented by 236e64c8aa0SThomas Gleixner leaving it in the global lists until we're done with it. 237e64c8aa0SThomas Gleixner cpa takes care of the direct mappings. */ 238e64c8aa0SThomas Gleixner read_lock(&vmlist_lock); 239e64c8aa0SThomas Gleixner for (p = vmlist; p; p = p->next) { 240e64c8aa0SThomas Gleixner if (p->addr == addr) 241e64c8aa0SThomas Gleixner break; 242e64c8aa0SThomas Gleixner } 243e64c8aa0SThomas Gleixner read_unlock(&vmlist_lock); 244e64c8aa0SThomas Gleixner 245e64c8aa0SThomas Gleixner if (!p) { 246e64c8aa0SThomas Gleixner printk(KERN_ERR "iounmap: bad address %p\n", addr); 247e64c8aa0SThomas Gleixner dump_stack(); 248e64c8aa0SThomas Gleixner return; 249e64c8aa0SThomas Gleixner } 250e64c8aa0SThomas Gleixner 251e64c8aa0SThomas Gleixner /* Finally remove it */ 252e64c8aa0SThomas Gleixner o = remove_vm_area((void *)addr); 253e64c8aa0SThomas Gleixner BUG_ON(p != o || o == NULL); 254e64c8aa0SThomas Gleixner kfree(p); 255e64c8aa0SThomas Gleixner } 256e64c8aa0SThomas Gleixner EXPORT_SYMBOL(iounmap); 257e64c8aa0SThomas Gleixner 258e64c8aa0SThomas Gleixner #ifdef CONFIG_X86_32 259e64c8aa0SThomas Gleixner 260e64c8aa0SThomas Gleixner int __initdata early_ioremap_debug; 261e64c8aa0SThomas Gleixner 262e64c8aa0SThomas Gleixner static int __init early_ioremap_debug_setup(char *str) 263e64c8aa0SThomas Gleixner { 264e64c8aa0SThomas Gleixner early_ioremap_debug = 1; 265e64c8aa0SThomas Gleixner 266e64c8aa0SThomas Gleixner return 0; 267e64c8aa0SThomas Gleixner } 268e64c8aa0SThomas Gleixner early_param("early_ioremap_debug", early_ioremap_debug_setup); 269e64c8aa0SThomas Gleixner 270e64c8aa0SThomas Gleixner static __initdata int after_paging_init; 271551889a6SIan Campbell static __initdata pte_t bm_pte[PAGE_SIZE/sizeof(pte_t)] 272e64c8aa0SThomas Gleixner __attribute__((aligned(PAGE_SIZE))); 273e64c8aa0SThomas Gleixner 274551889a6SIan Campbell static inline pmd_t * __init early_ioremap_pmd(unsigned long addr) 275e64c8aa0SThomas Gleixner { 27637cc8d7fSJeremy Fitzhardinge /* Don't assume we're using swapper_pg_dir at this point */ 27737cc8d7fSJeremy Fitzhardinge pgd_t *base = __va(read_cr3()); 27837cc8d7fSJeremy Fitzhardinge pgd_t *pgd = &base[pgd_index(addr)]; 279551889a6SIan Campbell pud_t *pud = pud_offset(pgd, addr); 280551889a6SIan Campbell pmd_t *pmd = pmd_offset(pud, addr); 281551889a6SIan Campbell 282551889a6SIan Campbell return pmd; 283e64c8aa0SThomas Gleixner } 284e64c8aa0SThomas Gleixner 285551889a6SIan Campbell static inline pte_t * __init early_ioremap_pte(unsigned long addr) 286e64c8aa0SThomas Gleixner { 287551889a6SIan Campbell return &bm_pte[pte_index(addr)]; 288e64c8aa0SThomas Gleixner } 289e64c8aa0SThomas Gleixner 290e64c8aa0SThomas Gleixner void __init early_ioremap_init(void) 291e64c8aa0SThomas Gleixner { 292551889a6SIan Campbell pmd_t *pmd; 293e64c8aa0SThomas Gleixner 294e64c8aa0SThomas Gleixner if (early_ioremap_debug) 295adafdf6aSIngo Molnar printk(KERN_INFO "early_ioremap_init()\n"); 296e64c8aa0SThomas Gleixner 297551889a6SIan Campbell pmd = early_ioremap_pmd(fix_to_virt(FIX_BTMAP_BEGIN)); 298e64c8aa0SThomas Gleixner memset(bm_pte, 0, sizeof(bm_pte)); 299b6fbb669SIan Campbell pmd_populate_kernel(&init_mm, pmd, bm_pte); 300551889a6SIan Campbell 301e64c8aa0SThomas Gleixner /* 302551889a6SIan Campbell * The boot-ioremap range spans multiple pmds, for which 303e64c8aa0SThomas Gleixner * we are not prepared: 304e64c8aa0SThomas Gleixner */ 305551889a6SIan Campbell if (pmd != early_ioremap_pmd(fix_to_virt(FIX_BTMAP_END))) { 306e64c8aa0SThomas Gleixner WARN_ON(1); 307551889a6SIan Campbell printk(KERN_WARNING "pmd %p != %p\n", 308551889a6SIan Campbell pmd, early_ioremap_pmd(fix_to_virt(FIX_BTMAP_END))); 309e64c8aa0SThomas Gleixner printk(KERN_WARNING "fix_to_virt(FIX_BTMAP_BEGIN): %08lx\n", 310e64c8aa0SThomas Gleixner fix_to_virt(FIX_BTMAP_BEGIN)); 311e64c8aa0SThomas Gleixner printk(KERN_WARNING "fix_to_virt(FIX_BTMAP_END): %08lx\n", 312e64c8aa0SThomas Gleixner fix_to_virt(FIX_BTMAP_END)); 313e64c8aa0SThomas Gleixner 314e64c8aa0SThomas Gleixner printk(KERN_WARNING "FIX_BTMAP_END: %d\n", FIX_BTMAP_END); 315e64c8aa0SThomas Gleixner printk(KERN_WARNING "FIX_BTMAP_BEGIN: %d\n", 316e64c8aa0SThomas Gleixner FIX_BTMAP_BEGIN); 317e64c8aa0SThomas Gleixner } 318e64c8aa0SThomas Gleixner } 319e64c8aa0SThomas Gleixner 320e64c8aa0SThomas Gleixner void __init early_ioremap_clear(void) 321e64c8aa0SThomas Gleixner { 322551889a6SIan Campbell pmd_t *pmd; 323e64c8aa0SThomas Gleixner 324e64c8aa0SThomas Gleixner if (early_ioremap_debug) 325adafdf6aSIngo Molnar printk(KERN_INFO "early_ioremap_clear()\n"); 326e64c8aa0SThomas Gleixner 327551889a6SIan Campbell pmd = early_ioremap_pmd(fix_to_virt(FIX_BTMAP_BEGIN)); 328551889a6SIan Campbell pmd_clear(pmd); 329b6fbb669SIan Campbell paravirt_release_pt(__pa(bm_pte) >> PAGE_SHIFT); 330e64c8aa0SThomas Gleixner __flush_tlb_all(); 331e64c8aa0SThomas Gleixner } 332e64c8aa0SThomas Gleixner 333e64c8aa0SThomas Gleixner void __init early_ioremap_reset(void) 334e64c8aa0SThomas Gleixner { 335e64c8aa0SThomas Gleixner enum fixed_addresses idx; 336551889a6SIan Campbell unsigned long addr, phys; 337551889a6SIan Campbell pte_t *pte; 338e64c8aa0SThomas Gleixner 339e64c8aa0SThomas Gleixner after_paging_init = 1; 340e64c8aa0SThomas Gleixner for (idx = FIX_BTMAP_BEGIN; idx >= FIX_BTMAP_END; idx--) { 341e64c8aa0SThomas Gleixner addr = fix_to_virt(idx); 342e64c8aa0SThomas Gleixner pte = early_ioremap_pte(addr); 343551889a6SIan Campbell if (pte_present(*pte)) { 344551889a6SIan Campbell phys = pte_val(*pte) & PAGE_MASK; 345e64c8aa0SThomas Gleixner set_fixmap(idx, phys); 346e64c8aa0SThomas Gleixner } 347e64c8aa0SThomas Gleixner } 348e64c8aa0SThomas Gleixner } 349e64c8aa0SThomas Gleixner 350e64c8aa0SThomas Gleixner static void __init __early_set_fixmap(enum fixed_addresses idx, 351e64c8aa0SThomas Gleixner unsigned long phys, pgprot_t flags) 352e64c8aa0SThomas Gleixner { 353551889a6SIan Campbell unsigned long addr = __fix_to_virt(idx); 354551889a6SIan Campbell pte_t *pte; 355e64c8aa0SThomas Gleixner 356e64c8aa0SThomas Gleixner if (idx >= __end_of_fixed_addresses) { 357e64c8aa0SThomas Gleixner BUG(); 358e64c8aa0SThomas Gleixner return; 359e64c8aa0SThomas Gleixner } 360e64c8aa0SThomas Gleixner pte = early_ioremap_pte(addr); 361e64c8aa0SThomas Gleixner if (pgprot_val(flags)) 362551889a6SIan Campbell set_pte(pte, pfn_pte(phys >> PAGE_SHIFT, flags)); 363e64c8aa0SThomas Gleixner else 364551889a6SIan Campbell pte_clear(NULL, addr, pte); 365e64c8aa0SThomas Gleixner __flush_tlb_one(addr); 366e64c8aa0SThomas Gleixner } 367e64c8aa0SThomas Gleixner 368e64c8aa0SThomas Gleixner static inline void __init early_set_fixmap(enum fixed_addresses idx, 369e64c8aa0SThomas Gleixner unsigned long phys) 370e64c8aa0SThomas Gleixner { 371e64c8aa0SThomas Gleixner if (after_paging_init) 372e64c8aa0SThomas Gleixner set_fixmap(idx, phys); 373e64c8aa0SThomas Gleixner else 374e64c8aa0SThomas Gleixner __early_set_fixmap(idx, phys, PAGE_KERNEL); 375e64c8aa0SThomas Gleixner } 376e64c8aa0SThomas Gleixner 377e64c8aa0SThomas Gleixner static inline void __init early_clear_fixmap(enum fixed_addresses idx) 378e64c8aa0SThomas Gleixner { 379e64c8aa0SThomas Gleixner if (after_paging_init) 380e64c8aa0SThomas Gleixner clear_fixmap(idx); 381e64c8aa0SThomas Gleixner else 382e64c8aa0SThomas Gleixner __early_set_fixmap(idx, 0, __pgprot(0)); 383e64c8aa0SThomas Gleixner } 384e64c8aa0SThomas Gleixner 385e64c8aa0SThomas Gleixner 386e64c8aa0SThomas Gleixner int __initdata early_ioremap_nested; 387e64c8aa0SThomas Gleixner 388e64c8aa0SThomas Gleixner static int __init check_early_ioremap_leak(void) 389e64c8aa0SThomas Gleixner { 390e64c8aa0SThomas Gleixner if (!early_ioremap_nested) 391e64c8aa0SThomas Gleixner return 0; 392e64c8aa0SThomas Gleixner 393e64c8aa0SThomas Gleixner printk(KERN_WARNING 394e64c8aa0SThomas Gleixner "Debug warning: early ioremap leak of %d areas detected.\n", 395e64c8aa0SThomas Gleixner early_ioremap_nested); 396e64c8aa0SThomas Gleixner printk(KERN_WARNING 397e64c8aa0SThomas Gleixner "please boot with early_ioremap_debug and report the dmesg.\n"); 398e64c8aa0SThomas Gleixner WARN_ON(1); 399e64c8aa0SThomas Gleixner 400e64c8aa0SThomas Gleixner return 1; 401e64c8aa0SThomas Gleixner } 402e64c8aa0SThomas Gleixner late_initcall(check_early_ioremap_leak); 403e64c8aa0SThomas Gleixner 404e64c8aa0SThomas Gleixner void __init *early_ioremap(unsigned long phys_addr, unsigned long size) 405e64c8aa0SThomas Gleixner { 406e64c8aa0SThomas Gleixner unsigned long offset, last_addr; 407e64c8aa0SThomas Gleixner unsigned int nrpages, nesting; 408e64c8aa0SThomas Gleixner enum fixed_addresses idx0, idx; 409e64c8aa0SThomas Gleixner 410e64c8aa0SThomas Gleixner WARN_ON(system_state != SYSTEM_BOOTING); 411e64c8aa0SThomas Gleixner 412e64c8aa0SThomas Gleixner nesting = early_ioremap_nested; 413e64c8aa0SThomas Gleixner if (early_ioremap_debug) { 414adafdf6aSIngo Molnar printk(KERN_INFO "early_ioremap(%08lx, %08lx) [%d] => ", 415e64c8aa0SThomas Gleixner phys_addr, size, nesting); 416e64c8aa0SThomas Gleixner dump_stack(); 417e64c8aa0SThomas Gleixner } 418e64c8aa0SThomas Gleixner 419e64c8aa0SThomas Gleixner /* Don't allow wraparound or zero size */ 420e64c8aa0SThomas Gleixner last_addr = phys_addr + size - 1; 421e64c8aa0SThomas Gleixner if (!size || last_addr < phys_addr) { 422e64c8aa0SThomas Gleixner WARN_ON(1); 423e64c8aa0SThomas Gleixner return NULL; 424e64c8aa0SThomas Gleixner } 425e64c8aa0SThomas Gleixner 426e64c8aa0SThomas Gleixner if (nesting >= FIX_BTMAPS_NESTING) { 427e64c8aa0SThomas Gleixner WARN_ON(1); 428e64c8aa0SThomas Gleixner return NULL; 429e64c8aa0SThomas Gleixner } 430e64c8aa0SThomas Gleixner early_ioremap_nested++; 431e64c8aa0SThomas Gleixner /* 432e64c8aa0SThomas Gleixner * Mappings have to be page-aligned 433e64c8aa0SThomas Gleixner */ 434e64c8aa0SThomas Gleixner offset = phys_addr & ~PAGE_MASK; 435e64c8aa0SThomas Gleixner phys_addr &= PAGE_MASK; 436e64c8aa0SThomas Gleixner size = PAGE_ALIGN(last_addr) - phys_addr; 437e64c8aa0SThomas Gleixner 438e64c8aa0SThomas Gleixner /* 439e64c8aa0SThomas Gleixner * Mappings have to fit in the FIX_BTMAP area. 440e64c8aa0SThomas Gleixner */ 441e64c8aa0SThomas Gleixner nrpages = size >> PAGE_SHIFT; 442e64c8aa0SThomas Gleixner if (nrpages > NR_FIX_BTMAPS) { 443e64c8aa0SThomas Gleixner WARN_ON(1); 444e64c8aa0SThomas Gleixner return NULL; 445e64c8aa0SThomas Gleixner } 446e64c8aa0SThomas Gleixner 447e64c8aa0SThomas Gleixner /* 448e64c8aa0SThomas Gleixner * Ok, go for it.. 449e64c8aa0SThomas Gleixner */ 450e64c8aa0SThomas Gleixner idx0 = FIX_BTMAP_BEGIN - NR_FIX_BTMAPS*nesting; 451e64c8aa0SThomas Gleixner idx = idx0; 452e64c8aa0SThomas Gleixner while (nrpages > 0) { 453e64c8aa0SThomas Gleixner early_set_fixmap(idx, phys_addr); 454e64c8aa0SThomas Gleixner phys_addr += PAGE_SIZE; 455e64c8aa0SThomas Gleixner --idx; 456e64c8aa0SThomas Gleixner --nrpages; 457e64c8aa0SThomas Gleixner } 458e64c8aa0SThomas Gleixner if (early_ioremap_debug) 459e64c8aa0SThomas Gleixner printk(KERN_CONT "%08lx + %08lx\n", offset, fix_to_virt(idx0)); 460e64c8aa0SThomas Gleixner 461e64c8aa0SThomas Gleixner return (void *) (offset + fix_to_virt(idx0)); 462e64c8aa0SThomas Gleixner } 463e64c8aa0SThomas Gleixner 464e64c8aa0SThomas Gleixner void __init early_iounmap(void *addr, unsigned long size) 465e64c8aa0SThomas Gleixner { 466e64c8aa0SThomas Gleixner unsigned long virt_addr; 467e64c8aa0SThomas Gleixner unsigned long offset; 468e64c8aa0SThomas Gleixner unsigned int nrpages; 469e64c8aa0SThomas Gleixner enum fixed_addresses idx; 470e64c8aa0SThomas Gleixner unsigned int nesting; 471e64c8aa0SThomas Gleixner 472e64c8aa0SThomas Gleixner nesting = --early_ioremap_nested; 473e64c8aa0SThomas Gleixner WARN_ON(nesting < 0); 474e64c8aa0SThomas Gleixner 475e64c8aa0SThomas Gleixner if (early_ioremap_debug) { 476adafdf6aSIngo Molnar printk(KERN_INFO "early_iounmap(%p, %08lx) [%d]\n", addr, 477e64c8aa0SThomas Gleixner size, nesting); 478e64c8aa0SThomas Gleixner dump_stack(); 479e64c8aa0SThomas Gleixner } 480e64c8aa0SThomas Gleixner 481e64c8aa0SThomas Gleixner virt_addr = (unsigned long)addr; 482e64c8aa0SThomas Gleixner if (virt_addr < fix_to_virt(FIX_BTMAP_BEGIN)) { 483e64c8aa0SThomas Gleixner WARN_ON(1); 484e64c8aa0SThomas Gleixner return; 485e64c8aa0SThomas Gleixner } 486e64c8aa0SThomas Gleixner offset = virt_addr & ~PAGE_MASK; 487e64c8aa0SThomas Gleixner nrpages = PAGE_ALIGN(offset + size - 1) >> PAGE_SHIFT; 488e64c8aa0SThomas Gleixner 489e64c8aa0SThomas Gleixner idx = FIX_BTMAP_BEGIN - NR_FIX_BTMAPS*nesting; 490e64c8aa0SThomas Gleixner while (nrpages > 0) { 491e64c8aa0SThomas Gleixner early_clear_fixmap(idx); 492e64c8aa0SThomas Gleixner --idx; 493e64c8aa0SThomas Gleixner --nrpages; 494e64c8aa0SThomas Gleixner } 495e64c8aa0SThomas Gleixner } 496e64c8aa0SThomas Gleixner 497e64c8aa0SThomas Gleixner void __this_fixmap_does_not_exist(void) 498e64c8aa0SThomas Gleixner { 499e64c8aa0SThomas Gleixner WARN_ON(1); 500e64c8aa0SThomas Gleixner } 501e64c8aa0SThomas Gleixner 502e64c8aa0SThomas Gleixner #endif /* CONFIG_X86_32 */ 503