mmu.c 37.2 KB
Newer Older
1
// SPDX-License-Identifier: GPL-2.0-only
C
Catalin Marinas 已提交
2 3 4 5 6 7 8
/*
 * Based on arch/arm/mm/mmu.c
 *
 * Copyright (C) 1995-2005 Russell King
 * Copyright (C) 2012 ARM Ltd.
 */

9
#include <linux/cache.h>
C
Catalin Marinas 已提交
10 11 12 13
#include <linux/export.h>
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/init.h>
14 15
#include <linux/ioport.h>
#include <linux/kexec.h>
16
#include <linux/libfdt.h>
C
Catalin Marinas 已提交
17 18 19
#include <linux/mman.h>
#include <linux/nodemask.h>
#include <linux/memblock.h>
20
#include <linux/memory.h>
C
Catalin Marinas 已提交
21
#include <linux/fs.h>
22
#include <linux/io.h>
23
#include <linux/mm.h>
24
#include <linux/vmalloc.h>
C
Catalin Marinas 已提交
25

26
#include <asm/barrier.h>
C
Catalin Marinas 已提交
27
#include <asm/cputype.h>
28
#include <asm/fixmap.h>
29
#include <asm/kasan.h>
30
#include <asm/kernel-pgtable.h>
C
Catalin Marinas 已提交
31 32
#include <asm/sections.h>
#include <asm/setup.h>
33
#include <linux/sizes.h>
C
Catalin Marinas 已提交
34 35
#include <asm/tlb.h>
#include <asm/mmu_context.h>
36
#include <asm/ptdump.h>
37
#include <asm/tlbflush.h>
C
Catalin Marinas 已提交
38

39
#define NO_BLOCK_MAPPINGS	BIT(0)
40
#define NO_CONT_MAPPINGS	BIT(1)
41

42
u64 idmap_t0sz = TCR_T0SZ(VA_BITS);
43
u64 idmap_ptrs_per_pgd = PTRS_PER_PGD;
44

45 46
u64 __section(".mmuoff.data.write") vabits_actual;
EXPORT_SYMBOL(vabits_actual);
47

48
u64 kimage_voffset __ro_after_init;
49 50
EXPORT_SYMBOL(kimage_voffset);

C
Catalin Marinas 已提交
51 52 53 54
/*
 * Empty_zero_page is a special page that is used for zero-initialized data
 * and COW.
 */
55
unsigned long empty_zero_page[PAGE_SIZE / sizeof(unsigned long)] __page_aligned_bss;
C
Catalin Marinas 已提交
56 57
EXPORT_SYMBOL(empty_zero_page);

58 59 60 61
static pte_t bm_pte[PTRS_PER_PTE] __page_aligned_bss;
static pmd_t bm_pmd[PTRS_PER_PMD] __page_aligned_bss __maybe_unused;
static pud_t bm_pud[PTRS_PER_PUD] __page_aligned_bss __maybe_unused;

62 63 64 65 66 67 68
static DEFINE_SPINLOCK(swapper_pgdir_lock);

void set_swapper_pgd(pgd_t *pgdp, pgd_t pgd)
{
	pgd_t *fixmap_pgdp;

	spin_lock(&swapper_pgdir_lock);
69
	fixmap_pgdp = pgd_set_fixmap(__pa_symbol(pgdp));
70 71 72 73 74 75 76 77 78 79
	WRITE_ONCE(*fixmap_pgdp, pgd);
	/*
	 * We need dsb(ishst) here to ensure the page-table-walker sees
	 * our new entry before set_p?d() returns. The fixmap's
	 * flush_tlb_kernel_range() via clear_fixmap() does this for us.
	 */
	pgd_clear_fixmap();
	spin_unlock(&swapper_pgdir_lock);
}

C
Catalin Marinas 已提交
80 81 82 83 84 85 86 87 88 89 90
pgprot_t phys_mem_access_prot(struct file *file, unsigned long pfn,
			      unsigned long size, pgprot_t vma_prot)
{
	if (!pfn_valid(pfn))
		return pgprot_noncached(vma_prot);
	else if (file->f_flags & O_SYNC)
		return pgprot_writecombine(vma_prot);
	return vma_prot;
}
EXPORT_SYMBOL(phys_mem_access_prot);

91
static phys_addr_t __init early_pgtable_alloc(int shift)
C
Catalin Marinas 已提交
92
{
93 94 95
	phys_addr_t phys;
	void *ptr;

96
	phys = memblock_phys_alloc(PAGE_SIZE, PAGE_SIZE);
97 98
	if (!phys)
		panic("Failed to allocate page table page\n");
99 100 101 102 103 104 105 106

	/*
	 * The FIX_{PGD,PUD,PMD} slots may be in active use, but the FIX_PTE
	 * slot will be free, so we can (ab)use the FIX_PTE slot to initialise
	 * any level of table.
	 */
	ptr = pte_set_fixmap(phys);

107 108
	memset(ptr, 0, PAGE_SIZE);

109 110 111 112 113 114 115
	/*
	 * Implicit barriers also ensure the zeroed page is visible to the page
	 * table walker
	 */
	pte_clear_fixmap();

	return phys;
C
Catalin Marinas 已提交
116 117
}

118 119 120 121 122 123
static bool pgattr_change_is_safe(u64 old, u64 new)
{
	/*
	 * The following mapping attributes may be updated in live
	 * kernel mappings without the need for break-before-make.
	 */
124
	static const pteval_t mask = PTE_PXN | PTE_RDONLY | PTE_WRITE | PTE_NG;
125

126 127 128 129 130 131 132 133
	/* creating or taking down mappings is always safe */
	if (old == 0 || new == 0)
		return true;

	/* live contiguous mappings may not be manipulated at all */
	if ((old | new) & PTE_CONT)
		return false;

134 135 136
	/* Transitioning from Non-Global to Global is unsafe */
	if (old & ~new & PTE_NG)
		return false;
137

138
	return ((old ^ new) & ~mask) == 0;
139 140
}

141
static void init_pte(pmd_t *pmdp, unsigned long addr, unsigned long end,
142
		     phys_addr_t phys, pgprot_t prot)
C
Catalin Marinas 已提交
143
{
144
	pte_t *ptep;
C
Catalin Marinas 已提交
145

146
	ptep = pte_set_fixmap_offset(pmdp, addr);
C
Catalin Marinas 已提交
147
	do {
148
		pte_t old_pte = READ_ONCE(*ptep);
149

150
		set_pte(ptep, pfn_pte(__phys_to_pfn(phys), prot));
151 152 153 154 155

		/*
		 * After the PTE entry has been populated once, we
		 * only allow updates to the permission attributes.
		 */
156 157
		BUG_ON(!pgattr_change_is_safe(pte_val(old_pte),
					      READ_ONCE(pte_val(*ptep))));
158

159
		phys += PAGE_SIZE;
160
	} while (ptep++, addr += PAGE_SIZE, addr != end);
161 162

	pte_clear_fixmap();
C
Catalin Marinas 已提交
163 164
}

165
static void alloc_init_cont_pte(pmd_t *pmdp, unsigned long addr,
166 167
				unsigned long end, phys_addr_t phys,
				pgprot_t prot,
168
				phys_addr_t (*pgtable_alloc)(int),
169
				int flags)
