162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * AMD Memory Encryption Support
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright (C) 2016 Advanced Micro Devices, Inc.
662306a36Sopenharmony_ci *
762306a36Sopenharmony_ci * Author: Tom Lendacky <thomas.lendacky@amd.com>
862306a36Sopenharmony_ci */
962306a36Sopenharmony_ci
1062306a36Sopenharmony_ci#define DISABLE_BRANCH_PROFILING
1162306a36Sopenharmony_ci
1262306a36Sopenharmony_ci/*
1362306a36Sopenharmony_ci * Since we're dealing with identity mappings, physical and virtual
1462306a36Sopenharmony_ci * addresses are the same, so override these defines which are ultimately
1562306a36Sopenharmony_ci * used by the headers in misc.h.
1662306a36Sopenharmony_ci */
1762306a36Sopenharmony_ci#define __pa(x)  ((unsigned long)(x))
1862306a36Sopenharmony_ci#define __va(x)  ((void *)((unsigned long)(x)))
1962306a36Sopenharmony_ci
2062306a36Sopenharmony_ci/*
2162306a36Sopenharmony_ci * Special hack: we have to be careful, because no indirections are
2262306a36Sopenharmony_ci * allowed here, and paravirt_ops is a kind of one. As it will only run in
2362306a36Sopenharmony_ci * baremetal anyway, we just keep it from happening. (This list needs to
2462306a36Sopenharmony_ci * be extended when new paravirt and debugging variants are added.)
2562306a36Sopenharmony_ci */
2662306a36Sopenharmony_ci#undef CONFIG_PARAVIRT
2762306a36Sopenharmony_ci#undef CONFIG_PARAVIRT_XXL
2862306a36Sopenharmony_ci#undef CONFIG_PARAVIRT_SPINLOCKS
2962306a36Sopenharmony_ci
3062306a36Sopenharmony_ci/*
3162306a36Sopenharmony_ci * This code runs before CPU feature bits are set. By default, the
3262306a36Sopenharmony_ci * pgtable_l5_enabled() function uses bit X86_FEATURE_LA57 to determine if
3362306a36Sopenharmony_ci * 5-level paging is active, so that won't work here. USE_EARLY_PGTABLE_L5
3462306a36Sopenharmony_ci * is provided to handle this situation and, instead, use a variable that
3562306a36Sopenharmony_ci * has been set by the early boot code.
3662306a36Sopenharmony_ci */
3762306a36Sopenharmony_ci#define USE_EARLY_PGTABLE_L5
3862306a36Sopenharmony_ci
3962306a36Sopenharmony_ci#include <linux/kernel.h>
4062306a36Sopenharmony_ci#include <linux/mm.h>
4162306a36Sopenharmony_ci#include <linux/mem_encrypt.h>
4262306a36Sopenharmony_ci#include <linux/cc_platform.h>
4362306a36Sopenharmony_ci
4462306a36Sopenharmony_ci#include <asm/setup.h>
4562306a36Sopenharmony_ci#include <asm/sections.h>
4662306a36Sopenharmony_ci#include <asm/cmdline.h>
4762306a36Sopenharmony_ci#include <asm/coco.h>
4862306a36Sopenharmony_ci#include <asm/sev.h>
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_ci#include "mm_internal.h"
5162306a36Sopenharmony_ci
5262306a36Sopenharmony_ci#define PGD_FLAGS		_KERNPG_TABLE_NOENC
5362306a36Sopenharmony_ci#define P4D_FLAGS		_KERNPG_TABLE_NOENC
5462306a36Sopenharmony_ci#define PUD_FLAGS		_KERNPG_TABLE_NOENC
5562306a36Sopenharmony_ci#define PMD_FLAGS		_KERNPG_TABLE_NOENC
5662306a36Sopenharmony_ci
5762306a36Sopenharmony_ci#define PMD_FLAGS_LARGE		(__PAGE_KERNEL_LARGE_EXEC & ~_PAGE_GLOBAL)
5862306a36Sopenharmony_ci
5962306a36Sopenharmony_ci#define PMD_FLAGS_DEC		PMD_FLAGS_LARGE
6062306a36Sopenharmony_ci#define PMD_FLAGS_DEC_WP	((PMD_FLAGS_DEC & ~_PAGE_LARGE_CACHE_MASK) | \
6162306a36Sopenharmony_ci				 (_PAGE_PAT_LARGE | _PAGE_PWT))
6262306a36Sopenharmony_ci
6362306a36Sopenharmony_ci#define PMD_FLAGS_ENC		(PMD_FLAGS_LARGE | _PAGE_ENC)
6462306a36Sopenharmony_ci
6562306a36Sopenharmony_ci#define PTE_FLAGS		(__PAGE_KERNEL_EXEC & ~_PAGE_GLOBAL)
6662306a36Sopenharmony_ci
6762306a36Sopenharmony_ci#define PTE_FLAGS_DEC		PTE_FLAGS
6862306a36Sopenharmony_ci#define PTE_FLAGS_DEC_WP	((PTE_FLAGS_DEC & ~_PAGE_CACHE_MASK) | \
6962306a36Sopenharmony_ci				 (_PAGE_PAT | _PAGE_PWT))
7062306a36Sopenharmony_ci
7162306a36Sopenharmony_ci#define PTE_FLAGS_ENC		(PTE_FLAGS | _PAGE_ENC)
7262306a36Sopenharmony_ci
7362306a36Sopenharmony_cistruct sme_populate_pgd_data {
7462306a36Sopenharmony_ci	void    *pgtable_area;
7562306a36Sopenharmony_ci	pgd_t   *pgd;
7662306a36Sopenharmony_ci
7762306a36Sopenharmony_ci	pmdval_t pmd_flags;
7862306a36Sopenharmony_ci	pteval_t pte_flags;
7962306a36Sopenharmony_ci	unsigned long paddr;
8062306a36Sopenharmony_ci
8162306a36Sopenharmony_ci	unsigned long vaddr;
8262306a36Sopenharmony_ci	unsigned long vaddr_end;
8362306a36Sopenharmony_ci};
8462306a36Sopenharmony_ci
8562306a36Sopenharmony_ci/*
8662306a36Sopenharmony_ci * This work area lives in the .init.scratch section, which lives outside of
8762306a36Sopenharmony_ci * the kernel proper. It is sized to hold the intermediate copy buffer and
8862306a36Sopenharmony_ci * more than enough pagetable pages.
8962306a36Sopenharmony_ci *
9062306a36Sopenharmony_ci * By using this section, the kernel can be encrypted in place and it
9162306a36Sopenharmony_ci * avoids any possibility of boot parameters or initramfs images being
9262306a36Sopenharmony_ci * placed such that the in-place encryption logic overwrites them.  This
9362306a36Sopenharmony_ci * section is 2MB aligned to allow for simple pagetable setup using only
9462306a36Sopenharmony_ci * PMD entries (see vmlinux.lds.S).
9562306a36Sopenharmony_ci */
9662306a36Sopenharmony_cistatic char sme_workarea[2 * PMD_SIZE] __section(".init.scratch");
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_cistatic char sme_cmdline_arg[] __initdata = "mem_encrypt";
9962306a36Sopenharmony_cistatic char sme_cmdline_on[]  __initdata = "on";
10062306a36Sopenharmony_cistatic char sme_cmdline_off[] __initdata = "off";
10162306a36Sopenharmony_ci
10262306a36Sopenharmony_cistatic void __init sme_clear_pgd(struct sme_populate_pgd_data *ppd)
10362306a36Sopenharmony_ci{
10462306a36Sopenharmony_ci	unsigned long pgd_start, pgd_end, pgd_size;
10562306a36Sopenharmony_ci	pgd_t *pgd_p;
10662306a36Sopenharmony_ci
10762306a36Sopenharmony_ci	pgd_start = ppd->vaddr & PGDIR_MASK;
10862306a36Sopenharmony_ci	pgd_end = ppd->vaddr_end & PGDIR_MASK;
10962306a36Sopenharmony_ci
11062306a36Sopenharmony_ci	pgd_size = (((pgd_end - pgd_start) / PGDIR_SIZE) + 1) * sizeof(pgd_t);
11162306a36Sopenharmony_ci
11262306a36Sopenharmony_ci	pgd_p = ppd->pgd + pgd_index(ppd->vaddr);
11362306a36Sopenharmony_ci
11462306a36Sopenharmony_ci	memset(pgd_p, 0, pgd_size);
11562306a36Sopenharmony_ci}
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_cistatic pud_t __init *sme_prepare_pgd(struct sme_populate_pgd_data *ppd)
11862306a36Sopenharmony_ci{
11962306a36Sopenharmony_ci	pgd_t *pgd;
12062306a36Sopenharmony_ci	p4d_t *p4d;
12162306a36Sopenharmony_ci	pud_t *pud;
12262306a36Sopenharmony_ci	pmd_t *pmd;
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_ci	pgd = ppd->pgd + pgd_index(ppd->vaddr);
12562306a36Sopenharmony_ci	if (pgd_none(*pgd)) {
12662306a36Sopenharmony_ci		p4d = ppd->pgtable_area;
12762306a36Sopenharmony_ci		memset(p4d, 0, sizeof(*p4d) * PTRS_PER_P4D);
12862306a36Sopenharmony_ci		ppd->pgtable_area += sizeof(*p4d) * PTRS_PER_P4D;
12962306a36Sopenharmony_ci		set_pgd(pgd, __pgd(PGD_FLAGS | __pa(p4d)));
13062306a36Sopenharmony_ci	}
13162306a36Sopenharmony_ci
13262306a36Sopenharmony_ci	p4d = p4d_offset(pgd, ppd->vaddr);
13362306a36Sopenharmony_ci	if (p4d_none(*p4d)) {
13462306a36Sopenharmony_ci		pud = ppd->pgtable_area;
13562306a36Sopenharmony_ci		memset(pud, 0, sizeof(*pud) * PTRS_PER_PUD);
13662306a36Sopenharmony_ci		ppd->pgtable_area += sizeof(*pud) * PTRS_PER_PUD;
13762306a36Sopenharmony_ci		set_p4d(p4d, __p4d(P4D_FLAGS | __pa(pud)));
13862306a36Sopenharmony_ci	}
13962306a36Sopenharmony_ci
14062306a36Sopenharmony_ci	pud = pud_offset(p4d, ppd->vaddr);
14162306a36Sopenharmony_ci	if (pud_none(*pud)) {
14262306a36Sopenharmony_ci		pmd = ppd->pgtable_area;
14362306a36Sopenharmony_ci		memset(pmd, 0, sizeof(*pmd) * PTRS_PER_PMD);
14462306a36Sopenharmony_ci		ppd->pgtable_area += sizeof(*pmd) * PTRS_PER_PMD;
14562306a36Sopenharmony_ci		set_pud(pud, __pud(PUD_FLAGS | __pa(pmd)));
14662306a36Sopenharmony_ci	}
14762306a36Sopenharmony_ci
14862306a36Sopenharmony_ci	if (pud_large(*pud))
14962306a36Sopenharmony_ci		return NULL;
15062306a36Sopenharmony_ci
15162306a36Sopenharmony_ci	return pud;
15262306a36Sopenharmony_ci}
15362306a36Sopenharmony_ci
15462306a36Sopenharmony_cistatic void __init sme_populate_pgd_large(struct sme_populate_pgd_data *ppd)
15562306a36Sopenharmony_ci{
15662306a36Sopenharmony_ci	pud_t *pud;
15762306a36Sopenharmony_ci	pmd_t *pmd;
15862306a36Sopenharmony_ci
15962306a36Sopenharmony_ci	pud = sme_prepare_pgd(ppd);
16062306a36Sopenharmony_ci	if (!pud)
16162306a36Sopenharmony_ci		return;
16262306a36Sopenharmony_ci
16362306a36Sopenharmony_ci	pmd = pmd_offset(pud, ppd->vaddr);
16462306a36Sopenharmony_ci	if (pmd_large(*pmd))
16562306a36Sopenharmony_ci		return;
16662306a36Sopenharmony_ci
16762306a36Sopenharmony_ci	set_pmd(pmd, __pmd(ppd->paddr | ppd->pmd_flags));
16862306a36Sopenharmony_ci}
16962306a36Sopenharmony_ci
17062306a36Sopenharmony_cistatic void __init sme_populate_pgd(struct sme_populate_pgd_data *ppd)
17162306a36Sopenharmony_ci{
17262306a36Sopenharmony_ci	pud_t *pud;
17362306a36Sopenharmony_ci	pmd_t *pmd;
17462306a36Sopenharmony_ci	pte_t *pte;
17562306a36Sopenharmony_ci
17662306a36Sopenharmony_ci	pud = sme_prepare_pgd(ppd);
17762306a36Sopenharmony_ci	if (!pud)
17862306a36Sopenharmony_ci		return;
17962306a36Sopenharmony_ci
18062306a36Sopenharmony_ci	pmd = pmd_offset(pud, ppd->vaddr);
18162306a36Sopenharmony_ci	if (pmd_none(*pmd)) {
18262306a36Sopenharmony_ci		pte = ppd->pgtable_area;
18362306a36Sopenharmony_ci		memset(pte, 0, sizeof(*pte) * PTRS_PER_PTE);
18462306a36Sopenharmony_ci		ppd->pgtable_area += sizeof(*pte) * PTRS_PER_PTE;
18562306a36Sopenharmony_ci		set_pmd(pmd, __pmd(PMD_FLAGS | __pa(pte)));
18662306a36Sopenharmony_ci	}
18762306a36Sopenharmony_ci
18862306a36Sopenharmony_ci	if (pmd_large(*pmd))
18962306a36Sopenharmony_ci		return;
19062306a36Sopenharmony_ci
19162306a36Sopenharmony_ci	pte = pte_offset_kernel(pmd, ppd->vaddr);
19262306a36Sopenharmony_ci	if (pte_none(*pte))
19362306a36Sopenharmony_ci		set_pte(pte, __pte(ppd->paddr | ppd->pte_flags));
19462306a36Sopenharmony_ci}
19562306a36Sopenharmony_ci
19662306a36Sopenharmony_cistatic void __init __sme_map_range_pmd(struct sme_populate_pgd_data *ppd)
19762306a36Sopenharmony_ci{
19862306a36Sopenharmony_ci	while (ppd->vaddr < ppd->vaddr_end) {
19962306a36Sopenharmony_ci		sme_populate_pgd_large(ppd);
20062306a36Sopenharmony_ci
20162306a36Sopenharmony_ci		ppd->vaddr += PMD_SIZE;
20262306a36Sopenharmony_ci		ppd->paddr += PMD_SIZE;
20362306a36Sopenharmony_ci	}
20462306a36Sopenharmony_ci}
20562306a36Sopenharmony_ci
20662306a36Sopenharmony_cistatic void __init __sme_map_range_pte(struct sme_populate_pgd_data *ppd)
20762306a36Sopenharmony_ci{
20862306a36Sopenharmony_ci	while (ppd->vaddr < ppd->vaddr_end) {
20962306a36Sopenharmony_ci		sme_populate_pgd(ppd);
21062306a36Sopenharmony_ci
21162306a36Sopenharmony_ci		ppd->vaddr += PAGE_SIZE;
21262306a36Sopenharmony_ci		ppd->paddr += PAGE_SIZE;
21362306a36Sopenharmony_ci	}
21462306a36Sopenharmony_ci}
21562306a36Sopenharmony_ci
21662306a36Sopenharmony_cistatic void __init __sme_map_range(struct sme_populate_pgd_data *ppd,
21762306a36Sopenharmony_ci				   pmdval_t pmd_flags, pteval_t pte_flags)
21862306a36Sopenharmony_ci{
21962306a36Sopenharmony_ci	unsigned long vaddr_end;
22062306a36Sopenharmony_ci
22162306a36Sopenharmony_ci	ppd->pmd_flags = pmd_flags;
22262306a36Sopenharmony_ci	ppd->pte_flags = pte_flags;
22362306a36Sopenharmony_ci
22462306a36Sopenharmony_ci	/* Save original end value since we modify the struct value */
22562306a36Sopenharmony_ci	vaddr_end = ppd->vaddr_end;
22662306a36Sopenharmony_ci
22762306a36Sopenharmony_ci	/* If start is not 2MB aligned, create PTE entries */
22862306a36Sopenharmony_ci	ppd->vaddr_end = ALIGN(ppd->vaddr, PMD_SIZE);
22962306a36Sopenharmony_ci	__sme_map_range_pte(ppd);
23062306a36Sopenharmony_ci
23162306a36Sopenharmony_ci	/* Create PMD entries */
23262306a36Sopenharmony_ci	ppd->vaddr_end = vaddr_end & PMD_MASK;
23362306a36Sopenharmony_ci	__sme_map_range_pmd(ppd);
23462306a36Sopenharmony_ci
23562306a36Sopenharmony_ci	/* If end is not 2MB aligned, create PTE entries */
23662306a36Sopenharmony_ci	ppd->vaddr_end = vaddr_end;
23762306a36Sopenharmony_ci	__sme_map_range_pte(ppd);
23862306a36Sopenharmony_ci}
23962306a36Sopenharmony_ci
24062306a36Sopenharmony_cistatic void __init sme_map_range_encrypted(struct sme_populate_pgd_data *ppd)
24162306a36Sopenharmony_ci{
24262306a36Sopenharmony_ci	__sme_map_range(ppd, PMD_FLAGS_ENC, PTE_FLAGS_ENC);
24362306a36Sopenharmony_ci}
24462306a36Sopenharmony_ci
24562306a36Sopenharmony_cistatic void __init sme_map_range_decrypted(struct sme_populate_pgd_data *ppd)
24662306a36Sopenharmony_ci{
24762306a36Sopenharmony_ci	__sme_map_range(ppd, PMD_FLAGS_DEC, PTE_FLAGS_DEC);
24862306a36Sopenharmony_ci}
24962306a36Sopenharmony_ci
25062306a36Sopenharmony_cistatic void __init sme_map_range_decrypted_wp(struct sme_populate_pgd_data *ppd)
25162306a36Sopenharmony_ci{
25262306a36Sopenharmony_ci	__sme_map_range(ppd, PMD_FLAGS_DEC_WP, PTE_FLAGS_DEC_WP);
25362306a36Sopenharmony_ci}
25462306a36Sopenharmony_ci
25562306a36Sopenharmony_cistatic unsigned long __init sme_pgtable_calc(unsigned long len)
25662306a36Sopenharmony_ci{
25762306a36Sopenharmony_ci	unsigned long entries = 0, tables = 0;
25862306a36Sopenharmony_ci
25962306a36Sopenharmony_ci	/*
26062306a36Sopenharmony_ci	 * Perform a relatively simplistic calculation of the pagetable
26162306a36Sopenharmony_ci	 * entries that are needed. Those mappings will be covered mostly
26262306a36Sopenharmony_ci	 * by 2MB PMD entries so we can conservatively calculate the required
26362306a36Sopenharmony_ci	 * number of P4D, PUD and PMD structures needed to perform the
26462306a36Sopenharmony_ci	 * mappings.  For mappings that are not 2MB aligned, PTE mappings
26562306a36Sopenharmony_ci	 * would be needed for the start and end portion of the address range
26662306a36Sopenharmony_ci	 * that fall outside of the 2MB alignment.  This results in, at most,
26762306a36Sopenharmony_ci	 * two extra pages to hold PTE entries for each range that is mapped.
26862306a36Sopenharmony_ci	 * Incrementing the count for each covers the case where the addresses
26962306a36Sopenharmony_ci	 * cross entries.
27062306a36Sopenharmony_ci	 */
27162306a36Sopenharmony_ci
27262306a36Sopenharmony_ci	/* PGDIR_SIZE is equal to P4D_SIZE on 4-level machine. */
27362306a36Sopenharmony_ci	if (PTRS_PER_P4D > 1)
27462306a36Sopenharmony_ci		entries += (DIV_ROUND_UP(len, PGDIR_SIZE) + 1) * sizeof(p4d_t) * PTRS_PER_P4D;
27562306a36Sopenharmony_ci	entries += (DIV_ROUND_UP(len, P4D_SIZE) + 1) * sizeof(pud_t) * PTRS_PER_PUD;
27662306a36Sopenharmony_ci	entries += (DIV_ROUND_UP(len, PUD_SIZE) + 1) * sizeof(pmd_t) * PTRS_PER_PMD;
27762306a36Sopenharmony_ci	entries += 2 * sizeof(pte_t) * PTRS_PER_PTE;
27862306a36Sopenharmony_ci
27962306a36Sopenharmony_ci	/*
28062306a36Sopenharmony_ci	 * Now calculate the added pagetable structures needed to populate
28162306a36Sopenharmony_ci	 * the new pagetables.
28262306a36Sopenharmony_ci	 */
28362306a36Sopenharmony_ci
28462306a36Sopenharmony_ci	if (PTRS_PER_P4D > 1)
28562306a36Sopenharmony_ci		tables += DIV_ROUND_UP(entries, PGDIR_SIZE) * sizeof(p4d_t) * PTRS_PER_P4D;
28662306a36Sopenharmony_ci	tables += DIV_ROUND_UP(entries, P4D_SIZE) * sizeof(pud_t) * PTRS_PER_PUD;
28762306a36Sopenharmony_ci	tables += DIV_ROUND_UP(entries, PUD_SIZE) * sizeof(pmd_t) * PTRS_PER_PMD;
28862306a36Sopenharmony_ci
28962306a36Sopenharmony_ci	return entries + tables;
29062306a36Sopenharmony_ci}
29162306a36Sopenharmony_ci
29262306a36Sopenharmony_civoid __init sme_encrypt_kernel(struct boot_params *bp)
29362306a36Sopenharmony_ci{
29462306a36Sopenharmony_ci	unsigned long workarea_start, workarea_end, workarea_len;
29562306a36Sopenharmony_ci	unsigned long execute_start, execute_end, execute_len;
29662306a36Sopenharmony_ci	unsigned long kernel_start, kernel_end, kernel_len;
29762306a36Sopenharmony_ci	unsigned long initrd_start, initrd_end, initrd_len;
29862306a36Sopenharmony_ci	struct sme_populate_pgd_data ppd;
29962306a36Sopenharmony_ci	unsigned long pgtable_area_len;
30062306a36Sopenharmony_ci	unsigned long decrypted_base;
30162306a36Sopenharmony_ci
30262306a36Sopenharmony_ci	/*
30362306a36Sopenharmony_ci	 * This is early code, use an open coded check for SME instead of
30462306a36Sopenharmony_ci	 * using cc_platform_has(). This eliminates worries about removing
30562306a36Sopenharmony_ci	 * instrumentation or checking boot_cpu_data in the cc_platform_has()
30662306a36Sopenharmony_ci	 * function.
30762306a36Sopenharmony_ci	 */
30862306a36Sopenharmony_ci	if (!sme_get_me_mask() || sev_status & MSR_AMD64_SEV_ENABLED)
30962306a36Sopenharmony_ci		return;
31062306a36Sopenharmony_ci
31162306a36Sopenharmony_ci	/*
31262306a36Sopenharmony_ci	 * Prepare for encrypting the kernel and initrd by building new
31362306a36Sopenharmony_ci	 * pagetables with the necessary attributes needed to encrypt the
31462306a36Sopenharmony_ci	 * kernel in place.
31562306a36Sopenharmony_ci	 *
31662306a36Sopenharmony_ci	 *   One range of virtual addresses will map the memory occupied
31762306a36Sopenharmony_ci	 *   by the kernel and initrd as encrypted.
31862306a36Sopenharmony_ci	 *
31962306a36Sopenharmony_ci	 *   Another range of virtual addresses will map the memory occupied
32062306a36Sopenharmony_ci	 *   by the kernel and initrd as decrypted and write-protected.
32162306a36Sopenharmony_ci	 *
32262306a36Sopenharmony_ci	 *     The use of write-protect attribute will prevent any of the
32362306a36Sopenharmony_ci	 *     memory from being cached.
32462306a36Sopenharmony_ci	 */
32562306a36Sopenharmony_ci
32662306a36Sopenharmony_ci	/* Physical addresses gives us the identity mapped virtual addresses */
32762306a36Sopenharmony_ci	kernel_start = __pa_symbol(_text);
32862306a36Sopenharmony_ci	kernel_end = ALIGN(__pa_symbol(_end), PMD_SIZE);
32962306a36Sopenharmony_ci	kernel_len = kernel_end - kernel_start;
33062306a36Sopenharmony_ci
33162306a36Sopenharmony_ci	initrd_start = 0;
33262306a36Sopenharmony_ci	initrd_end = 0;
33362306a36Sopenharmony_ci	initrd_len = 0;
33462306a36Sopenharmony_ci#ifdef CONFIG_BLK_DEV_INITRD
33562306a36Sopenharmony_ci	initrd_len = (unsigned long)bp->hdr.ramdisk_size |
33662306a36Sopenharmony_ci		     ((unsigned long)bp->ext_ramdisk_size << 32);
33762306a36Sopenharmony_ci	if (initrd_len) {
33862306a36Sopenharmony_ci		initrd_start = (unsigned long)bp->hdr.ramdisk_image |
33962306a36Sopenharmony_ci			       ((unsigned long)bp->ext_ramdisk_image << 32);
34062306a36Sopenharmony_ci		initrd_end = PAGE_ALIGN(initrd_start + initrd_len);
34162306a36Sopenharmony_ci		initrd_len = initrd_end - initrd_start;
34262306a36Sopenharmony_ci	}
34362306a36Sopenharmony_ci#endif
34462306a36Sopenharmony_ci
34562306a36Sopenharmony_ci	/*
34662306a36Sopenharmony_ci	 * We're running identity mapped, so we must obtain the address to the
34762306a36Sopenharmony_ci	 * SME encryption workarea using rip-relative addressing.
34862306a36Sopenharmony_ci	 */
34962306a36Sopenharmony_ci	asm ("lea sme_workarea(%%rip), %0"
35062306a36Sopenharmony_ci	     : "=r" (workarea_start)
35162306a36Sopenharmony_ci	     : "p" (sme_workarea));
35262306a36Sopenharmony_ci
35362306a36Sopenharmony_ci	/*
35462306a36Sopenharmony_ci	 * Calculate required number of workarea bytes needed:
35562306a36Sopenharmony_ci	 *   executable encryption area size:
35662306a36Sopenharmony_ci	 *     stack page (PAGE_SIZE)
35762306a36Sopenharmony_ci	 *     encryption routine page (PAGE_SIZE)
35862306a36Sopenharmony_ci	 *     intermediate copy buffer (PMD_SIZE)
35962306a36Sopenharmony_ci	 *   pagetable structures for the encryption of the kernel
36062306a36Sopenharmony_ci	 *   pagetable structures for workarea (in case not currently mapped)
36162306a36Sopenharmony_ci	 */
36262306a36Sopenharmony_ci	execute_start = workarea_start;
36362306a36Sopenharmony_ci	execute_end = execute_start + (PAGE_SIZE * 2) + PMD_SIZE;
36462306a36Sopenharmony_ci	execute_len = execute_end - execute_start;
36562306a36Sopenharmony_ci
36662306a36Sopenharmony_ci	/*
36762306a36Sopenharmony_ci	 * One PGD for both encrypted and decrypted mappings and a set of
36862306a36Sopenharmony_ci	 * PUDs and PMDs for each of the encrypted and decrypted mappings.
36962306a36Sopenharmony_ci	 */
37062306a36Sopenharmony_ci	pgtable_area_len = sizeof(pgd_t) * PTRS_PER_PGD;
37162306a36Sopenharmony_ci	pgtable_area_len += sme_pgtable_calc(execute_end - kernel_start) * 2;
37262306a36Sopenharmony_ci	if (initrd_len)
37362306a36Sopenharmony_ci		pgtable_area_len += sme_pgtable_calc(initrd_len) * 2;
37462306a36Sopenharmony_ci
37562306a36Sopenharmony_ci	/* PUDs and PMDs needed in the current pagetables for the workarea */
37662306a36Sopenharmony_ci	pgtable_area_len += sme_pgtable_calc(execute_len + pgtable_area_len);
37762306a36Sopenharmony_ci
37862306a36Sopenharmony_ci	/*
37962306a36Sopenharmony_ci	 * The total workarea includes the executable encryption area and
38062306a36Sopenharmony_ci	 * the pagetable area. The start of the workarea is already 2MB
38162306a36Sopenharmony_ci	 * aligned, align the end of the workarea on a 2MB boundary so that
38262306a36Sopenharmony_ci	 * we don't try to create/allocate PTE entries from the workarea
38362306a36Sopenharmony_ci	 * before it is mapped.
38462306a36Sopenharmony_ci	 */
38562306a36Sopenharmony_ci	workarea_len = execute_len + pgtable_area_len;
38662306a36Sopenharmony_ci	workarea_end = ALIGN(workarea_start + workarea_len, PMD_SIZE);
38762306a36Sopenharmony_ci
38862306a36Sopenharmony_ci	/*
38962306a36Sopenharmony_ci	 * Set the address to the start of where newly created pagetable
39062306a36Sopenharmony_ci	 * structures (PGDs, PUDs and PMDs) will be allocated. New pagetable
39162306a36Sopenharmony_ci	 * structures are created when the workarea is added to the current
39262306a36Sopenharmony_ci	 * pagetables and when the new encrypted and decrypted kernel
39362306a36Sopenharmony_ci	 * mappings are populated.
39462306a36Sopenharmony_ci	 */
39562306a36Sopenharmony_ci	ppd.pgtable_area = (void *)execute_end;
39662306a36Sopenharmony_ci
39762306a36Sopenharmony_ci	/*
39862306a36Sopenharmony_ci	 * Make sure the current pagetable structure has entries for
39962306a36Sopenharmony_ci	 * addressing the workarea.
40062306a36Sopenharmony_ci	 */
40162306a36Sopenharmony_ci	ppd.pgd = (pgd_t *)native_read_cr3_pa();
40262306a36Sopenharmony_ci	ppd.paddr = workarea_start;
40362306a36Sopenharmony_ci	ppd.vaddr = workarea_start;
40462306a36Sopenharmony_ci	ppd.vaddr_end = workarea_end;
40562306a36Sopenharmony_ci	sme_map_range_decrypted(&ppd);
40662306a36Sopenharmony_ci
40762306a36Sopenharmony_ci	/* Flush the TLB - no globals so cr3 is enough */
40862306a36Sopenharmony_ci	native_write_cr3(__native_read_cr3());
40962306a36Sopenharmony_ci
41062306a36Sopenharmony_ci	/*
41162306a36Sopenharmony_ci	 * A new pagetable structure is being built to allow for the kernel
41262306a36Sopenharmony_ci	 * and initrd to be encrypted. It starts with an empty PGD that will
41362306a36Sopenharmony_ci	 * then be populated with new PUDs and PMDs as the encrypted and
41462306a36Sopenharmony_ci	 * decrypted kernel mappings are created.
41562306a36Sopenharmony_ci	 */
41662306a36Sopenharmony_ci	ppd.pgd = ppd.pgtable_area;
41762306a36Sopenharmony_ci	memset(ppd.pgd, 0, sizeof(pgd_t) * PTRS_PER_PGD);
41862306a36Sopenharmony_ci	ppd.pgtable_area += sizeof(pgd_t) * PTRS_PER_PGD;
41962306a36Sopenharmony_ci
42062306a36Sopenharmony_ci	/*
42162306a36Sopenharmony_ci	 * A different PGD index/entry must be used to get different
42262306a36Sopenharmony_ci	 * pagetable entries for the decrypted mapping. Choose the next
42362306a36Sopenharmony_ci	 * PGD index and convert it to a virtual address to be used as
42462306a36Sopenharmony_ci	 * the base of the mapping.
42562306a36Sopenharmony_ci	 */
42662306a36Sopenharmony_ci	decrypted_base = (pgd_index(workarea_end) + 1) & (PTRS_PER_PGD - 1);
42762306a36Sopenharmony_ci	if (initrd_len) {
42862306a36Sopenharmony_ci		unsigned long check_base;
42962306a36Sopenharmony_ci
43062306a36Sopenharmony_ci		check_base = (pgd_index(initrd_end) + 1) & (PTRS_PER_PGD - 1);
43162306a36Sopenharmony_ci		decrypted_base = max(decrypted_base, check_base);
43262306a36Sopenharmony_ci	}
43362306a36Sopenharmony_ci	decrypted_base <<= PGDIR_SHIFT;
43462306a36Sopenharmony_ci
43562306a36Sopenharmony_ci	/* Add encrypted kernel (identity) mappings */
43662306a36Sopenharmony_ci	ppd.paddr = kernel_start;
43762306a36Sopenharmony_ci	ppd.vaddr = kernel_start;
43862306a36Sopenharmony_ci	ppd.vaddr_end = kernel_end;
43962306a36Sopenharmony_ci	sme_map_range_encrypted(&ppd);
44062306a36Sopenharmony_ci
44162306a36Sopenharmony_ci	/* Add decrypted, write-protected kernel (non-identity) mappings */
44262306a36Sopenharmony_ci	ppd.paddr = kernel_start;
44362306a36Sopenharmony_ci	ppd.vaddr = kernel_start + decrypted_base;
44462306a36Sopenharmony_ci	ppd.vaddr_end = kernel_end + decrypted_base;
44562306a36Sopenharmony_ci	sme_map_range_decrypted_wp(&ppd);
44662306a36Sopenharmony_ci
44762306a36Sopenharmony_ci	if (initrd_len) {
44862306a36Sopenharmony_ci		/* Add encrypted initrd (identity) mappings */
44962306a36Sopenharmony_ci		ppd.paddr = initrd_start;
45062306a36Sopenharmony_ci		ppd.vaddr = initrd_start;
45162306a36Sopenharmony_ci		ppd.vaddr_end = initrd_end;
45262306a36Sopenharmony_ci		sme_map_range_encrypted(&ppd);
45362306a36Sopenharmony_ci		/*
45462306a36Sopenharmony_ci		 * Add decrypted, write-protected initrd (non-identity) mappings
45562306a36Sopenharmony_ci		 */
45662306a36Sopenharmony_ci		ppd.paddr = initrd_start;
45762306a36Sopenharmony_ci		ppd.vaddr = initrd_start + decrypted_base;
45862306a36Sopenharmony_ci		ppd.vaddr_end = initrd_end + decrypted_base;
45962306a36Sopenharmony_ci		sme_map_range_decrypted_wp(&ppd);
46062306a36Sopenharmony_ci	}
46162306a36Sopenharmony_ci
46262306a36Sopenharmony_ci	/* Add decrypted workarea mappings to both kernel mappings */
46362306a36Sopenharmony_ci	ppd.paddr = workarea_start;
46462306a36Sopenharmony_ci	ppd.vaddr = workarea_start;
46562306a36Sopenharmony_ci	ppd.vaddr_end = workarea_end;
46662306a36Sopenharmony_ci	sme_map_range_decrypted(&ppd);
46762306a36Sopenharmony_ci
46862306a36Sopenharmony_ci	ppd.paddr = workarea_start;
46962306a36Sopenharmony_ci	ppd.vaddr = workarea_start + decrypted_base;
47062306a36Sopenharmony_ci	ppd.vaddr_end = workarea_end + decrypted_base;
47162306a36Sopenharmony_ci	sme_map_range_decrypted(&ppd);
47262306a36Sopenharmony_ci
47362306a36Sopenharmony_ci	/* Perform the encryption */
47462306a36Sopenharmony_ci	sme_encrypt_execute(kernel_start, kernel_start + decrypted_base,
47562306a36Sopenharmony_ci			    kernel_len, workarea_start, (unsigned long)ppd.pgd);
47662306a36Sopenharmony_ci
47762306a36Sopenharmony_ci	if (initrd_len)
47862306a36Sopenharmony_ci		sme_encrypt_execute(initrd_start, initrd_start + decrypted_base,
47962306a36Sopenharmony_ci				    initrd_len, workarea_start,
48062306a36Sopenharmony_ci				    (unsigned long)ppd.pgd);
48162306a36Sopenharmony_ci
48262306a36Sopenharmony_ci	/*
48362306a36Sopenharmony_ci	 * At this point we are running encrypted.  Remove the mappings for
48462306a36Sopenharmony_ci	 * the decrypted areas - all that is needed for this is to remove
48562306a36Sopenharmony_ci	 * the PGD entry/entries.
48662306a36Sopenharmony_ci	 */
48762306a36Sopenharmony_ci	ppd.vaddr = kernel_start + decrypted_base;
48862306a36Sopenharmony_ci	ppd.vaddr_end = kernel_end + decrypted_base;
48962306a36Sopenharmony_ci	sme_clear_pgd(&ppd);
49062306a36Sopenharmony_ci
49162306a36Sopenharmony_ci	if (initrd_len) {
49262306a36Sopenharmony_ci		ppd.vaddr = initrd_start + decrypted_base;
49362306a36Sopenharmony_ci		ppd.vaddr_end = initrd_end + decrypted_base;
49462306a36Sopenharmony_ci		sme_clear_pgd(&ppd);
49562306a36Sopenharmony_ci	}
49662306a36Sopenharmony_ci
49762306a36Sopenharmony_ci	ppd.vaddr = workarea_start + decrypted_base;
49862306a36Sopenharmony_ci	ppd.vaddr_end = workarea_end + decrypted_base;
49962306a36Sopenharmony_ci	sme_clear_pgd(&ppd);
50062306a36Sopenharmony_ci
50162306a36Sopenharmony_ci	/* Flush the TLB - no globals so cr3 is enough */
50262306a36Sopenharmony_ci	native_write_cr3(__native_read_cr3());
50362306a36Sopenharmony_ci}
50462306a36Sopenharmony_ci
50562306a36Sopenharmony_civoid __init sme_enable(struct boot_params *bp)
50662306a36Sopenharmony_ci{
50762306a36Sopenharmony_ci	const char *cmdline_ptr, *cmdline_arg, *cmdline_on, *cmdline_off;
50862306a36Sopenharmony_ci	unsigned int eax, ebx, ecx, edx;
50962306a36Sopenharmony_ci	unsigned long feature_mask;
51062306a36Sopenharmony_ci	unsigned long me_mask;
51162306a36Sopenharmony_ci	char buffer[16];
51262306a36Sopenharmony_ci	bool snp;
51362306a36Sopenharmony_ci	u64 msr;
51462306a36Sopenharmony_ci
51562306a36Sopenharmony_ci	snp = snp_init(bp);
51662306a36Sopenharmony_ci
51762306a36Sopenharmony_ci	/* Check for the SME/SEV support leaf */
51862306a36Sopenharmony_ci	eax = 0x80000000;
51962306a36Sopenharmony_ci	ecx = 0;
52062306a36Sopenharmony_ci	native_cpuid(&eax, &ebx, &ecx, &edx);
52162306a36Sopenharmony_ci	if (eax < 0x8000001f)
52262306a36Sopenharmony_ci		return;
52362306a36Sopenharmony_ci
52462306a36Sopenharmony_ci#define AMD_SME_BIT	BIT(0)
52562306a36Sopenharmony_ci#define AMD_SEV_BIT	BIT(1)
52662306a36Sopenharmony_ci
52762306a36Sopenharmony_ci	/*
52862306a36Sopenharmony_ci	 * Check for the SME/SEV feature:
52962306a36Sopenharmony_ci	 *   CPUID Fn8000_001F[EAX]
53062306a36Sopenharmony_ci	 *   - Bit 0 - Secure Memory Encryption support
53162306a36Sopenharmony_ci	 *   - Bit 1 - Secure Encrypted Virtualization support
53262306a36Sopenharmony_ci	 *   CPUID Fn8000_001F[EBX]
53362306a36Sopenharmony_ci	 *   - Bits 5:0 - Pagetable bit position used to indicate encryption
53462306a36Sopenharmony_ci	 */
53562306a36Sopenharmony_ci	eax = 0x8000001f;
53662306a36Sopenharmony_ci	ecx = 0;
53762306a36Sopenharmony_ci	native_cpuid(&eax, &ebx, &ecx, &edx);
53862306a36Sopenharmony_ci	/* Check whether SEV or SME is supported */
53962306a36Sopenharmony_ci	if (!(eax & (AMD_SEV_BIT | AMD_SME_BIT)))
54062306a36Sopenharmony_ci		return;
54162306a36Sopenharmony_ci
54262306a36Sopenharmony_ci	me_mask = 1UL << (ebx & 0x3f);
54362306a36Sopenharmony_ci
54462306a36Sopenharmony_ci	/* Check the SEV MSR whether SEV or SME is enabled */
54562306a36Sopenharmony_ci	sev_status   = __rdmsr(MSR_AMD64_SEV);
54662306a36Sopenharmony_ci	feature_mask = (sev_status & MSR_AMD64_SEV_ENABLED) ? AMD_SEV_BIT : AMD_SME_BIT;
54762306a36Sopenharmony_ci
54862306a36Sopenharmony_ci	/* The SEV-SNP CC blob should never be present unless SEV-SNP is enabled. */
54962306a36Sopenharmony_ci	if (snp && !(sev_status & MSR_AMD64_SEV_SNP_ENABLED))
55062306a36Sopenharmony_ci		snp_abort();
55162306a36Sopenharmony_ci
55262306a36Sopenharmony_ci	/* Check if memory encryption is enabled */
55362306a36Sopenharmony_ci	if (feature_mask == AMD_SME_BIT) {
55462306a36Sopenharmony_ci		/*
55562306a36Sopenharmony_ci		 * No SME if Hypervisor bit is set. This check is here to
55662306a36Sopenharmony_ci		 * prevent a guest from trying to enable SME. For running as a
55762306a36Sopenharmony_ci		 * KVM guest the MSR_AMD64_SYSCFG will be sufficient, but there
55862306a36Sopenharmony_ci		 * might be other hypervisors which emulate that MSR as non-zero
55962306a36Sopenharmony_ci		 * or even pass it through to the guest.
56062306a36Sopenharmony_ci		 * A malicious hypervisor can still trick a guest into this
56162306a36Sopenharmony_ci		 * path, but there is no way to protect against that.
56262306a36Sopenharmony_ci		 */
56362306a36Sopenharmony_ci		eax = 1;
56462306a36Sopenharmony_ci		ecx = 0;
56562306a36Sopenharmony_ci		native_cpuid(&eax, &ebx, &ecx, &edx);
56662306a36Sopenharmony_ci		if (ecx & BIT(31))
56762306a36Sopenharmony_ci			return;
56862306a36Sopenharmony_ci
56962306a36Sopenharmony_ci		/* For SME, check the SYSCFG MSR */
57062306a36Sopenharmony_ci		msr = __rdmsr(MSR_AMD64_SYSCFG);
57162306a36Sopenharmony_ci		if (!(msr & MSR_AMD64_SYSCFG_MEM_ENCRYPT))
57262306a36Sopenharmony_ci			return;
57362306a36Sopenharmony_ci	} else {
57462306a36Sopenharmony_ci		/* SEV state cannot be controlled by a command line option */
57562306a36Sopenharmony_ci		sme_me_mask = me_mask;
57662306a36Sopenharmony_ci		goto out;
57762306a36Sopenharmony_ci	}
57862306a36Sopenharmony_ci
57962306a36Sopenharmony_ci	/*
58062306a36Sopenharmony_ci	 * Fixups have not been applied to phys_base yet and we're running
58162306a36Sopenharmony_ci	 * identity mapped, so we must obtain the address to the SME command
58262306a36Sopenharmony_ci	 * line argument data using rip-relative addressing.
58362306a36Sopenharmony_ci	 */
58462306a36Sopenharmony_ci	asm ("lea sme_cmdline_arg(%%rip), %0"
58562306a36Sopenharmony_ci	     : "=r" (cmdline_arg)
58662306a36Sopenharmony_ci	     : "p" (sme_cmdline_arg));
58762306a36Sopenharmony_ci	asm ("lea sme_cmdline_on(%%rip), %0"
58862306a36Sopenharmony_ci	     : "=r" (cmdline_on)
58962306a36Sopenharmony_ci	     : "p" (sme_cmdline_on));
59062306a36Sopenharmony_ci	asm ("lea sme_cmdline_off(%%rip), %0"
59162306a36Sopenharmony_ci	     : "=r" (cmdline_off)
59262306a36Sopenharmony_ci	     : "p" (sme_cmdline_off));
59362306a36Sopenharmony_ci
59462306a36Sopenharmony_ci	if (IS_ENABLED(CONFIG_AMD_MEM_ENCRYPT_ACTIVE_BY_DEFAULT))
59562306a36Sopenharmony_ci		sme_me_mask = me_mask;
59662306a36Sopenharmony_ci
59762306a36Sopenharmony_ci	cmdline_ptr = (const char *)((u64)bp->hdr.cmd_line_ptr |
59862306a36Sopenharmony_ci				     ((u64)bp->ext_cmd_line_ptr << 32));
59962306a36Sopenharmony_ci
60062306a36Sopenharmony_ci	if (cmdline_find_option(cmdline_ptr, cmdline_arg, buffer, sizeof(buffer)) < 0)
60162306a36Sopenharmony_ci		goto out;
60262306a36Sopenharmony_ci
60362306a36Sopenharmony_ci	if (!strncmp(buffer, cmdline_on, sizeof(buffer)))
60462306a36Sopenharmony_ci		sme_me_mask = me_mask;
60562306a36Sopenharmony_ci	else if (!strncmp(buffer, cmdline_off, sizeof(buffer)))
60662306a36Sopenharmony_ci		sme_me_mask = 0;
60762306a36Sopenharmony_ci
60862306a36Sopenharmony_ciout:
60962306a36Sopenharmony_ci	if (sme_me_mask) {
61062306a36Sopenharmony_ci		physical_mask &= ~sme_me_mask;
61162306a36Sopenharmony_ci		cc_vendor = CC_VENDOR_AMD;
61262306a36Sopenharmony_ci		cc_set_mask(sme_me_mask);
61362306a36Sopenharmony_ci	}
61462306a36Sopenharmony_ci}
615