1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Re-map IO memory to kernel address space so that we can access it.
4  * This is needed for high PCI addresses that aren't mapped in the
5  * 640k-1MB IO memory area on PC's
6  *
7  * (C) Copyright 1995 1996 Linus Torvalds
8  */
9 
10 #include <linux/memblock.h>
11 #include <linux/init.h>
12 #include <linux/io.h>
13 #include <linux/ioport.h>
14 #include <linux/slab.h>
15 #include <linux/vmalloc.h>
16 #include <linux/mmiotrace.h>
17 #include <linux/cc_platform.h>
18 #include <linux/efi.h>
19 #include <linux/pgtable.h>
20 #include <linux/kmsan.h>
21 
22 #include <asm/set_memory.h>
23 #include <asm/e820/api.h>
24 #include <asm/efi.h>
25 #include <asm/fixmap.h>
26 #include <asm/tlbflush.h>
27 #include <asm/pgalloc.h>
28 #include <asm/memtype.h>
29 #include <asm/setup.h>
30 
31 #include "physaddr.h"
32 
33 /*
34  * Descriptor controlling ioremap() behavior.
35  */
36 struct ioremap_desc {
37 	unsigned int flags;
38 };
39 
40 /*
41  * Fix up the linear direct mapping of the kernel to avoid cache attribute
42  * conflicts.
43  */
ioremap_change_attr(unsigned long vaddr,unsigned long size,enum page_cache_mode pcm)44 int ioremap_change_attr(unsigned long vaddr, unsigned long size,
45 			enum page_cache_mode pcm)
46 {
47 	unsigned long nrpages = size >> PAGE_SHIFT;
48 	int err;
49 
50 	switch (pcm) {
51 	case _PAGE_CACHE_MODE_UC:
52 	default:
53 		err = _set_memory_uc(vaddr, nrpages);
54 		break;
55 	case _PAGE_CACHE_MODE_WC:
56 		err = _set_memory_wc(vaddr, nrpages);
57 		break;
58 	case _PAGE_CACHE_MODE_WT:
59 		err = _set_memory_wt(vaddr, nrpages);
60 		break;
61 	case _PAGE_CACHE_MODE_WB:
62 		err = _set_memory_wb(vaddr, nrpages);
63 		break;
64 	}
65 
66 	return err;
67 }
68 
69 /* Does the range (or a subset of) contain normal RAM? */
__ioremap_check_ram(struct resource * res)70 static unsigned int __ioremap_check_ram(struct resource *res)
71 {
72 	unsigned long start_pfn, stop_pfn;
73 	unsigned long i;
74 
75 	if ((res->flags & IORESOURCE_SYSTEM_RAM) != IORESOURCE_SYSTEM_RAM)
76 		return 0;
77 
78 	start_pfn = (res->start + PAGE_SIZE - 1) >> PAGE_SHIFT;
79 	stop_pfn = (res->end + 1) >> PAGE_SHIFT;
80 	if (stop_pfn > start_pfn) {
81 		for (i = 0; i < (stop_pfn - start_pfn); ++i)
82 			if (pfn_valid(start_pfn + i) &&
83 			    !PageReserved(pfn_to_page(start_pfn + i)))
84 				return IORES_MAP_SYSTEM_RAM;
85 	}
86 
87 	return 0;
88 }
89 
90 /*
91  * In a SEV guest, NONE and RESERVED should not be mapped encrypted because
92  * there the whole memory is already encrypted.
93  */
__ioremap_check_encrypted(struct resource * res)94 static unsigned int __ioremap_check_encrypted(struct resource *res)
95 {
96 	if (!cc_platform_has(CC_ATTR_GUEST_MEM_ENCRYPT))
97 		return 0;
98 
99 	switch (res->desc) {
100 	case IORES_DESC_NONE:
101 	case IORES_DESC_RESERVED:
102 		break;
103 	default:
104 		return IORES_MAP_ENCRYPTED;
105 	}
106 
107 	return 0;
108 }
109 
110 /*
111  * The EFI runtime services data area is not covered by walk_mem_res(), but must
112  * be mapped encrypted when SEV is active.
113  */
__ioremap_check_other(resource_size_t addr,struct ioremap_desc * desc)114 static void __ioremap_check_other(resource_size_t addr, struct ioremap_desc *desc)
115 {
116 	if (!cc_platform_has(CC_ATTR_GUEST_MEM_ENCRYPT))
117 		return;
118 
119 	if (x86_platform.hyper.is_private_mmio(addr)) {
120 		desc->flags |= IORES_MAP_ENCRYPTED;
121 		return;
122 	}
123 
124 	if (!IS_ENABLED(CONFIG_EFI))
125 		return;
126 
127 	if (efi_mem_type(addr) == EFI_RUNTIME_SERVICES_DATA ||
128 	    (efi_mem_type(addr) == EFI_BOOT_SERVICES_DATA &&
129 	     efi_mem_attributes(addr) & EFI_MEMORY_RUNTIME))
130 		desc->flags |= IORES_MAP_ENCRYPTED;
131 }
132 
__ioremap_collect_map_flags(struct resource * res,void * arg)133 static int __ioremap_collect_map_flags(struct resource *res, void *arg)
134 {
135 	struct ioremap_desc *desc = arg;
136 
137 	if (!(desc->flags & IORES_MAP_SYSTEM_RAM))
138 		desc->flags |= __ioremap_check_ram(res);
139 
140 	if (!(desc->flags & IORES_MAP_ENCRYPTED))
141 		desc->flags |= __ioremap_check_encrypted(res);
142 
143 	return ((desc->flags & (IORES_MAP_SYSTEM_RAM | IORES_MAP_ENCRYPTED)) ==
144 			       (IORES_MAP_SYSTEM_RAM | IORES_MAP_ENCRYPTED));
145 }
146 
147 /*
148  * To avoid multiple resource walks, this function walks resources marked as
149  * IORESOURCE_MEM and IORESOURCE_BUSY and looking for system RAM and/or a
150  * resource described not as IORES_DESC_NONE (e.g. IORES_DESC_ACPI_TABLES).
151  *
152  * After that, deal with misc other ranges in __ioremap_check_other() which do
153  * not fall into the above category.
154  */
__ioremap_check_mem(resource_size_t addr,unsigned long size,struct ioremap_desc * desc)155 static void __ioremap_check_mem(resource_size_t addr, unsigned long size,
156 				struct ioremap_desc *desc)
157 {
158 	u64 start, end;
159 
160 	start = (u64)addr;
161 	end = start + size - 1;
162 	memset(desc, 0, sizeof(struct ioremap_desc));
163 
164 	walk_mem_res(start, end, desc, __ioremap_collect_map_flags);
165 
166 	__ioremap_check_other(addr, desc);
167 }
168 
169 /*
170  * Remap an arbitrary physical address space into the kernel virtual
171  * address space. It transparently creates kernel huge I/O mapping when
172  * the physical address is aligned by a huge page size (1GB or 2MB) and
173  * the requested size is at least the huge page size.
174  *
175  * NOTE: MTRRs can override PAT memory types with a 4KB granularity.
176  * Therefore, the mapping code falls back to use a smaller page toward 4KB
177  * when a mapping range is covered by non-WB type of MTRRs.
178  *
179  * NOTE! We need to allow non-page-aligned mappings too: we will obviously
180  * have to convert them into an offset in a page-aligned mapping, but the
181  * caller shouldn't need to know that small detail.
182  */
183 static void __iomem *
__ioremap_caller(resource_size_t phys_addr,unsigned long size,enum page_cache_mode pcm,void * caller,bool encrypted)184 __ioremap_caller(resource_size_t phys_addr, unsigned long size,
185 		 enum page_cache_mode pcm, void *caller, bool encrypted)
186 {
187 	unsigned long offset, vaddr;
188 	resource_size_t last_addr;
189 	const resource_size_t unaligned_phys_addr = phys_addr;
190 	const unsigned long unaligned_size = size;
191 	struct ioremap_desc io_desc;
192 	struct vm_struct *area;
193 	enum page_cache_mode new_pcm;
194 	pgprot_t prot;
195 	int retval;
196 	void __iomem *ret_addr;
197 
198 	/* Don't allow wraparound or zero size */
199 	last_addr = phys_addr + size - 1;
200 	if (!size || last_addr < phys_addr)
201 		return NULL;
202 
203 	if (!phys_addr_valid(phys_addr)) {
204 		printk(KERN_WARNING "ioremap: invalid physical address %llx\n",
205 		       (unsigned long long)phys_addr);
206 		WARN_ON_ONCE(1);
207 		return NULL;
208 	}
209 
210 	__ioremap_check_mem(phys_addr, size, &io_desc);
211 
212 	/*
213 	 * Don't allow anybody to remap normal RAM that we're using..
214 	 */
215 	if (io_desc.flags & IORES_MAP_SYSTEM_RAM) {
216 		WARN_ONCE(1, "ioremap on RAM at %pa - %pa\n",
217 			  &phys_addr, &last_addr);
218 		return NULL;
219 	}
220 
221 	/*
222 	 * Mappings have to be page-aligned
223 	 */
224 	offset = phys_addr & ~PAGE_MASK;
225 	phys_addr &= PAGE_MASK;
226 	size = PAGE_ALIGN(last_addr+1) - phys_addr;
227 
228 	/*
229 	 * Mask out any bits not part of the actual physical
230 	 * address, like memory encryption bits.
231 	 */
232 	phys_addr &= PHYSICAL_PAGE_MASK;
233 
234 	retval = memtype_reserve(phys_addr, (u64)phys_addr + size,
235 						pcm, &new_pcm);
236 	if (retval) {
237 		printk(KERN_ERR "ioremap memtype_reserve failed %d\n", retval);
238 		return NULL;
239 	}
240 
241 	if (pcm != new_pcm) {
242 		if (!is_new_memtype_allowed(phys_addr, size, pcm, new_pcm)) {
243 			printk(KERN_ERR
244 		"ioremap error for 0x%llx-0x%llx, requested 0x%x, got 0x%x\n",
245 				(unsigned long long)phys_addr,
246 				(unsigned long long)(phys_addr + size),
247 				pcm, new_pcm);
248 			goto err_free_memtype;
249 		}
250 		pcm = new_pcm;
251 	}
252 
253 	/*
254 	 * If the page being mapped is in memory and SEV is active then
255 	 * make sure the memory encryption attribute is enabled in the
256 	 * resulting mapping.
257 	 * In TDX guests, memory is marked private by default. If encryption
258 	 * is not requested (using encrypted), explicitly set decrypt
259 	 * attribute in all IOREMAPPED memory.
260 	 */
261 	prot = PAGE_KERNEL_IO;
262 	if ((io_desc.flags & IORES_MAP_ENCRYPTED) || encrypted)
263 		prot = pgprot_encrypted(prot);
264 	else
265 		prot = pgprot_decrypted(prot);
266 
267 	switch (pcm) {
268 	case _PAGE_CACHE_MODE_UC:
269 	default:
270 		prot = __pgprot(pgprot_val(prot) |
271 				cachemode2protval(_PAGE_CACHE_MODE_UC));
272 		break;
273 	case _PAGE_CACHE_MODE_UC_MINUS:
274 		prot = __pgprot(pgprot_val(prot) |
275 				cachemode2protval(_PAGE_CACHE_MODE_UC_MINUS));
276 		break;
277 	case _PAGE_CACHE_MODE_WC:
278 		prot = __pgprot(pgprot_val(prot) |
279 				cachemode2protval(_PAGE_CACHE_MODE_WC));
280 		break;
281 	case _PAGE_CACHE_MODE_WT:
282 		prot = __pgprot(pgprot_val(prot) |
283 				cachemode2protval(_PAGE_CACHE_MODE_WT));
284 		break;
285 	case _PAGE_CACHE_MODE_WB:
286 		break;
287 	}
288 
289 	/*
290 	 * Ok, go for it..
291 	 */
292 	area = get_vm_area_caller(size, VM_IOREMAP, caller);
293 	if (!area)
294 		goto err_free_memtype;
295 	area->phys_addr = phys_addr;
296 	vaddr = (unsigned long) area->addr;
297 
298 	if (memtype_kernel_map_sync(phys_addr, size, pcm))
299 		goto err_free_area;
300 
301 	if (ioremap_page_range(vaddr, vaddr + size, phys_addr, prot))
302 		goto err_free_area;
303 
304 	ret_addr = (void __iomem *) (vaddr + offset);
305 	mmiotrace_ioremap(unaligned_phys_addr, unaligned_size, ret_addr);
306 
307 	/*
308 	 * Check if the request spans more than any BAR in the iomem resource
309 	 * tree.
310 	 */
311 	if (iomem_map_sanity_check(unaligned_phys_addr, unaligned_size))
312 		pr_warn("caller %pS mapping multiple BARs\n", caller);
313 
314 	return ret_addr;
315 err_free_area:
316 	free_vm_area(area);
317 err_free_memtype:
318 	memtype_free(phys_addr, phys_addr + size);
319 	return NULL;
320 }
321 
322 /**
323  * ioremap     -   map bus memory into CPU space
324  * @phys_addr:    bus address of the memory
325  * @size:      size of the resource to map
326  *
327  * ioremap performs a platform specific sequence of operations to
328  * make bus memory CPU accessible via the readb/readw/readl/writeb/
329  * writew/writel functions and the other mmio helpers. The returned
330  * address is not guaranteed to be usable directly as a virtual
331  * address.
332  *
333  * This version of ioremap ensures that the memory is marked uncachable
334  * on the CPU as well as honouring existing caching rules from things like
335  * the PCI bus. Note that there are other caches and buffers on many
336  * busses. In particular driver authors should read up on PCI writes
337  *
338  * It's useful if some control registers are in such an area and
339  * write combining or read caching is not desirable:
340  *
341  * Must be freed with iounmap.
342  */
ioremap(resource_size_t phys_addr,unsigned long size)343 void __iomem *ioremap(resource_size_t phys_addr, unsigned long size)
344 {
345 	/*
346 	 * Ideally, this should be:
347 	 *	pat_enabled() ? _PAGE_CACHE_MODE_UC : _PAGE_CACHE_MODE_UC_MINUS;
348 	 *
349 	 * Till we fix all X drivers to use ioremap_wc(), we will use
350 	 * UC MINUS. Drivers that are certain they need or can already
351 	 * be converted over to strong UC can use ioremap_uc().
352 	 */
353 	enum page_cache_mode pcm = _PAGE_CACHE_MODE_UC_MINUS;
354 
355 	return __ioremap_caller(phys_addr, size, pcm,
356 				__builtin_return_address(0), false);
357 }
358 EXPORT_SYMBOL(ioremap);
359 
360 /**
361  * ioremap_uc     -   map bus memory into CPU space as strongly uncachable
362  * @phys_addr:    bus address of the memory
363  * @size:      size of the resource to map
364  *
365  * ioremap_uc performs a platform specific sequence of operations to
366  * make bus memory CPU accessible via the readb/readw/readl/writeb/
367  * writew/writel functions and the other mmio helpers. The returned
368  * address is not guaranteed to be usable directly as a virtual
369  * address.
370  *
371  * This version of ioremap ensures that the memory is marked with a strong
372  * preference as completely uncachable on the CPU when possible. For non-PAT
373  * systems this ends up setting page-attribute flags PCD=1, PWT=1. For PAT
374  * systems this will set the PAT entry for the pages as strong UC.  This call
375  * will honor existing caching rules from things like the PCI bus. Note that
376  * there are other caches and buffers on many busses. In particular driver
377  * authors should read up on PCI writes.
378  *
379  * It's useful if some control registers are in such an area and
380  * write combining or read caching is not desirable:
381  *
382  * Must be freed with iounmap.
383  */
ioremap_uc(resource_size_t phys_addr,unsigned long size)384 void __iomem *ioremap_uc(resource_size_t phys_addr, unsigned long size)
385 {
386 	enum page_cache_mode pcm = _PAGE_CACHE_MODE_UC;
387 
388 	return __ioremap_caller(phys_addr, size, pcm,
389 				__builtin_return_address(0), false);
390 }
391 EXPORT_SYMBOL_GPL(ioremap_uc);
392 
393 /**
394  * ioremap_wc	-	map memory into CPU space write combined
395  * @phys_addr:	bus address of the memory
396  * @size:	size of the resource to map
397  *
398  * This version of ioremap ensures that the memory is marked write combining.
399  * Write combining allows faster writes to some hardware devices.
400  *
401  * Must be freed with iounmap.
402  */
ioremap_wc(resource_size_t phys_addr,unsigned long size)403 void __iomem *ioremap_wc(resource_size_t phys_addr, unsigned long size)
404 {
405 	return __ioremap_caller(phys_addr, size, _PAGE_CACHE_MODE_WC,
406 					__builtin_return_address(0), false);
407 }
408 EXPORT_SYMBOL(ioremap_wc);
409 
410 /**
411  * ioremap_wt	-	map memory into CPU space write through
412  * @phys_addr:	bus address of the memory
413  * @size:	size of the resource to map
414  *
415  * This version of ioremap ensures that the memory is marked write through.
416  * Write through stores data into memory while keeping the cache up-to-date.
417  *
418  * Must be freed with iounmap.
419  */
ioremap_wt(resource_size_t phys_addr,unsigned long size)420 void __iomem *ioremap_wt(resource_size_t phys_addr, unsigned long size)
421 {
422 	return __ioremap_caller(phys_addr, size, _PAGE_CACHE_MODE_WT,
423 					__builtin_return_address(0), false);
424 }
425 EXPORT_SYMBOL(ioremap_wt);
426 
ioremap_encrypted(resource_size_t phys_addr,unsigned long size)427 void __iomem *ioremap_encrypted(resource_size_t phys_addr, unsigned long size)
428 {
429 	return __ioremap_caller(phys_addr, size, _PAGE_CACHE_MODE_WB,
430 				__builtin_return_address(0), true);
431 }
432 EXPORT_SYMBOL(ioremap_encrypted);
433 
ioremap_cache(resource_size_t phys_addr,unsigned long size)434 void __iomem *ioremap_cache(resource_size_t phys_addr, unsigned long size)
435 {
436 	return __ioremap_caller(phys_addr, size, _PAGE_CACHE_MODE_WB,
437 				__builtin_return_address(0), false);
438 }
439 EXPORT_SYMBOL(ioremap_cache);
440 
ioremap_prot(resource_size_t phys_addr,unsigned long size,unsigned long prot_val)441 void __iomem *ioremap_prot(resource_size_t phys_addr, unsigned long size,
442 				unsigned long prot_val)
443 {
444 	return __ioremap_caller(phys_addr, size,
445 				pgprot2cachemode(__pgprot(prot_val)),
446 				__builtin_return_address(0), false);
447 }
448 EXPORT_SYMBOL(ioremap_prot);
449 
450 /**
451  * iounmap - Free a IO remapping
452  * @addr: virtual address from ioremap_*
453  *
454  * Caller must ensure there is only one unmapping for the same pointer.
455  */
iounmap(volatile void __iomem * addr)456 void iounmap(volatile void __iomem *addr)
457 {
458 	struct vm_struct *p, *o;
459 
460 	if ((void __force *)addr <= high_memory)
461 		return;
462 
463 	/*
464 	 * The PCI/ISA range special-casing was removed from __ioremap()
465 	 * so this check, in theory, can be removed. However, there are
466 	 * cases where iounmap() is called for addresses not obtained via
467 	 * ioremap() (vga16fb for example). Add a warning so that these
468 	 * cases can be caught and fixed.
469 	 */
470 	if ((void __force *)addr >= phys_to_virt(ISA_START_ADDRESS) &&
471 	    (void __force *)addr < phys_to_virt(ISA_END_ADDRESS)) {
472 		WARN(1, "iounmap() called for ISA range not obtained using ioremap()\n");
473 		return;
474 	}
475 
476 	mmiotrace_iounmap(addr);
477 
478 	addr = (volatile void __iomem *)
479 		(PAGE_MASK & (unsigned long __force)addr);
480 
481 	/* Use the vm area unlocked, assuming the caller
482 	   ensures there isn't another iounmap for the same address
483 	   in parallel. Reuse of the virtual address is prevented by
484 	   leaving it in the global lists until we're done with it.
485 	   cpa takes care of the direct mappings. */
486 	p = find_vm_area((void __force *)addr);
487 
488 	if (!p) {
489 		printk(KERN_ERR "iounmap: bad address %p\n", addr);
490 		dump_stack();
491 		return;
492 	}
493 
494 	kmsan_iounmap_page_range((unsigned long)addr,
495 		(unsigned long)addr + get_vm_area_size(p));
496 	memtype_free(p->phys_addr, p->phys_addr + get_vm_area_size(p));
497 
498 	/* Finally remove it */
499 	o = remove_vm_area((void __force *)addr);
500 	BUG_ON(p != o || o == NULL);
501 	kfree(p);
502 }
503 EXPORT_SYMBOL(iounmap);
504 
505 /*
506  * Convert a physical pointer to a virtual kernel pointer for /dev/mem
507  * access
508  */
xlate_dev_mem_ptr(phys_addr_t phys)509 void *xlate_dev_mem_ptr(phys_addr_t phys)
510 {
511 	unsigned long start  = phys &  PAGE_MASK;
512 	unsigned long offset = phys & ~PAGE_MASK;
513 	void *vaddr;
514 
515 	/* memremap() maps if RAM, otherwise falls back to ioremap() */
516 	vaddr = memremap(start, PAGE_SIZE, MEMREMAP_WB);
517 
518 	/* Only add the offset on success and return NULL if memremap() failed */
519 	if (vaddr)
520 		vaddr += offset;
521 
522 	return vaddr;
523 }
524 
unxlate_dev_mem_ptr(phys_addr_t phys,void * addr)525 void unxlate_dev_mem_ptr(phys_addr_t phys, void *addr)
526 {
527 	memunmap((void *)((unsigned long)addr & PAGE_MASK));
528 }
529 
530 #ifdef CONFIG_AMD_MEM_ENCRYPT
531 /*
532  * Examine the physical address to determine if it is an area of memory
533  * that should be mapped decrypted.  If the memory is not part of the
534  * kernel usable area it was accessed and created decrypted, so these
535  * areas should be mapped decrypted. And since the encryption key can
536  * change across reboots, persistent memory should also be mapped
537  * decrypted.
538  *
539  * If SEV is active, that implies that BIOS/UEFI also ran encrypted so
540  * only persistent memory should be mapped decrypted.
541  */
memremap_should_map_decrypted(resource_size_t phys_addr,unsigned long size)542 static bool memremap_should_map_decrypted(resource_size_t phys_addr,
543 					  unsigned long size)
544 {
545 	int is_pmem;
546 
547 	/*
548 	 * Check if the address is part of a persistent memory region.
549 	 * This check covers areas added by E820, EFI and ACPI.
550 	 */
551 	is_pmem = region_intersects(phys_addr, size, IORESOURCE_MEM,
552 				    IORES_DESC_PERSISTENT_MEMORY);
553 	if (is_pmem != REGION_DISJOINT)
554 		return true;
555 
556 	/*
557 	 * Check if the non-volatile attribute is set for an EFI
558 	 * reserved area.
559 	 */
560 	if (efi_enabled(EFI_BOOT)) {
561 		switch (efi_mem_type(phys_addr)) {
562 		case EFI_RESERVED_TYPE:
563 			if (efi_mem_attributes(phys_addr) & EFI_MEMORY_NV)
564 				return true;
565 			break;
566 		default:
567 			break;
568 		}
569 	}
570 
571 	/* Check if the address is outside kernel usable area */
572 	switch (e820__get_entry_type(phys_addr, phys_addr + size - 1)) {
573 	case E820_TYPE_RESERVED:
574 	case E820_TYPE_ACPI:
575 	case E820_TYPE_NVS:
576 	case E820_TYPE_UNUSABLE:
577 		/* For SEV, these areas are encrypted */
578 		if (cc_platform_has(CC_ATTR_GUEST_MEM_ENCRYPT))
579 			break;
580 		fallthrough;
581 
582 	case E820_TYPE_PRAM:
583 		return true;
584 	default:
585 		break;
586 	}
587 
588 	return false;
589 }
590 
591 /*
592  * Examine the physical address to determine if it is EFI data. Check
593  * it against the boot params structure and EFI tables and memory types.
594  */
memremap_is_efi_data(resource_size_t phys_addr,unsigned long size)595 static bool memremap_is_efi_data(resource_size_t phys_addr,
596 				 unsigned long size)
597 {
598 	u64 paddr;
599 
600 	/* Check if the address is part of EFI boot/runtime data */
601 	if (!efi_enabled(EFI_BOOT))
602 		return false;
603 
604 	paddr = boot_params.efi_info.efi_memmap_hi;
605 	paddr <<= 32;
606 	paddr |= boot_params.efi_info.efi_memmap;
607 	if (phys_addr == paddr)
608 		return true;
609 
610 	paddr = boot_params.efi_info.efi_systab_hi;
611 	paddr <<= 32;
612 	paddr |= boot_params.efi_info.efi_systab;
613 	if (phys_addr == paddr)
614 		return true;
615 
616 	if (efi_is_table_address(phys_addr))
617 		return true;
618 
619 	switch (efi_mem_type(phys_addr)) {
620 	case EFI_BOOT_SERVICES_DATA:
621 	case EFI_RUNTIME_SERVICES_DATA:
622 		return true;
623 	default:
624 		break;
625 	}
626 
627 	return false;
628 }
629 
630 /*
631  * Examine the physical address to determine if it is boot data by checking
632  * it against the boot params setup_data chain.
633  */
memremap_is_setup_data(resource_size_t phys_addr,unsigned long size)634 static bool memremap_is_setup_data(resource_size_t phys_addr,
635 				   unsigned long size)
636 {
637 	struct setup_indirect *indirect;
638 	struct setup_data *data;
639 	u64 paddr, paddr_next;
640 
641 	paddr = boot_params.hdr.setup_data;
642 	while (paddr) {
643 		unsigned int len;
644 
645 		if (phys_addr == paddr)
646 			return true;
647 
648 		data = memremap(paddr, sizeof(*data),
649 				MEMREMAP_WB | MEMREMAP_DEC);
650 		if (!data) {
651 			pr_warn("failed to memremap setup_data entry\n");
652 			return false;
653 		}
654 
655 		paddr_next = data->next;
656 		len = data->len;
657 
658 		if ((phys_addr > paddr) && (phys_addr < (paddr + len))) {
659 			memunmap(data);
660 			return true;
661 		}
662 
663 		if (data->type == SETUP_INDIRECT) {
664 			memunmap(data);
665 			data = memremap(paddr, sizeof(*data) + len,
666 					MEMREMAP_WB | MEMREMAP_DEC);
667 			if (!data) {
668 				pr_warn("failed to memremap indirect setup_data\n");
669 				return false;
670 			}
671 
672 			indirect = (struct setup_indirect *)data->data;
673 
674 			if (indirect->type != SETUP_INDIRECT) {
675 				paddr = indirect->addr;
676 				len = indirect->len;
677 			}
678 		}
679 
680 		memunmap(data);
681 
682 		if ((phys_addr > paddr) && (phys_addr < (paddr + len)))
683 			return true;
684 
685 		paddr = paddr_next;
686 	}
687 
688 	return false;
689 }
690 
691 /*
692  * Examine the physical address to determine if it is boot data by checking
693  * it against the boot params setup_data chain (early boot version).
694  */
early_memremap_is_setup_data(resource_size_t phys_addr,unsigned long size)695 static bool __init early_memremap_is_setup_data(resource_size_t phys_addr,
696 						unsigned long size)
697 {
698 	struct setup_indirect *indirect;
699 	struct setup_data *data;
700 	u64 paddr, paddr_next;
701 
702 	paddr = boot_params.hdr.setup_data;
703 	while (paddr) {
704 		unsigned int len, size;
705 
706 		if (phys_addr == paddr)
707 			return true;
708 
709 		data = early_memremap_decrypted(paddr, sizeof(*data));
710 		if (!data) {
711 			pr_warn("failed to early memremap setup_data entry\n");
712 			return false;
713 		}
714 
715 		size = sizeof(*data);
716 
717 		paddr_next = data->next;
718 		len = data->len;
719 
720 		if ((phys_addr > paddr) && (phys_addr < (paddr + len))) {
721 			early_memunmap(data, sizeof(*data));
722 			return true;
723 		}
724 
725 		if (data->type == SETUP_INDIRECT) {
726 			size += len;
727 			early_memunmap(data, sizeof(*data));
728 			data = early_memremap_decrypted(paddr, size);
729 			if (!data) {
730 				pr_warn("failed to early memremap indirect setup_data\n");
731 				return false;
732 			}
733 
734 			indirect = (struct setup_indirect *)data->data;
735 
736 			if (indirect->type != SETUP_INDIRECT) {
737 				paddr = indirect->addr;
738 				len = indirect->len;
739 			}
740 		}
741 
742 		early_memunmap(data, size);
743 
744 		if ((phys_addr > paddr) && (phys_addr < (paddr + len)))
745 			return true;
746 
747 		paddr = paddr_next;
748 	}
749 
750 	return false;
751 }
752 
753 /*
754  * Architecture function to determine if RAM remap is allowed. By default, a
755  * RAM remap will map the data as encrypted. Determine if a RAM remap should
756  * not be done so that the data will be mapped decrypted.
757  */
arch_memremap_can_ram_remap(resource_size_t phys_addr,unsigned long size,unsigned long flags)758 bool arch_memremap_can_ram_remap(resource_size_t phys_addr, unsigned long size,
759 				 unsigned long flags)
760 {
761 	if (!cc_platform_has(CC_ATTR_MEM_ENCRYPT))
762 		return true;
763 
764 	if (flags & MEMREMAP_ENC)
765 		return true;
766 
767 	if (flags & MEMREMAP_DEC)
768 		return false;
769 
770 	if (cc_platform_has(CC_ATTR_HOST_MEM_ENCRYPT)) {
771 		if (memremap_is_setup_data(phys_addr, size) ||
772 		    memremap_is_efi_data(phys_addr, size))
773 			return false;
774 	}
775 
776 	return !memremap_should_map_decrypted(phys_addr, size);
777 }
778 
779 /*
780  * Architecture override of __weak function to adjust the protection attributes
781  * used when remapping memory. By default, early_memremap() will map the data
782  * as encrypted. Determine if an encrypted mapping should not be done and set
783  * the appropriate protection attributes.
784  */
early_memremap_pgprot_adjust(resource_size_t phys_addr,unsigned long size,pgprot_t prot)785 pgprot_t __init early_memremap_pgprot_adjust(resource_size_t phys_addr,
786 					     unsigned long size,
787 					     pgprot_t prot)
788 {
789 	bool encrypted_prot;
790 
791 	if (!cc_platform_has(CC_ATTR_MEM_ENCRYPT))
792 		return prot;
793 
794 	encrypted_prot = true;
795 
796 	if (cc_platform_has(CC_ATTR_HOST_MEM_ENCRYPT)) {
797 		if (early_memremap_is_setup_data(phys_addr, size) ||
798 		    memremap_is_efi_data(phys_addr, size))
799 			encrypted_prot = false;
800 	}
801 
802 	if (encrypted_prot && memremap_should_map_decrypted(phys_addr, size))
803 		encrypted_prot = false;
804 
805 	return encrypted_prot ? pgprot_encrypted(prot)
806 			      : pgprot_decrypted(prot);
807 }
808 
phys_mem_access_encrypted(unsigned long phys_addr,unsigned long size)809 bool phys_mem_access_encrypted(unsigned long phys_addr, unsigned long size)
810 {
811 	return arch_memremap_can_ram_remap(phys_addr, size, 0);
812 }
813 
814 /* Remap memory with encryption */
early_memremap_encrypted(resource_size_t phys_addr,unsigned long size)815 void __init *early_memremap_encrypted(resource_size_t phys_addr,
816 				      unsigned long size)
817 {
818 	return early_memremap_prot(phys_addr, size, __PAGE_KERNEL_ENC);
819 }
820 
821 /*
822  * Remap memory with encryption and write-protected - cannot be called
823  * before pat_init() is called
824  */
early_memremap_encrypted_wp(resource_size_t phys_addr,unsigned long size)825 void __init *early_memremap_encrypted_wp(resource_size_t phys_addr,
826 					 unsigned long size)
827 {
828 	if (!x86_has_pat_wp())
829 		return NULL;
830 	return early_memremap_prot(phys_addr, size, __PAGE_KERNEL_ENC_WP);
831 }
832 
833 /* Remap memory without encryption */
early_memremap_decrypted(resource_size_t phys_addr,unsigned long size)834 void __init *early_memremap_decrypted(resource_size_t phys_addr,
835 				      unsigned long size)
836 {
837 	return early_memremap_prot(phys_addr, size, __PAGE_KERNEL_NOENC);
838 }
839 
840 /*
841  * Remap memory without encryption and write-protected - cannot be called
842  * before pat_init() is called
843  */
early_memremap_decrypted_wp(resource_size_t phys_addr,unsigned long size)844 void __init *early_memremap_decrypted_wp(resource_size_t phys_addr,
845 					 unsigned long size)
846 {
847 	if (!x86_has_pat_wp())
848 		return NULL;
849 	return early_memremap_prot(phys_addr, size, __PAGE_KERNEL_NOENC_WP);
850 }
851 #endif	/* CONFIG_AMD_MEM_ENCRYPT */
852 
853 static pte_t bm_pte[PAGE_SIZE/sizeof(pte_t)] __page_aligned_bss;
854 
early_ioremap_pmd(unsigned long addr)855 static inline pmd_t * __init early_ioremap_pmd(unsigned long addr)
856 {
857 	/* Don't assume we're using swapper_pg_dir at this point */
858 	pgd_t *base = __va(read_cr3_pa());
859 	pgd_t *pgd = &base[pgd_index(addr)];
860 	p4d_t *p4d = p4d_offset(pgd, addr);
861 	pud_t *pud = pud_offset(p4d, addr);
862 	pmd_t *pmd = pmd_offset(pud, addr);
863 
864 	return pmd;
865 }
866 
early_ioremap_pte(unsigned long addr)867 static inline pte_t * __init early_ioremap_pte(unsigned long addr)
868 {
869 	return &bm_pte[pte_index(addr)];
870 }
871 
is_early_ioremap_ptep(pte_t * ptep)872 bool __init is_early_ioremap_ptep(pte_t *ptep)
873 {
874 	return ptep >= &bm_pte[0] && ptep < &bm_pte[PAGE_SIZE/sizeof(pte_t)];
875 }
876 
early_ioremap_init(void)877 void __init early_ioremap_init(void)
878 {
879 	pmd_t *pmd;
880 
881 #ifdef CONFIG_X86_64
882 	BUILD_BUG_ON((fix_to_virt(0) + PAGE_SIZE) & ((1 << PMD_SHIFT) - 1));
883 #else
884 	WARN_ON((fix_to_virt(0) + PAGE_SIZE) & ((1 << PMD_SHIFT) - 1));
885 #endif
886 
887 	early_ioremap_setup();
888 
889 	pmd = early_ioremap_pmd(fix_to_virt(FIX_BTMAP_BEGIN));
890 	memset(bm_pte, 0, sizeof(bm_pte));
891 	pmd_populate_kernel(&init_mm, pmd, bm_pte);
892 
893 	/*
894 	 * The boot-ioremap range spans multiple pmds, for which
895 	 * we are not prepared:
896 	 */
897 #define __FIXADDR_TOP (-PAGE_SIZE)
898 	BUILD_BUG_ON((__fix_to_virt(FIX_BTMAP_BEGIN) >> PMD_SHIFT)
899 		     != (__fix_to_virt(FIX_BTMAP_END) >> PMD_SHIFT));
900 #undef __FIXADDR_TOP
901 	if (pmd != early_ioremap_pmd(fix_to_virt(FIX_BTMAP_END))) {
902 		WARN_ON(1);
903 		printk(KERN_WARNING "pmd %p != %p\n",
904 		       pmd, early_ioremap_pmd(fix_to_virt(FIX_BTMAP_END)));
905 		printk(KERN_WARNING "fix_to_virt(FIX_BTMAP_BEGIN): %08lx\n",
906 			fix_to_virt(FIX_BTMAP_BEGIN));
907 		printk(KERN_WARNING "fix_to_virt(FIX_BTMAP_END):   %08lx\n",
908 			fix_to_virt(FIX_BTMAP_END));
909 
910 		printk(KERN_WARNING "FIX_BTMAP_END:       %d\n", FIX_BTMAP_END);
911 		printk(KERN_WARNING "FIX_BTMAP_BEGIN:     %d\n",
912 		       FIX_BTMAP_BEGIN);
913 	}
914 }
915 
__early_set_fixmap(enum fixed_addresses idx,phys_addr_t phys,pgprot_t flags)916 void __init __early_set_fixmap(enum fixed_addresses idx,
917 			       phys_addr_t phys, pgprot_t flags)
918 {
919 	unsigned long addr = __fix_to_virt(idx);
920 	pte_t *pte;
921 
922 	if (idx >= __end_of_fixed_addresses) {
923 		BUG();
924 		return;
925 	}
926 	pte = early_ioremap_pte(addr);
927 
928 	/* Sanitize 'prot' against any unsupported bits: */
929 	pgprot_val(flags) &= __supported_pte_mask;
930 
931 	if (pgprot_val(flags))
932 		set_pte(pte, pfn_pte(phys >> PAGE_SHIFT, flags));
933 	else
934 		pte_clear(&init_mm, addr, pte);
935 	flush_tlb_one_kernel(addr);
936 }
937