C
Catalin Marinas 已提交
170 171
{
	unsigned long next;
172
	pmd_t pmd = READ_ONCE(*pmdp);
C
Catalin Marinas 已提交
173

174 175
	BUG_ON(pmd_sect(pmd));
	if (pmd_none(pmd)) {
176
		phys_addr_t pte_phys;
177
		BUG_ON(!pgtable_alloc);
178
		pte_phys = pgtable_alloc(PAGE_SHIFT);
179 180
		__pmd_populate(pmdp, pte_phys, PMD_TYPE_TABLE);
		pmd = READ_ONCE(*pmdp);
C
Catalin Marinas 已提交
181
	}
182
	BUG_ON(pmd_bad(pmd));
183 184 185 186 187 188 189 190 191 192 193

	do {
		pgprot_t __prot = prot;

		next = pte_cont_addr_end(addr, end);

		/* use a contiguous mapping if the range is suitably aligned */
		if ((((addr | next | phys) & ~CONT_PTE_MASK) == 0) &&
		    (flags & NO_CONT_MAPPINGS) == 0)
			__prot = __pgprot(pgprot_val(prot) | PTE_CONT);

194
		init_pte(pmdp, addr, next, phys, __prot);
195 196 197 198 199

		phys += next - addr;
	} while (addr = next, addr != end);
}

200
static void init_pmd(pud_t *pudp, unsigned long addr, unsigned long end,
201
		     phys_addr_t phys, pgprot_t prot,
202
		     phys_addr_t (*pgtable_alloc)(int), int flags)
203 204
{
	unsigned long next;
205
	pmd_t *pmdp;
C
Catalin Marinas 已提交
206

207
	pmdp = pmd_set_fixmap_offset(pudp, addr);
C
Catalin Marinas 已提交
208
	do {
209
		pmd_t old_pmd = READ_ONCE(*pmdp);
210

C
Catalin Marinas 已提交
211
		next = pmd_addr_end(addr, end);
212

C
Catalin Marinas 已提交
213
		/* try section mapping first */
214
		if (((addr | next | phys) & ~SECTION_MASK) == 0 &&
215
		    (flags & NO_BLOCK_MAPPINGS) == 0) {
216
			pmd_set_huge(pmdp, phys, prot);
217

218
			/*
219 220
			 * After the PMD entry has been populated once, we
			 * only allow updates to the permission attributes.
221
			 */
222
			BUG_ON(!pgattr_change_is_safe(pmd_val(old_pmd),
223
						      READ_ONCE(pmd_val(*pmdp))));
224
		} else {
225
			alloc_init_cont_pte(pmdp, addr, next, phys, prot,
226
					    pgtable_alloc, flags);
227 228

			BUG_ON(pmd_val(old_pmd) != 0 &&
229
			       pmd_val(old_pmd) != READ_ONCE(pmd_val(*pmdp)));
230
		}
C
Catalin Marinas 已提交
231
		phys += next - addr;
232
	} while (pmdp++, addr = next, addr != end);
233 234

	pmd_clear_fixmap();
C
Catalin Marinas 已提交
235 236
}

237
static void alloc_init_cont_pmd(pud_t *pudp, unsigned long addr,
238 239
				unsigned long end, phys_addr_t phys,
				pgprot_t prot,
240
				phys_addr_t (*pgtable_alloc)(int), int flags)
241 242
{
	unsigned long next;
243
	pud_t pud = READ_ONCE(*pudp);
244 245 246 247

	/*
	 * Check for initial section mappings in the pgd/pud.
	 */
248 249
	BUG_ON(pud_sect(pud));
	if (pud_none(pud)) {
250 251
		phys_addr_t pmd_phys;
		BUG_ON(!pgtable_alloc);
252
		pmd_phys = pgtable_alloc(PMD_SHIFT);
253 254
		__pud_populate(pudp, pmd_phys, PUD_TYPE_TABLE);
		pud = READ_ONCE(*pudp);
255
	}
256
	BUG_ON(pud_bad(pud));
257 258 259 260 261 262 263 264 265 266 267

	do {
		pgprot_t __prot = prot;

		next = pmd_cont_addr_end(addr, end);

		/* use a contiguous mapping if the range is suitably aligned */
		if ((((addr | next | phys) & ~CONT_PMD_MASK) == 0) &&
		    (flags & NO_CONT_MAPPINGS) == 0)
			__prot = __pgprot(pgprot_val(prot) | PTE_CONT);

268
		init_pmd(pudp, addr, next, phys, __prot, pgtable_alloc, flags);
269 270 271 272 273

		phys += next - addr;
	} while (addr = next, addr != end);
}

274 275 276 277 278 279 280 281 282 283 284 285
static inline bool use_1G_block(unsigned long addr, unsigned long next,
			unsigned long phys)
{
	if (PAGE_SHIFT != 12)
		return false;

	if (((addr | next | phys) & ~PUD_MASK) != 0)
		return false;

	return true;
}

286 287
static void alloc_init_pud(pgd_t *pgdp, unsigned long addr, unsigned long end,
			   phys_addr_t phys, pgprot_t prot,
288
			   phys_addr_t (*pgtable_alloc)(int),
289
			   int flags)
C
Catalin Marinas 已提交
290 291
{
	unsigned long next;
292 293
	pud_t *pudp;
	pgd_t pgd = READ_ONCE(*pgdp);
C
Catalin Marinas 已提交
294

295
	if (pgd_none(pgd)) {
296 297
		phys_addr_t pud_phys;
		BUG_ON(!pgtable_alloc);
298
		pud_phys = pgtable_alloc(PUD_SHIFT);
299 300
		__pgd_populate(pgdp, pud_phys, PUD_TYPE_TABLE);
		pgd = READ_ONCE(*pgdp);
301
	}
302
	BUG_ON(pgd_bad(pgd));
303

304
	pudp = pud_set_fixmap_offset(pgdp, addr);
C
Catalin Marinas 已提交
305
	do {
306
		pud_t old_pud = READ_ONCE(*pudp);
307

C
Catalin Marinas 已提交
308
		next = pud_addr_end(addr, end);
309 310 311 312

		/*
		 * For 4K granule only, attempt to put down a 1GB block
		 */
313 314
		if (use_1G_block(addr, next, phys) &&
		    (flags & NO_BLOCK_MAPPINGS) == 0) {
315
			pud_set_huge(pudp, phys, prot);
316 317

			/*
318 319
			 * After the PUD entry has been populated once, we
			 * only allow updates to the permission attributes.
320
			 */
321
			BUG_ON(!pgattr_change_is_safe(pud_val(old_pud),
322
						      READ_ONCE(pud_val(*pudp))));
323
		} else {
324
			alloc_init_cont_pmd(pudp, addr, next, phys, prot,
325
					    pgtable_alloc, flags);
326 327

			BUG_ON(pud_val(old_pud) != 0 &&
328
			       pud_val(old_pud) != READ_ONCE(pud_val(*pudp)));
329
		}
C
Catalin Marinas 已提交
330
		phys += next - addr;
331
	} while (pudp++, addr = next, addr != end);
332 333

	pud_clear_fixmap();
C
Catalin Marinas 已提交
334 335
}

336 337 338
static void __create_pgd_mapping(pgd_t *pgdir, phys_addr_t phys,
				 unsigned long virt, phys_addr_t size,
				 pgprot_t prot,
339
				 phys_addr_t (*pgtable_alloc)(int),
340
				 int flags)
