xref: /openbmc/linux/tools/testing/selftests/kvm/lib/x86_64/vmx.c (revision 7ae9fb1b7ecbb5d85d07857943f677fd1a559b18)
17a338472SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2cc68765dSAndrew Jones /*
3cc68765dSAndrew Jones  * tools/testing/selftests/kvm/lib/x86_64/vmx.c
4cc68765dSAndrew Jones  *
5cc68765dSAndrew Jones  * Copyright (C) 2018, Google LLC.
6cc68765dSAndrew Jones  */
7cc68765dSAndrew Jones 
80f816e02SDavid Matlack #include <asm/msr-index.h>
90f816e02SDavid Matlack 
10cc68765dSAndrew Jones #include "test_util.h"
11cc68765dSAndrew Jones #include "kvm_util.h"
12cc68765dSAndrew Jones #include "processor.h"
13cc68765dSAndrew Jones #include "vmx.h"
14cc68765dSAndrew Jones 
1509444420SPaolo Bonzini #define PAGE_SHIFT_4K  12
1609444420SPaolo Bonzini 
1709444420SPaolo Bonzini #define KVM_EPT_PAGE_TABLE_MIN_PADDR 0x1c0000
1809444420SPaolo Bonzini 
1918178ff8SVitaly Kuznetsov bool enable_evmcs;
2018178ff8SVitaly Kuznetsov 
218ffdaf91SPeter Xu struct hv_enlightened_vmcs *current_evmcs;
228ffdaf91SPeter Xu struct hv_vp_assist_page *current_vp_assist;
238ffdaf91SPeter Xu 
2409444420SPaolo Bonzini struct eptPageTableEntry {
2509444420SPaolo Bonzini 	uint64_t readable:1;
2609444420SPaolo Bonzini 	uint64_t writable:1;
2709444420SPaolo Bonzini 	uint64_t executable:1;
2809444420SPaolo Bonzini 	uint64_t memory_type:3;
2909444420SPaolo Bonzini 	uint64_t ignore_pat:1;
3009444420SPaolo Bonzini 	uint64_t page_size:1;
3109444420SPaolo Bonzini 	uint64_t accessed:1;
3209444420SPaolo Bonzini 	uint64_t dirty:1;
3309444420SPaolo Bonzini 	uint64_t ignored_11_10:2;
3409444420SPaolo Bonzini 	uint64_t address:40;
3509444420SPaolo Bonzini 	uint64_t ignored_62_52:11;
3609444420SPaolo Bonzini 	uint64_t suppress_ve:1;
3709444420SPaolo Bonzini };
3809444420SPaolo Bonzini 
3909444420SPaolo Bonzini struct eptPageTablePointer {
4009444420SPaolo Bonzini 	uint64_t memory_type:3;
4109444420SPaolo Bonzini 	uint64_t page_walk_length:3;
4209444420SPaolo Bonzini 	uint64_t ad_enabled:1;
4309444420SPaolo Bonzini 	uint64_t reserved_11_07:5;
4409444420SPaolo Bonzini 	uint64_t address:40;
4509444420SPaolo Bonzini 	uint64_t reserved_63_52:12;
4609444420SPaolo Bonzini };
vcpu_enable_evmcs(struct kvm_vcpu * vcpu)47768e9a61SSean Christopherson int vcpu_enable_evmcs(struct kvm_vcpu *vcpu)
4865efa61dSPaolo Bonzini {
4965efa61dSPaolo Bonzini 	uint16_t evmcs_ver;
5065efa61dSPaolo Bonzini 
51768e9a61SSean Christopherson 	vcpu_enable_cap(vcpu, KVM_CAP_HYPERV_ENLIGHTENED_VMCS,
52a12c86c4SSean Christopherson 			(unsigned long)&evmcs_ver);
5365efa61dSPaolo Bonzini 
5465efa61dSPaolo Bonzini 	/* KVM should return supported EVMCS version range */
5565efa61dSPaolo Bonzini 	TEST_ASSERT(((evmcs_ver >> 8) >= (evmcs_ver & 0xff)) &&
5665efa61dSPaolo Bonzini 		    (evmcs_ver & 0xff) > 0,
5765efa61dSPaolo Bonzini 		    "Incorrect EVMCS version range: %x:%x\n",
5865efa61dSPaolo Bonzini 		    evmcs_ver & 0xff, evmcs_ver >> 8);
5965efa61dSPaolo Bonzini 
6065efa61dSPaolo Bonzini 	return evmcs_ver;
6165efa61dSPaolo Bonzini }
6265efa61dSPaolo Bonzini 
63cc68765dSAndrew Jones /* Allocate memory regions for nested VMX tests.
64cc68765dSAndrew Jones  *
65cc68765dSAndrew Jones  * Input Args:
66cc68765dSAndrew Jones  *   vm - The VM to allocate guest-virtual addresses in.
67cc68765dSAndrew Jones  *
68cc68765dSAndrew Jones  * Output Args:
69cc68765dSAndrew Jones  *   p_vmx_gva - The guest virtual address for the struct vmx_pages.
70cc68765dSAndrew Jones  *
71cc68765dSAndrew Jones  * Return:
72cc68765dSAndrew Jones  *   Pointer to structure with the addresses of the VMX areas.
73cc68765dSAndrew Jones  */
74cc68765dSAndrew Jones struct vmx_pages *
vcpu_alloc_vmx(struct kvm_vm * vm,vm_vaddr_t * p_vmx_gva)75cc68765dSAndrew Jones vcpu_alloc_vmx(struct kvm_vm *vm, vm_vaddr_t *p_vmx_gva)
76cc68765dSAndrew Jones {
77a9db9609SSean Christopherson 	vm_vaddr_t vmx_gva = vm_vaddr_alloc_page(vm);
78cc68765dSAndrew Jones 	struct vmx_pages *vmx = addr_gva2hva(vm, vmx_gva);
79cc68765dSAndrew Jones 
80cc68765dSAndrew Jones 	/* Setup of a region of guest memory for the vmxon region. */
81a9db9609SSean Christopherson 	vmx->vmxon = (void *)vm_vaddr_alloc_page(vm);
82cc68765dSAndrew Jones 	vmx->vmxon_hva = addr_gva2hva(vm, (uintptr_t)vmx->vmxon);
83cc68765dSAndrew Jones 	vmx->vmxon_gpa = addr_gva2gpa(vm, (uintptr_t)vmx->vmxon);
84cc68765dSAndrew Jones 
85cc68765dSAndrew Jones 	/* Setup of a region of guest memory for a vmcs. */
86a9db9609SSean Christopherson 	vmx->vmcs = (void *)vm_vaddr_alloc_page(vm);
87cc68765dSAndrew Jones 	vmx->vmcs_hva = addr_gva2hva(vm, (uintptr_t)vmx->vmcs);
88cc68765dSAndrew Jones 	vmx->vmcs_gpa = addr_gva2gpa(vm, (uintptr_t)vmx->vmcs);
89cc68765dSAndrew Jones 
90cc68765dSAndrew Jones 	/* Setup of a region of guest memory for the MSR bitmap. */
91a9db9609SSean Christopherson 	vmx->msr = (void *)vm_vaddr_alloc_page(vm);
92cc68765dSAndrew Jones 	vmx->msr_hva = addr_gva2hva(vm, (uintptr_t)vmx->msr);
93cc68765dSAndrew Jones 	vmx->msr_gpa = addr_gva2gpa(vm, (uintptr_t)vmx->msr);
94cc68765dSAndrew Jones 	memset(vmx->msr_hva, 0, getpagesize());
95cc68765dSAndrew Jones 
96cc68765dSAndrew Jones 	/* Setup of a region of guest memory for the shadow VMCS. */
97a9db9609SSean Christopherson 	vmx->shadow_vmcs = (void *)vm_vaddr_alloc_page(vm);
98cc68765dSAndrew Jones 	vmx->shadow_vmcs_hva = addr_gva2hva(vm, (uintptr_t)vmx->shadow_vmcs);
99cc68765dSAndrew Jones 	vmx->shadow_vmcs_gpa = addr_gva2gpa(vm, (uintptr_t)vmx->shadow_vmcs);
100cc68765dSAndrew Jones 
101cc68765dSAndrew Jones 	/* Setup of a region of guest memory for the VMREAD and VMWRITE bitmaps. */
102a9db9609SSean Christopherson 	vmx->vmread = (void *)vm_vaddr_alloc_page(vm);
103cc68765dSAndrew Jones 	vmx->vmread_hva = addr_gva2hva(vm, (uintptr_t)vmx->vmread);
104cc68765dSAndrew Jones 	vmx->vmread_gpa = addr_gva2gpa(vm, (uintptr_t)vmx->vmread);
105cc68765dSAndrew Jones 	memset(vmx->vmread_hva, 0, getpagesize());
106cc68765dSAndrew Jones 
107a9db9609SSean Christopherson 	vmx->vmwrite = (void *)vm_vaddr_alloc_page(vm);
108cc68765dSAndrew Jones 	vmx->vmwrite_hva = addr_gva2hva(vm, (uintptr_t)vmx->vmwrite);
109cc68765dSAndrew Jones 	vmx->vmwrite_gpa = addr_gva2gpa(vm, (uintptr_t)vmx->vmwrite);
110cc68765dSAndrew Jones 	memset(vmx->vmwrite_hva, 0, getpagesize());
111cc68765dSAndrew Jones 
112cc68765dSAndrew Jones 	*p_vmx_gva = vmx_gva;
113cc68765dSAndrew Jones 	return vmx;
114cc68765dSAndrew Jones }
115cc68765dSAndrew Jones 
prepare_for_vmx_operation(struct vmx_pages * vmx)116cc68765dSAndrew Jones bool prepare_for_vmx_operation(struct vmx_pages *vmx)
117cc68765dSAndrew Jones {
118cc68765dSAndrew Jones 	uint64_t feature_control;
119cc68765dSAndrew Jones 	uint64_t required;
120cc68765dSAndrew Jones 	unsigned long cr0;
121cc68765dSAndrew Jones 	unsigned long cr4;
122cc68765dSAndrew Jones 
123cc68765dSAndrew Jones 	/*
124cc68765dSAndrew Jones 	 * Ensure bits in CR0 and CR4 are valid in VMX operation:
125cc68765dSAndrew Jones 	 * - Bit X is 1 in _FIXED0: bit X is fixed to 1 in CRx.
126cc68765dSAndrew Jones 	 * - Bit X is 0 in _FIXED1: bit X is fixed to 0 in CRx.
127cc68765dSAndrew Jones 	 */
128cc68765dSAndrew Jones 	__asm__ __volatile__("mov %%cr0, %0" : "=r"(cr0) : : "memory");
129cc68765dSAndrew Jones 	cr0 &= rdmsr(MSR_IA32_VMX_CR0_FIXED1);
130cc68765dSAndrew Jones 	cr0 |= rdmsr(MSR_IA32_VMX_CR0_FIXED0);
131cc68765dSAndrew Jones 	__asm__ __volatile__("mov %0, %%cr0" : : "r"(cr0) : "memory");
132cc68765dSAndrew Jones 
133cc68765dSAndrew Jones 	__asm__ __volatile__("mov %%cr4, %0" : "=r"(cr4) : : "memory");
134cc68765dSAndrew Jones 	cr4 &= rdmsr(MSR_IA32_VMX_CR4_FIXED1);
135cc68765dSAndrew Jones 	cr4 |= rdmsr(MSR_IA32_VMX_CR4_FIXED0);
136cc68765dSAndrew Jones 	/* Enable VMX operation */
137cc68765dSAndrew Jones 	cr4 |= X86_CR4_VMXE;
138cc68765dSAndrew Jones 	__asm__ __volatile__("mov %0, %%cr4" : : "r"(cr4) : "memory");
139cc68765dSAndrew Jones 
140cc68765dSAndrew Jones 	/*
141cc68765dSAndrew Jones 	 * Configure IA32_FEATURE_CONTROL MSR to allow VMXON:
142cc68765dSAndrew Jones 	 *  Bit 0: Lock bit. If clear, VMXON causes a #GP.
143cc68765dSAndrew Jones 	 *  Bit 2: Enables VMXON outside of SMX operation. If clear, VMXON
144cc68765dSAndrew Jones 	 *    outside of SMX causes a #GP.
145cc68765dSAndrew Jones 	 */
146f6505c88SSean Christopherson 	required = FEAT_CTL_VMX_ENABLED_OUTSIDE_SMX;
147f6505c88SSean Christopherson 	required |= FEAT_CTL_LOCKED;
148f6505c88SSean Christopherson 	feature_control = rdmsr(MSR_IA32_FEAT_CTL);
149cc68765dSAndrew Jones 	if ((feature_control & required) != required)
150f6505c88SSean Christopherson 		wrmsr(MSR_IA32_FEAT_CTL, feature_control | required);
151cc68765dSAndrew Jones 
152cc68765dSAndrew Jones 	/* Enter VMX root operation. */
153cc68765dSAndrew Jones 	*(uint32_t *)(vmx->vmxon) = vmcs_revision();
154cc68765dSAndrew Jones 	if (vmxon(vmx->vmxon_gpa))
155cc68765dSAndrew Jones 		return false;
156cc68765dSAndrew Jones 
1571e7ecd1bSVitaly Kuznetsov 	return true;
1581e7ecd1bSVitaly Kuznetsov }
1591e7ecd1bSVitaly Kuznetsov 
load_vmcs(struct vmx_pages * vmx)1601e7ecd1bSVitaly Kuznetsov bool load_vmcs(struct vmx_pages *vmx)
1611e7ecd1bSVitaly Kuznetsov {
162cc68765dSAndrew Jones 	/* Load a VMCS. */
163cc68765dSAndrew Jones 	*(uint32_t *)(vmx->vmcs) = vmcs_revision();
164cc68765dSAndrew Jones 	if (vmclear(vmx->vmcs_gpa))
165cc68765dSAndrew Jones 		return false;
166cc68765dSAndrew Jones 
167cc68765dSAndrew Jones 	if (vmptrld(vmx->vmcs_gpa))
168cc68765dSAndrew Jones 		return false;
169cc68765dSAndrew Jones 
170cc68765dSAndrew Jones 	/* Setup shadow VMCS, do not load it yet. */
171*cd8f11bdSVitaly Kuznetsov 	*(uint32_t *)(vmx->shadow_vmcs) = vmcs_revision() | 0x80000000ul;
172cc68765dSAndrew Jones 	if (vmclear(vmx->shadow_vmcs_gpa))
173cc68765dSAndrew Jones 		return false;
174cc68765dSAndrew Jones 
175cc68765dSAndrew Jones 	return true;
176cc68765dSAndrew Jones }
177cc68765dSAndrew Jones 
ept_vpid_cap_supported(uint64_t mask)178c363d959SDavid Matlack static bool ept_vpid_cap_supported(uint64_t mask)
179c363d959SDavid Matlack {
180c363d959SDavid Matlack 	return rdmsr(MSR_IA32_VMX_EPT_VPID_CAP) & mask;
181c363d959SDavid Matlack }
182c363d959SDavid Matlack 
ept_1g_pages_supported(void)18371d48966SDavid Matlack bool ept_1g_pages_supported(void)
18471d48966SDavid Matlack {
18571d48966SDavid Matlack 	return ept_vpid_cap_supported(VMX_EPT_VPID_CAP_1G_PAGES);
18671d48966SDavid Matlack }
18771d48966SDavid Matlack 
188cc68765dSAndrew Jones /*
189cc68765dSAndrew Jones  * Initialize the control fields to the most basic settings possible.
190cc68765dSAndrew Jones  */
init_vmcs_control_fields(struct vmx_pages * vmx)191cc68765dSAndrew Jones static inline void init_vmcs_control_fields(struct vmx_pages *vmx)
192cc68765dSAndrew Jones {
19309444420SPaolo Bonzini 	uint32_t sec_exec_ctl = 0;
19409444420SPaolo Bonzini 
195cc68765dSAndrew Jones 	vmwrite(VIRTUAL_PROCESSOR_ID, 0);
196cc68765dSAndrew Jones 	vmwrite(POSTED_INTR_NV, 0);
197cc68765dSAndrew Jones 
198cc68765dSAndrew Jones 	vmwrite(PIN_BASED_VM_EXEC_CONTROL, rdmsr(MSR_IA32_VMX_TRUE_PINBASED_CTLS));
19909444420SPaolo Bonzini 
20009444420SPaolo Bonzini 	if (vmx->eptp_gpa) {
20109444420SPaolo Bonzini 		uint64_t ept_paddr;
20209444420SPaolo Bonzini 		struct eptPageTablePointer eptp = {
20309444420SPaolo Bonzini 			.memory_type = VMX_BASIC_MEM_TYPE_WB,
20409444420SPaolo Bonzini 			.page_walk_length = 3, /* + 1 */
205c363d959SDavid Matlack 			.ad_enabled = ept_vpid_cap_supported(VMX_EPT_VPID_CAP_AD_BITS),
20609444420SPaolo Bonzini 			.address = vmx->eptp_gpa >> PAGE_SHIFT_4K,
20709444420SPaolo Bonzini 		};
20809444420SPaolo Bonzini 
20909444420SPaolo Bonzini 		memcpy(&ept_paddr, &eptp, sizeof(ept_paddr));
21009444420SPaolo Bonzini 		vmwrite(EPT_POINTER, ept_paddr);
21109444420SPaolo Bonzini 		sec_exec_ctl |= SECONDARY_EXEC_ENABLE_EPT;
21209444420SPaolo Bonzini 	}
21309444420SPaolo Bonzini 
21409444420SPaolo Bonzini 	if (!vmwrite(SECONDARY_VM_EXEC_CONTROL, sec_exec_ctl))
215cc68765dSAndrew Jones 		vmwrite(CPU_BASED_VM_EXEC_CONTROL,
216cc68765dSAndrew Jones 			rdmsr(MSR_IA32_VMX_TRUE_PROCBASED_CTLS) | CPU_BASED_ACTIVATE_SECONDARY_CONTROLS);
21709444420SPaolo Bonzini 	else {
218cc68765dSAndrew Jones 		vmwrite(CPU_BASED_VM_EXEC_CONTROL, rdmsr(MSR_IA32_VMX_TRUE_PROCBASED_CTLS));
21909444420SPaolo Bonzini 		GUEST_ASSERT(!sec_exec_ctl);
22009444420SPaolo Bonzini 	}
22109444420SPaolo Bonzini 
222cc68765dSAndrew Jones 	vmwrite(EXCEPTION_BITMAP, 0);
223cc68765dSAndrew Jones 	vmwrite(PAGE_FAULT_ERROR_CODE_MASK, 0);
224cc68765dSAndrew Jones 	vmwrite(PAGE_FAULT_ERROR_CODE_MATCH, -1); /* Never match */
225cc68765dSAndrew Jones 	vmwrite(CR3_TARGET_COUNT, 0);
226cc68765dSAndrew Jones 	vmwrite(VM_EXIT_CONTROLS, rdmsr(MSR_IA32_VMX_EXIT_CTLS) |
227cc68765dSAndrew Jones 		VM_EXIT_HOST_ADDR_SPACE_SIZE);	  /* 64-bit host */
228cc68765dSAndrew Jones 	vmwrite(VM_EXIT_MSR_STORE_COUNT, 0);
229cc68765dSAndrew Jones 	vmwrite(VM_EXIT_MSR_LOAD_COUNT, 0);
230cc68765dSAndrew Jones 	vmwrite(VM_ENTRY_CONTROLS, rdmsr(MSR_IA32_VMX_ENTRY_CTLS) |
231cc68765dSAndrew Jones 		VM_ENTRY_IA32E_MODE);		  /* 64-bit guest */
232cc68765dSAndrew Jones 	vmwrite(VM_ENTRY_MSR_LOAD_COUNT, 0);
233cc68765dSAndrew Jones 	vmwrite(VM_ENTRY_INTR_INFO_FIELD, 0);
234cc68765dSAndrew Jones 	vmwrite(TPR_THRESHOLD, 0);
235cc68765dSAndrew Jones 
236cc68765dSAndrew Jones 	vmwrite(CR0_GUEST_HOST_MASK, 0);
237cc68765dSAndrew Jones 	vmwrite(CR4_GUEST_HOST_MASK, 0);
238cc68765dSAndrew Jones 	vmwrite(CR0_READ_SHADOW, get_cr0());
239cc68765dSAndrew Jones 	vmwrite(CR4_READ_SHADOW, get_cr4());
240cc68765dSAndrew Jones 
241cc68765dSAndrew Jones 	vmwrite(MSR_BITMAP, vmx->msr_gpa);
242cc68765dSAndrew Jones 	vmwrite(VMREAD_BITMAP, vmx->vmread_gpa);
243cc68765dSAndrew Jones 	vmwrite(VMWRITE_BITMAP, vmx->vmwrite_gpa);
244cc68765dSAndrew Jones }
245cc68765dSAndrew Jones 
246cc68765dSAndrew Jones /*
247cc68765dSAndrew Jones  * Initialize the host state fields based on the current host state, with
248cc68765dSAndrew Jones  * the exception of HOST_RSP and HOST_RIP, which should be set by vmlaunch
249cc68765dSAndrew Jones  * or vmresume.
250cc68765dSAndrew Jones  */
init_vmcs_host_state(void)251cc68765dSAndrew Jones static inline void init_vmcs_host_state(void)
252cc68765dSAndrew Jones {
253cc68765dSAndrew Jones 	uint32_t exit_controls = vmreadz(VM_EXIT_CONTROLS);
254cc68765dSAndrew Jones 
255cc68765dSAndrew Jones 	vmwrite(HOST_ES_SELECTOR, get_es());
256cc68765dSAndrew Jones 	vmwrite(HOST_CS_SELECTOR, get_cs());
257cc68765dSAndrew Jones 	vmwrite(HOST_SS_SELECTOR, get_ss());
258cc68765dSAndrew Jones 	vmwrite(HOST_DS_SELECTOR, get_ds());
259cc68765dSAndrew Jones 	vmwrite(HOST_FS_SELECTOR, get_fs());
260cc68765dSAndrew Jones 	vmwrite(HOST_GS_SELECTOR, get_gs());
261cc68765dSAndrew Jones 	vmwrite(HOST_TR_SELECTOR, get_tr());
262cc68765dSAndrew Jones 
263cc68765dSAndrew Jones 	if (exit_controls & VM_EXIT_LOAD_IA32_PAT)
264cc68765dSAndrew Jones 		vmwrite(HOST_IA32_PAT, rdmsr(MSR_IA32_CR_PAT));
265cc68765dSAndrew Jones 	if (exit_controls & VM_EXIT_LOAD_IA32_EFER)
266cc68765dSAndrew Jones 		vmwrite(HOST_IA32_EFER, rdmsr(MSR_EFER));
267cc68765dSAndrew Jones 	if (exit_controls & VM_EXIT_LOAD_IA32_PERF_GLOBAL_CTRL)
268cc68765dSAndrew Jones 		vmwrite(HOST_IA32_PERF_GLOBAL_CTRL,
269cc68765dSAndrew Jones 			rdmsr(MSR_CORE_PERF_GLOBAL_CTRL));
270cc68765dSAndrew Jones 
271cc68765dSAndrew Jones 	vmwrite(HOST_IA32_SYSENTER_CS, rdmsr(MSR_IA32_SYSENTER_CS));
272cc68765dSAndrew Jones 
273cc68765dSAndrew Jones 	vmwrite(HOST_CR0, get_cr0());
274cc68765dSAndrew Jones 	vmwrite(HOST_CR3, get_cr3());
275cc68765dSAndrew Jones 	vmwrite(HOST_CR4, get_cr4());
276cc68765dSAndrew Jones 	vmwrite(HOST_FS_BASE, rdmsr(MSR_FS_BASE));
277cc68765dSAndrew Jones 	vmwrite(HOST_GS_BASE, rdmsr(MSR_GS_BASE));
278cc68765dSAndrew Jones 	vmwrite(HOST_TR_BASE,
2791ecaabedSEric Auger 		get_desc64_base((struct desc64 *)(get_gdt().address + get_tr())));
2801ecaabedSEric Auger 	vmwrite(HOST_GDTR_BASE, get_gdt().address);
2811ecaabedSEric Auger 	vmwrite(HOST_IDTR_BASE, get_idt().address);
282cc68765dSAndrew Jones 	vmwrite(HOST_IA32_SYSENTER_ESP, rdmsr(MSR_IA32_SYSENTER_ESP));
283cc68765dSAndrew Jones 	vmwrite(HOST_IA32_SYSENTER_EIP, rdmsr(MSR_IA32_SYSENTER_EIP));
284cc68765dSAndrew Jones }
285cc68765dSAndrew Jones 
286cc68765dSAndrew Jones /*
287cc68765dSAndrew Jones  * Initialize the guest state fields essentially as a clone of
288cc68765dSAndrew Jones  * the host state fields. Some host state fields have fixed
289cc68765dSAndrew Jones  * values, and we set the corresponding guest state fields accordingly.
290cc68765dSAndrew Jones  */
init_vmcs_guest_state(void * rip,void * rsp)291cc68765dSAndrew Jones static inline void init_vmcs_guest_state(void *rip, void *rsp)
292cc68765dSAndrew Jones {
293cc68765dSAndrew Jones 	vmwrite(GUEST_ES_SELECTOR, vmreadz(HOST_ES_SELECTOR));
294cc68765dSAndrew Jones 	vmwrite(GUEST_CS_SELECTOR, vmreadz(HOST_CS_SELECTOR));
295cc68765dSAndrew Jones 	vmwrite(GUEST_SS_SELECTOR, vmreadz(HOST_SS_SELECTOR));
296cc68765dSAndrew Jones 	vmwrite(GUEST_DS_SELECTOR, vmreadz(HOST_DS_SELECTOR));
297cc68765dSAndrew Jones 	vmwrite(GUEST_FS_SELECTOR, vmreadz(HOST_FS_SELECTOR));
298cc68765dSAndrew Jones 	vmwrite(GUEST_GS_SELECTOR, vmreadz(HOST_GS_SELECTOR));
299cc68765dSAndrew Jones 	vmwrite(GUEST_LDTR_SELECTOR, 0);
300cc68765dSAndrew Jones 	vmwrite(GUEST_TR_SELECTOR, vmreadz(HOST_TR_SELECTOR));
301cc68765dSAndrew Jones 	vmwrite(GUEST_INTR_STATUS, 0);
302cc68765dSAndrew Jones 	vmwrite(GUEST_PML_INDEX, 0);
303cc68765dSAndrew Jones 
304cc68765dSAndrew Jones 	vmwrite(VMCS_LINK_POINTER, -1ll);
305cc68765dSAndrew Jones 	vmwrite(GUEST_IA32_DEBUGCTL, 0);
306cc68765dSAndrew Jones 	vmwrite(GUEST_IA32_PAT, vmreadz(HOST_IA32_PAT));
307cc68765dSAndrew Jones 	vmwrite(GUEST_IA32_EFER, vmreadz(HOST_IA32_EFER));
308cc68765dSAndrew Jones 	vmwrite(GUEST_IA32_PERF_GLOBAL_CTRL,
309cc68765dSAndrew Jones 		vmreadz(HOST_IA32_PERF_GLOBAL_CTRL));
310cc68765dSAndrew Jones 
311cc68765dSAndrew Jones 	vmwrite(GUEST_ES_LIMIT, -1);
312cc68765dSAndrew Jones 	vmwrite(GUEST_CS_LIMIT, -1);
313cc68765dSAndrew Jones 	vmwrite(GUEST_SS_LIMIT, -1);
314cc68765dSAndrew Jones 	vmwrite(GUEST_DS_LIMIT, -1);
315cc68765dSAndrew Jones 	vmwrite(GUEST_FS_LIMIT, -1);
316cc68765dSAndrew Jones 	vmwrite(GUEST_GS_LIMIT, -1);
317cc68765dSAndrew Jones 	vmwrite(GUEST_LDTR_LIMIT, -1);
318cc68765dSAndrew Jones 	vmwrite(GUEST_TR_LIMIT, 0x67);
319cc68765dSAndrew Jones 	vmwrite(GUEST_GDTR_LIMIT, 0xffff);
320cc68765dSAndrew Jones 	vmwrite(GUEST_IDTR_LIMIT, 0xffff);
321cc68765dSAndrew Jones 	vmwrite(GUEST_ES_AR_BYTES,
322cc68765dSAndrew Jones 		vmreadz(GUEST_ES_SELECTOR) == 0 ? 0x10000 : 0xc093);
323cc68765dSAndrew Jones 	vmwrite(GUEST_CS_AR_BYTES, 0xa09b);
324cc68765dSAndrew Jones 	vmwrite(GUEST_SS_AR_BYTES, 0xc093);
325cc68765dSAndrew Jones 	vmwrite(GUEST_DS_AR_BYTES,
326cc68765dSAndrew Jones 		vmreadz(GUEST_DS_SELECTOR) == 0 ? 0x10000 : 0xc093);
327cc68765dSAndrew Jones 	vmwrite(GUEST_FS_AR_BYTES,
328cc68765dSAndrew Jones 		vmreadz(GUEST_FS_SELECTOR) == 0 ? 0x10000 : 0xc093);
329cc68765dSAndrew Jones 	vmwrite(GUEST_GS_AR_BYTES,
330cc68765dSAndrew Jones 		vmreadz(GUEST_GS_SELECTOR) == 0 ? 0x10000 : 0xc093);
331cc68765dSAndrew Jones 	vmwrite(GUEST_LDTR_AR_BYTES, 0x10000);
332cc68765dSAndrew Jones 	vmwrite(GUEST_TR_AR_BYTES, 0x8b);
333cc68765dSAndrew Jones 	vmwrite(GUEST_INTERRUPTIBILITY_INFO, 0);
334cc68765dSAndrew Jones 	vmwrite(GUEST_ACTIVITY_STATE, 0);
335cc68765dSAndrew Jones 	vmwrite(GUEST_SYSENTER_CS, vmreadz(HOST_IA32_SYSENTER_CS));
336cc68765dSAndrew Jones 	vmwrite(VMX_PREEMPTION_TIMER_VALUE, 0);
337cc68765dSAndrew Jones 
338cc68765dSAndrew Jones 	vmwrite(GUEST_CR0, vmreadz(HOST_CR0));
339cc68765dSAndrew Jones 	vmwrite(GUEST_CR3, vmreadz(HOST_CR3));
340cc68765dSAndrew Jones 	vmwrite(GUEST_CR4, vmreadz(HOST_CR4));
341cc68765dSAndrew Jones 	vmwrite(GUEST_ES_BASE, 0);
342cc68765dSAndrew Jones 	vmwrite(GUEST_CS_BASE, 0);
343cc68765dSAndrew Jones 	vmwrite(GUEST_SS_BASE, 0);
344cc68765dSAndrew Jones 	vmwrite(GUEST_DS_BASE, 0);
345cc68765dSAndrew Jones 	vmwrite(GUEST_FS_BASE, vmreadz(HOST_FS_BASE));
346cc68765dSAndrew Jones 	vmwrite(GUEST_GS_BASE, vmreadz(HOST_GS_BASE));
347cc68765dSAndrew Jones 	vmwrite(GUEST_LDTR_BASE, 0);
348cc68765dSAndrew Jones 	vmwrite(GUEST_TR_BASE, vmreadz(HOST_TR_BASE));
349cc68765dSAndrew Jones 	vmwrite(GUEST_GDTR_BASE, vmreadz(HOST_GDTR_BASE));
350cc68765dSAndrew Jones 	vmwrite(GUEST_IDTR_BASE, vmreadz(HOST_IDTR_BASE));
351cc68765dSAndrew Jones 	vmwrite(GUEST_DR7, 0x400);
352cc68765dSAndrew Jones 	vmwrite(GUEST_RSP, (uint64_t)rsp);
353cc68765dSAndrew Jones 	vmwrite(GUEST_RIP, (uint64_t)rip);
354cc68765dSAndrew Jones 	vmwrite(GUEST_RFLAGS, 2);
355cc68765dSAndrew Jones 	vmwrite(GUEST_PENDING_DBG_EXCEPTIONS, 0);
356cc68765dSAndrew Jones 	vmwrite(GUEST_SYSENTER_ESP, vmreadz(HOST_IA32_SYSENTER_ESP));
357cc68765dSAndrew Jones 	vmwrite(GUEST_SYSENTER_EIP, vmreadz(HOST_IA32_SYSENTER_EIP));
358cc68765dSAndrew Jones }
359cc68765dSAndrew Jones 
prepare_vmcs(struct vmx_pages * vmx,void * guest_rip,void * guest_rsp)360cc68765dSAndrew Jones void prepare_vmcs(struct vmx_pages *vmx, void *guest_rip, void *guest_rsp)
361cc68765dSAndrew Jones {
362cc68765dSAndrew Jones 	init_vmcs_control_fields(vmx);
363cc68765dSAndrew Jones 	init_vmcs_host_state();
364cc68765dSAndrew Jones 	init_vmcs_guest_state(guest_rip, guest_rsp);
365cc68765dSAndrew Jones }
36609444420SPaolo Bonzini 
nested_create_pte(struct kvm_vm * vm,struct eptPageTableEntry * pte,uint64_t nested_paddr,uint64_t paddr,int current_level,int target_level)367c5a0ccecSDavid Matlack static void nested_create_pte(struct kvm_vm *vm,
368c5a0ccecSDavid Matlack 			      struct eptPageTableEntry *pte,
369c5a0ccecSDavid Matlack 			      uint64_t nested_paddr,
370c5a0ccecSDavid Matlack 			      uint64_t paddr,
371c5a0ccecSDavid Matlack 			      int current_level,
372c5a0ccecSDavid Matlack 			      int target_level)
37309444420SPaolo Bonzini {
374c5a0ccecSDavid Matlack 	if (!pte->readable) {
375c5a0ccecSDavid Matlack 		pte->writable = true;
376c5a0ccecSDavid Matlack 		pte->readable = true;
377c5a0ccecSDavid Matlack 		pte->executable = true;
378c5a0ccecSDavid Matlack 		pte->page_size = (current_level == target_level);
379c5a0ccecSDavid Matlack 		if (pte->page_size)
380c5a0ccecSDavid Matlack 			pte->address = paddr >> vm->page_shift;
381c5a0ccecSDavid Matlack 		else
382c5a0ccecSDavid Matlack 			pte->address = vm_alloc_page_table(vm) >> vm->page_shift;
383c5a0ccecSDavid Matlack 	} else {
384c5a0ccecSDavid Matlack 		/*
385c5a0ccecSDavid Matlack 		 * Entry already present.  Assert that the caller doesn't want
386c5a0ccecSDavid Matlack 		 * a hugepage at this level, and that there isn't a hugepage at
387c5a0ccecSDavid Matlack 		 * this level.
388c5a0ccecSDavid Matlack 		 */
389c5a0ccecSDavid Matlack 		TEST_ASSERT(current_level != target_level,
390c5a0ccecSDavid Matlack 			    "Cannot create hugepage at level: %u, nested_paddr: 0x%lx\n",
391c5a0ccecSDavid Matlack 			    current_level, nested_paddr);
392c5a0ccecSDavid Matlack 		TEST_ASSERT(!pte->page_size,
393c5a0ccecSDavid Matlack 			    "Cannot create page table at level: %u, nested_paddr: 0x%lx\n",
394c5a0ccecSDavid Matlack 			    current_level, nested_paddr);
395c5a0ccecSDavid Matlack 	}
396c5a0ccecSDavid Matlack }
397c5a0ccecSDavid Matlack 
398c5a0ccecSDavid Matlack 
__nested_pg_map(struct vmx_pages * vmx,struct kvm_vm * vm,uint64_t nested_paddr,uint64_t paddr,int target_level)399c5a0ccecSDavid Matlack void __nested_pg_map(struct vmx_pages *vmx, struct kvm_vm *vm,
400c5a0ccecSDavid Matlack 		     uint64_t nested_paddr, uint64_t paddr, int target_level)
401c5a0ccecSDavid Matlack {
402c5a0ccecSDavid Matlack 	const uint64_t page_size = PG_LEVEL_SIZE(target_level);
403c5a0ccecSDavid Matlack 	struct eptPageTableEntry *pt = vmx->eptp_hva, *pte;
404c5a0ccecSDavid Matlack 	uint16_t index;
40509444420SPaolo Bonzini 
40609444420SPaolo Bonzini 	TEST_ASSERT(vm->mode == VM_MODE_PXXV48_4K, "Attempt to use "
40709444420SPaolo Bonzini 		    "unknown or unsupported guest mode, mode: 0x%x", vm->mode);
40809444420SPaolo Bonzini 
40971d48966SDavid Matlack 	TEST_ASSERT((nested_paddr >> 48) == 0,
41071d48966SDavid Matlack 		    "Nested physical address 0x%lx requires 5-level paging",
41171d48966SDavid Matlack 		    nested_paddr);
412c5a0ccecSDavid Matlack 	TEST_ASSERT((nested_paddr % page_size) == 0,
41309444420SPaolo Bonzini 		    "Nested physical address not on page boundary,\n"
414c5a0ccecSDavid Matlack 		    "  nested_paddr: 0x%lx page_size: 0x%lx",
415c5a0ccecSDavid Matlack 		    nested_paddr, page_size);
41609444420SPaolo Bonzini 	TEST_ASSERT((nested_paddr >> vm->page_shift) <= vm->max_gfn,
41709444420SPaolo Bonzini 		    "Physical address beyond beyond maximum supported,\n"
41809444420SPaolo Bonzini 		    "  nested_paddr: 0x%lx vm->max_gfn: 0x%lx vm->page_size: 0x%x",
41909444420SPaolo Bonzini 		    paddr, vm->max_gfn, vm->page_size);
420c5a0ccecSDavid Matlack 	TEST_ASSERT((paddr % page_size) == 0,
42109444420SPaolo Bonzini 		    "Physical address not on page boundary,\n"
422c5a0ccecSDavid Matlack 		    "  paddr: 0x%lx page_size: 0x%lx",
423c5a0ccecSDavid Matlack 		    paddr, page_size);
42409444420SPaolo Bonzini 	TEST_ASSERT((paddr >> vm->page_shift) <= vm->max_gfn,
42509444420SPaolo Bonzini 		    "Physical address beyond beyond maximum supported,\n"
42609444420SPaolo Bonzini 		    "  paddr: 0x%lx vm->max_gfn: 0x%lx vm->page_size: 0x%x",
42709444420SPaolo Bonzini 		    paddr, vm->max_gfn, vm->page_size);
42809444420SPaolo Bonzini 
429c5a0ccecSDavid Matlack 	for (int level = PG_LEVEL_512G; level >= PG_LEVEL_4K; level--) {
430c5a0ccecSDavid Matlack 		index = (nested_paddr >> PG_LEVEL_SHIFT(level)) & 0x1ffu;
431c5a0ccecSDavid Matlack 		pte = &pt[index];
43209444420SPaolo Bonzini 
433c5a0ccecSDavid Matlack 		nested_create_pte(vm, pte, nested_paddr, paddr, level, target_level);
434c5a0ccecSDavid Matlack 
435c5a0ccecSDavid Matlack 		if (pte->page_size)
436c5a0ccecSDavid Matlack 			break;
437c5a0ccecSDavid Matlack 
438c5a0ccecSDavid Matlack 		pt = addr_gpa2hva(vm, pte->address * vm->page_size);
43909444420SPaolo Bonzini 	}
44009444420SPaolo Bonzini 
44109444420SPaolo Bonzini 	/*
44209444420SPaolo Bonzini 	 * For now mark these as accessed and dirty because the only
44309444420SPaolo Bonzini 	 * testcase we have needs that.  Can be reconsidered later.
44409444420SPaolo Bonzini 	 */
445c5a0ccecSDavid Matlack 	pte->accessed = true;
446c5a0ccecSDavid Matlack 	pte->dirty = true;
447c5a0ccecSDavid Matlack 
448c5a0ccecSDavid Matlack }
449c5a0ccecSDavid Matlack 
nested_pg_map(struct vmx_pages * vmx,struct kvm_vm * vm,uint64_t nested_paddr,uint64_t paddr)450c5a0ccecSDavid Matlack void nested_pg_map(struct vmx_pages *vmx, struct kvm_vm *vm,
451c5a0ccecSDavid Matlack 		   uint64_t nested_paddr, uint64_t paddr)
452c5a0ccecSDavid Matlack {
453c5a0ccecSDavid Matlack 	__nested_pg_map(vmx, vm, nested_paddr, paddr, PG_LEVEL_4K);
45409444420SPaolo Bonzini }
45509444420SPaolo Bonzini 
45609444420SPaolo Bonzini /*
45709444420SPaolo Bonzini  * Map a range of EPT guest physical addresses to the VM's physical address
45809444420SPaolo Bonzini  *
45909444420SPaolo Bonzini  * Input Args:
46009444420SPaolo Bonzini  *   vm - Virtual Machine
46109444420SPaolo Bonzini  *   nested_paddr - Nested guest physical address to map
46209444420SPaolo Bonzini  *   paddr - VM Physical Address
46309444420SPaolo Bonzini  *   size - The size of the range to map
464ce690e9cSDavid Matlack  *   level - The level at which to map the range
46509444420SPaolo Bonzini  *
46609444420SPaolo Bonzini  * Output Args: None
46709444420SPaolo Bonzini  *
46809444420SPaolo Bonzini  * Return: None
46909444420SPaolo Bonzini  *
47009444420SPaolo Bonzini  * Within the VM given by vm, creates a nested guest translation for the
47109444420SPaolo Bonzini  * page range starting at nested_paddr to the page range starting at paddr.
47209444420SPaolo Bonzini  */
__nested_map(struct vmx_pages * vmx,struct kvm_vm * vm,uint64_t nested_paddr,uint64_t paddr,uint64_t size,int level)473ce690e9cSDavid Matlack void __nested_map(struct vmx_pages *vmx, struct kvm_vm *vm,
474ce690e9cSDavid Matlack 		  uint64_t nested_paddr, uint64_t paddr, uint64_t size,
475ce690e9cSDavid Matlack 		  int level)
47609444420SPaolo Bonzini {
477ce690e9cSDavid Matlack 	size_t page_size = PG_LEVEL_SIZE(level);
47809444420SPaolo Bonzini 	size_t npages = size / page_size;
47909444420SPaolo Bonzini 
48009444420SPaolo Bonzini 	TEST_ASSERT(nested_paddr + size > nested_paddr, "Vaddr overflow");
48109444420SPaolo Bonzini 	TEST_ASSERT(paddr + size > paddr, "Paddr overflow");
48209444420SPaolo Bonzini 
48309444420SPaolo Bonzini 	while (npages--) {
484ce690e9cSDavid Matlack 		__nested_pg_map(vmx, vm, nested_paddr, paddr, level);
48509444420SPaolo Bonzini 		nested_paddr += page_size;
48609444420SPaolo Bonzini 		paddr += page_size;
48709444420SPaolo Bonzini 	}
48809444420SPaolo Bonzini }
48909444420SPaolo Bonzini 
nested_map(struct vmx_pages * vmx,struct kvm_vm * vm,uint64_t nested_paddr,uint64_t paddr,uint64_t size)490ce690e9cSDavid Matlack void nested_map(struct vmx_pages *vmx, struct kvm_vm *vm,
491ce690e9cSDavid Matlack 		uint64_t nested_paddr, uint64_t paddr, uint64_t size)
492ce690e9cSDavid Matlack {
493ce690e9cSDavid Matlack 	__nested_map(vmx, vm, nested_paddr, paddr, size, PG_LEVEL_4K);
494ce690e9cSDavid Matlack }
495ce690e9cSDavid Matlack 
49609444420SPaolo Bonzini /* Prepare an identity extended page table that maps all the
49709444420SPaolo Bonzini  * physical pages in VM.
49809444420SPaolo Bonzini  */
nested_map_memslot(struct vmx_pages * vmx,struct kvm_vm * vm,uint32_t memslot)49909444420SPaolo Bonzini void nested_map_memslot(struct vmx_pages *vmx, struct kvm_vm *vm,
500444d084bSSean Christopherson 			uint32_t memslot)
50109444420SPaolo Bonzini {
50209444420SPaolo Bonzini 	sparsebit_idx_t i, last;
50309444420SPaolo Bonzini 	struct userspace_mem_region *region =
50409444420SPaolo Bonzini 		memslot2region(vm, memslot);
50509444420SPaolo Bonzini 
50609444420SPaolo Bonzini 	i = (region->region.guest_phys_addr >> vm->page_shift) - 1;
50709444420SPaolo Bonzini 	last = i + (region->region.memory_size >> vm->page_shift);
50809444420SPaolo Bonzini 	for (;;) {
50909444420SPaolo Bonzini 		i = sparsebit_next_clear(region->unused_phy_pages, i);
51009444420SPaolo Bonzini 		if (i > last)
51109444420SPaolo Bonzini 			break;
51209444420SPaolo Bonzini 
51309444420SPaolo Bonzini 		nested_map(vmx, vm,
51409444420SPaolo Bonzini 			   (uint64_t)i << vm->page_shift,
51509444420SPaolo Bonzini 			   (uint64_t)i << vm->page_shift,
516444d084bSSean Christopherson 			   1 << vm->page_shift);
51709444420SPaolo Bonzini 	}
51809444420SPaolo Bonzini }
51909444420SPaolo Bonzini 
52071d48966SDavid Matlack /* Identity map a region with 1GiB Pages. */
nested_identity_map_1g(struct vmx_pages * vmx,struct kvm_vm * vm,uint64_t addr,uint64_t size)52171d48966SDavid Matlack void nested_identity_map_1g(struct vmx_pages *vmx, struct kvm_vm *vm,
52271d48966SDavid Matlack 			    uint64_t addr, uint64_t size)
52371d48966SDavid Matlack {
52471d48966SDavid Matlack 	__nested_map(vmx, vm, addr, addr, size, PG_LEVEL_1G);
52571d48966SDavid Matlack }
52671d48966SDavid Matlack 
kvm_cpu_has_ept(void)527ecb89a51SDavid Matlack bool kvm_cpu_has_ept(void)
5280f816e02SDavid Matlack {
5290f816e02SDavid Matlack 	uint64_t ctrl;
5300f816e02SDavid Matlack 
531ecb89a51SDavid Matlack 	ctrl = kvm_get_feature_msr(MSR_IA32_VMX_TRUE_PROCBASED_CTLS) >> 32;
5320f816e02SDavid Matlack 	if (!(ctrl & CPU_BASED_ACTIVATE_SECONDARY_CONTROLS))
5330f816e02SDavid Matlack 		return false;
5340f816e02SDavid Matlack 
535ecb89a51SDavid Matlack 	ctrl = kvm_get_feature_msr(MSR_IA32_VMX_PROCBASED_CTLS2) >> 32;
5360f816e02SDavid Matlack 	return ctrl & SECONDARY_EXEC_ENABLE_EPT;
5370f816e02SDavid Matlack }
5380f816e02SDavid Matlack 
prepare_eptp(struct vmx_pages * vmx,struct kvm_vm * vm,uint32_t eptp_memslot)53909444420SPaolo Bonzini void prepare_eptp(struct vmx_pages *vmx, struct kvm_vm *vm,
54009444420SPaolo Bonzini 		  uint32_t eptp_memslot)
54109444420SPaolo Bonzini {
5425c107f70SDavid Matlack 	TEST_ASSERT(kvm_cpu_has_ept(), "KVM doesn't support nested EPT");
5430f816e02SDavid Matlack 
544a9db9609SSean Christopherson 	vmx->eptp = (void *)vm_vaddr_alloc_page(vm);
54509444420SPaolo Bonzini 	vmx->eptp_hva = addr_gva2hva(vm, (uintptr_t)vmx->eptp);
54609444420SPaolo Bonzini 	vmx->eptp_gpa = addr_gva2gpa(vm, (uintptr_t)vmx->eptp);
54709444420SPaolo Bonzini }
54897a71a54SJim Mattson 
prepare_virtualize_apic_accesses(struct vmx_pages * vmx,struct kvm_vm * vm)549444d084bSSean Christopherson void prepare_virtualize_apic_accesses(struct vmx_pages *vmx, struct kvm_vm *vm)
55097a71a54SJim Mattson {
551a9db9609SSean Christopherson 	vmx->apic_access = (void *)vm_vaddr_alloc_page(vm);
55297a71a54SJim Mattson 	vmx->apic_access_hva = addr_gva2hva(vm, (uintptr_t)vmx->apic_access);
55397a71a54SJim Mattson 	vmx->apic_access_gpa = addr_gva2gpa(vm, (uintptr_t)vmx->apic_access);
55497a71a54SJim Mattson }
555