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