C
Catalin Marinas 已提交
341
{
342
	unsigned long addr, end, next;
343
	pgd_t *pgdp = pgd_offset_raw(pgdir, virt);
C
Catalin Marinas 已提交
344

345 346 347 348 349 350 351
	/*
	 * If the virtual and physical address don't have the same offset
	 * within a page, we cannot map the region as the caller expects.
	 */
	if (WARN_ON((phys ^ virt) & ~PAGE_MASK))
		return;

352
	phys &= PAGE_MASK;
C
Catalin Marinas 已提交
353
	addr = virt & PAGE_MASK;
354
	end = PAGE_ALIGN(virt + size);
C
Catalin Marinas 已提交
355 356 357

	do {
		next = pgd_addr_end(addr, end);
358
		alloc_init_pud(pgdp, addr, next, phys, prot, pgtable_alloc,
359
			       flags);
C
Catalin Marinas 已提交
360
		phys += next - addr;
361
	} while (pgdp++, addr = next, addr != end);
C
Catalin Marinas 已提交
362 363
}

364
static phys_addr_t __pgd_pgtable_alloc(int shift)
365
{
366
	void *ptr = (void *)__get_free_page(GFP_PGTABLE_KERNEL);
367 368 369 370 371 372 373
	BUG_ON(!ptr);

	/* Ensure the zeroed page is visible to the page table walker */
	dsb(ishst);
	return __pa(ptr);
}

374
static phys_addr_t pgd_pgtable_alloc(int shift)
375
{
376
	phys_addr_t pa = __pgd_pgtable_alloc(shift);
377 378 379 380 381 382 383 384 385 386

	/*
	 * Call proper page table ctor in case later we need to
	 * call core mm functions like apply_to_page_range() on
	 * this pre-allocated page table.
	 *
	 * We don't select ARCH_ENABLE_SPLIT_PMD_PTLOCK if pmd is
	 * folded, and if so pgtable_pmd_page_ctor() becomes nop.
	 */
	if (shift == PAGE_SHIFT)
387
		BUG_ON(!pgtable_pte_page_ctor(phys_to_page(pa)));
388
	else if (shift == PMD_SHIFT)
389
		BUG_ON(!pgtable_pmd_page_ctor(phys_to_page(pa)));
390

391
	return pa;
392 393
}

394 395 396 397 398 399
/*
 * This function can only be used to modify existing table entries,
 * without allocating new levels of table. Note that this permits the
 * creation of new section or page entries.
 */
static void __init create_mapping_noalloc(phys_addr_t phys, unsigned long virt,
400
				  phys_addr_t size, pgprot_t prot)
401
{
402
	if ((virt >= PAGE_END) && (virt < VMALLOC_START)) {
403 404 405 406
		pr_warn("BUG: not creating mapping for %pa at 0x%016lx - outside kernel range\n",
			&phys, virt);
		return;
	}
407 408
	__create_pgd_mapping(init_mm.pgd, phys, virt, size, prot, NULL,
			     NO_CONT_MAPPINGS);
409 410
}

411 412
void __init create_pgd_mapping(struct mm_struct *mm, phys_addr_t phys,
			       unsigned long virt, phys_addr_t size,
413
			       pgprot_t prot, bool page_mappings_only)
414
{
415 416
	int flags = 0;

417 418
	BUG_ON(mm == &init_mm);

419
	if (page_mappings_only)
420
		flags = NO_BLOCK_MAPPINGS | NO_CONT_MAPPINGS;
421

422
	__create_pgd_mapping(mm->pgd, phys, virt, size, prot,
423
			     pgd_pgtable_alloc, flags);
424 425
}

426 427
static void update_mapping_prot(phys_addr_t phys, unsigned long virt,
				phys_addr_t size, pgprot_t prot)
428
{
429
	if ((virt >= PAGE_END) && (virt < VMALLOC_START)) {
430
		pr_warn("BUG: not updating mapping for %pa at 0x%016lx - outside kernel range\n",
431 432 433 434
			&phys, virt);
		return;
	}

435 436
	__create_pgd_mapping(init_mm.pgd, phys, virt, size, prot, NULL,
			     NO_CONT_MAPPINGS);
437 438 439

	/* flush the TLBs after updating live kernel mappings */
	flush_tlb_kernel_range(virt, virt + size);
440 441
}

442
static void __init __map_memblock(pgd_t *pgdp, phys_addr_t start,
443 444
				  phys_addr_t end, pgprot_t prot, int flags)
{
445
	__create_pgd_mapping(pgdp, start, __phys_to_virt(start), end - start,
446 447 448 449 450 451 452 453 454 455 456 457 458
			     prot, early_pgtable_alloc, flags);
}

void __init mark_linear_text_alias_ro(void)
{
	/*
	 * Remove the write permissions from the linear alias of .text/.rodata
	 */
	update_mapping_prot(__pa_symbol(_text), (unsigned long)lm_alias(_text),
			    (unsigned long)__init_begin - (unsigned long)_text,
			    PAGE_KERNEL_RO);
}

459
static void __init map_mem(pgd_t *pgdp)
460
{
461 462
	phys_addr_t kernel_start = __pa_symbol(_text);
	phys_addr_t kernel_end = __pa_symbol(__init_begin);
463
	struct memblock_region *reg;
464 465
	int flags = 0;

466
	if (rodata_full || debug_pagealloc_enabled())
467
		flags = NO_BLOCK_MAPPINGS | NO_CONT_MAPPINGS;
468

469
	/*
470 471
	 * Take care not to create a writable alias for the
	 * read-only text and rodata sections of the kernel image.
472 473
	 * So temporarily mark them as NOMAP to skip mappings in
	 * the following for-loop
474
	 */
475 476 477 478 479 480
	memblock_mark_nomap(kernel_start, kernel_end - kernel_start);
#ifdef CONFIG_KEXEC_CORE
	if (crashk_res.end)
		memblock_mark_nomap(crashk_res.start,
				    resource_size(&crashk_res));
#endif
481

482 483 484 485
	/* map all the memory banks */
	for_each_memblock(memory, reg) {
		phys_addr_t start = reg->base;
		phys_addr_t end = start + reg->size;
486

487 488 489 490 491
		if (start >= end)
			break;
		if (memblock_is_nomap(reg))
			continue;

492
		__map_memblock(pgdp, start, end, PAGE_KERNEL, flags);
493
	}
494 495

	/*
496 497 498 499 500 501
	 * Map the linear alias of the [_text, __init_begin) interval
	 * as non-executable now, and remove the write permission in
	 * mark_linear_text_alias_ro() below (which will be called after
	 * alternative patching has completed). This makes the contents
	 * of the region accessible to subsystems such as hibernate,
	 * but protects it from inadvertent modification or execution.
502 503
	 * Note that contiguous mappings cannot be remapped in this way,
	 * so we should avoid them here.
504
	 */
505
	__map_memblock(pgdp, kernel_start, kernel_end,
506 507
		       PAGE_KERNEL, NO_CONT_MAPPINGS);
	memblock_clear_nomap(kernel_start, kernel_end - kernel_start);
508

509
#ifdef CONFIG_KEXEC_CORE
510
	/*
511 512 513
	 * Use page-level mappings here so that we can shrink the region
	 * in page granularity and put back unused memory to buddy system
	 * through /sys/kernel/kexec_crash_size interface.
514
	 */
515
	if (crashk_res.end) {
516
		__map_memblock(pgdp, crashk_res.start, crashk_res.end + 1,
517 518 519 520
			       PAGE_KERNEL,
			       NO_BLOCK_MAPPINGS | NO_CONT_MAPPINGS);
		memblock_clear_nomap(crashk_res.start,
				     resource_size(&crashk_res));
C
Catalin Marinas 已提交
521
	}
522
#endif
C
Catalin Marinas 已提交
523 524
}

