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