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 455f5192b9SThomas Gleixner for (i = 0; i < e820.nr_map; i++) { 465f5192b9SThomas Gleixner /* 475f5192b9SThomas Gleixner * Not usable memory: 485f5192b9SThomas Gleixner */ 495f5192b9SThomas Gleixner if (e820.map[i].type != E820_RAM) 505f5192b9SThomas Gleixner continue; 515f5192b9SThomas Gleixner addr = (e820.map[i].addr + PAGE_SIZE-1) >> PAGE_SHIFT; 525f5192b9SThomas Gleixner end = (e820.map[i].addr + e820.map[i].size) >> PAGE_SHIFT; 53950f9d95SThomas Gleixner 54950f9d95SThomas Gleixner /* 55950f9d95SThomas Gleixner * Sanity check: Some BIOSen report areas as RAM that 56950f9d95SThomas Gleixner * are not. Notably the 640->1Mb area, which is the 57950f9d95SThomas Gleixner * PCI BIOS area. 58950f9d95SThomas Gleixner */ 59950f9d95SThomas Gleixner if (addr >= (BIOS_BEGIN >> PAGE_SHIFT) && 60950f9d95SThomas Gleixner end < (BIOS_END >> PAGE_SHIFT)) 61950f9d95SThomas Gleixner continue; 62950f9d95SThomas Gleixner 635f5192b9SThomas Gleixner if ((pagenr >= addr) && (pagenr < end)) 645f5192b9SThomas Gleixner return 1; 655f5192b9SThomas Gleixner } 665f5192b9SThomas Gleixner return 0; 675f5192b9SThomas Gleixner } 685f5192b9SThomas Gleixner 69e64c8aa0SThomas Gleixner /* 70e64c8aa0SThomas Gleixner * Fix up the linear direct mapping of the kernel to avoid cache attribute 71e64c8aa0SThomas Gleixner * conflicts. 72e64c8aa0SThomas Gleixner */ 73*75ab43bfSThomas Gleixner static int ioremap_change_attr(unsigned long vaddr, unsigned long size, 74d806e5eeSThomas Gleixner enum ioremap_mode mode) 75e64c8aa0SThomas Gleixner { 76d806e5eeSThomas Gleixner unsigned long nrpages = size >> PAGE_SHIFT; 7793809be8SHarvey Harrison int err; 78e64c8aa0SThomas Gleixner 79d806e5eeSThomas Gleixner switch (mode) { 80d806e5eeSThomas Gleixner case IOR_MODE_UNCACHED: 81d806e5eeSThomas Gleixner default: 82d806e5eeSThomas Gleixner err = set_memory_uc(vaddr, nrpages); 83d806e5eeSThomas Gleixner break; 84d806e5eeSThomas Gleixner case IOR_MODE_CACHED: 85d806e5eeSThomas Gleixner err = set_memory_wb(vaddr, nrpages); 86d806e5eeSThomas Gleixner break; 87d806e5eeSThomas Gleixner } 88e64c8aa0SThomas Gleixner 89e64c8aa0SThomas Gleixner return err; 90e64c8aa0SThomas Gleixner } 91e64c8aa0SThomas Gleixner 92e64c8aa0SThomas Gleixner /* 93e64c8aa0SThomas Gleixner * Remap an arbitrary physical address space into the kernel virtual 94e64c8aa0SThomas Gleixner * address space. Needed when the kernel wants to access high addresses 95e64c8aa0SThomas Gleixner * directly. 96e64c8aa0SThomas Gleixner * 97e64c8aa0SThomas Gleixner * NOTE! We need to allow non-page-aligned mappings too: we will obviously 98e64c8aa0SThomas Gleixner * have to convert them into an offset in a page-aligned mapping, but the 99e64c8aa0SThomas Gleixner * caller shouldn't need to know that small detail. 100e64c8aa0SThomas Gleixner */ 1015f868152SThomas Gleixner static void __iomem *__ioremap(unsigned long phys_addr, unsigned long size, 102d806e5eeSThomas Gleixner enum ioremap_mode mode) 103e64c8aa0SThomas Gleixner { 104e66aadbeSThomas Gleixner unsigned long pfn, offset, last_addr, vaddr; 105e64c8aa0SThomas Gleixner struct vm_struct *area; 106d806e5eeSThomas Gleixner pgprot_t prot; 107e64c8aa0SThomas Gleixner 108e64c8aa0SThomas Gleixner /* Don't allow wraparound or zero size */ 109e64c8aa0SThomas Gleixner last_addr = phys_addr + size - 1; 110e64c8aa0SThomas Gleixner if (!size || last_addr < phys_addr) 111e64c8aa0SThomas Gleixner return NULL; 112e64c8aa0SThomas Gleixner 113e64c8aa0SThomas Gleixner /* 114e64c8aa0SThomas Gleixner * Don't remap the low PCI/ISA area, it's always mapped.. 115e64c8aa0SThomas Gleixner */ 116e64c8aa0SThomas Gleixner if (phys_addr >= ISA_START_ADDRESS && last_addr < ISA_END_ADDRESS) 117e64c8aa0SThomas Gleixner return (__force void __iomem *)phys_to_virt(phys_addr); 118e64c8aa0SThomas Gleixner 119e64c8aa0SThomas Gleixner /* 120e64c8aa0SThomas Gleixner * Don't allow anybody to remap normal RAM that we're using.. 121e64c8aa0SThomas Gleixner */ 12238cb47baSIngo Molnar for (pfn = phys_addr >> PAGE_SHIFT; pfn < max_pfn_mapped && 12338cb47baSIngo Molnar (pfn << PAGE_SHIFT) < last_addr; pfn++) { 12438cb47baSIngo Molnar if (page_is_ram(pfn) && pfn_valid(pfn) && 12538cb47baSIngo Molnar !PageReserved(pfn_to_page(pfn))) 126e64c8aa0SThomas Gleixner return NULL; 127e64c8aa0SThomas Gleixner } 128e64c8aa0SThomas Gleixner 129d806e5eeSThomas Gleixner switch (mode) { 130d806e5eeSThomas Gleixner case IOR_MODE_UNCACHED: 131d806e5eeSThomas Gleixner default: 132d806e5eeSThomas Gleixner prot = PAGE_KERNEL_NOCACHE; 133d806e5eeSThomas Gleixner break; 134d806e5eeSThomas Gleixner case IOR_MODE_CACHED: 135d806e5eeSThomas Gleixner prot = PAGE_KERNEL; 136d806e5eeSThomas Gleixner break; 137d806e5eeSThomas Gleixner } 138e64c8aa0SThomas Gleixner 139e64c8aa0SThomas Gleixner /* 140e64c8aa0SThomas Gleixner * Mappings have to be page-aligned 141e64c8aa0SThomas Gleixner */ 142e64c8aa0SThomas Gleixner offset = phys_addr & ~PAGE_MASK; 143e64c8aa0SThomas Gleixner phys_addr &= PAGE_MASK; 144e64c8aa0SThomas Gleixner size = PAGE_ALIGN(last_addr+1) - phys_addr; 145e64c8aa0SThomas Gleixner 146e64c8aa0SThomas Gleixner /* 147e64c8aa0SThomas Gleixner * Ok, go for it.. 148e64c8aa0SThomas Gleixner */ 149e64c8aa0SThomas Gleixner area = get_vm_area(size, VM_IOREMAP); 150e64c8aa0SThomas Gleixner if (!area) 151e64c8aa0SThomas Gleixner return NULL; 152e64c8aa0SThomas Gleixner area->phys_addr = phys_addr; 153e66aadbeSThomas Gleixner vaddr = (unsigned long) area->addr; 154e66aadbeSThomas Gleixner if (ioremap_page_range(vaddr, vaddr + size, phys_addr, prot)) { 155e66aadbeSThomas Gleixner remove_vm_area((void *)(vaddr & PAGE_MASK)); 156e64c8aa0SThomas Gleixner return NULL; 157e64c8aa0SThomas Gleixner } 158e64c8aa0SThomas Gleixner 159*75ab43bfSThomas Gleixner if (ioremap_change_attr(vaddr, size, mode) < 0) { 160e66aadbeSThomas Gleixner vunmap(area->addr); 161e64c8aa0SThomas Gleixner return NULL; 162e64c8aa0SThomas Gleixner } 163e64c8aa0SThomas Gleixner 164e66aadbeSThomas Gleixner return (void __iomem *) (vaddr + offset); 165e64c8aa0SThomas Gleixner } 166e64c8aa0SThomas Gleixner 167e64c8aa0SThomas Gleixner /** 168e64c8aa0SThomas Gleixner * ioremap_nocache - map bus memory into CPU space 169e64c8aa0SThomas Gleixner * @offset: bus address of the memory 170e64c8aa0SThomas Gleixner * @size: size of the resource to map 171e64c8aa0SThomas Gleixner * 172e64c8aa0SThomas Gleixner * ioremap_nocache performs a platform specific sequence of operations to 173e64c8aa0SThomas Gleixner * make bus memory CPU accessible via the readb/readw/readl/writeb/ 174e64c8aa0SThomas Gleixner * writew/writel functions and the other mmio helpers. The returned 175e64c8aa0SThomas Gleixner * address is not guaranteed to be usable directly as a virtual 176e64c8aa0SThomas Gleixner * address. 177e64c8aa0SThomas Gleixner * 178e64c8aa0SThomas Gleixner * This version of ioremap ensures that the memory is marked uncachable 179e64c8aa0SThomas Gleixner * on the CPU as well as honouring existing caching rules from things like 180e64c8aa0SThomas Gleixner * the PCI bus. Note that there are other caches and buffers on many 181e64c8aa0SThomas Gleixner * busses. In particular driver authors should read up on PCI writes 182e64c8aa0SThomas Gleixner * 183e64c8aa0SThomas Gleixner * It's useful if some control registers are in such an area and 184e64c8aa0SThomas Gleixner * write combining or read caching is not desirable: 185e64c8aa0SThomas Gleixner * 186e64c8aa0SThomas Gleixner * Must be freed with iounmap. 187e64c8aa0SThomas Gleixner */ 188e64c8aa0SThomas Gleixner void __iomem *ioremap_nocache(unsigned long phys_addr, unsigned long size) 189e64c8aa0SThomas Gleixner { 190d806e5eeSThomas Gleixner return __ioremap(phys_addr, size, IOR_MODE_UNCACHED); 191e64c8aa0SThomas Gleixner } 192e64c8aa0SThomas Gleixner EXPORT_SYMBOL(ioremap_nocache); 193e64c8aa0SThomas Gleixner 1945f868152SThomas Gleixner void __iomem *ioremap_cache(unsigned long phys_addr, unsigned long size) 1955f868152SThomas Gleixner { 196d806e5eeSThomas Gleixner return __ioremap(phys_addr, size, IOR_MODE_CACHED); 1975f868152SThomas Gleixner } 1985f868152SThomas Gleixner EXPORT_SYMBOL(ioremap_cache); 1995f868152SThomas Gleixner 200e64c8aa0SThomas Gleixner /** 201e64c8aa0SThomas Gleixner * iounmap - Free a IO remapping 202e64c8aa0SThomas Gleixner * @addr: virtual address from ioremap_* 203e64c8aa0SThomas Gleixner * 204e64c8aa0SThomas Gleixner * Caller must ensure there is only one unmapping for the same pointer. 205e64c8aa0SThomas Gleixner */ 206e64c8aa0SThomas Gleixner void iounmap(volatile void __iomem *addr) 207e64c8aa0SThomas Gleixner { 208e64c8aa0SThomas Gleixner struct vm_struct *p, *o; 209e64c8aa0SThomas Gleixner 210e64c8aa0SThomas Gleixner if ((void __force *)addr <= high_memory) 211e64c8aa0SThomas Gleixner return; 212e64c8aa0SThomas Gleixner 213e64c8aa0SThomas Gleixner /* 214e64c8aa0SThomas Gleixner * __ioremap special-cases the PCI/ISA range by not instantiating a 215e64c8aa0SThomas Gleixner * vm_area and by simply returning an address into the kernel mapping 216e64c8aa0SThomas Gleixner * of ISA space. So handle that here. 217e64c8aa0SThomas Gleixner */ 218e64c8aa0SThomas Gleixner if (addr >= phys_to_virt(ISA_START_ADDRESS) && 219e64c8aa0SThomas Gleixner addr < phys_to_virt(ISA_END_ADDRESS)) 220e64c8aa0SThomas Gleixner return; 221e64c8aa0SThomas Gleixner 222e64c8aa0SThomas Gleixner addr = (volatile void __iomem *) 223e64c8aa0SThomas Gleixner (PAGE_MASK & (unsigned long __force)addr); 224e64c8aa0SThomas Gleixner 225e64c8aa0SThomas Gleixner /* Use the vm area unlocked, assuming the caller 226e64c8aa0SThomas Gleixner ensures there isn't another iounmap for the same address 227e64c8aa0SThomas Gleixner in parallel. Reuse of the virtual address is prevented by 228e64c8aa0SThomas Gleixner leaving it in the global lists until we're done with it. 229e64c8aa0SThomas Gleixner cpa takes care of the direct mappings. */ 230e64c8aa0SThomas Gleixner read_lock(&vmlist_lock); 231e64c8aa0SThomas Gleixner for (p = vmlist; p; p = p->next) { 232e64c8aa0SThomas Gleixner if (p->addr == addr) 233e64c8aa0SThomas Gleixner break; 234e64c8aa0SThomas Gleixner } 235e64c8aa0SThomas Gleixner read_unlock(&vmlist_lock); 236e64c8aa0SThomas Gleixner 237e64c8aa0SThomas Gleixner if (!p) { 238e64c8aa0SThomas Gleixner printk(KERN_ERR "iounmap: bad address %p\n", addr); 239e64c8aa0SThomas Gleixner dump_stack(); 240e64c8aa0SThomas Gleixner return; 241e64c8aa0SThomas Gleixner } 242e64c8aa0SThomas Gleixner 243e64c8aa0SThomas Gleixner /* Reset the direct mapping. Can block */ 244d806e5eeSThomas Gleixner ioremap_change_attr(p->phys_addr, p->size, IOR_MODE_CACHED); 245e64c8aa0SThomas Gleixner 246e64c8aa0SThomas Gleixner /* Finally remove it */ 247e64c8aa0SThomas Gleixner o = remove_vm_area((void *)addr); 248e64c8aa0SThomas Gleixner BUG_ON(p != o || o == NULL); 249e64c8aa0SThomas Gleixner kfree(p); 250e64c8aa0SThomas Gleixner } 251e64c8aa0SThomas Gleixner EXPORT_SYMBOL(iounmap); 252e64c8aa0SThomas Gleixner 253e64c8aa0SThomas Gleixner #ifdef CONFIG_X86_32 254e64c8aa0SThomas Gleixner 255e64c8aa0SThomas Gleixner int __initdata early_ioremap_debug; 256e64c8aa0SThomas Gleixner 257e64c8aa0SThomas Gleixner static int __init early_ioremap_debug_setup(char *str) 258e64c8aa0SThomas Gleixner { 259e64c8aa0SThomas Gleixner early_ioremap_debug = 1; 260e64c8aa0SThomas Gleixner 261e64c8aa0SThomas Gleixner return 0; 262e64c8aa0SThomas Gleixner } 263e64c8aa0SThomas Gleixner early_param("early_ioremap_debug", early_ioremap_debug_setup); 264e64c8aa0SThomas Gleixner 265e64c8aa0SThomas Gleixner static __initdata int after_paging_init; 266e64c8aa0SThomas Gleixner static __initdata unsigned long bm_pte[1024] 267e64c8aa0SThomas Gleixner __attribute__((aligned(PAGE_SIZE))); 268e64c8aa0SThomas Gleixner 269e64c8aa0SThomas Gleixner static inline unsigned long * __init early_ioremap_pgd(unsigned long addr) 270e64c8aa0SThomas Gleixner { 271e64c8aa0SThomas Gleixner return (unsigned long *)swapper_pg_dir + ((addr >> 22) & 1023); 272e64c8aa0SThomas Gleixner } 273e64c8aa0SThomas Gleixner 274e64c8aa0SThomas Gleixner static inline unsigned long * __init early_ioremap_pte(unsigned long addr) 275e64c8aa0SThomas Gleixner { 276e64c8aa0SThomas Gleixner return bm_pte + ((addr >> PAGE_SHIFT) & 1023); 277e64c8aa0SThomas Gleixner } 278e64c8aa0SThomas Gleixner 279e64c8aa0SThomas Gleixner void __init early_ioremap_init(void) 280e64c8aa0SThomas Gleixner { 281e64c8aa0SThomas Gleixner unsigned long *pgd; 282e64c8aa0SThomas Gleixner 283e64c8aa0SThomas Gleixner if (early_ioremap_debug) 284adafdf6aSIngo Molnar printk(KERN_INFO "early_ioremap_init()\n"); 285e64c8aa0SThomas Gleixner 286e64c8aa0SThomas Gleixner pgd = early_ioremap_pgd(fix_to_virt(FIX_BTMAP_BEGIN)); 287e64c8aa0SThomas Gleixner *pgd = __pa(bm_pte) | _PAGE_TABLE; 288e64c8aa0SThomas Gleixner memset(bm_pte, 0, sizeof(bm_pte)); 289e64c8aa0SThomas Gleixner /* 290e64c8aa0SThomas Gleixner * The boot-ioremap range spans multiple pgds, for which 291e64c8aa0SThomas Gleixner * we are not prepared: 292e64c8aa0SThomas Gleixner */ 293e64c8aa0SThomas Gleixner if (pgd != early_ioremap_pgd(fix_to_virt(FIX_BTMAP_END))) { 294e64c8aa0SThomas Gleixner WARN_ON(1); 295e64c8aa0SThomas Gleixner printk(KERN_WARNING "pgd %p != %p\n", 296e64c8aa0SThomas Gleixner pgd, early_ioremap_pgd(fix_to_virt(FIX_BTMAP_END))); 297e64c8aa0SThomas Gleixner printk(KERN_WARNING "fix_to_virt(FIX_BTMAP_BEGIN): %08lx\n", 298e64c8aa0SThomas Gleixner fix_to_virt(FIX_BTMAP_BEGIN)); 299e64c8aa0SThomas Gleixner printk(KERN_WARNING "fix_to_virt(FIX_BTMAP_END): %08lx\n", 300e64c8aa0SThomas Gleixner fix_to_virt(FIX_BTMAP_END)); 301e64c8aa0SThomas Gleixner 302e64c8aa0SThomas Gleixner printk(KERN_WARNING "FIX_BTMAP_END: %d\n", FIX_BTMAP_END); 303e64c8aa0SThomas Gleixner printk(KERN_WARNING "FIX_BTMAP_BEGIN: %d\n", 304e64c8aa0SThomas Gleixner FIX_BTMAP_BEGIN); 305e64c8aa0SThomas Gleixner } 306e64c8aa0SThomas Gleixner } 307e64c8aa0SThomas Gleixner 308e64c8aa0SThomas Gleixner void __init early_ioremap_clear(void) 309e64c8aa0SThomas Gleixner { 310e64c8aa0SThomas Gleixner unsigned long *pgd; 311e64c8aa0SThomas Gleixner 312e64c8aa0SThomas Gleixner if (early_ioremap_debug) 313adafdf6aSIngo Molnar printk(KERN_INFO "early_ioremap_clear()\n"); 314e64c8aa0SThomas Gleixner 315e64c8aa0SThomas Gleixner pgd = early_ioremap_pgd(fix_to_virt(FIX_BTMAP_BEGIN)); 316e64c8aa0SThomas Gleixner *pgd = 0; 317f6df72e7SJeremy Fitzhardinge paravirt_release_pt(__pa(pgd) >> PAGE_SHIFT); 318e64c8aa0SThomas Gleixner __flush_tlb_all(); 319e64c8aa0SThomas Gleixner } 320e64c8aa0SThomas Gleixner 321e64c8aa0SThomas Gleixner void __init early_ioremap_reset(void) 322e64c8aa0SThomas Gleixner { 323e64c8aa0SThomas Gleixner enum fixed_addresses idx; 324e64c8aa0SThomas Gleixner unsigned long *pte, phys, addr; 325e64c8aa0SThomas Gleixner 326e64c8aa0SThomas Gleixner after_paging_init = 1; 327e64c8aa0SThomas Gleixner for (idx = FIX_BTMAP_BEGIN; idx >= FIX_BTMAP_END; idx--) { 328e64c8aa0SThomas Gleixner addr = fix_to_virt(idx); 329e64c8aa0SThomas Gleixner pte = early_ioremap_pte(addr); 3301fd6a53dSHuang, Ying if (*pte & _PAGE_PRESENT) { 331e64c8aa0SThomas Gleixner phys = *pte & PAGE_MASK; 332e64c8aa0SThomas Gleixner set_fixmap(idx, phys); 333e64c8aa0SThomas Gleixner } 334e64c8aa0SThomas Gleixner } 335e64c8aa0SThomas Gleixner } 336e64c8aa0SThomas Gleixner 337e64c8aa0SThomas Gleixner static void __init __early_set_fixmap(enum fixed_addresses idx, 338e64c8aa0SThomas Gleixner unsigned long phys, pgprot_t flags) 339e64c8aa0SThomas Gleixner { 340e64c8aa0SThomas Gleixner unsigned long *pte, addr = __fix_to_virt(idx); 341e64c8aa0SThomas Gleixner 342e64c8aa0SThomas Gleixner if (idx >= __end_of_fixed_addresses) { 343e64c8aa0SThomas Gleixner BUG(); 344e64c8aa0SThomas Gleixner return; 345e64c8aa0SThomas Gleixner } 346e64c8aa0SThomas Gleixner pte = early_ioremap_pte(addr); 347e64c8aa0SThomas Gleixner if (pgprot_val(flags)) 348e64c8aa0SThomas Gleixner *pte = (phys & PAGE_MASK) | pgprot_val(flags); 349e64c8aa0SThomas Gleixner else 350e64c8aa0SThomas Gleixner *pte = 0; 351e64c8aa0SThomas Gleixner __flush_tlb_one(addr); 352e64c8aa0SThomas Gleixner } 353e64c8aa0SThomas Gleixner 354e64c8aa0SThomas Gleixner static inline void __init early_set_fixmap(enum fixed_addresses idx, 355e64c8aa0SThomas Gleixner unsigned long phys) 356e64c8aa0SThomas Gleixner { 357e64c8aa0SThomas Gleixner if (after_paging_init) 358e64c8aa0SThomas Gleixner set_fixmap(idx, phys); 359e64c8aa0SThomas Gleixner else 360e64c8aa0SThomas Gleixner __early_set_fixmap(idx, phys, PAGE_KERNEL); 361e64c8aa0SThomas Gleixner } 362e64c8aa0SThomas Gleixner 363e64c8aa0SThomas Gleixner static inline void __init early_clear_fixmap(enum fixed_addresses idx) 364e64c8aa0SThomas Gleixner { 365e64c8aa0SThomas Gleixner if (after_paging_init) 366e64c8aa0SThomas Gleixner clear_fixmap(idx); 367e64c8aa0SThomas Gleixner else 368e64c8aa0SThomas Gleixner __early_set_fixmap(idx, 0, __pgprot(0)); 369e64c8aa0SThomas Gleixner } 370e64c8aa0SThomas Gleixner 371e64c8aa0SThomas Gleixner 372e64c8aa0SThomas Gleixner int __initdata early_ioremap_nested; 373e64c8aa0SThomas Gleixner 374e64c8aa0SThomas Gleixner static int __init check_early_ioremap_leak(void) 375e64c8aa0SThomas Gleixner { 376e64c8aa0SThomas Gleixner if (!early_ioremap_nested) 377e64c8aa0SThomas Gleixner return 0; 378e64c8aa0SThomas Gleixner 379e64c8aa0SThomas Gleixner printk(KERN_WARNING 380e64c8aa0SThomas Gleixner "Debug warning: early ioremap leak of %d areas detected.\n", 381e64c8aa0SThomas Gleixner early_ioremap_nested); 382e64c8aa0SThomas Gleixner printk(KERN_WARNING 383e64c8aa0SThomas Gleixner "please boot with early_ioremap_debug and report the dmesg.\n"); 384e64c8aa0SThomas Gleixner WARN_ON(1); 385e64c8aa0SThomas Gleixner 386e64c8aa0SThomas Gleixner return 1; 387e64c8aa0SThomas Gleixner } 388e64c8aa0SThomas Gleixner late_initcall(check_early_ioremap_leak); 389e64c8aa0SThomas Gleixner 390e64c8aa0SThomas Gleixner void __init *early_ioremap(unsigned long phys_addr, unsigned long size) 391e64c8aa0SThomas Gleixner { 392e64c8aa0SThomas Gleixner unsigned long offset, last_addr; 393e64c8aa0SThomas Gleixner unsigned int nrpages, nesting; 394e64c8aa0SThomas Gleixner enum fixed_addresses idx0, idx; 395e64c8aa0SThomas Gleixner 396e64c8aa0SThomas Gleixner WARN_ON(system_state != SYSTEM_BOOTING); 397e64c8aa0SThomas Gleixner 398e64c8aa0SThomas Gleixner nesting = early_ioremap_nested; 399e64c8aa0SThomas Gleixner if (early_ioremap_debug) { 400adafdf6aSIngo Molnar printk(KERN_INFO "early_ioremap(%08lx, %08lx) [%d] => ", 401e64c8aa0SThomas Gleixner phys_addr, size, nesting); 402e64c8aa0SThomas Gleixner dump_stack(); 403e64c8aa0SThomas Gleixner } 404e64c8aa0SThomas Gleixner 405e64c8aa0SThomas Gleixner /* Don't allow wraparound or zero size */ 406e64c8aa0SThomas Gleixner last_addr = phys_addr + size - 1; 407e64c8aa0SThomas Gleixner if (!size || last_addr < phys_addr) { 408e64c8aa0SThomas Gleixner WARN_ON(1); 409e64c8aa0SThomas Gleixner return NULL; 410e64c8aa0SThomas Gleixner } 411e64c8aa0SThomas Gleixner 412e64c8aa0SThomas Gleixner if (nesting >= FIX_BTMAPS_NESTING) { 413e64c8aa0SThomas Gleixner WARN_ON(1); 414e64c8aa0SThomas Gleixner return NULL; 415e64c8aa0SThomas Gleixner } 416e64c8aa0SThomas Gleixner early_ioremap_nested++; 417e64c8aa0SThomas Gleixner /* 418e64c8aa0SThomas Gleixner * Mappings have to be page-aligned 419e64c8aa0SThomas Gleixner */ 420e64c8aa0SThomas Gleixner offset = phys_addr & ~PAGE_MASK; 421e64c8aa0SThomas Gleixner phys_addr &= PAGE_MASK; 422e64c8aa0SThomas Gleixner size = PAGE_ALIGN(last_addr) - phys_addr; 423e64c8aa0SThomas Gleixner 424e64c8aa0SThomas Gleixner /* 425e64c8aa0SThomas Gleixner * Mappings have to fit in the FIX_BTMAP area. 426e64c8aa0SThomas Gleixner */ 427e64c8aa0SThomas Gleixner nrpages = size >> PAGE_SHIFT; 428e64c8aa0SThomas Gleixner if (nrpages > NR_FIX_BTMAPS) { 429e64c8aa0SThomas Gleixner WARN_ON(1); 430e64c8aa0SThomas Gleixner return NULL; 431e64c8aa0SThomas Gleixner } 432e64c8aa0SThomas Gleixner 433e64c8aa0SThomas Gleixner /* 434e64c8aa0SThomas Gleixner * Ok, go for it.. 435e64c8aa0SThomas Gleixner */ 436e64c8aa0SThomas Gleixner idx0 = FIX_BTMAP_BEGIN - NR_FIX_BTMAPS*nesting; 437e64c8aa0SThomas Gleixner idx = idx0; 438e64c8aa0SThomas Gleixner while (nrpages > 0) { 439e64c8aa0SThomas Gleixner early_set_fixmap(idx, phys_addr); 440e64c8aa0SThomas Gleixner phys_addr += PAGE_SIZE; 441e64c8aa0SThomas Gleixner --idx; 442e64c8aa0SThomas Gleixner --nrpages; 443e64c8aa0SThomas Gleixner } 444e64c8aa0SThomas Gleixner if (early_ioremap_debug) 445e64c8aa0SThomas Gleixner printk(KERN_CONT "%08lx + %08lx\n", offset, fix_to_virt(idx0)); 446e64c8aa0SThomas Gleixner 447e64c8aa0SThomas Gleixner return (void *) (offset + fix_to_virt(idx0)); 448e64c8aa0SThomas Gleixner } 449e64c8aa0SThomas Gleixner 450e64c8aa0SThomas Gleixner void __init early_iounmap(void *addr, unsigned long size) 451e64c8aa0SThomas Gleixner { 452e64c8aa0SThomas Gleixner unsigned long virt_addr; 453e64c8aa0SThomas Gleixner unsigned long offset; 454e64c8aa0SThomas Gleixner unsigned int nrpages; 455e64c8aa0SThomas Gleixner enum fixed_addresses idx; 456e64c8aa0SThomas Gleixner unsigned int nesting; 457e64c8aa0SThomas Gleixner 458e64c8aa0SThomas Gleixner nesting = --early_ioremap_nested; 459e64c8aa0SThomas Gleixner WARN_ON(nesting < 0); 460e64c8aa0SThomas Gleixner 461e64c8aa0SThomas Gleixner if (early_ioremap_debug) { 462adafdf6aSIngo Molnar printk(KERN_INFO "early_iounmap(%p, %08lx) [%d]\n", addr, 463e64c8aa0SThomas Gleixner size, nesting); 464e64c8aa0SThomas Gleixner dump_stack(); 465e64c8aa0SThomas Gleixner } 466e64c8aa0SThomas Gleixner 467e64c8aa0SThomas Gleixner virt_addr = (unsigned long)addr; 468e64c8aa0SThomas Gleixner if (virt_addr < fix_to_virt(FIX_BTMAP_BEGIN)) { 469e64c8aa0SThomas Gleixner WARN_ON(1); 470e64c8aa0SThomas Gleixner return; 471e64c8aa0SThomas Gleixner } 472e64c8aa0SThomas Gleixner offset = virt_addr & ~PAGE_MASK; 473e64c8aa0SThomas Gleixner nrpages = PAGE_ALIGN(offset + size - 1) >> PAGE_SHIFT; 474e64c8aa0SThomas Gleixner 475e64c8aa0SThomas Gleixner idx = FIX_BTMAP_BEGIN - NR_FIX_BTMAPS*nesting; 476e64c8aa0SThomas Gleixner while (nrpages > 0) { 477e64c8aa0SThomas Gleixner early_clear_fixmap(idx); 478e64c8aa0SThomas Gleixner --idx; 479e64c8aa0SThomas Gleixner --nrpages; 480e64c8aa0SThomas Gleixner } 481e64c8aa0SThomas Gleixner } 482e64c8aa0SThomas Gleixner 483e64c8aa0SThomas Gleixner void __this_fixmap_does_not_exist(void) 484e64c8aa0SThomas Gleixner { 485e64c8aa0SThomas Gleixner WARN_ON(1); 486e64c8aa0SThomas Gleixner } 487e64c8aa0SThomas Gleixner 488e64c8aa0SThomas Gleixner #endif /* CONFIG_X86_32 */ 489