Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
1da177e4 LT |
2 | * 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 | ||
e9332cac | 9 | #include <linux/bootmem.h> |
1da177e4 | 10 | #include <linux/init.h> |
a148ecfd | 11 | #include <linux/io.h> |
3cbd09e4 TG |
12 | #include <linux/module.h> |
13 | #include <linux/slab.h> | |
14 | #include <linux/vmalloc.h> | |
d61fc448 | 15 | #include <linux/mmiotrace.h> |
3cbd09e4 | 16 | |
1da177e4 | 17 | #include <asm/cacheflush.h> |
3cbd09e4 TG |
18 | #include <asm/e820.h> |
19 | #include <asm/fixmap.h> | |
1da177e4 | 20 | #include <asm/pgtable.h> |
3cbd09e4 | 21 | #include <asm/tlbflush.h> |
f6df72e7 | 22 | #include <asm/pgalloc.h> |
d7677d40 | 23 | #include <asm/pat.h> |
1da177e4 | 24 | |
240d3a7c TG |
25 | #ifdef CONFIG_X86_64 |
26 | ||
27 | unsigned long __phys_addr(unsigned long x) | |
28 | { | |
29 | if (x >= __START_KERNEL_map) | |
30 | return x - __START_KERNEL_map + phys_base; | |
31 | return x - PAGE_OFFSET; | |
32 | } | |
33 | EXPORT_SYMBOL(__phys_addr); | |
34 | ||
e3100c82 TG |
35 | static inline int phys_addr_valid(unsigned long addr) |
36 | { | |
37 | return addr < (1UL << boot_cpu_data.x86_phys_bits); | |
38 | } | |
39 | ||
40 | #else | |
41 | ||
42 | static inline int phys_addr_valid(unsigned long addr) | |
43 | { | |
44 | return 1; | |
45 | } | |
46 | ||
240d3a7c TG |
47 | #endif |
48 | ||
5f5192b9 TG |
49 | int page_is_ram(unsigned long pagenr) |
50 | { | |
756a6c68 | 51 | resource_size_t addr, end; |
5f5192b9 TG |
52 | int i; |
53 | ||
d8a9e6a5 AV |
54 | /* |
55 | * A special case is the first 4Kb of memory; | |
56 | * This is a BIOS owned area, not kernel ram, but generally | |
57 | * not listed as such in the E820 table. | |
58 | */ | |
59 | if (pagenr == 0) | |
60 | return 0; | |
61 | ||
156fbc3f AV |
62 | /* |
63 | * Second special case: Some BIOSen report the PC BIOS | |
64 | * area (640->1Mb) as ram even though it is not. | |
65 | */ | |
66 | if (pagenr >= (BIOS_BEGIN >> PAGE_SHIFT) && | |
67 | pagenr < (BIOS_END >> PAGE_SHIFT)) | |
68 | return 0; | |
d8a9e6a5 | 69 | |
5f5192b9 TG |
70 | for (i = 0; i < e820.nr_map; i++) { |
71 | /* | |
72 | * Not usable memory: | |
73 | */ | |
74 | if (e820.map[i].type != E820_RAM) | |
75 | continue; | |
5f5192b9 TG |
76 | addr = (e820.map[i].addr + PAGE_SIZE-1) >> PAGE_SHIFT; |
77 | end = (e820.map[i].addr + e820.map[i].size) >> PAGE_SHIFT; | |
950f9d95 | 78 | |
950f9d95 | 79 | |
5f5192b9 TG |
80 | if ((pagenr >= addr) && (pagenr < end)) |
81 | return 1; | |
82 | } | |
83 | return 0; | |
84 | } | |
85 | ||
e9332cac TG |
86 | /* |
87 | * Fix up the linear direct mapping of the kernel to avoid cache attribute | |
88 | * conflicts. | |
89 | */ | |
3a96ce8c | 90 | int ioremap_change_attr(unsigned long vaddr, unsigned long size, |
91 | unsigned long prot_val) | |
e9332cac | 92 | { |
d806e5ee | 93 | unsigned long nrpages = size >> PAGE_SHIFT; |
93809be8 | 94 | int err; |
e9332cac | 95 | |
3a96ce8c | 96 | switch (prot_val) { |
97 | case _PAGE_CACHE_UC: | |
d806e5ee | 98 | default: |
1219333d | 99 | err = _set_memory_uc(vaddr, nrpages); |
d806e5ee | 100 | break; |
b310f381 | 101 | case _PAGE_CACHE_WC: |
102 | err = _set_memory_wc(vaddr, nrpages); | |
103 | break; | |
3a96ce8c | 104 | case _PAGE_CACHE_WB: |
1219333d | 105 | err = _set_memory_wb(vaddr, nrpages); |
d806e5ee TG |
106 | break; |
107 | } | |
e9332cac TG |
108 | |
109 | return err; | |
110 | } | |
111 | ||
1da177e4 LT |
112 | /* |
113 | * Remap an arbitrary physical address space into the kernel virtual | |
114 | * address space. Needed when the kernel wants to access high addresses | |
115 | * directly. | |
116 | * | |
117 | * NOTE! We need to allow non-page-aligned mappings too: we will obviously | |
118 | * have to convert them into an offset in a page-aligned mapping, but the | |
119 | * caller shouldn't need to know that small detail. | |
120 | */ | |
23016969 CL |
121 | static void __iomem *__ioremap_caller(resource_size_t phys_addr, |
122 | unsigned long size, unsigned long prot_val, void *caller) | |
1da177e4 | 123 | { |
756a6c68 IM |
124 | unsigned long pfn, offset, vaddr; |
125 | resource_size_t last_addr; | |
87e547fe PP |
126 | const resource_size_t unaligned_phys_addr = phys_addr; |
127 | const unsigned long unaligned_size = size; | |
91eebf40 | 128 | struct vm_struct *area; |
d7677d40 | 129 | unsigned long new_prot_val; |
d806e5ee | 130 | pgprot_t prot; |
dee7cbb2 | 131 | int retval; |
d61fc448 | 132 | void __iomem *ret_addr; |
1da177e4 LT |
133 | |
134 | /* Don't allow wraparound or zero size */ | |
135 | last_addr = phys_addr + size - 1; | |
136 | if (!size || last_addr < phys_addr) | |
137 | return NULL; | |
138 | ||
e3100c82 | 139 | if (!phys_addr_valid(phys_addr)) { |
6997ab49 | 140 | printk(KERN_WARNING "ioremap: invalid physical address %llx\n", |
4c8337ac | 141 | (unsigned long long)phys_addr); |
e3100c82 TG |
142 | WARN_ON_ONCE(1); |
143 | return NULL; | |
144 | } | |
145 | ||
1da177e4 LT |
146 | /* |
147 | * Don't remap the low PCI/ISA area, it's always mapped.. | |
148 | */ | |
bcc643dc | 149 | if (is_ISA_range(phys_addr, last_addr)) |
4b40fcee | 150 | return (__force void __iomem *)phys_to_virt(phys_addr); |
1da177e4 LT |
151 | |
152 | /* | |
153 | * Don't allow anybody to remap normal RAM that we're using.. | |
154 | */ | |
cb8ab687 AS |
155 | for (pfn = phys_addr >> PAGE_SHIFT; |
156 | (pfn << PAGE_SHIFT) < (last_addr & PAGE_MASK); | |
157 | pfn++) { | |
bdd3cee2 | 158 | |
ba748d22 IM |
159 | int is_ram = page_is_ram(pfn); |
160 | ||
161 | if (is_ram && pfn_valid(pfn) && !PageReserved(pfn_to_page(pfn))) | |
266b9f87 | 162 | return NULL; |
ba748d22 | 163 | WARN_ON_ONCE(is_ram); |
1da177e4 LT |
164 | } |
165 | ||
d7677d40 | 166 | /* |
167 | * Mappings have to be page-aligned | |
168 | */ | |
169 | offset = phys_addr & ~PAGE_MASK; | |
170 | phys_addr &= PAGE_MASK; | |
171 | size = PAGE_ALIGN(last_addr+1) - phys_addr; | |
172 | ||
dee7cbb2 VP |
173 | retval = reserve_memtype(phys_addr, phys_addr + size, |
174 | prot_val, &new_prot_val); | |
175 | if (retval) { | |
b450e5e8 | 176 | pr_debug("Warning: reserve_memtype returned %d\n", retval); |
dee7cbb2 VP |
177 | return NULL; |
178 | } | |
179 | ||
180 | if (prot_val != new_prot_val) { | |
d7677d40 | 181 | /* |
182 | * Do not fallback to certain memory types with certain | |
183 | * requested type: | |
de33c442 SS |
184 | * - request is uc-, return cannot be write-back |
185 | * - request is uc-, return cannot be write-combine | |
b310f381 | 186 | * - request is write-combine, return cannot be write-back |
d7677d40 | 187 | */ |
de33c442 | 188 | if ((prot_val == _PAGE_CACHE_UC_MINUS && |
b310f381 | 189 | (new_prot_val == _PAGE_CACHE_WB || |
190 | new_prot_val == _PAGE_CACHE_WC)) || | |
191 | (prot_val == _PAGE_CACHE_WC && | |
d7677d40 | 192 | new_prot_val == _PAGE_CACHE_WB)) { |
b450e5e8 | 193 | pr_debug( |
6997ab49 | 194 | "ioremap error for 0x%llx-0x%llx, requested 0x%lx, got 0x%lx\n", |
4c8337ac RD |
195 | (unsigned long long)phys_addr, |
196 | (unsigned long long)(phys_addr + size), | |
6997ab49 | 197 | prot_val, new_prot_val); |
d7677d40 | 198 | free_memtype(phys_addr, phys_addr + size); |
199 | return NULL; | |
200 | } | |
201 | prot_val = new_prot_val; | |
202 | } | |
203 | ||
3a96ce8c | 204 | switch (prot_val) { |
205 | case _PAGE_CACHE_UC: | |
d806e5ee | 206 | default: |
55c62682 | 207 | prot = PAGE_KERNEL_NOCACHE; |
d806e5ee | 208 | break; |
de33c442 SS |
209 | case _PAGE_CACHE_UC_MINUS: |
210 | prot = PAGE_KERNEL_UC_MINUS; | |
211 | break; | |
b310f381 | 212 | case _PAGE_CACHE_WC: |
213 | prot = PAGE_KERNEL_WC; | |
214 | break; | |
3a96ce8c | 215 | case _PAGE_CACHE_WB: |
d806e5ee TG |
216 | prot = PAGE_KERNEL; |
217 | break; | |
218 | } | |
a148ecfd | 219 | |
1da177e4 LT |
220 | /* |
221 | * Ok, go for it.. | |
222 | */ | |
23016969 | 223 | area = get_vm_area_caller(size, VM_IOREMAP, caller); |
1da177e4 LT |
224 | if (!area) |
225 | return NULL; | |
226 | area->phys_addr = phys_addr; | |
e66aadbe TG |
227 | vaddr = (unsigned long) area->addr; |
228 | if (ioremap_page_range(vaddr, vaddr + size, phys_addr, prot)) { | |
d7677d40 | 229 | free_memtype(phys_addr, phys_addr + size); |
b16bf712 | 230 | free_vm_area(area); |
1da177e4 LT |
231 | return NULL; |
232 | } | |
e9332cac | 233 | |
3a96ce8c | 234 | if (ioremap_change_attr(vaddr, size, prot_val) < 0) { |
d7677d40 | 235 | free_memtype(phys_addr, phys_addr + size); |
e66aadbe | 236 | vunmap(area->addr); |
e9332cac TG |
237 | return NULL; |
238 | } | |
239 | ||
d61fc448 | 240 | ret_addr = (void __iomem *) (vaddr + offset); |
87e547fe | 241 | mmiotrace_ioremap(unaligned_phys_addr, unaligned_size, ret_addr); |
d61fc448 PP |
242 | |
243 | return ret_addr; | |
1da177e4 | 244 | } |
1da177e4 LT |
245 | |
246 | /** | |
247 | * ioremap_nocache - map bus memory into CPU space | |
248 | * @offset: bus address of the memory | |
249 | * @size: size of the resource to map | |
250 | * | |
251 | * ioremap_nocache performs a platform specific sequence of operations to | |
252 | * make bus memory CPU accessible via the readb/readw/readl/writeb/ | |
253 | * writew/writel functions and the other mmio helpers. The returned | |
254 | * address is not guaranteed to be usable directly as a virtual | |
91eebf40 | 255 | * address. |
1da177e4 LT |
256 | * |
257 | * This version of ioremap ensures that the memory is marked uncachable | |
258 | * on the CPU as well as honouring existing caching rules from things like | |
91eebf40 | 259 | * the PCI bus. Note that there are other caches and buffers on many |
1da177e4 LT |
260 | * busses. In particular driver authors should read up on PCI writes |
261 | * | |
262 | * It's useful if some control registers are in such an area and | |
263 | * write combining or read caching is not desirable: | |
91eebf40 | 264 | * |
1da177e4 LT |
265 | * Must be freed with iounmap. |
266 | */ | |
b9e76a00 | 267 | void __iomem *ioremap_nocache(resource_size_t phys_addr, unsigned long size) |
1da177e4 | 268 | { |
de33c442 SS |
269 | /* |
270 | * Ideally, this should be: | |
499f8f84 | 271 | * pat_enabled ? _PAGE_CACHE_UC : _PAGE_CACHE_UC_MINUS; |
de33c442 SS |
272 | * |
273 | * Till we fix all X drivers to use ioremap_wc(), we will use | |
274 | * UC MINUS. | |
275 | */ | |
276 | unsigned long val = _PAGE_CACHE_UC_MINUS; | |
277 | ||
278 | return __ioremap_caller(phys_addr, size, val, | |
23016969 | 279 | __builtin_return_address(0)); |
1da177e4 | 280 | } |
129f6946 | 281 | EXPORT_SYMBOL(ioremap_nocache); |
1da177e4 | 282 | |
b310f381 | 283 | /** |
284 | * ioremap_wc - map memory into CPU space write combined | |
285 | * @offset: bus address of the memory | |
286 | * @size: size of the resource to map | |
287 | * | |
288 | * This version of ioremap ensures that the memory is marked write combining. | |
289 | * Write combining allows faster writes to some hardware devices. | |
290 | * | |
291 | * Must be freed with iounmap. | |
292 | */ | |
293 | void __iomem *ioremap_wc(unsigned long phys_addr, unsigned long size) | |
294 | { | |
499f8f84 | 295 | if (pat_enabled) |
23016969 CL |
296 | return __ioremap_caller(phys_addr, size, _PAGE_CACHE_WC, |
297 | __builtin_return_address(0)); | |
b310f381 | 298 | else |
299 | return ioremap_nocache(phys_addr, size); | |
300 | } | |
301 | EXPORT_SYMBOL(ioremap_wc); | |
302 | ||
b9e76a00 | 303 | void __iomem *ioremap_cache(resource_size_t phys_addr, unsigned long size) |
5f868152 | 304 | { |
23016969 CL |
305 | return __ioremap_caller(phys_addr, size, _PAGE_CACHE_WB, |
306 | __builtin_return_address(0)); | |
5f868152 TG |
307 | } |
308 | EXPORT_SYMBOL(ioremap_cache); | |
309 | ||
a361ee5c VP |
310 | static void __iomem *ioremap_default(resource_size_t phys_addr, |
311 | unsigned long size) | |
312 | { | |
313 | unsigned long flags; | |
314 | void *ret; | |
315 | int err; | |
316 | ||
317 | /* | |
318 | * - WB for WB-able memory and no other conflicting mappings | |
319 | * - UC_MINUS for non-WB-able memory with no other conflicting mappings | |
320 | * - Inherit from confliting mappings otherwise | |
321 | */ | |
322 | err = reserve_memtype(phys_addr, phys_addr + size, -1, &flags); | |
323 | if (err < 0) | |
324 | return NULL; | |
325 | ||
326 | ret = (void *) __ioremap_caller(phys_addr, size, flags, | |
327 | __builtin_return_address(0)); | |
328 | ||
329 | free_memtype(phys_addr, phys_addr + size); | |
330 | return (void __iomem *)ret; | |
331 | } | |
332 | ||
28b2ee20 RR |
333 | void __iomem *ioremap_prot(resource_size_t phys_addr, unsigned long size, |
334 | unsigned long prot_val) | |
335 | { | |
336 | return __ioremap_caller(phys_addr, size, (prot_val & _PAGE_CACHE_MASK), | |
337 | __builtin_return_address(0)); | |
338 | } | |
339 | EXPORT_SYMBOL(ioremap_prot); | |
340 | ||
bf5421c3 AK |
341 | /** |
342 | * iounmap - Free a IO remapping | |
343 | * @addr: virtual address from ioremap_* | |
344 | * | |
345 | * Caller must ensure there is only one unmapping for the same pointer. | |
346 | */ | |
1da177e4 LT |
347 | void iounmap(volatile void __iomem *addr) |
348 | { | |
bf5421c3 | 349 | struct vm_struct *p, *o; |
c23a4e96 AM |
350 | |
351 | if ((void __force *)addr <= high_memory) | |
1da177e4 LT |
352 | return; |
353 | ||
354 | /* | |
355 | * __ioremap special-cases the PCI/ISA range by not instantiating a | |
356 | * vm_area and by simply returning an address into the kernel mapping | |
357 | * of ISA space. So handle that here. | |
358 | */ | |
6e92a5a6 TG |
359 | if ((void __force *)addr >= phys_to_virt(ISA_START_ADDRESS) && |
360 | (void __force *)addr < phys_to_virt(ISA_END_ADDRESS)) | |
1da177e4 LT |
361 | return; |
362 | ||
91eebf40 TG |
363 | addr = (volatile void __iomem *) |
364 | (PAGE_MASK & (unsigned long __force)addr); | |
bf5421c3 | 365 | |
d61fc448 PP |
366 | mmiotrace_iounmap(addr); |
367 | ||
bf5421c3 AK |
368 | /* Use the vm area unlocked, assuming the caller |
369 | ensures there isn't another iounmap for the same address | |
370 | in parallel. Reuse of the virtual address is prevented by | |
371 | leaving it in the global lists until we're done with it. | |
372 | cpa takes care of the direct mappings. */ | |
373 | read_lock(&vmlist_lock); | |
374 | for (p = vmlist; p; p = p->next) { | |
6e92a5a6 | 375 | if (p->addr == (void __force *)addr) |
bf5421c3 AK |
376 | break; |
377 | } | |
378 | read_unlock(&vmlist_lock); | |
379 | ||
380 | if (!p) { | |
91eebf40 | 381 | printk(KERN_ERR "iounmap: bad address %p\n", addr); |
c23a4e96 | 382 | dump_stack(); |
bf5421c3 | 383 | return; |
1da177e4 LT |
384 | } |
385 | ||
d7677d40 | 386 | free_memtype(p->phys_addr, p->phys_addr + get_vm_area_size(p)); |
387 | ||
bf5421c3 | 388 | /* Finally remove it */ |
6e92a5a6 | 389 | o = remove_vm_area((void __force *)addr); |
bf5421c3 | 390 | BUG_ON(p != o || o == NULL); |
91eebf40 | 391 | kfree(p); |
1da177e4 | 392 | } |
129f6946 | 393 | EXPORT_SYMBOL(iounmap); |
1da177e4 | 394 | |
e045fb2a | 395 | /* |
396 | * Convert a physical pointer to a virtual kernel pointer for /dev/mem | |
397 | * access | |
398 | */ | |
399 | void *xlate_dev_mem_ptr(unsigned long phys) | |
400 | { | |
401 | void *addr; | |
402 | unsigned long start = phys & PAGE_MASK; | |
403 | ||
404 | /* If page is RAM, we can use __va. Otherwise ioremap and unmap. */ | |
405 | if (page_is_ram(start >> PAGE_SHIFT)) | |
406 | return __va(phys); | |
407 | ||
ae94b807 | 408 | addr = (void __force *)ioremap_default(start, PAGE_SIZE); |
e045fb2a | 409 | if (addr) |
410 | addr = (void *)((unsigned long)addr | (phys & ~PAGE_MASK)); | |
411 | ||
412 | return addr; | |
413 | } | |
414 | ||
415 | void unxlate_dev_mem_ptr(unsigned long phys, void *addr) | |
416 | { | |
417 | if (page_is_ram(phys >> PAGE_SHIFT)) | |
418 | return; | |
419 | ||
420 | iounmap((void __iomem *)((unsigned long)addr & PAGE_MASK)); | |
421 | return; | |
422 | } | |
423 | ||
d18d6d65 IM |
424 | int __initdata early_ioremap_debug; |
425 | ||
426 | static int __init early_ioremap_debug_setup(char *str) | |
427 | { | |
428 | early_ioremap_debug = 1; | |
429 | ||
793b24a2 | 430 | return 0; |
d18d6d65 | 431 | } |
793b24a2 | 432 | early_param("early_ioremap_debug", early_ioremap_debug_setup); |
d18d6d65 | 433 | |
0947b2f3 | 434 | static __initdata int after_paging_init; |
a7bf0bd5 | 435 | static pte_t bm_pte[PAGE_SIZE/sizeof(pte_t)] __page_aligned_bss; |
0947b2f3 | 436 | |
551889a6 | 437 | static inline pmd_t * __init early_ioremap_pmd(unsigned long addr) |
0947b2f3 | 438 | { |
37cc8d7f JF |
439 | /* Don't assume we're using swapper_pg_dir at this point */ |
440 | pgd_t *base = __va(read_cr3()); | |
441 | pgd_t *pgd = &base[pgd_index(addr)]; | |
551889a6 IC |
442 | pud_t *pud = pud_offset(pgd, addr); |
443 | pmd_t *pmd = pmd_offset(pud, addr); | |
444 | ||
445 | return pmd; | |
0947b2f3 HY |
446 | } |
447 | ||
551889a6 | 448 | static inline pte_t * __init early_ioremap_pte(unsigned long addr) |
0947b2f3 | 449 | { |
551889a6 | 450 | return &bm_pte[pte_index(addr)]; |
0947b2f3 HY |
451 | } |
452 | ||
beacfaac | 453 | void __init early_ioremap_init(void) |
0947b2f3 | 454 | { |
551889a6 | 455 | pmd_t *pmd; |
0947b2f3 | 456 | |
d18d6d65 | 457 | if (early_ioremap_debug) |
adafdf6a | 458 | printk(KERN_INFO "early_ioremap_init()\n"); |
d18d6d65 | 459 | |
551889a6 | 460 | pmd = early_ioremap_pmd(fix_to_virt(FIX_BTMAP_BEGIN)); |
0947b2f3 | 461 | memset(bm_pte, 0, sizeof(bm_pte)); |
b6fbb669 | 462 | pmd_populate_kernel(&init_mm, pmd, bm_pte); |
551889a6 | 463 | |
0e3a9549 | 464 | /* |
551889a6 | 465 | * The boot-ioremap range spans multiple pmds, for which |
0e3a9549 IM |
466 | * we are not prepared: |
467 | */ | |
551889a6 | 468 | if (pmd != early_ioremap_pmd(fix_to_virt(FIX_BTMAP_END))) { |
0e3a9549 | 469 | WARN_ON(1); |
551889a6 IC |
470 | printk(KERN_WARNING "pmd %p != %p\n", |
471 | pmd, early_ioremap_pmd(fix_to_virt(FIX_BTMAP_END))); | |
91eebf40 | 472 | printk(KERN_WARNING "fix_to_virt(FIX_BTMAP_BEGIN): %08lx\n", |
551889a6 | 473 | fix_to_virt(FIX_BTMAP_BEGIN)); |
91eebf40 | 474 | printk(KERN_WARNING "fix_to_virt(FIX_BTMAP_END): %08lx\n", |
551889a6 | 475 | fix_to_virt(FIX_BTMAP_END)); |
91eebf40 TG |
476 | |
477 | printk(KERN_WARNING "FIX_BTMAP_END: %d\n", FIX_BTMAP_END); | |
478 | printk(KERN_WARNING "FIX_BTMAP_BEGIN: %d\n", | |
479 | FIX_BTMAP_BEGIN); | |
0e3a9549 | 480 | } |
0947b2f3 HY |
481 | } |
482 | ||
beacfaac | 483 | void __init early_ioremap_clear(void) |
0947b2f3 | 484 | { |
551889a6 | 485 | pmd_t *pmd; |
0947b2f3 | 486 | |
d18d6d65 | 487 | if (early_ioremap_debug) |
adafdf6a | 488 | printk(KERN_INFO "early_ioremap_clear()\n"); |
d18d6d65 | 489 | |
551889a6 IC |
490 | pmd = early_ioremap_pmd(fix_to_virt(FIX_BTMAP_BEGIN)); |
491 | pmd_clear(pmd); | |
6944a9c8 | 492 | paravirt_release_pte(__pa(bm_pte) >> PAGE_SHIFT); |
0947b2f3 HY |
493 | __flush_tlb_all(); |
494 | } | |
495 | ||
beacfaac | 496 | void __init early_ioremap_reset(void) |
0947b2f3 HY |
497 | { |
498 | enum fixed_addresses idx; | |
551889a6 IC |
499 | unsigned long addr, phys; |
500 | pte_t *pte; | |
0947b2f3 HY |
501 | |
502 | after_paging_init = 1; | |
64a8f852 | 503 | for (idx = FIX_BTMAP_BEGIN; idx >= FIX_BTMAP_END; idx--) { |
0947b2f3 | 504 | addr = fix_to_virt(idx); |
beacfaac | 505 | pte = early_ioremap_pte(addr); |
551889a6 IC |
506 | if (pte_present(*pte)) { |
507 | phys = pte_val(*pte) & PAGE_MASK; | |
0947b2f3 HY |
508 | set_fixmap(idx, phys); |
509 | } | |
510 | } | |
511 | } | |
512 | ||
beacfaac | 513 | static void __init __early_set_fixmap(enum fixed_addresses idx, |
0947b2f3 HY |
514 | unsigned long phys, pgprot_t flags) |
515 | { | |
551889a6 IC |
516 | unsigned long addr = __fix_to_virt(idx); |
517 | pte_t *pte; | |
0947b2f3 HY |
518 | |
519 | if (idx >= __end_of_fixed_addresses) { | |
520 | BUG(); | |
521 | return; | |
522 | } | |
beacfaac | 523 | pte = early_ioremap_pte(addr); |
4583ed51 | 524 | |
0947b2f3 | 525 | if (pgprot_val(flags)) |
551889a6 | 526 | set_pte(pte, pfn_pte(phys >> PAGE_SHIFT, flags)); |
0947b2f3 | 527 | else |
4f9c11dd | 528 | pte_clear(&init_mm, addr, pte); |
0947b2f3 HY |
529 | __flush_tlb_one(addr); |
530 | } | |
531 | ||
beacfaac | 532 | static inline void __init early_set_fixmap(enum fixed_addresses idx, |
0947b2f3 HY |
533 | unsigned long phys) |
534 | { | |
535 | if (after_paging_init) | |
536 | set_fixmap(idx, phys); | |
537 | else | |
beacfaac | 538 | __early_set_fixmap(idx, phys, PAGE_KERNEL); |
0947b2f3 HY |
539 | } |
540 | ||
beacfaac | 541 | static inline void __init early_clear_fixmap(enum fixed_addresses idx) |
0947b2f3 HY |
542 | { |
543 | if (after_paging_init) | |
544 | clear_fixmap(idx); | |
545 | else | |
beacfaac | 546 | __early_set_fixmap(idx, 0, __pgprot(0)); |
0947b2f3 HY |
547 | } |
548 | ||
1b42f516 IM |
549 | |
550 | int __initdata early_ioremap_nested; | |
551 | ||
d690b2af IM |
552 | static int __init check_early_ioremap_leak(void) |
553 | { | |
554 | if (!early_ioremap_nested) | |
555 | return 0; | |
556 | ||
557 | printk(KERN_WARNING | |
91eebf40 TG |
558 | "Debug warning: early ioremap leak of %d areas detected.\n", |
559 | early_ioremap_nested); | |
d690b2af | 560 | printk(KERN_WARNING |
91eebf40 | 561 | "please boot with early_ioremap_debug and report the dmesg.\n"); |
d690b2af IM |
562 | WARN_ON(1); |
563 | ||
564 | return 1; | |
565 | } | |
566 | late_initcall(check_early_ioremap_leak); | |
567 | ||
beacfaac | 568 | void __init *early_ioremap(unsigned long phys_addr, unsigned long size) |
1da177e4 LT |
569 | { |
570 | unsigned long offset, last_addr; | |
1b42f516 IM |
571 | unsigned int nrpages, nesting; |
572 | enum fixed_addresses idx0, idx; | |
573 | ||
574 | WARN_ON(system_state != SYSTEM_BOOTING); | |
575 | ||
576 | nesting = early_ioremap_nested; | |
d18d6d65 | 577 | if (early_ioremap_debug) { |
adafdf6a | 578 | printk(KERN_INFO "early_ioremap(%08lx, %08lx) [%d] => ", |
91eebf40 | 579 | phys_addr, size, nesting); |
d18d6d65 IM |
580 | dump_stack(); |
581 | } | |
1da177e4 LT |
582 | |
583 | /* Don't allow wraparound or zero size */ | |
584 | last_addr = phys_addr + size - 1; | |
bd796ed0 IM |
585 | if (!size || last_addr < phys_addr) { |
586 | WARN_ON(1); | |
1da177e4 | 587 | return NULL; |
bd796ed0 | 588 | } |
1da177e4 | 589 | |
bd796ed0 IM |
590 | if (nesting >= FIX_BTMAPS_NESTING) { |
591 | WARN_ON(1); | |
1b42f516 | 592 | return NULL; |
bd796ed0 | 593 | } |
1b42f516 | 594 | early_ioremap_nested++; |
1da177e4 LT |
595 | /* |
596 | * Mappings have to be page-aligned | |
597 | */ | |
598 | offset = phys_addr & ~PAGE_MASK; | |
599 | phys_addr &= PAGE_MASK; | |
600 | size = PAGE_ALIGN(last_addr) - phys_addr; | |
601 | ||
602 | /* | |
603 | * Mappings have to fit in the FIX_BTMAP area. | |
604 | */ | |
605 | nrpages = size >> PAGE_SHIFT; | |
bd796ed0 IM |
606 | if (nrpages > NR_FIX_BTMAPS) { |
607 | WARN_ON(1); | |
1da177e4 | 608 | return NULL; |
bd796ed0 | 609 | } |
1da177e4 LT |
610 | |
611 | /* | |
612 | * Ok, go for it.. | |
613 | */ | |
1b42f516 IM |
614 | idx0 = FIX_BTMAP_BEGIN - NR_FIX_BTMAPS*nesting; |
615 | idx = idx0; | |
1da177e4 | 616 | while (nrpages > 0) { |
beacfaac | 617 | early_set_fixmap(idx, phys_addr); |
1da177e4 LT |
618 | phys_addr += PAGE_SIZE; |
619 | --idx; | |
620 | --nrpages; | |
621 | } | |
d18d6d65 IM |
622 | if (early_ioremap_debug) |
623 | printk(KERN_CONT "%08lx + %08lx\n", offset, fix_to_virt(idx0)); | |
1b42f516 | 624 | |
91eebf40 | 625 | return (void *) (offset + fix_to_virt(idx0)); |
1da177e4 LT |
626 | } |
627 | ||
beacfaac | 628 | void __init early_iounmap(void *addr, unsigned long size) |
1da177e4 LT |
629 | { |
630 | unsigned long virt_addr; | |
631 | unsigned long offset; | |
632 | unsigned int nrpages; | |
633 | enum fixed_addresses idx; | |
226e9a93 | 634 | int nesting; |
1b42f516 IM |
635 | |
636 | nesting = --early_ioremap_nested; | |
226e9a93 IM |
637 | if (WARN_ON(nesting < 0)) |
638 | return; | |
1da177e4 | 639 | |
d18d6d65 | 640 | if (early_ioremap_debug) { |
adafdf6a | 641 | printk(KERN_INFO "early_iounmap(%p, %08lx) [%d]\n", addr, |
91eebf40 | 642 | size, nesting); |
d18d6d65 IM |
643 | dump_stack(); |
644 | } | |
645 | ||
1da177e4 | 646 | virt_addr = (unsigned long)addr; |
bd796ed0 IM |
647 | if (virt_addr < fix_to_virt(FIX_BTMAP_BEGIN)) { |
648 | WARN_ON(1); | |
1da177e4 | 649 | return; |
bd796ed0 | 650 | } |
1da177e4 LT |
651 | offset = virt_addr & ~PAGE_MASK; |
652 | nrpages = PAGE_ALIGN(offset + size - 1) >> PAGE_SHIFT; | |
653 | ||
1b42f516 | 654 | idx = FIX_BTMAP_BEGIN - NR_FIX_BTMAPS*nesting; |
1da177e4 | 655 | while (nrpages > 0) { |
beacfaac | 656 | early_clear_fixmap(idx); |
1da177e4 LT |
657 | --idx; |
658 | --nrpages; | |
659 | } | |
660 | } | |
1b42f516 IM |
661 | |
662 | void __this_fixmap_does_not_exist(void) | |
663 | { | |
664 | WARN_ON(1); | |
665 | } |