525 526
void mark_rodata_ro(void)
{
J
Jeremy Linton 已提交
527
	unsigned long section_size;
528

J
Jeremy Linton 已提交
529
	/*
530 531
	 * mark .rodata as read only. Use __init_begin rather than __end_rodata
	 * to cover NOTES and EXCEPTION_TABLE.
J
Jeremy Linton 已提交
532
	 */
533
	section_size = (unsigned long)__init_begin - (unsigned long)__start_rodata;
534
	update_mapping_prot(__pa_symbol(__start_rodata), (unsigned long)__start_rodata,
J
Jeremy Linton 已提交
535
			    section_size, PAGE_KERNEL_RO);
536

537
	debug_checkwx();
538 539
}

540
static void __init map_kernel_segment(pgd_t *pgdp, void *va_start, void *va_end,
541
				      pgprot_t prot, struct vm_struct *vma,
542
				      int flags, unsigned long vm_flags)
543
{
544
	phys_addr_t pa_start = __pa_symbol(va_start);
545 546 547 548 549
	unsigned long size = va_end - va_start;

	BUG_ON(!PAGE_ALIGNED(pa_start));
	BUG_ON(!PAGE_ALIGNED(size));

550
	__create_pgd_mapping(pgdp, pa_start, (unsigned long)va_start, size, prot,
551
			     early_pgtable_alloc, flags);
552

553 554 555
	if (!(vm_flags & VM_NO_GUARD))
		size += PAGE_SIZE;

556 557 558
	vma->addr	= va_start;
	vma->phys_addr	= pa_start;
	vma->size	= size;
559
	vma->flags	= VM_MAP | vm_flags;
560 561 562
	vma->caller	= __builtin_return_address(0);

	vm_area_add_early(vma);
563 564
}

565 566
static int __init parse_rodata(char *arg)
{
567 568 569 570 571 572 573 574 575 576 577 578 579
	int ret = strtobool(arg, &rodata_enabled);
	if (!ret) {
		rodata_full = false;
		return 0;
	}

	/* permit 'full' in addition to boolean options */
	if (strcmp(arg, "full"))
		return -EINVAL;

	rodata_enabled = true;
	rodata_full = true;
	return 0;
580 581 582
}
early_param("rodata", parse_rodata);

583 584 585 586 587 588 589 590 591 592 593 594
#ifdef CONFIG_UNMAP_KERNEL_AT_EL0
static int __init map_entry_trampoline(void)
{
	pgprot_t prot = rodata_enabled ? PAGE_KERNEL_ROX : PAGE_KERNEL_EXEC;
	phys_addr_t pa_start = __pa_symbol(__entry_tramp_text_start);

	/* The trampoline is always mapped and can therefore be global */
	pgprot_val(prot) &= ~PTE_NG;

	/* Map only the text into the trampoline page table */
	memset(tramp_pg_dir, 0, PGD_SIZE);
	__create_pgd_mapping(tramp_pg_dir, pa_start, TRAMP_VALIAS, PAGE_SIZE,
595
			     prot, __pgd_pgtable_alloc, 0);
596

597
	/* Map both the text and data into the kernel page table */
598
	__set_fixmap(FIX_ENTRY_TRAMP_TEXT, pa_start, prot);
599 600 601 602 603 604 605 606
	if (IS_ENABLED(CONFIG_RANDOMIZE_BASE)) {
		extern char __entry_tramp_data_start[];

		__set_fixmap(FIX_ENTRY_TRAMP_DATA,
			     __pa_symbol(__entry_tramp_data_start),
			     PAGE_KERNEL_RO);
	}

607 608 609 610 611
	return 0;
}
core_initcall(map_entry_trampoline);
#endif

612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627
/*
 * Open coded check for BTI, only for use to determine configuration
 * for early mappings for before the cpufeature code has run.
 */
static bool arm64_early_this_cpu_has_bti(void)
{
	u64 pfr1;

	if (!IS_ENABLED(CONFIG_ARM64_BTI_KERNEL))
		return false;

	pfr1 = read_sysreg_s(SYS_ID_AA64PFR1_EL1);
	return cpuid_feature_extract_unsigned_field(pfr1,
						    ID_AA64PFR1_BT_SHIFT);
}

628 629 630
/*
 * Create fine-grained mappings for the kernel.
 */
631
static void __init map_kernel(pgd_t *pgdp)
632
{
633 634
	static struct vm_struct vmlinux_text, vmlinux_rodata, vmlinux_inittext,
				vmlinux_initdata, vmlinux_data;
635

636 637 638 639 640 641 642
	/*
	 * External debuggers may need to write directly to the text
	 * mapping to install SW breakpoints. Allow this (only) when
	 * explicitly requested with rodata=off.
	 */
	pgprot_t text_prot = rodata_enabled ? PAGE_KERNEL_ROX : PAGE_KERNEL_EXEC;

643 644 645 646 647 648 649 650
	/*
	 * If we have a CPU that supports BTI and a kernel built for
	 * BTI then mark the kernel executable text as guarded pages
	 * now so we don't have to rewrite the page tables later.
	 */
	if (arm64_early_this_cpu_has_bti())
		text_prot = __pgprot_modify(text_prot, PTE_GP, PTE_GP);

651 652 653 654
	/*
	 * Only rodata will be remapped with different permissions later on,
	 * all other segments are allowed to use contiguous mappings.
	 */
655
	map_kernel_segment(pgdp, _text, _etext, text_prot, &vmlinux_text, 0,
656
			   VM_NO_GUARD);
657
	map_kernel_segment(pgdp, __start_rodata, __inittext_begin, PAGE_KERNEL,
658
			   &vmlinux_rodata, NO_CONT_MAPPINGS, VM_NO_GUARD);
659
	map_kernel_segment(pgdp, __inittext_begin, __inittext_end, text_prot,
660
			   &vmlinux_inittext, 0, VM_NO_GUARD);
661
	map_kernel_segment(pgdp, __initdata_begin, __initdata_end, PAGE_KERNEL,
662
			   &vmlinux_initdata, 0, VM_NO_GUARD);
663
	map_kernel_segment(pgdp, _data, _end, PAGE_KERNEL, &vmlinux_data, 0, 0);
664

665
	if (!READ_ONCE(pgd_val(*pgd_offset_raw(pgdp, FIXADDR_START)))) {
666 667 668 669 670
		/*
		 * The fixmap falls in a separate pgd to the kernel, and doesn't
		 * live in the carveout for the swapper_pg_dir. We can simply
		 * re-use the existing dir for the fixmap.
		 */
671 672
		set_pgd(pgd_offset_raw(pgdp, FIXADDR_START),
			READ_ONCE(*pgd_offset_k(FIXADDR_START)));
673
	} else if (CONFIG_PGTABLE_LEVELS > 3) {
674 675
		pgd_t *bm_pgdp;
		pud_t *bm_pudp;
676 677 678 679 680 681 682
		/*
		 * The fixmap shares its top level pgd entry with the kernel
		 * mapping. This can really only occur when we are running
		 * with 16k/4 levels, so we can simply reuse the pud level
		 * entry instead.
		 */
		BUG_ON(!IS_ENABLED(CONFIG_ARM64_16K_PAGES));
683 684 685
		bm_pgdp = pgd_offset_raw(pgdp, FIXADDR_START);
		bm_pudp = pud_set_fixmap_offset(bm_pgdp, FIXADDR_START);
		pud_populate(&init_mm, bm_pudp, lm_alias(bm_pmd));
686 687 688 689
		pud_clear_fixmap();
	} else {
		BUG();
	}
690

691
	kasan_copy_shadow(pgdp);
692 693
}

