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