blob: b12f43c192cf71e839ffeb09ca3f6682690616b6 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 * Re-map IO memory to kernel address space so that we can access it.
3 * This is needed for high PCI addresses that aren't mapped in the
4 * 640k-1MB IO memory area on PC's
5 *
6 * (C) Copyright 1995 1996 Linus Torvalds
7 */
8
Thomas Gleixnere9332ca2008-01-30 13:34:05 +01009#include <linux/bootmem.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070010#include <linux/init.h>
Haavard Skinnemoena148ecf2006-09-30 23:29:17 -070011#include <linux/io.h>
Thomas Gleixner3cbd09e2008-01-30 13:34:05 +010012#include <linux/module.h>
13#include <linux/slab.h>
14#include <linux/vmalloc.h>
Pekka Paalanend61fc442008-05-12 21:20:57 +020015#include <linux/mmiotrace.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070016
Thomas Gleixner3cbd09e2008-01-30 13:34:05 +010017#include <asm/cacheflush.h>
18#include <asm/e820.h>
19#include <asm/fixmap.h>
20#include <asm/pgtable.h>
21#include <asm/tlbflush.h>
Jeremy Fitzhardingef6df72e2008-01-30 13:34:11 +010022#include <asm/pgalloc.h>
venkatesh.pallipadi@intel.comd7677d42008-03-18 17:00:17 -070023#include <asm/pat.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070024
Jeremy Fitzhardinge78c86e52009-09-10 10:09:38 -070025#include "physaddr.h"
Thomas Gleixner240d3a72008-01-30 13:34:05 +010026
Linus Torvalds1da177e2005-04-16 15:20:36 -070027/*
Thomas Gleixnere9332ca2008-01-30 13:34:05 +010028 * Fix up the linear direct mapping of the kernel to avoid cache attribute
29 * conflicts.
30 */
venkatesh.pallipadi@intel.com3a96ce82008-03-18 17:00:16 -070031int ioremap_change_attr(unsigned long vaddr, unsigned long size,
32 unsigned long prot_val)
Thomas Gleixnere9332ca2008-01-30 13:34:05 +010033{
Thomas Gleixnerd806e5e2008-01-30 13:34:06 +010034 unsigned long nrpages = size >> PAGE_SHIFT;
Harvey Harrison93809be2008-02-01 17:49:43 +010035 int err;
Thomas Gleixnere9332ca2008-01-30 13:34:05 +010036
venkatesh.pallipadi@intel.com3a96ce82008-03-18 17:00:16 -070037 switch (prot_val) {
38 case _PAGE_CACHE_UC:
Thomas Gleixnerd806e5e2008-01-30 13:34:06 +010039 default:
venkatesh.pallipadi@intel.com12193332008-03-18 17:00:18 -070040 err = _set_memory_uc(vaddr, nrpages);
Thomas Gleixnerd806e5e2008-01-30 13:34:06 +010041 break;
venkatesh.pallipadi@intel.comb310f381d2008-03-18 17:00:24 -070042 case _PAGE_CACHE_WC:
43 err = _set_memory_wc(vaddr, nrpages);
44 break;
venkatesh.pallipadi@intel.com3a96ce82008-03-18 17:00:16 -070045 case _PAGE_CACHE_WB:
venkatesh.pallipadi@intel.com12193332008-03-18 17:00:18 -070046 err = _set_memory_wb(vaddr, nrpages);
Thomas Gleixnerd806e5e2008-01-30 13:34:06 +010047 break;
48 }
Thomas Gleixnere9332ca2008-01-30 13:34:05 +010049
50 return err;
51}
52
Roland Dreierc81c8a12014-05-02 11:18:41 -070053static int __ioremap_check_ram(unsigned long start_pfn, unsigned long nr_pages,
54 void *arg)
55{
56 unsigned long i;
57
58 for (i = 0; i < nr_pages; ++i)
59 if (pfn_valid(start_pfn + i) &&
60 !PageReserved(pfn_to_page(start_pfn + i)))
61 return 1;
62
63 WARN_ONCE(1, "ioremap on RAM pfn 0x%lx\n", start_pfn);
64
65 return 0;
66}
67
Thomas Gleixnere9332ca2008-01-30 13:34:05 +010068/*
Linus Torvalds1da177e2005-04-16 15:20:36 -070069 * Remap an arbitrary physical address space into the kernel virtual
70 * address space. Needed when the kernel wants to access high addresses
71 * directly.
72 *
73 * NOTE! We need to allow non-page-aligned mappings too: we will obviously
74 * have to convert them into an offset in a page-aligned mapping, but the
75 * caller shouldn't need to know that small detail.
76 */
Christoph Lameter23016962008-04-28 02:12:42 -070077static void __iomem *__ioremap_caller(resource_size_t phys_addr,
78 unsigned long size, unsigned long prot_val, void *caller)
Linus Torvalds1da177e2005-04-16 15:20:36 -070079{
Kenji Kaneshigeffa71f32010-06-18 12:22:40 +090080 unsigned long offset, vaddr;
81 resource_size_t pfn, last_pfn, last_addr;
Pekka Paalanen87e547f2008-05-12 21:21:03 +020082 const resource_size_t unaligned_phys_addr = phys_addr;
83 const unsigned long unaligned_size = size;
Thomas Gleixner91eebf42008-01-30 13:34:05 +010084 struct vm_struct *area;
venkatesh.pallipadi@intel.comd7677d42008-03-18 17:00:17 -070085 unsigned long new_prot_val;
Thomas Gleixnerd806e5e2008-01-30 13:34:06 +010086 pgprot_t prot;
Venki Pallipadidee7cbb2008-03-24 14:39:55 -070087 int retval;
Pekka Paalanend61fc442008-05-12 21:20:57 +020088 void __iomem *ret_addr;
Mike Travis906e36c2014-10-13 15:54:05 -070089 int ram_region;
Linus Torvalds1da177e2005-04-16 15:20:36 -070090
91 /* Don't allow wraparound or zero size */
92 last_addr = phys_addr + size - 1;
93 if (!size || last_addr < phys_addr)
94 return NULL;
95
Thomas Gleixnere3100c82008-02-27 20:57:40 +010096 if (!phys_addr_valid(phys_addr)) {
venkatesh.pallipadi@intel.com6997ab42008-03-18 17:00:25 -070097 printk(KERN_WARNING "ioremap: invalid physical address %llx\n",
Randy Dunlap4c8337a2008-04-10 15:09:50 -070098 (unsigned long long)phys_addr);
Thomas Gleixnere3100c82008-02-27 20:57:40 +010099 WARN_ON_ONCE(1);
100 return NULL;
101 }
102
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103 /*
104 * Don't remap the low PCI/ISA area, it's always mapped..
105 */
Andreas Herrmannbcc643d2008-06-20 21:58:46 +0200106 if (is_ISA_range(phys_addr, last_addr))
Thomas Gleixner4b40fce2008-01-30 13:34:05 +0100107 return (__force void __iomem *)phys_to_virt(phys_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700108
109 /*
110 * Don't allow anybody to remap normal RAM that we're using..
111 */
Mike Travis906e36c2014-10-13 15:54:05 -0700112 /* First check if whole region can be identified as RAM or not */
113 ram_region = region_is_ram(phys_addr, size);
114 if (ram_region > 0) {
115 WARN_ONCE(1, "ioremap on RAM at 0x%lx - 0x%lx\n",
116 (unsigned long int)phys_addr,
117 (unsigned long int)last_addr);
Roland Dreierc81c8a12014-05-02 11:18:41 -0700118 return NULL;
Mike Travis906e36c2014-10-13 15:54:05 -0700119 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700120
Mike Travis906e36c2014-10-13 15:54:05 -0700121 /* If could not be identified(-1), check page by page */
122 if (ram_region < 0) {
123 pfn = phys_addr >> PAGE_SHIFT;
124 last_pfn = last_addr >> PAGE_SHIFT;
125 if (walk_system_ram_range(pfn, last_pfn - pfn + 1, NULL,
126 __ioremap_check_ram) == 1)
127 return NULL;
128 }
venkatesh.pallipadi@intel.comd7677d42008-03-18 17:00:17 -0700129 /*
130 * Mappings have to be page-aligned
131 */
132 offset = phys_addr & ~PAGE_MASK;
Kenji Kaneshigeffa71f32010-06-18 12:22:40 +0900133 phys_addr &= PHYSICAL_PAGE_MASK;
venkatesh.pallipadi@intel.comd7677d42008-03-18 17:00:17 -0700134 size = PAGE_ALIGN(last_addr+1) - phys_addr;
135
Andi Kleene213e872008-08-15 18:12:47 +0200136 retval = reserve_memtype(phys_addr, (u64)phys_addr + size,
Venki Pallipadidee7cbb2008-03-24 14:39:55 -0700137 prot_val, &new_prot_val);
138 if (retval) {
Venkatesh Pallipadi279e6692009-07-10 09:57:33 -0700139 printk(KERN_ERR "ioremap reserve_memtype failed %d\n", retval);
Venki Pallipadidee7cbb2008-03-24 14:39:55 -0700140 return NULL;
141 }
142
143 if (prot_val != new_prot_val) {
H. Peter Anvinb8551922009-08-26 17:17:51 -0700144 if (!is_new_memtype_allowed(phys_addr, size,
145 prot_val, new_prot_val)) {
Venkatesh Pallipadi279e6692009-07-10 09:57:33 -0700146 printk(KERN_ERR
venkatesh.pallipadi@intel.com6997ab42008-03-18 17:00:25 -0700147 "ioremap error for 0x%llx-0x%llx, requested 0x%lx, got 0x%lx\n",
Randy Dunlap4c8337a2008-04-10 15:09:50 -0700148 (unsigned long long)phys_addr,
149 (unsigned long long)(phys_addr + size),
venkatesh.pallipadi@intel.com6997ab42008-03-18 17:00:25 -0700150 prot_val, new_prot_val);
Xiaotian Fengde2a47c2009-11-05 10:43:51 +0800151 goto err_free_memtype;
venkatesh.pallipadi@intel.comd7677d42008-03-18 17:00:17 -0700152 }
153 prot_val = new_prot_val;
154 }
155
venkatesh.pallipadi@intel.com3a96ce82008-03-18 17:00:16 -0700156 switch (prot_val) {
157 case _PAGE_CACHE_UC:
Thomas Gleixnerd806e5e2008-01-30 13:34:06 +0100158 default:
Jeremy Fitzhardingebe43d722008-09-07 15:21:13 -0700159 prot = PAGE_KERNEL_IO_NOCACHE;
Thomas Gleixnerd806e5e2008-01-30 13:34:06 +0100160 break;
Suresh Siddhade33c442008-04-25 17:07:22 -0700161 case _PAGE_CACHE_UC_MINUS:
Jeremy Fitzhardingebe43d722008-09-07 15:21:13 -0700162 prot = PAGE_KERNEL_IO_UC_MINUS;
Suresh Siddhade33c442008-04-25 17:07:22 -0700163 break;
venkatesh.pallipadi@intel.comb310f381d2008-03-18 17:00:24 -0700164 case _PAGE_CACHE_WC:
Jeremy Fitzhardingebe43d722008-09-07 15:21:13 -0700165 prot = PAGE_KERNEL_IO_WC;
venkatesh.pallipadi@intel.comb310f381d2008-03-18 17:00:24 -0700166 break;
venkatesh.pallipadi@intel.com3a96ce82008-03-18 17:00:16 -0700167 case _PAGE_CACHE_WB:
Jeremy Fitzhardingebe43d722008-09-07 15:21:13 -0700168 prot = PAGE_KERNEL_IO;
Thomas Gleixnerd806e5e2008-01-30 13:34:06 +0100169 break;
170 }
Haavard Skinnemoena148ecf2006-09-30 23:29:17 -0700171
Linus Torvalds1da177e2005-04-16 15:20:36 -0700172 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700173 * Ok, go for it..
174 */
Christoph Lameter23016962008-04-28 02:12:42 -0700175 area = get_vm_area_caller(size, VM_IOREMAP, caller);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700176 if (!area)
Xiaotian Fengde2a47c2009-11-05 10:43:51 +0800177 goto err_free_memtype;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700178 area->phys_addr = phys_addr;
Thomas Gleixnere66aadb2008-02-04 16:48:05 +0100179 vaddr = (unsigned long) area->addr;
Suresh Siddha43a432b2009-04-09 14:26:47 -0700180
Xiaotian Fengde2a47c2009-11-05 10:43:51 +0800181 if (kernel_map_sync_memtype(phys_addr, size, prot_val))
182 goto err_free_area;
Thomas Gleixnere9332ca2008-01-30 13:34:05 +0100183
Xiaotian Fengde2a47c2009-11-05 10:43:51 +0800184 if (ioremap_page_range(vaddr, vaddr + size, phys_addr, prot))
185 goto err_free_area;
Thomas Gleixnere9332ca2008-01-30 13:34:05 +0100186
Pekka Paalanend61fc442008-05-12 21:20:57 +0200187 ret_addr = (void __iomem *) (vaddr + offset);
Pekka Paalanen87e547f2008-05-12 21:21:03 +0200188 mmiotrace_ioremap(unaligned_phys_addr, unaligned_size, ret_addr);
Pekka Paalanend61fc442008-05-12 21:20:57 +0200189
Tim Gardnerc7a7b8142011-04-28 11:00:30 -0600190 /*
191 * Check if the request spans more than any BAR in the iomem resource
192 * tree.
193 */
194 WARN_ONCE(iomem_map_sanity_check(unaligned_phys_addr, unaligned_size),
195 KERN_INFO "Info: mapping multiple BARs. Your kernel is fine.");
196
Pekka Paalanend61fc442008-05-12 21:20:57 +0200197 return ret_addr;
Xiaotian Fengde2a47c2009-11-05 10:43:51 +0800198err_free_area:
199 free_vm_area(area);
200err_free_memtype:
201 free_memtype(phys_addr, phys_addr + size);
202 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700203}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700204
205/**
206 * ioremap_nocache - map bus memory into CPU space
Wanpeng Li9efc31b2012-06-10 10:50:52 +0800207 * @phys_addr: bus address of the memory
Linus Torvalds1da177e2005-04-16 15:20:36 -0700208 * @size: size of the resource to map
209 *
210 * ioremap_nocache performs a platform specific sequence of operations to
211 * make bus memory CPU accessible via the readb/readw/readl/writeb/
212 * writew/writel functions and the other mmio helpers. The returned
213 * address is not guaranteed to be usable directly as a virtual
Thomas Gleixner91eebf42008-01-30 13:34:05 +0100214 * address.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700215 *
216 * This version of ioremap ensures that the memory is marked uncachable
217 * on the CPU as well as honouring existing caching rules from things like
Thomas Gleixner91eebf42008-01-30 13:34:05 +0100218 * the PCI bus. Note that there are other caches and buffers on many
Linus Torvalds1da177e2005-04-16 15:20:36 -0700219 * busses. In particular driver authors should read up on PCI writes
220 *
221 * It's useful if some control registers are in such an area and
222 * write combining or read caching is not desirable:
Thomas Gleixner91eebf42008-01-30 13:34:05 +0100223 *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700224 * Must be freed with iounmap.
225 */
Linus Torvaldsb9e76a02008-03-24 11:22:39 -0700226void __iomem *ioremap_nocache(resource_size_t phys_addr, unsigned long size)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700227{
Suresh Siddhade33c442008-04-25 17:07:22 -0700228 /*
229 * Ideally, this should be:
Andreas Herrmann499f8f82008-06-10 16:06:21 +0200230 * pat_enabled ? _PAGE_CACHE_UC : _PAGE_CACHE_UC_MINUS;
Suresh Siddhade33c442008-04-25 17:07:22 -0700231 *
232 * Till we fix all X drivers to use ioremap_wc(), we will use
233 * UC MINUS.
234 */
235 unsigned long val = _PAGE_CACHE_UC_MINUS;
236
237 return __ioremap_caller(phys_addr, size, val,
Christoph Lameter23016962008-04-28 02:12:42 -0700238 __builtin_return_address(0));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700239}
Alexey Dobriyan129f6942005-06-23 00:08:33 -0700240EXPORT_SYMBOL(ioremap_nocache);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700241
venkatesh.pallipadi@intel.comb310f381d2008-03-18 17:00:24 -0700242/**
243 * ioremap_wc - map memory into CPU space write combined
Wanpeng Li9efc31b2012-06-10 10:50:52 +0800244 * @phys_addr: bus address of the memory
venkatesh.pallipadi@intel.comb310f381d2008-03-18 17:00:24 -0700245 * @size: size of the resource to map
246 *
247 * This version of ioremap ensures that the memory is marked write combining.
248 * Write combining allows faster writes to some hardware devices.
249 *
250 * Must be freed with iounmap.
251 */
venkatesh.pallipadi@intel.comd639bab2009-01-09 16:13:13 -0800252void __iomem *ioremap_wc(resource_size_t phys_addr, unsigned long size)
venkatesh.pallipadi@intel.comb310f381d2008-03-18 17:00:24 -0700253{
Andreas Herrmann499f8f82008-06-10 16:06:21 +0200254 if (pat_enabled)
Christoph Lameter23016962008-04-28 02:12:42 -0700255 return __ioremap_caller(phys_addr, size, _PAGE_CACHE_WC,
256 __builtin_return_address(0));
venkatesh.pallipadi@intel.comb310f381d2008-03-18 17:00:24 -0700257 else
258 return ioremap_nocache(phys_addr, size);
259}
260EXPORT_SYMBOL(ioremap_wc);
261
Linus Torvaldsb9e76a02008-03-24 11:22:39 -0700262void __iomem *ioremap_cache(resource_size_t phys_addr, unsigned long size)
Thomas Gleixner5f868152008-01-30 13:34:06 +0100263{
Christoph Lameter23016962008-04-28 02:12:42 -0700264 return __ioremap_caller(phys_addr, size, _PAGE_CACHE_WB,
265 __builtin_return_address(0));
Thomas Gleixner5f868152008-01-30 13:34:06 +0100266}
267EXPORT_SYMBOL(ioremap_cache);
268
Rik van Riel28b2ee22008-07-23 21:27:05 -0700269void __iomem *ioremap_prot(resource_size_t phys_addr, unsigned long size,
270 unsigned long prot_val)
271{
272 return __ioremap_caller(phys_addr, size, (prot_val & _PAGE_CACHE_MASK),
273 __builtin_return_address(0));
274}
275EXPORT_SYMBOL(ioremap_prot);
276
Andi Kleenbf5421c2005-12-12 22:17:09 -0800277/**
278 * iounmap - Free a IO remapping
279 * @addr: virtual address from ioremap_*
280 *
281 * Caller must ensure there is only one unmapping for the same pointer.
282 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700283void iounmap(volatile void __iomem *addr)
284{
Andi Kleenbf5421c2005-12-12 22:17:09 -0800285 struct vm_struct *p, *o;
Andrew Mortonc23a4e962005-07-07 17:56:02 -0700286
287 if ((void __force *)addr <= high_memory)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700288 return;
289
290 /*
291 * __ioremap special-cases the PCI/ISA range by not instantiating a
292 * vm_area and by simply returning an address into the kernel mapping
293 * of ISA space. So handle that here.
294 */
Thomas Gleixner6e92a5a2008-05-12 15:43:35 +0200295 if ((void __force *)addr >= phys_to_virt(ISA_START_ADDRESS) &&
296 (void __force *)addr < phys_to_virt(ISA_END_ADDRESS))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700297 return;
298
Thomas Gleixner91eebf42008-01-30 13:34:05 +0100299 addr = (volatile void __iomem *)
300 (PAGE_MASK & (unsigned long __force)addr);
Andi Kleenbf5421c2005-12-12 22:17:09 -0800301
Pekka Paalanend61fc442008-05-12 21:20:57 +0200302 mmiotrace_iounmap(addr);
303
Andi Kleenbf5421c2005-12-12 22:17:09 -0800304 /* Use the vm area unlocked, assuming the caller
305 ensures there isn't another iounmap for the same address
306 in parallel. Reuse of the virtual address is prevented by
307 leaving it in the global lists until we're done with it.
308 cpa takes care of the direct mappings. */
Joonsoo Kimef932472013-04-29 15:07:27 -0700309 p = find_vm_area((void __force *)addr);
Andi Kleenbf5421c2005-12-12 22:17:09 -0800310
311 if (!p) {
Thomas Gleixner91eebf42008-01-30 13:34:05 +0100312 printk(KERN_ERR "iounmap: bad address %p\n", addr);
Andrew Mortonc23a4e962005-07-07 17:56:02 -0700313 dump_stack();
Andi Kleenbf5421c2005-12-12 22:17:09 -0800314 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700315 }
316
venkatesh.pallipadi@intel.comd7677d42008-03-18 17:00:17 -0700317 free_memtype(p->phys_addr, p->phys_addr + get_vm_area_size(p));
318
Andi Kleenbf5421c2005-12-12 22:17:09 -0800319 /* Finally remove it */
Thomas Gleixner6e92a5a2008-05-12 15:43:35 +0200320 o = remove_vm_area((void __force *)addr);
Andi Kleenbf5421c2005-12-12 22:17:09 -0800321 BUG_ON(p != o || o == NULL);
Thomas Gleixner91eebf42008-01-30 13:34:05 +0100322 kfree(p);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700323}
Alexey Dobriyan129f6942005-06-23 00:08:33 -0700324EXPORT_SYMBOL(iounmap);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700325
venkatesh.pallipadi@intel.come045fb22008-03-18 17:00:15 -0700326/*
327 * Convert a physical pointer to a virtual kernel pointer for /dev/mem
328 * access
329 */
Thierry Reding4707a342014-07-28 17:20:33 +0200330void *xlate_dev_mem_ptr(phys_addr_t phys)
venkatesh.pallipadi@intel.come045fb22008-03-18 17:00:15 -0700331{
332 void *addr;
333 unsigned long start = phys & PAGE_MASK;
334
335 /* If page is RAM, we can use __va. Otherwise ioremap and unmap. */
336 if (page_is_ram(start >> PAGE_SHIFT))
337 return __va(phys);
338
Xiaotian Feng2fb8f4e2009-11-10 17:23:25 +0800339 addr = (void __force *)ioremap_cache(start, PAGE_SIZE);
venkatesh.pallipadi@intel.come045fb22008-03-18 17:00:15 -0700340 if (addr)
341 addr = (void *)((unsigned long)addr | (phys & ~PAGE_MASK));
342
343 return addr;
344}
345
Thierry Reding4707a342014-07-28 17:20:33 +0200346void unxlate_dev_mem_ptr(phys_addr_t phys, void *addr)
venkatesh.pallipadi@intel.come045fb22008-03-18 17:00:15 -0700347{
348 if (page_is_ram(phys >> PAGE_SHIFT))
349 return;
350
351 iounmap((void __iomem *)((unsigned long)addr & PAGE_MASK));
352 return;
353}
354
Jeremy Fitzhardinge45c7b282009-03-20 17:53:34 -0700355static pte_t bm_pte[PAGE_SIZE/sizeof(pte_t)] __page_aligned_bss;
Huang, Ying0947b2f2008-01-30 13:33:44 +0100356
Ian Campbell551889a2008-02-09 23:24:09 +0100357static inline pmd_t * __init early_ioremap_pmd(unsigned long addr)
Huang, Ying0947b2f2008-01-30 13:33:44 +0100358{
Jeremy Fitzhardinge37cc8d72008-02-13 16:20:35 +0100359 /* Don't assume we're using swapper_pg_dir at this point */
360 pgd_t *base = __va(read_cr3());
361 pgd_t *pgd = &base[pgd_index(addr)];
Ian Campbell551889a2008-02-09 23:24:09 +0100362 pud_t *pud = pud_offset(pgd, addr);
363 pmd_t *pmd = pmd_offset(pud, addr);
364
365 return pmd;
Huang, Ying0947b2f2008-01-30 13:33:44 +0100366}
367
Ian Campbell551889a2008-02-09 23:24:09 +0100368static inline pte_t * __init early_ioremap_pte(unsigned long addr)
Huang, Ying0947b2f2008-01-30 13:33:44 +0100369{
Ian Campbell551889a2008-02-09 23:24:09 +0100370 return &bm_pte[pte_index(addr)];
Huang, Ying0947b2f2008-01-30 13:33:44 +0100371}
372
Jeremy Fitzhardingefef5ba72010-10-13 16:02:24 -0700373bool __init is_early_ioremap_ptep(pte_t *ptep)
374{
375 return ptep >= &bm_pte[0] && ptep < &bm_pte[PAGE_SIZE/sizeof(pte_t)];
376}
377
Huang, Yingbeacfaa2008-01-30 13:33:44 +0100378void __init early_ioremap_init(void)
Huang, Ying0947b2f2008-01-30 13:33:44 +0100379{
Ian Campbell551889a2008-02-09 23:24:09 +0100380 pmd_t *pmd;
Huang, Ying0947b2f2008-01-30 13:33:44 +0100381
Andy Lutomirski73159fd2014-05-05 12:19:31 -0700382#ifdef CONFIG_X86_64
383 BUILD_BUG_ON((fix_to_virt(0) + PAGE_SIZE) & ((1 << PMD_SHIFT) - 1));
384#else
385 WARN_ON((fix_to_virt(0) + PAGE_SIZE) & ((1 << PMD_SHIFT) - 1));
386#endif
387
Mark Salter5b7c73e2014-04-07 15:39:49 -0700388 early_ioremap_setup();
Wang Chen88272472009-03-07 13:34:19 +0800389
Ian Campbell551889a2008-02-09 23:24:09 +0100390 pmd = early_ioremap_pmd(fix_to_virt(FIX_BTMAP_BEGIN));
Jeremy Fitzhardinge45c7b282009-03-20 17:53:34 -0700391 memset(bm_pte, 0, sizeof(bm_pte));
392 pmd_populate_kernel(&init_mm, pmd, bm_pte);
Ian Campbell551889a2008-02-09 23:24:09 +0100393
Ingo Molnar0e3a9542008-01-30 13:33:49 +0100394 /*
Ian Campbell551889a2008-02-09 23:24:09 +0100395 * The boot-ioremap range spans multiple pmds, for which
Ingo Molnar0e3a9542008-01-30 13:33:49 +0100396 * we are not prepared:
397 */
Jan Beulich499a5f12009-12-18 16:05:51 +0000398#define __FIXADDR_TOP (-PAGE_SIZE)
399 BUILD_BUG_ON((__fix_to_virt(FIX_BTMAP_BEGIN) >> PMD_SHIFT)
400 != (__fix_to_virt(FIX_BTMAP_END) >> PMD_SHIFT));
401#undef __FIXADDR_TOP
Ian Campbell551889a2008-02-09 23:24:09 +0100402 if (pmd != early_ioremap_pmd(fix_to_virt(FIX_BTMAP_END))) {
Ingo Molnar0e3a9542008-01-30 13:33:49 +0100403 WARN_ON(1);
Ian Campbell551889a2008-02-09 23:24:09 +0100404 printk(KERN_WARNING "pmd %p != %p\n",
405 pmd, early_ioremap_pmd(fix_to_virt(FIX_BTMAP_END)));
Thomas Gleixner91eebf42008-01-30 13:34:05 +0100406 printk(KERN_WARNING "fix_to_virt(FIX_BTMAP_BEGIN): %08lx\n",
Ian Campbell551889a2008-02-09 23:24:09 +0100407 fix_to_virt(FIX_BTMAP_BEGIN));
Thomas Gleixner91eebf42008-01-30 13:34:05 +0100408 printk(KERN_WARNING "fix_to_virt(FIX_BTMAP_END): %08lx\n",
Ian Campbell551889a2008-02-09 23:24:09 +0100409 fix_to_virt(FIX_BTMAP_END));
Ingo Molnar0e3a9542008-01-30 13:33:49 +0100410
Thomas Gleixner91eebf42008-01-30 13:34:05 +0100411 printk(KERN_WARNING "FIX_BTMAP_END: %d\n", FIX_BTMAP_END);
412 printk(KERN_WARNING "FIX_BTMAP_BEGIN: %d\n",
413 FIX_BTMAP_BEGIN);
Ingo Molnar0e3a9542008-01-30 13:33:49 +0100414 }
Huang, Ying0947b2f2008-01-30 13:33:44 +0100415}
416
Mark Salter5b7c73e2014-04-07 15:39:49 -0700417void __init __early_set_fixmap(enum fixed_addresses idx,
418 phys_addr_t phys, pgprot_t flags)
Huang, Ying0947b2f2008-01-30 13:33:44 +0100419{
Ian Campbell551889a2008-02-09 23:24:09 +0100420 unsigned long addr = __fix_to_virt(idx);
421 pte_t *pte;
Huang, Ying0947b2f2008-01-30 13:33:44 +0100422
423 if (idx >= __end_of_fixed_addresses) {
424 BUG();
425 return;
426 }
Huang, Yingbeacfaa2008-01-30 13:33:44 +0100427 pte = early_ioremap_pte(addr);
Jeremy Fitzhardinge4583ed52008-06-25 00:19:03 -0400428
Huang, Ying0947b2f2008-01-30 13:33:44 +0100429 if (pgprot_val(flags))
Ian Campbell551889a2008-02-09 23:24:09 +0100430 set_pte(pte, pfn_pte(phys >> PAGE_SHIFT, flags));
Huang, Ying0947b2f2008-01-30 13:33:44 +0100431 else
Jeremy Fitzhardinge4f9c11d2008-06-25 00:19:19 -0400432 pte_clear(&init_mm, addr, pte);
Huang, Ying0947b2f2008-01-30 13:33:44 +0100433 __flush_tlb_one(addr);
434}