C
Catalin Marinas 已提交
694 695
void __init paging_init(void)
{
696
	pgd_t *pgdp = pgd_set_fixmap(__pa_symbol(swapper_pg_dir));
697

698 699
	map_kernel(pgdp);
	map_mem(pgdp);
700 701 702

	pgd_clear_fixmap();

703
	cpu_replace_ttbr1(lm_alias(swapper_pg_dir));
704
	init_mm.pgd = swapper_pg_dir;
705

706 707
	memblock_free(__pa_symbol(init_pg_dir),
		      __pa_symbol(init_pg_end) - __pa_symbol(init_pg_dir));
708 709

	memblock_allow_resize();
C
Catalin Marinas 已提交
710 711 712 713 714 715 716
}

/*
 * Check whether a kernel address is valid (derived from arch/x86/).
 */
int kern_addr_valid(unsigned long addr)
{
717 718 719 720
	pgd_t *pgdp;
	pud_t *pudp, pud;
	pmd_t *pmdp, pmd;
	pte_t *ptep, pte;
C
Catalin Marinas 已提交
721 722 723 724

	if ((((long)addr) >> VA_BITS) != -1UL)
		return 0;

725 726
	pgdp = pgd_offset_k(addr);
	if (pgd_none(READ_ONCE(*pgdp)))
C
Catalin Marinas 已提交
727 728
		return 0;

729 730 731
	pudp = pud_offset(pgdp, addr);
	pud = READ_ONCE(*pudp);
	if (pud_none(pud))
C
Catalin Marinas 已提交
732 733
		return 0;

734 735
	if (pud_sect(pud))
		return pfn_valid(pud_pfn(pud));
736

737 738 739
	pmdp = pmd_offset(pudp, addr);
	pmd = READ_ONCE(*pmdp);
	if (pmd_none(pmd))
C
Catalin Marinas 已提交
740 741
		return 0;

742 743
	if (pmd_sect(pmd))
		return pfn_valid(pmd_pfn(pmd));
744

745 746 747
	ptep = pte_offset_kernel(pmdp, addr);
	pte = READ_ONCE(*ptep);
	if (pte_none(pte))
C
Catalin Marinas 已提交
748 749
		return 0;

750
	return pfn_valid(pte_pfn(pte));
C
Catalin Marinas 已提交
751
}
752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057

#ifdef CONFIG_MEMORY_HOTPLUG
static void free_hotplug_page_range(struct page *page, size_t size)
{
	WARN_ON(PageReserved(page));
	free_pages((unsigned long)page_address(page), get_order(size));
}

static void free_hotplug_pgtable_page(struct page *page)
{
	free_hotplug_page_range(page, PAGE_SIZE);
}

static bool pgtable_range_aligned(unsigned long start, unsigned long end,
				  unsigned long floor, unsigned long ceiling,
				  unsigned long mask)
{
	start &= mask;
	if (start < floor)
		return false;

	if (ceiling) {
		ceiling &= mask;
		if (!ceiling)
			return false;
	}

	if (end - 1 > ceiling - 1)
		return false;
	return true;
}

static void unmap_hotplug_pte_range(pmd_t *pmdp, unsigned long addr,
				    unsigned long end, bool free_mapped)
{
	pte_t *ptep, pte;

	do {
		ptep = pte_offset_kernel(pmdp, addr);
		pte = READ_ONCE(*ptep);
		if (pte_none(pte))
			continue;

		WARN_ON(!pte_present(pte));
		pte_clear(&init_mm, addr, ptep);
		flush_tlb_kernel_range(addr, addr + PAGE_SIZE);
		if (free_mapped)
			free_hotplug_page_range(pte_page(pte), PAGE_SIZE);
	} while (addr += PAGE_SIZE, addr < end);
}

static void unmap_hotplug_pmd_range(pud_t *pudp, unsigned long addr,
				    unsigned long end, bool free_mapped)
{
	unsigned long next;
	pmd_t *pmdp, pmd;

	do {
		next = pmd_addr_end(addr, end);
		pmdp = pmd_offset(pudp, addr);
		pmd = READ_ONCE(*pmdp);
		if (pmd_none(pmd))
			continue;

		WARN_ON(!pmd_present(pmd));
		if (pmd_sect(pmd)) {
			pmd_clear(pmdp);

			/*
			 * One TLBI should be sufficient here as the PMD_SIZE
			 * range is mapped with a single block entry.
			 */
			flush_tlb_kernel_range(addr, addr + PAGE_SIZE);
			if (free_mapped)
				free_hotplug_page_range(pmd_page(pmd),
							PMD_SIZE);
			continue;
		}
		WARN_ON(!pmd_table(pmd));
		unmap_hotplug_pte_range(pmdp, addr, next, free_mapped);
	} while (addr = next, addr < end);
}

static void unmap_hotplug_pud_range(p4d_t *p4dp, unsigned long addr,
				    unsigned long end, bool free_mapped)
{
	unsigned long next;
	pud_t *pudp, pud;

	do {
		next = pud_addr_end(addr, end);
		pudp = pud_offset(p4dp, addr);
		pud = READ_ONCE(*pudp);
		if (pud_none(pud))
			continue;

		WARN_ON(!pud_present(pud));
		if (pud_sect(pud)) {
			pud_clear(pudp);

			/*
			 * One TLBI should be sufficient here as the PUD_SIZE
			 * range is mapped with a single block entry.
			 */
			flush_tlb_kernel_range(addr, addr + PAGE_SIZE);
			if (free_mapped)
				free_hotplug_page_range(pud_page(pud),
							PUD_SIZE);
			continue;
		}
		WARN_ON(!pud_table(pud));
		unmap_hotplug_pmd_range(pudp, addr, next, free_mapped);
	} while (addr = next, addr < end);
}

static void unmap_hotplug_p4d_range(pgd_t *pgdp, unsigned long addr,
				    unsigned long end, bool free_mapped)
{
	unsigned long next;
	p4d_t *p4dp, p4d;

	do {
		next = p4d_addr_end(addr, end);
		p4dp = p4d_offset(pgdp, addr);
		p4d = READ_ONCE(*p4dp);
		if (p4d_none(p4d))
			continue;

		WARN_ON(!p4d_present(p4d));
		unmap_hotplug_pud_range(p4dp, addr, next, free_mapped);
	} while (addr = next, addr < end);
}

static void unmap_hotplug_range(unsigned long addr, unsigned long end,
				bool free_mapped)
{
	unsigned long next;
	pgd_t *pgdp, pgd;

	do {
		next = pgd_addr_end(addr, end);
		pgdp = pgd_offset_k(addr);
		pgd = READ_ONCE(*pgdp);
		if (pgd_none(pgd))
			continue;

		WARN_ON(!pgd_present(pgd));
		unmap_hotplug_p4d_range(pgdp, addr, next, free_mapped);
	} while (addr = next, addr < end);
}

static void free_empty_pte_table(pmd_t *pmdp, unsigned long addr,
				 unsigned long end, unsigned long floor,
				 unsigned long ceiling)
{
	pte_t *ptep, pte;
	unsigned long i, start = addr;

	do {
		ptep = pte_offset_kernel(pmdp, addr);
		pte = READ_ONCE(*ptep);

		/*
		 * This is just a sanity check here which verifies that
		 * pte clearing has been done by earlier unmap loops.
		 */
		WARN_ON(!pte_none(pte));
	} while (addr += PAGE_SIZE, addr < end);

	if (!pgtable_range_aligned(start, end, floor, ceiling, PMD_MASK))
		return;

	/*
	 * Check whether we can free the pte page if the rest of the
	 * entries are empty. Overlap with other regions have been
	 * handled by the floor/ceiling check.
	 */
	ptep = pte_offset_kernel(pmdp, 0UL);
	for (i = 0; i < PTRS_PER_PTE; i++) {
		if (!pte_none(READ_ONCE(ptep[i])))
			return;
	}

	pmd_clear(pmdp);
	__flush_tlb_kernel_pgtable(start);
	free_hotplug_pgtable_page(virt_to_page(ptep));
}

