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