static void free_empty_pmd_table(pud_t *pudp, unsigned long addr,
				 unsigned long end, unsigned long floor,
				 unsigned long ceiling)
{
	pmd_t *pmdp, pmd;
	unsigned long i, next, start = addr;

	do {
		next = pmd_addr_end(addr, end);
		pmdp = pmd_offset(pudp, addr);
		pmd = READ_ONCE(*pmdp);
		if (pmd_none(pmd))
			continue;

		WARN_ON(!pmd_present(pmd) || !pmd_table(pmd) || pmd_sect(pmd));
		free_empty_pte_table(pmdp, addr, next, floor, ceiling);
	} while (addr = next, addr < end);

	if (CONFIG_PGTABLE_LEVELS <= 2)
		return;

	if (!pgtable_range_aligned(start, end, floor, ceiling, PUD_MASK))
		return;

	/*
	 * Check whether we can free the pmd page if the rest of the
	 * entries are empty. Overlap with other regions have been
	 * handled by the floor/ceiling check.
	 */
	pmdp = pmd_offset(pudp, 0UL);
	for (i = 0; i < PTRS_PER_PMD; i++) {
		if (!pmd_none(READ_ONCE(pmdp[i])))
			return;
	}

	pud_clear(pudp);
	__flush_tlb_kernel_pgtable(start);
	free_hotplug_pgtable_page(virt_to_page(pmdp));
}

static void free_empty_pud_table(p4d_t *p4dp, unsigned long addr,
				 unsigned long end, unsigned long floor,
				 unsigned long ceiling)
{
	pud_t *pudp, pud;
	unsigned long i, next, start = addr;

	do {
		next = pud_addr_end(addr, end);
		pudp = pud_offset(p4dp, addr);
		pud = READ_ONCE(*pudp);
		if (pud_none(pud))
			continue;

		WARN_ON(!pud_present(pud) || !pud_table(pud) || pud_sect(pud));
		free_empty_pmd_table(pudp, addr, next, floor, ceiling);
	} while (addr = next, addr < end);

	if (CONFIG_PGTABLE_LEVELS <= 3)
		return;

	if (!pgtable_range_aligned(start, end, floor, ceiling, PGDIR_MASK))
		return;

	/*
	 * Check whether we can free the pud page if the rest of the
	 * entries are empty. Overlap with other regions have been
	 * handled by the floor/ceiling check.
	 */
	pudp = pud_offset(p4dp, 0UL);
	for (i = 0; i < PTRS_PER_PUD; i++) {
		if (!pud_none(READ_ONCE(pudp[i])))
			return;
	}

	p4d_clear(p4dp);
	__flush_tlb_kernel_pgtable(start);
	free_hotplug_pgtable_page(virt_to_page(pudp));
}

static void free_empty_p4d_table(pgd_t *pgdp, unsigned long addr,
				 unsigned long end, unsigned long floor,
				 unsigned long ceiling)
{
	unsigned long next;
	p4d_t *p4dp, p4d;

	do {
		next = p4d_addr_end(addr, end);
		p4dp = p4d_offset(pgdp, addr);
		p4d = READ_ONCE(*p4dp);
		if (p4d_none(p4d))
			continue;

		WARN_ON(!p4d_present(p4d));
		free_empty_pud_table(p4dp, addr, next, floor, ceiling);
	} while (addr = next, addr < end);
}

static void free_empty_tables(unsigned long addr, unsigned long end,
			      unsigned long floor, unsigned long ceiling)
{
	unsigned long next;
	pgd_t *pgdp, pgd;

	do {
		next = pgd_addr_end(addr, end);
		pgdp = pgd_offset_k(addr);
		pgd = READ_ONCE(*pgdp);
		if (pgd_none(pgd))
			continue;

		WARN_ON(!pgd_present(pgd));
		free_empty_p4d_table(pgdp, addr, next, floor, ceiling);
	} while (addr = next, addr < end);
}
#endif

C
Catalin Marinas 已提交
1058
#ifdef CONFIG_SPARSEMEM_VMEMMAP
1059
#if !ARM64_SWAPPER_USES_SECTION_MAPS
1060 1061
int __meminit vmemmap_populate(unsigned long start, unsigned long end, int node,
		struct vmem_altmap *altmap)
C
Catalin Marinas 已提交
1062
{
1063
	return vmemmap_populate_basepages(start, end, node);
C
Catalin Marinas 已提交
1064
}
1065
#else	/* !ARM64_SWAPPER_USES_SECTION_MAPS */
1066 1067
int __meminit vmemmap_populate(unsigned long start, unsigned long end, int node,
		struct vmem_altmap *altmap)
C
Catalin Marinas 已提交
1068
{
1069
	unsigned long addr = start;
C
Catalin Marinas 已提交
1070
	unsigned long next;
1071 1072 1073
	pgd_t *pgdp;
	pud_t *pudp;
	pmd_t *pmdp;
C
Catalin Marinas 已提交
1074 1075 1076 1077

	do {
		next = pmd_addr_end(addr, end);

1078 1079
		pgdp = vmemmap_pgd_populate(addr, node);
		if (!pgdp)
C
Catalin Marinas 已提交
1080 1081
			return -ENOMEM;

1082 1083
		pudp = vmemmap_pud_populate(pgdp, addr, node);
		if (!pudp)
C
Catalin Marinas 已提交
1084 1085
			return -ENOMEM;

1086 1087
		pmdp = pmd_offset(pudp, addr);
		if (pmd_none(READ_ONCE(*pmdp))) {
C
Catalin Marinas 已提交
1088 1089 1090 1091 1092 1093
			void *p = NULL;

			p = vmemmap_alloc_block_buf(PMD_SIZE, node);
			if (!p)
				return -ENOMEM;

1094
			pmd_set_huge(pmdp, __pa(p), __pgprot(PROT_SECT_NORMAL));
C
Catalin Marinas 已提交
1095
		} else
1096
			vmemmap_verify((pte_t *)pmdp, node, addr, next);
C
Catalin Marinas 已提交
1097 1098 1099 1100
	} while (addr = next, addr != end);

	return 0;
}
O
Odin Ugedal 已提交
1101
#endif	/* !ARM64_SWAPPER_USES_SECTION_MAPS */
1102 1103
void vmemmap_free(unsigned long start, unsigned long end,
		struct vmem_altmap *altmap)
1104
{
1105 1106 1107 1108 1109 1110
#ifdef CONFIG_MEMORY_HOTPLUG
	WARN_ON((start < VMEMMAP_START) || (end > VMEMMAP_END));

	unmap_hotplug_range(start, end, true);
	free_empty_tables(start, end, VMEMMAP_START, VMEMMAP_END);
#endif
1111
}
C
Catalin Marinas 已提交
1112
#endif	/* CONFIG_SPARSEMEM_VMEMMAP */
1113 1114 1115

static inline pud_t * fixmap_pud(unsigned long addr)
{
1116 1117
	pgd_t *pgdp = pgd_offset_k(addr);
	pgd_t pgd = READ_ONCE(*pgdp);
1118

1119
	BUG_ON(pgd_none(pgd) || pgd_bad(pgd));
1120

1121
	return pud_offset_kimg(pgdp, addr);
1122 1123 1124 1125
}

static inline pmd_t * fixmap_pmd(unsigned long addr)
{
1126 1127
	pud_t *pudp = fixmap_pud(addr);
	pud_t pud = READ_ONCE(*pudp);
1128

1129
	BUG_ON(pud_none(pud) || pud_bad(pud));
1130

1131
	return pmd_offset_kimg(pudp, addr);
1132 1133 1134 1135
}

static inline pte_t * fixmap_pte(unsigned long addr)
{
1136
	return &bm_pte[pte_index(addr)];
1137 1138
}

1139 1140 1141 1142 1143 1144
/*
 * The p*d_populate functions call virt_to_phys implicitly so they can't be used
 * directly on kernel symbols (bm_p*d). This function is called too early to use
 * lm_alias so __p*d_populate functions must be used to populate with the
 * physical address from __pa_symbol.
 */
1145 1146
void __init early_fixmap_init(void)
{
1147 1148 1149
	pgd_t *pgdp, pgd;
	pud_t *pudp;
	pmd_t *pmdp;
1150 1151
	unsigned long addr = FIXADDR_START;

1152 1153
	pgdp = pgd_offset_k(addr);
	pgd = READ_ONCE(*pgdp);
1154
	if (CONFIG_PGTABLE_LEVELS > 3 &&
1155
	    !(pgd_none(pgd) || pgd_page_paddr(pgd) == __pa_symbol(bm_pud))) {
1156 1157 1158 1159 1160 1161
		/*
		 * We only end up here if the kernel mapping and the fixmap
		 * share the top level pgd entry, which should only happen on
		 * 16k/4 levels configurations.
		 */
		BUG_ON(!IS_ENABLED(CONFIG_ARM64_16K_PAGES));
1162
		pudp = pud_offset_kimg(pgdp, addr);
1163
	} else {
1164 1165 1166
		if (pgd_none(pgd))
			__pgd_populate(pgdp, __pa_symbol(bm_pud), PUD_TYPE_TABLE);
		pudp = fixmap_pud(addr);
1167
	}
1168 1169 1170 1171
	if (pud_none(READ_ONCE(*pudp)))
		__pud_populate(pudp, __pa_symbol(bm_pmd), PMD_TYPE_TABLE);
	pmdp = fixmap_pmd(addr);
	__pmd_populate(pmdp, __pa_symbol(bm_pte), PMD_TYPE_TABLE);
1172 1173 1174

	/*
	 * The boot-ioremap range spans multiple pmds, for which
1175
	 * we are not prepared:
1176 1177 1178 1179
	 */
	BUILD_BUG_ON((__fix_to_virt(FIX_BTMAP_BEGIN) >> PMD_SHIFT)
		     != (__fix_to_virt(FIX_BTMAP_END) >> PMD_SHIFT));

1180 1181
	if ((pmdp != fixmap_pmd(fix_to_virt(FIX_BTMAP_BEGIN)))
	     || pmdp != fixmap_pmd(fix_to_virt(FIX_BTMAP_END))) {
1182
		WARN_ON(1);
1183 1184
		pr_warn("pmdp %p != %p, %p\n",
			pmdp, fixmap_pmd(fix_to_virt(FIX_BTMAP_BEGIN)),
1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195
			fixmap_pmd(fix_to_virt(FIX_BTMAP_END)));
		pr_warn("fix_to_virt(FIX_BTMAP_BEGIN): %08lx\n",
			fix_to_virt(FIX_BTMAP_BEGIN));
		pr_warn("fix_to_virt(FIX_BTMAP_END):   %08lx\n",
			fix_to_virt(FIX_BTMAP_END));

		pr_warn("FIX_BTMAP_END:       %d\n", FIX_BTMAP_END);
		pr_warn("FIX_BTMAP_BEGIN:     %d\n", FIX_BTMAP_BEGIN);
	}
}

1196 1197 1198 1199
/*
 * Unusually, this is also called in IRQ context (ghes_iounmap_irq) so if we
 * ever need to use IPIs for TLB broadcasting, then we're in trouble here.
 */
1200 1201 1202 1203
void __set_fixmap(enum fixed_addresses idx,
			       phys_addr_t phys, pgprot_t flags)
{
	unsigned long addr = __fix_to_virt(idx);
1204
	pte_t *ptep;
1205

1206
	BUG_ON(idx <= FIX_HOLE || idx >= __end_of_fixed_addresses);
1207

1208
	ptep = fixmap_pte(addr);
1209 1210

	if (pgprot_val(flags)) {
1211
		set_pte(ptep, pfn_pte(phys >> PAGE_SHIFT, flags));
1212
	} else {
1213
		pte_clear(&init_mm, addr, ptep);
1214 1215 1216
		flush_tlb_kernel_range(addr, addr+PAGE_SIZE);
	}
}
1217

1218
void *__init fixmap_remap_fdt(phys_addr_t dt_phys, int *size, pgprot_t prot)
1219 1220
{
	const u64 dt_virt_base = __fix_to_virt(FIX_FDT);
1221
	int offset;
1222 1223 1224 1225 1226
	void *dt_virt;

	/*
	 * Check whether the physical FDT address is set and meets the minimum
	 * alignment requirement. Since we are relying on MIN_FDT_ALIGN to be
1227 1228 1229
	 * at least 8 bytes so that we can always access the magic and size
	 * fields of the FDT header after mapping the first chunk, double check
	 * here if that is indeed the case.
1230 1231 1232 1233 1234 1235 1236 1237
	 */
	BUILD_BUG_ON(MIN_FDT_ALIGN < 8);
	if (!dt_phys || dt_phys % MIN_FDT_ALIGN)
		return NULL;

	/*
	 * Make sure that the FDT region can be mapped without the need to
	 * allocate additional translation table pages, so that it is safe
1238
	 * to call create_mapping_noalloc() this early.
1239 1240 1241 1242 1243 1244 1245 1246
	 *
	 * On 64k pages, the FDT will be mapped using PTEs, so we need to
	 * be in the same PMD as the rest of the fixmap.
	 * On 4k pages, we'll use section mappings for the FDT so we only
	 * have to be in the same PUD.
	 */
	BUILD_BUG_ON(dt_virt_base % SZ_2M);

1247 1248
	BUILD_BUG_ON(__fix_to_virt(FIX_FDT_END) >> SWAPPER_TABLE_SHIFT !=
		     __fix_to_virt(FIX_BTMAP_BEGIN) >> SWAPPER_TABLE_SHIFT);
1249

1250
	offset = dt_phys % SWAPPER_BLOCK_SIZE;
1251 1252 1253
	dt_virt = (void *)dt_virt_base + offset;

	/* map the first chunk so we can read the size from the header */
1254 1255
	create_mapping_noalloc(round_down(dt_phys, SWAPPER_BLOCK_SIZE),
			dt_virt_base, SWAPPER_BLOCK_SIZE, prot);
1256

1257
	if (fdt_magic(dt_virt) != FDT_MAGIC)
1258 1259
		return NULL;

1260 1261
	*size = fdt_totalsize(dt_virt);
	if (*size > MAX_FDT_SIZE)
1262 1263
		return NULL;

1264
	if (offset + *size > SWAPPER_BLOCK_SIZE)
1265
		create_mapping_noalloc(round_down(dt_phys, SWAPPER_BLOCK_SIZE), dt_virt_base,
1266
			       round_up(offset + *size, SWAPPER_BLOCK_SIZE), prot);
1267

1268 1269
	return dt_virt;
}
1270

1271 1272 1273 1274 1275
int __init arch_ioremap_p4d_supported(void)
{
	return 0;
}

1276 1277
int __init arch_ioremap_pud_supported(void)
{
1278 1279 1280 1281 1282
	/*
	 * Only 4k granule supports level 1 block mappings.
	 * SW table walks can't handle removal of intermediate entries.
	 */
	return IS_ENABLED(CONFIG_ARM64_4K_PAGES) &&
1283
	       !IS_ENABLED(CONFIG_PTDUMP_DEBUGFS);
1284 1285 1286 1287
}

int __init arch_ioremap_pmd_supported(void)
{
1288
	/* See arch_ioremap_pud_supported() */
1289
	return !IS_ENABLED(CONFIG_PTDUMP_DEBUGFS);
1290 1291
}

1292
int pud_set_huge(pud_t *pudp, phys_addr_t phys, pgprot_t prot)
1293
{
1294
	pud_t new_pud = pfn_pud(__phys_to_pfn(phys), mk_pud_sect_prot(prot));
1295

1296 1297 1298
	/* Only allow permission changes for now */
	if (!pgattr_change_is_safe(READ_ONCE(pud_val(*pudp)),
				   pud_val(new_pud)))
1299 1300
		return 0;

1301
	VM_BUG_ON(phys & ~PUD_MASK);
1302
	set_pud(pudp, new_pud);
1303 1304 1305
	return 1;
}

1306
int pmd_set_huge(pmd_t *pmdp, phys_addr_t phys, pgprot_t prot)
1307
{
1308
	pmd_t new_pmd = pfn_pmd(__phys_to_pfn(phys), mk_pmd_sect_prot(prot));
1309

1310 1311 1312
	/* Only allow permission changes for now */
	if (!pgattr_change_is_safe(READ_ONCE(pmd_val(*pmdp)),
				   pmd_val(new_pmd)))
1313 1314
		return 0;

1315
	VM_BUG_ON(phys & ~PMD_MASK);
1316
	set_pmd(pmdp, new_pmd);
1317 1318 1319
	return 1;
}

1320
int pud_clear_huge(pud_t *pudp)
1321
{
1322
	if (!pud_sect(READ_ONCE(*pudp)))
1323
		return 0;
1324
	pud_clear(pudp);
1325 1326 1327
	return 1;
}

1328
int pmd_clear_huge(pmd_t *pmdp)
1329
{
1330
	if (!pmd_sect(READ_ONCE(*pmdp)))
1331
		return 0;
1332
	pmd_clear(pmdp);
1333 1334
	return 1;
}
1335

1336
int pmd_free_pte_page(pmd_t *pmdp, unsigned long addr)
1337
{
1338 1339 1340 1341 1342
	pte_t *table;
	pmd_t pmd;

	pmd = READ_ONCE(*pmdp);

1343
	if (!pmd_table(pmd)) {
1344
		VM_WARN_ON(1);
1345 1346 1347 1348 1349 1350 1351 1352
		return 1;
	}

	table = pte_offset_kernel(pmdp, addr);
	pmd_clear(pmdp);
	__flush_tlb_kernel_pgtable(addr);
	pte_free_kernel(NULL, table);
	return 1;
1353 1354
}

1355
int pud_free_pmd_page(pud_t *pudp, unsigned long addr)
1356
{
1357 1358 1359 1360 1361 1362 1363
	pmd_t *table;
	pmd_t *pmdp;
	pud_t pud;
	unsigned long next, end;

	pud = READ_ONCE(*pudp);

1364
	if (!pud_table(pud)) {
1365
		VM_WARN_ON(1);
1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380
		return 1;
	}

	table = pmd_offset(pudp, addr);
	pmdp = table;
	next = addr;
	end = addr + PUD_SIZE;
	do {
		pmd_free_pte_page(pmdp, next);
	} while (pmdp++, next += PMD_SIZE, next != end);

	pud_clear(pudp);
	__flush_tlb_kernel_pgtable(addr);
	pmd_free(NULL, table);
	return 1;
1381
}
R
Robin Murphy 已提交
1382

1383 1384 1385 1386 1387
int p4d_free_pud_page(p4d_t *p4d, unsigned long addr)
{
	return 0;	/* Don't attempt a block mapping */
}

R
Robin Murphy 已提交
1388
#ifdef CONFIG_MEMORY_HOTPLUG
1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399
static void __remove_pgd_mapping(pgd_t *pgdir, unsigned long start, u64 size)
{
	unsigned long end = start + size;

	WARN_ON(pgdir != init_mm.pgd);
	WARN_ON((start < PAGE_OFFSET) || (end > PAGE_END));

	unmap_hotplug_range(start, end, false);
	free_empty_tables(start, end, PAGE_OFFSET, PAGE_END);
}

1400
int arch_add_memory(int nid, u64 start, u64 size,
1401
		    struct mhp_params *params)
R
Robin Murphy 已提交
1402
{
1403
	int ret, flags = 0;
R
Robin Murphy 已提交
1404 1405 1406 1407 1408

	if (rodata_full || debug_pagealloc_enabled())
		flags = NO_BLOCK_MAPPINGS | NO_CONT_MAPPINGS;

	__create_pgd_mapping(swapper_pg_dir, start, __phys_to_virt(start),
1409 1410
			     size, params->pgprot, __pgd_pgtable_alloc,
			     flags);
R
Robin Murphy 已提交
1411

1412 1413
	memblock_clear_nomap(start, size);

1414
	ret = __add_pages(nid, start >> PAGE_SHIFT, size >> PAGE_SHIFT,
1415
			   params);
1416 1417 1418 1419
	if (ret)
		__remove_pgd_mapping(swapper_pg_dir,
				     __phys_to_virt(start), size);
	return ret;
R
Robin Murphy 已提交
1420
}
1421

1422 1423 1424 1425 1426 1427
void arch_remove_memory(int nid, u64 start, u64 size,
			struct vmem_altmap *altmap)
{
	unsigned long start_pfn = start >> PAGE_SHIFT;
	unsigned long nr_pages = size >> PAGE_SHIFT;

1428
	__remove_pages(start_pfn, nr_pages, altmap);
1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466
	__remove_pgd_mapping(swapper_pg_dir, __phys_to_virt(start), size);
}

/*
 * This memory hotplug notifier helps prevent boot memory from being
 * inadvertently removed as it blocks pfn range offlining process in
 * __offline_pages(). Hence this prevents both offlining as well as
 * removal process for boot memory which is initially always online.
 * In future if and when boot memory could be removed, this notifier
 * should be dropped and free_hotplug_page_range() should handle any
 * reserved pages allocated during boot.
 */
static int prevent_bootmem_remove_notifier(struct notifier_block *nb,
					   unsigned long action, void *data)
{
	struct mem_section *ms;
	struct memory_notify *arg = data;
	unsigned long end_pfn = arg->start_pfn + arg->nr_pages;
	unsigned long pfn = arg->start_pfn;

	if (action != MEM_GOING_OFFLINE)
		return NOTIFY_OK;

	for (; pfn < end_pfn; pfn += PAGES_PER_SECTION) {
		ms = __pfn_to_section(pfn);
		if (early_section(ms))
			return NOTIFY_BAD;
	}
	return NOTIFY_OK;
}

static struct notifier_block prevent_bootmem_remove_nb = {
	.notifier_call = prevent_bootmem_remove_notifier,
};

static int __init prevent_bootmem_remove_init(void)
{
	return register_memory_notifier(&prevent_bootmem_remove_nb);
1467
}
1468
device_initcall(prevent_bootmem_remove_init);
1469
#endif