xref: /kvm-unit-tests/x86/vmx.c (revision a299895b7abb54e7ba6bb4108f202acbb484ac65)
17ada359dSArthur Chunqi Li /*
27ada359dSArthur Chunqi Li  * x86/vmx.c : Framework for testing nested virtualization
37ada359dSArthur Chunqi Li  *	This is a framework to test nested VMX for KVM, which
47ada359dSArthur Chunqi Li  * 	started as a project of GSoC 2013. All test cases should
57ada359dSArthur Chunqi Li  *	be located in x86/vmx_tests.c and framework related
67ada359dSArthur Chunqi Li  *	functions should be in this file.
77ada359dSArthur Chunqi Li  *
87ada359dSArthur Chunqi Li  * How to write test cases?
97ada359dSArthur Chunqi Li  *	Add callbacks of test suite in variant "vmx_tests". You can
107ada359dSArthur Chunqi Li  *	write:
117ada359dSArthur Chunqi Li  *		1. init function used for initializing test suite
127ada359dSArthur Chunqi Li  *		2. main function for codes running in L2 guest,
137ada359dSArthur Chunqi Li  *		3. exit_handler to handle vmexit of L2 to L1
147ada359dSArthur Chunqi Li  *		4. syscall handler to handle L2 syscall vmexit
157ada359dSArthur Chunqi Li  *		5. vmenter fail handler to handle direct failure of vmenter
167ada359dSArthur Chunqi Li  *		6. guest_regs is loaded when vmenter and saved when
177ada359dSArthur Chunqi Li  *			vmexit, you can read and set it in exit_handler
187ada359dSArthur Chunqi Li  *	If no special function is needed for a test suite, use
197ada359dSArthur Chunqi Li  *	coressponding basic_* functions as callback. More handlers
207ada359dSArthur Chunqi Li  *	can be added to "vmx_tests", see details of "struct vmx_test"
217ada359dSArthur Chunqi Li  *	and function test_run().
227ada359dSArthur Chunqi Li  *
237ada359dSArthur Chunqi Li  * Currently, vmx test framework only set up one VCPU and one
247ada359dSArthur Chunqi Li  * concurrent guest test environment with same paging for L2 and
257ada359dSArthur Chunqi Li  * L1. For usage of EPT, only 1:1 mapped paging is used from VFN
267ada359dSArthur Chunqi Li  * to PFN.
277ada359dSArthur Chunqi Li  *
287ada359dSArthur Chunqi Li  * Author : Arthur Chunqi Li <yzt356@gmail.com>
297ada359dSArthur Chunqi Li  */
307ada359dSArthur Chunqi Li 
319d7eaa29SArthur Chunqi Li #include "libcflat.h"
329d7eaa29SArthur Chunqi Li #include "processor.h"
335aca024eSPaolo Bonzini #include "alloc_page.h"
349d7eaa29SArthur Chunqi Li #include "vm.h"
359d7eaa29SArthur Chunqi Li #include "desc.h"
369d7eaa29SArthur Chunqi Li #include "vmx.h"
379d7eaa29SArthur Chunqi Li #include "msr.h"
389d7eaa29SArthur Chunqi Li #include "smp.h"
397371c622SVitaly Kuznetsov #include "apic.h"
409d7eaa29SArthur Chunqi Li 
41c937d495SLiran Alon u64 *bsp_vmxon_region;
429d7eaa29SArthur Chunqi Li struct vmcs *vmcs_root;
439d7eaa29SArthur Chunqi Li u32 vpid_cnt;
449d7eaa29SArthur Chunqi Li void *guest_stack, *guest_syscall_stack;
459d7eaa29SArthur Chunqi Li u32 ctrl_pin, ctrl_enter, ctrl_exit, ctrl_cpu[2];
469d7eaa29SArthur Chunqi Li struct regs regs;
47794c67a9SPeter Feiner 
489d7eaa29SArthur Chunqi Li struct vmx_test *current;
49794c67a9SPeter Feiner 
50794c67a9SPeter Feiner #define MAX_TEST_TEARDOWN_STEPS 10
51794c67a9SPeter Feiner 
52794c67a9SPeter Feiner struct test_teardown_step {
53794c67a9SPeter Feiner 	test_teardown_func func;
54794c67a9SPeter Feiner 	void *data;
55794c67a9SPeter Feiner };
56794c67a9SPeter Feiner 
57794c67a9SPeter Feiner static int teardown_count;
58794c67a9SPeter Feiner static struct test_teardown_step teardown_steps[MAX_TEST_TEARDOWN_STEPS];
59794c67a9SPeter Feiner 
60794c67a9SPeter Feiner static test_guest_func v2_guest_main;
61794c67a9SPeter Feiner 
623ee34093SArthur Chunqi Li u64 hypercall_field;
639d7eaa29SArthur Chunqi Li bool launched;
64c04259ffSDavid Matlack static int matched;
65794c67a9SPeter Feiner static int guest_finished;
66794c67a9SPeter Feiner static int in_guest;
679d7eaa29SArthur Chunqi Li 
683ee34093SArthur Chunqi Li union vmx_basic basic;
695f18e779SJan Kiszka union vmx_ctrl_msr ctrl_pin_rev;
705f18e779SJan Kiszka union vmx_ctrl_msr ctrl_cpu_rev[2];
715f18e779SJan Kiszka union vmx_ctrl_msr ctrl_exit_rev;
725f18e779SJan Kiszka union vmx_ctrl_msr ctrl_enter_rev;
733ee34093SArthur Chunqi Li union vmx_ept_vpid  ept_vpid;
743ee34093SArthur Chunqi Li 
75337166aaSJan Kiszka extern struct descriptor_table_ptr gdt64_desc;
76337166aaSJan Kiszka extern struct descriptor_table_ptr idt_descr;
77337166aaSJan Kiszka extern struct descriptor_table_ptr tss_descr;
789d7eaa29SArthur Chunqi Li extern void *vmx_return;
799d7eaa29SArthur Chunqi Li extern void *entry_sysenter;
809d7eaa29SArthur Chunqi Li extern void *guest_entry;
819d7eaa29SArthur Chunqi Li 
82ffb1a9e0SJan Kiszka static volatile u32 stage;
83ffb1a9e0SJan Kiszka 
84794c67a9SPeter Feiner static jmp_buf abort_target;
85794c67a9SPeter Feiner 
86ecd5b431SDavid Matlack struct vmcs_field {
87ecd5b431SDavid Matlack 	u64 mask;
88ecd5b431SDavid Matlack 	u64 encoding;
89ecd5b431SDavid Matlack };
90ecd5b431SDavid Matlack 
91ecd5b431SDavid Matlack #define MASK(_bits) GENMASK_ULL((_bits) - 1, 0)
92ecd5b431SDavid Matlack #define MASK_NATURAL MASK(sizeof(unsigned long) * 8)
93ecd5b431SDavid Matlack 
94ecd5b431SDavid Matlack static struct vmcs_field vmcs_fields[] = {
95ecd5b431SDavid Matlack 	{ MASK(16), VPID },
96ecd5b431SDavid Matlack 	{ MASK(16), PINV },
97ecd5b431SDavid Matlack 	{ MASK(16), EPTP_IDX },
98ecd5b431SDavid Matlack 
99ecd5b431SDavid Matlack 	{ MASK(16), GUEST_SEL_ES },
100ecd5b431SDavid Matlack 	{ MASK(16), GUEST_SEL_CS },
101ecd5b431SDavid Matlack 	{ MASK(16), GUEST_SEL_SS },
102ecd5b431SDavid Matlack 	{ MASK(16), GUEST_SEL_DS },
103ecd5b431SDavid Matlack 	{ MASK(16), GUEST_SEL_FS },
104ecd5b431SDavid Matlack 	{ MASK(16), GUEST_SEL_GS },
105ecd5b431SDavid Matlack 	{ MASK(16), GUEST_SEL_LDTR },
106ecd5b431SDavid Matlack 	{ MASK(16), GUEST_SEL_TR },
107ecd5b431SDavid Matlack 	{ MASK(16), GUEST_INT_STATUS },
108ecd5b431SDavid Matlack 
109ecd5b431SDavid Matlack 	{ MASK(16), HOST_SEL_ES },
110ecd5b431SDavid Matlack 	{ MASK(16), HOST_SEL_CS },
111ecd5b431SDavid Matlack 	{ MASK(16), HOST_SEL_SS },
112ecd5b431SDavid Matlack 	{ MASK(16), HOST_SEL_DS },
113ecd5b431SDavid Matlack 	{ MASK(16), HOST_SEL_FS },
114ecd5b431SDavid Matlack 	{ MASK(16), HOST_SEL_GS },
115ecd5b431SDavid Matlack 	{ MASK(16), HOST_SEL_TR },
116ecd5b431SDavid Matlack 
117ecd5b431SDavid Matlack 	{ MASK(64), IO_BITMAP_A },
118ecd5b431SDavid Matlack 	{ MASK(64), IO_BITMAP_B },
119ecd5b431SDavid Matlack 	{ MASK(64), MSR_BITMAP },
120ecd5b431SDavid Matlack 	{ MASK(64), EXIT_MSR_ST_ADDR },
121ecd5b431SDavid Matlack 	{ MASK(64), EXIT_MSR_LD_ADDR },
122ecd5b431SDavid Matlack 	{ MASK(64), ENTER_MSR_LD_ADDR },
123ecd5b431SDavid Matlack 	{ MASK(64), VMCS_EXEC_PTR },
124ecd5b431SDavid Matlack 	{ MASK(64), TSC_OFFSET },
125ecd5b431SDavid Matlack 	{ MASK(64), APIC_VIRT_ADDR },
126ecd5b431SDavid Matlack 	{ MASK(64), APIC_ACCS_ADDR },
127ecd5b431SDavid Matlack 	{ MASK(64), EPTP },
128ecd5b431SDavid Matlack 
129faea4fc6SLiran Alon 	{ MASK(64), INFO_PHYS_ADDR },
130ecd5b431SDavid Matlack 
131ecd5b431SDavid Matlack 	{ MASK(64), VMCS_LINK_PTR },
132ecd5b431SDavid Matlack 	{ MASK(64), GUEST_DEBUGCTL },
133ecd5b431SDavid Matlack 	{ MASK(64), GUEST_EFER },
134ecd5b431SDavid Matlack 	{ MASK(64), GUEST_PAT },
135ecd5b431SDavid Matlack 	{ MASK(64), GUEST_PERF_GLOBAL_CTRL },
136ecd5b431SDavid Matlack 	{ MASK(64), GUEST_PDPTE },
137ecd5b431SDavid Matlack 
138ecd5b431SDavid Matlack 	{ MASK(64), HOST_PAT },
139ecd5b431SDavid Matlack 	{ MASK(64), HOST_EFER },
140ecd5b431SDavid Matlack 	{ MASK(64), HOST_PERF_GLOBAL_CTRL },
141ecd5b431SDavid Matlack 
142ecd5b431SDavid Matlack 	{ MASK(32), PIN_CONTROLS },
143ecd5b431SDavid Matlack 	{ MASK(32), CPU_EXEC_CTRL0 },
144ecd5b431SDavid Matlack 	{ MASK(32), EXC_BITMAP },
145ecd5b431SDavid Matlack 	{ MASK(32), PF_ERROR_MASK },
146ecd5b431SDavid Matlack 	{ MASK(32), PF_ERROR_MATCH },
147ecd5b431SDavid Matlack 	{ MASK(32), CR3_TARGET_COUNT },
148ecd5b431SDavid Matlack 	{ MASK(32), EXI_CONTROLS },
149ecd5b431SDavid Matlack 	{ MASK(32), EXI_MSR_ST_CNT },
150ecd5b431SDavid Matlack 	{ MASK(32), EXI_MSR_LD_CNT },
151ecd5b431SDavid Matlack 	{ MASK(32), ENT_CONTROLS },
152ecd5b431SDavid Matlack 	{ MASK(32), ENT_MSR_LD_CNT },
153ecd5b431SDavid Matlack 	{ MASK(32), ENT_INTR_INFO },
154ecd5b431SDavid Matlack 	{ MASK(32), ENT_INTR_ERROR },
155ecd5b431SDavid Matlack 	{ MASK(32), ENT_INST_LEN },
156ecd5b431SDavid Matlack 	{ MASK(32), TPR_THRESHOLD },
157ecd5b431SDavid Matlack 	{ MASK(32), CPU_EXEC_CTRL1 },
158ecd5b431SDavid Matlack 
159faea4fc6SLiran Alon 	{ MASK(32), VMX_INST_ERROR },
160faea4fc6SLiran Alon 	{ MASK(32), EXI_REASON },
161faea4fc6SLiran Alon 	{ MASK(32), EXI_INTR_INFO },
162faea4fc6SLiran Alon 	{ MASK(32), EXI_INTR_ERROR },
163faea4fc6SLiran Alon 	{ MASK(32), IDT_VECT_INFO },
164faea4fc6SLiran Alon 	{ MASK(32), IDT_VECT_ERROR },
165faea4fc6SLiran Alon 	{ MASK(32), EXI_INST_LEN },
166faea4fc6SLiran Alon 	{ MASK(32), EXI_INST_INFO },
167ecd5b431SDavid Matlack 
168ecd5b431SDavid Matlack 	{ MASK(32), GUEST_LIMIT_ES },
169ecd5b431SDavid Matlack 	{ MASK(32), GUEST_LIMIT_CS },
170ecd5b431SDavid Matlack 	{ MASK(32), GUEST_LIMIT_SS },
171ecd5b431SDavid Matlack 	{ MASK(32), GUEST_LIMIT_DS },
172ecd5b431SDavid Matlack 	{ MASK(32), GUEST_LIMIT_FS },
173ecd5b431SDavid Matlack 	{ MASK(32), GUEST_LIMIT_GS },
174ecd5b431SDavid Matlack 	{ MASK(32), GUEST_LIMIT_LDTR },
175ecd5b431SDavid Matlack 	{ MASK(32), GUEST_LIMIT_TR },
176ecd5b431SDavid Matlack 	{ MASK(32), GUEST_LIMIT_GDTR },
177ecd5b431SDavid Matlack 	{ MASK(32), GUEST_LIMIT_IDTR },
178ecd5b431SDavid Matlack 	{ 0x1d0ff, GUEST_AR_ES },
179ecd5b431SDavid Matlack 	{ 0x1f0ff, GUEST_AR_CS },
180ecd5b431SDavid Matlack 	{ 0x1d0ff, GUEST_AR_SS },
181ecd5b431SDavid Matlack 	{ 0x1d0ff, GUEST_AR_DS },
182ecd5b431SDavid Matlack 	{ 0x1d0ff, GUEST_AR_FS },
183ecd5b431SDavid Matlack 	{ 0x1d0ff, GUEST_AR_GS },
184ecd5b431SDavid Matlack 	{ 0x1d0ff, GUEST_AR_LDTR },
185ecd5b431SDavid Matlack 	{ 0x1d0ff, GUEST_AR_TR },
186ecd5b431SDavid Matlack 	{ MASK(32), GUEST_INTR_STATE },
187ecd5b431SDavid Matlack 	{ MASK(32), GUEST_ACTV_STATE },
188ecd5b431SDavid Matlack 	{ MASK(32), GUEST_SMBASE },
189ecd5b431SDavid Matlack 	{ MASK(32), GUEST_SYSENTER_CS },
190ecd5b431SDavid Matlack 	{ MASK(32), PREEMPT_TIMER_VALUE },
191ecd5b431SDavid Matlack 
192ecd5b431SDavid Matlack 	{ MASK(32), HOST_SYSENTER_CS },
193ecd5b431SDavid Matlack 
194ecd5b431SDavid Matlack 	{ MASK_NATURAL, CR0_MASK },
195ecd5b431SDavid Matlack 	{ MASK_NATURAL, CR4_MASK },
196ecd5b431SDavid Matlack 	{ MASK_NATURAL, CR0_READ_SHADOW },
197ecd5b431SDavid Matlack 	{ MASK_NATURAL, CR4_READ_SHADOW },
198ecd5b431SDavid Matlack 	{ MASK_NATURAL, CR3_TARGET_0 },
199ecd5b431SDavid Matlack 	{ MASK_NATURAL, CR3_TARGET_1 },
200ecd5b431SDavid Matlack 	{ MASK_NATURAL, CR3_TARGET_2 },
201ecd5b431SDavid Matlack 	{ MASK_NATURAL, CR3_TARGET_3 },
202ecd5b431SDavid Matlack 
203faea4fc6SLiran Alon 	{ MASK_NATURAL, EXI_QUALIFICATION },
204faea4fc6SLiran Alon 	{ MASK_NATURAL, IO_RCX },
205faea4fc6SLiran Alon 	{ MASK_NATURAL, IO_RSI },
206faea4fc6SLiran Alon 	{ MASK_NATURAL, IO_RDI },
207faea4fc6SLiran Alon 	{ MASK_NATURAL, IO_RIP },
208faea4fc6SLiran Alon 	{ MASK_NATURAL, GUEST_LINEAR_ADDRESS },
209ecd5b431SDavid Matlack 
210ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_CR0 },
211ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_CR3 },
212ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_CR4 },
213ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_BASE_ES },
214ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_BASE_CS },
215ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_BASE_SS },
216ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_BASE_DS },
217ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_BASE_FS },
218ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_BASE_GS },
219ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_BASE_LDTR },
220ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_BASE_TR },
221ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_BASE_GDTR },
222ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_BASE_IDTR },
223ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_DR7 },
224ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_RSP },
225ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_RIP },
226ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_RFLAGS },
227ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_PENDING_DEBUG },
228ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_SYSENTER_ESP },
229ecd5b431SDavid Matlack 	{ MASK_NATURAL, GUEST_SYSENTER_EIP },
230ecd5b431SDavid Matlack 
231ecd5b431SDavid Matlack 	{ MASK_NATURAL, HOST_CR0 },
232ecd5b431SDavid Matlack 	{ MASK_NATURAL, HOST_CR3 },
233ecd5b431SDavid Matlack 	{ MASK_NATURAL, HOST_CR4 },
234ecd5b431SDavid Matlack 	{ MASK_NATURAL, HOST_BASE_FS },
235ecd5b431SDavid Matlack 	{ MASK_NATURAL, HOST_BASE_GS },
236ecd5b431SDavid Matlack 	{ MASK_NATURAL, HOST_BASE_TR },
237ecd5b431SDavid Matlack 	{ MASK_NATURAL, HOST_BASE_GDTR },
238ecd5b431SDavid Matlack 	{ MASK_NATURAL, HOST_BASE_IDTR },
239ecd5b431SDavid Matlack 	{ MASK_NATURAL, HOST_SYSENTER_ESP },
240ecd5b431SDavid Matlack 	{ MASK_NATURAL, HOST_SYSENTER_EIP },
241ecd5b431SDavid Matlack 	{ MASK_NATURAL, HOST_RSP },
242ecd5b431SDavid Matlack 	{ MASK_NATURAL, HOST_RIP },
243ecd5b431SDavid Matlack };
244ecd5b431SDavid Matlack 
245faea4fc6SLiran Alon enum vmcs_field_type {
246faea4fc6SLiran Alon 	VMCS_FIELD_TYPE_CONTROL = 0,
247faea4fc6SLiran Alon 	VMCS_FIELD_TYPE_READ_ONLY_DATA = 1,
248faea4fc6SLiran Alon 	VMCS_FIELD_TYPE_GUEST = 2,
249faea4fc6SLiran Alon 	VMCS_FIELD_TYPE_HOST = 3,
250faea4fc6SLiran Alon 	VMCS_FIELD_TYPES,
251faea4fc6SLiran Alon };
252faea4fc6SLiran Alon 
253faea4fc6SLiran Alon static inline int vmcs_field_type(struct vmcs_field *f)
254faea4fc6SLiran Alon {
255faea4fc6SLiran Alon 	return (f->encoding >> VMCS_FIELD_TYPE_SHIFT) & 0x3;
256faea4fc6SLiran Alon }
257faea4fc6SLiran Alon 
258faea4fc6SLiran Alon static int vmcs_field_readonly(struct vmcs_field *f)
259faea4fc6SLiran Alon {
260faea4fc6SLiran Alon 	u64 ia32_vmx_misc;
261faea4fc6SLiran Alon 
262faea4fc6SLiran Alon 	ia32_vmx_misc = rdmsr(MSR_IA32_VMX_MISC);
263faea4fc6SLiran Alon 	return !(ia32_vmx_misc & MSR_IA32_VMX_MISC_VMWRITE_SHADOW_RO_FIELDS) &&
264faea4fc6SLiran Alon 		(vmcs_field_type(f) == VMCS_FIELD_TYPE_READ_ONLY_DATA);
265faea4fc6SLiran Alon }
266faea4fc6SLiran Alon 
267ecd5b431SDavid Matlack static inline u64 vmcs_field_value(struct vmcs_field *f, u8 cookie)
268ecd5b431SDavid Matlack {
269ecd5b431SDavid Matlack 	u64 value;
270ecd5b431SDavid Matlack 
271ecd5b431SDavid Matlack 	/* Incorporate the cookie and the field encoding into the value. */
272ecd5b431SDavid Matlack 	value = cookie;
273ecd5b431SDavid Matlack 	value |= (f->encoding << 8);
274ecd5b431SDavid Matlack 	value |= 0xdeadbeefull << 32;
275ecd5b431SDavid Matlack 
276ecd5b431SDavid Matlack 	return value & f->mask;
277ecd5b431SDavid Matlack }
278ecd5b431SDavid Matlack 
279ecd5b431SDavid Matlack static void set_vmcs_field(struct vmcs_field *f, u8 cookie)
280ecd5b431SDavid Matlack {
281ecd5b431SDavid Matlack 	vmcs_write(f->encoding, vmcs_field_value(f, cookie));
282ecd5b431SDavid Matlack }
283ecd5b431SDavid Matlack 
28485cd1cf9SSean Christopherson static bool check_vmcs_field(struct vmcs_field *f, u8 cookie, u32 *max_index)
285ecd5b431SDavid Matlack {
286ecd5b431SDavid Matlack 	u64 expected;
287ecd5b431SDavid Matlack 	u64 actual;
28885cd1cf9SSean Christopherson 	u32 index;
289ecd5b431SDavid Matlack 	int ret;
290ecd5b431SDavid Matlack 
291faea4fc6SLiran Alon 	if (f->encoding == VMX_INST_ERROR) {
292faea4fc6SLiran Alon 		printf("Skipping volatile field %lx\n", f->encoding);
293faea4fc6SLiran Alon 		return true;
294faea4fc6SLiran Alon 	}
295faea4fc6SLiran Alon 
296ecd5b431SDavid Matlack 	ret = vmcs_read_checking(f->encoding, &actual);
297ecd5b431SDavid Matlack 	assert(!(ret & X86_EFLAGS_CF));
298ecd5b431SDavid Matlack 	/* Skip VMCS fields that aren't recognized by the CPU */
299ecd5b431SDavid Matlack 	if (ret & X86_EFLAGS_ZF)
300ecd5b431SDavid Matlack 		return true;
301ecd5b431SDavid Matlack 
30285cd1cf9SSean Christopherson 	if (max_index) {
30385cd1cf9SSean Christopherson 		index = f->encoding & VMCS_FIELD_INDEX_MASK;
30485cd1cf9SSean Christopherson 		if (index > *max_index)
30585cd1cf9SSean Christopherson 			*max_index = index;
30685cd1cf9SSean Christopherson 	}
30785cd1cf9SSean Christopherson 
30885cd1cf9SSean Christopherson 	if (vmcs_field_readonly(f)) {
30985cd1cf9SSean Christopherson 		printf("Skipping read-only field %lx\n", f->encoding);
31085cd1cf9SSean Christopherson 		return true;
31185cd1cf9SSean Christopherson 	}
31285cd1cf9SSean Christopherson 
313ecd5b431SDavid Matlack 	expected = vmcs_field_value(f, cookie);
314ecd5b431SDavid Matlack 	actual &= f->mask;
315ecd5b431SDavid Matlack 
316ecd5b431SDavid Matlack 	if (expected == actual)
317ecd5b431SDavid Matlack 		return true;
318ecd5b431SDavid Matlack 
319d4ab68adSDavid Matlack 	printf("FAIL: VMWRITE/VMREAD %lx (expected: %lx, actual: %lx)\n",
320ecd5b431SDavid Matlack 	       f->encoding, (unsigned long) expected, (unsigned long) actual);
321ecd5b431SDavid Matlack 
322ecd5b431SDavid Matlack 	return false;
323ecd5b431SDavid Matlack }
324ecd5b431SDavid Matlack 
325ecd5b431SDavid Matlack static void set_all_vmcs_fields(u8 cookie)
326ecd5b431SDavid Matlack {
327ecd5b431SDavid Matlack 	int i;
328ecd5b431SDavid Matlack 
329ecd5b431SDavid Matlack 	for (i = 0; i < ARRAY_SIZE(vmcs_fields); i++)
330ecd5b431SDavid Matlack 		set_vmcs_field(&vmcs_fields[i], cookie);
331ecd5b431SDavid Matlack }
332ecd5b431SDavid Matlack 
33385cd1cf9SSean Christopherson static bool __check_all_vmcs_fields(u8 cookie, u32 *max_index)
334ecd5b431SDavid Matlack {
335ecd5b431SDavid Matlack 	bool pass = true;
336ecd5b431SDavid Matlack 	int i;
337ecd5b431SDavid Matlack 
338ecd5b431SDavid Matlack 	for (i = 0; i < ARRAY_SIZE(vmcs_fields); i++) {
33985cd1cf9SSean Christopherson 		if (!check_vmcs_field(&vmcs_fields[i], cookie, max_index))
340ecd5b431SDavid Matlack 			pass = false;
341ecd5b431SDavid Matlack 	}
342ecd5b431SDavid Matlack 
343ecd5b431SDavid Matlack 	return pass;
344ecd5b431SDavid Matlack }
345ecd5b431SDavid Matlack 
34685cd1cf9SSean Christopherson static bool check_all_vmcs_fields(u8 cookie)
34785cd1cf9SSean Christopherson {
34885cd1cf9SSean Christopherson 	return __check_all_vmcs_fields(cookie, NULL);
34985cd1cf9SSean Christopherson }
35085cd1cf9SSean Christopherson 
351b29804b8SThomas Huth static void test_vmwrite_vmread(void)
352ecd5b431SDavid Matlack {
353ecd5b431SDavid Matlack 	struct vmcs *vmcs = alloc_page();
35485cd1cf9SSean Christopherson 	u32 vmcs_enum_max, max_index = 0;
355ecd5b431SDavid Matlack 
3566c0ba6e7SLiran Alon 	vmcs->hdr.revision_id = basic.revision;
357ecd5b431SDavid Matlack 	assert(!vmcs_clear(vmcs));
358ecd5b431SDavid Matlack 	assert(!make_vmcs_current(vmcs));
359ecd5b431SDavid Matlack 
360ecd5b431SDavid Matlack 	set_all_vmcs_fields(0x42);
361*a299895bSThomas Huth 	report(__check_all_vmcs_fields(0x42, &max_index), "VMWRITE/VMREAD");
36285cd1cf9SSean Christopherson 
36385cd1cf9SSean Christopherson 	vmcs_enum_max = rdmsr(MSR_IA32_VMX_VMCS_ENUM) & VMCS_FIELD_INDEX_MASK;
364*a299895bSThomas Huth 	report(vmcs_enum_max >= max_index,
365*a299895bSThomas Huth 	       "VMX_VMCS_ENUM.MAX_INDEX expected at least: %x, actual: %x",
366*a299895bSThomas Huth 	       max_index, vmcs_enum_max);
367ecd5b431SDavid Matlack 
368ecd5b431SDavid Matlack 	assert(!vmcs_clear(vmcs));
369ecd5b431SDavid Matlack 	free_page(vmcs);
370ecd5b431SDavid Matlack }
371ecd5b431SDavid Matlack 
372b29804b8SThomas Huth static void test_vmcs_high(void)
37359161cfaSJim Mattson {
37459161cfaSJim Mattson 	struct vmcs *vmcs = alloc_page();
37559161cfaSJim Mattson 
3766c0ba6e7SLiran Alon 	vmcs->hdr.revision_id = basic.revision;
37759161cfaSJim Mattson 	assert(!vmcs_clear(vmcs));
37859161cfaSJim Mattson 	assert(!make_vmcs_current(vmcs));
37959161cfaSJim Mattson 
38059161cfaSJim Mattson 	vmcs_write(TSC_OFFSET, 0x0123456789ABCDEFull);
381*a299895bSThomas Huth 	report(vmcs_read(TSC_OFFSET) == 0x0123456789ABCDEFull,
382*a299895bSThomas Huth 	       "VMREAD TSC_OFFSET after VMWRITE TSC_OFFSET");
383*a299895bSThomas Huth 	report(vmcs_read(TSC_OFFSET_HI) == 0x01234567ull,
384*a299895bSThomas Huth 	       "VMREAD TSC_OFFSET_HI after VMWRITE TSC_OFFSET");
38559161cfaSJim Mattson 	vmcs_write(TSC_OFFSET_HI, 0x76543210ul);
386*a299895bSThomas Huth 	report(vmcs_read(TSC_OFFSET_HI) == 0x76543210ul,
387*a299895bSThomas Huth 	       "VMREAD TSC_OFFSET_HI after VMWRITE TSC_OFFSET_HI");
388*a299895bSThomas Huth 	report(vmcs_read(TSC_OFFSET) == 0x7654321089ABCDEFull,
389*a299895bSThomas Huth 	       "VMREAD TSC_OFFSET after VMWRITE TSC_OFFSET_HI");
39059161cfaSJim Mattson 
39159161cfaSJim Mattson 	assert(!vmcs_clear(vmcs));
39259161cfaSJim Mattson 	free_page(vmcs);
39359161cfaSJim Mattson }
39459161cfaSJim Mattson 
395b29804b8SThomas Huth static void test_vmcs_lifecycle(void)
3966b72cf76SDavid Matlack {
3976b72cf76SDavid Matlack 	struct vmcs *vmcs[2] = {};
3986b72cf76SDavid Matlack 	int i;
3996b72cf76SDavid Matlack 
4006b72cf76SDavid Matlack 	for (i = 0; i < ARRAY_SIZE(vmcs); i++) {
4016b72cf76SDavid Matlack 		vmcs[i] = alloc_page();
4026c0ba6e7SLiran Alon 		vmcs[i]->hdr.revision_id = basic.revision;
4036b72cf76SDavid Matlack 	}
4046b72cf76SDavid Matlack 
4056b72cf76SDavid Matlack #define VMPTRLD(_i) do { \
4066b72cf76SDavid Matlack 	assert(_i < ARRAY_SIZE(vmcs)); \
4076b72cf76SDavid Matlack 	assert(!make_vmcs_current(vmcs[_i])); \
4086b72cf76SDavid Matlack 	printf("VMPTRLD VMCS%d\n", (_i)); \
4096b72cf76SDavid Matlack } while (0)
4106b72cf76SDavid Matlack 
4116b72cf76SDavid Matlack #define VMCLEAR(_i) do { \
4126b72cf76SDavid Matlack 	assert(_i < ARRAY_SIZE(vmcs)); \
4136b72cf76SDavid Matlack 	assert(!vmcs_clear(vmcs[_i])); \
4146b72cf76SDavid Matlack 	printf("VMCLEAR VMCS%d\n", (_i)); \
4156b72cf76SDavid Matlack } while (0)
4166b72cf76SDavid Matlack 
4176b72cf76SDavid Matlack 	VMCLEAR(0);
4186b72cf76SDavid Matlack 	VMPTRLD(0);
4196b72cf76SDavid Matlack 	set_all_vmcs_fields(0);
420*a299895bSThomas Huth 	report(check_all_vmcs_fields(0), "current:VMCS0 active:[VMCS0]");
4216b72cf76SDavid Matlack 
4226b72cf76SDavid Matlack 	VMCLEAR(0);
4236b72cf76SDavid Matlack 	VMPTRLD(0);
424*a299895bSThomas Huth 	report(check_all_vmcs_fields(0), "current:VMCS0 active:[VMCS0]");
4256b72cf76SDavid Matlack 
4266b72cf76SDavid Matlack 	VMCLEAR(1);
427*a299895bSThomas Huth 	report(check_all_vmcs_fields(0), "current:VMCS0 active:[VMCS0]");
4286b72cf76SDavid Matlack 
4296b72cf76SDavid Matlack 	VMPTRLD(1);
4306b72cf76SDavid Matlack 	set_all_vmcs_fields(1);
431*a299895bSThomas Huth 	report(check_all_vmcs_fields(1), "current:VMCS1 active:[VMCS0,VCMS1]");
4326b72cf76SDavid Matlack 
4336b72cf76SDavid Matlack 	VMPTRLD(0);
434*a299895bSThomas Huth 	report(check_all_vmcs_fields(0), "current:VMCS0 active:[VMCS0,VCMS1]");
4356b72cf76SDavid Matlack 	VMPTRLD(1);
436*a299895bSThomas Huth 	report(check_all_vmcs_fields(1), "current:VMCS1 active:[VMCS0,VCMS1]");
4376b72cf76SDavid Matlack 	VMPTRLD(1);
438*a299895bSThomas Huth 	report(check_all_vmcs_fields(1), "current:VMCS1 active:[VMCS0,VCMS1]");
4396b72cf76SDavid Matlack 
4406b72cf76SDavid Matlack 	VMCLEAR(0);
441*a299895bSThomas Huth 	report(check_all_vmcs_fields(1), "current:VMCS1 active:[VCMS1]");
4426b72cf76SDavid Matlack 
443d4ab68adSDavid Matlack 	/* VMPTRLD should not erase VMWRITEs to the current VMCS */
444d4ab68adSDavid Matlack 	set_all_vmcs_fields(2);
445d4ab68adSDavid Matlack 	VMPTRLD(1);
446*a299895bSThomas Huth 	report(check_all_vmcs_fields(2), "current:VMCS1 active:[VCMS1]");
447d4ab68adSDavid Matlack 
4486b72cf76SDavid Matlack 	for (i = 0; i < ARRAY_SIZE(vmcs); i++) {
4496b72cf76SDavid Matlack 		VMCLEAR(i);
4506b72cf76SDavid Matlack 		free_page(vmcs[i]);
4516b72cf76SDavid Matlack 	}
4526b72cf76SDavid Matlack 
4536b72cf76SDavid Matlack #undef VMPTRLD
4546b72cf76SDavid Matlack #undef VMCLEAR
4556b72cf76SDavid Matlack }
4566b72cf76SDavid Matlack 
457ffb1a9e0SJan Kiszka void vmx_set_test_stage(u32 s)
458ffb1a9e0SJan Kiszka {
459ffb1a9e0SJan Kiszka 	barrier();
460ffb1a9e0SJan Kiszka 	stage = s;
461ffb1a9e0SJan Kiszka 	barrier();
462ffb1a9e0SJan Kiszka }
463ffb1a9e0SJan Kiszka 
464ffb1a9e0SJan Kiszka u32 vmx_get_test_stage(void)
465ffb1a9e0SJan Kiszka {
466ffb1a9e0SJan Kiszka 	u32 s;
467ffb1a9e0SJan Kiszka 
468ffb1a9e0SJan Kiszka 	barrier();
469ffb1a9e0SJan Kiszka 	s = stage;
470ffb1a9e0SJan Kiszka 	barrier();
471ffb1a9e0SJan Kiszka 	return s;
472ffb1a9e0SJan Kiszka }
473ffb1a9e0SJan Kiszka 
474ffb1a9e0SJan Kiszka void vmx_inc_test_stage(void)
475ffb1a9e0SJan Kiszka {
476ffb1a9e0SJan Kiszka 	barrier();
477ffb1a9e0SJan Kiszka 	stage++;
478ffb1a9e0SJan Kiszka 	barrier();
479ffb1a9e0SJan Kiszka }
480ffb1a9e0SJan Kiszka 
4819d7eaa29SArthur Chunqi Li /* entry_sysenter */
4829d7eaa29SArthur Chunqi Li asm(
4839d7eaa29SArthur Chunqi Li 	".align	4, 0x90\n\t"
4849d7eaa29SArthur Chunqi Li 	".globl	entry_sysenter\n\t"
4859d7eaa29SArthur Chunqi Li 	"entry_sysenter:\n\t"
4869d7eaa29SArthur Chunqi Li 	SAVE_GPR
4879d7eaa29SArthur Chunqi Li 	"	and	$0xf, %rax\n\t"
4889d7eaa29SArthur Chunqi Li 	"	mov	%rax, %rdi\n\t"
4899d7eaa29SArthur Chunqi Li 	"	call	syscall_handler\n\t"
4909d7eaa29SArthur Chunqi Li 	LOAD_GPR
4919d7eaa29SArthur Chunqi Li 	"	vmresume\n\t"
4929d7eaa29SArthur Chunqi Li );
4939d7eaa29SArthur Chunqi Li 
4949d7eaa29SArthur Chunqi Li static void __attribute__((__used__)) syscall_handler(u64 syscall_no)
4959d7eaa29SArthur Chunqi Li {
496d5315e3dSJan Kiszka 	if (current->syscall_handler)
4979d7eaa29SArthur Chunqi Li 		current->syscall_handler(syscall_no);
4989d7eaa29SArthur Chunqi Li }
4999d7eaa29SArthur Chunqi Li 
5007e207ec1SPeter Feiner static const char * const exit_reason_descriptions[] = {
5017e207ec1SPeter Feiner 	[VMX_EXC_NMI]		= "VMX_EXC_NMI",
5027e207ec1SPeter Feiner 	[VMX_EXTINT]		= "VMX_EXTINT",
5037e207ec1SPeter Feiner 	[VMX_TRIPLE_FAULT]	= "VMX_TRIPLE_FAULT",
5047e207ec1SPeter Feiner 	[VMX_INIT]		= "VMX_INIT",
5057e207ec1SPeter Feiner 	[VMX_SIPI]		= "VMX_SIPI",
5067e207ec1SPeter Feiner 	[VMX_SMI_IO]		= "VMX_SMI_IO",
5077e207ec1SPeter Feiner 	[VMX_SMI_OTHER]		= "VMX_SMI_OTHER",
5087e207ec1SPeter Feiner 	[VMX_INTR_WINDOW]	= "VMX_INTR_WINDOW",
5097e207ec1SPeter Feiner 	[VMX_NMI_WINDOW]	= "VMX_NMI_WINDOW",
5107e207ec1SPeter Feiner 	[VMX_TASK_SWITCH]	= "VMX_TASK_SWITCH",
5117e207ec1SPeter Feiner 	[VMX_CPUID]		= "VMX_CPUID",
5127e207ec1SPeter Feiner 	[VMX_GETSEC]		= "VMX_GETSEC",
5137e207ec1SPeter Feiner 	[VMX_HLT]		= "VMX_HLT",
5147e207ec1SPeter Feiner 	[VMX_INVD]		= "VMX_INVD",
5157e207ec1SPeter Feiner 	[VMX_INVLPG]		= "VMX_INVLPG",
5167e207ec1SPeter Feiner 	[VMX_RDPMC]		= "VMX_RDPMC",
5177e207ec1SPeter Feiner 	[VMX_RDTSC]		= "VMX_RDTSC",
5187e207ec1SPeter Feiner 	[VMX_RSM]		= "VMX_RSM",
5197e207ec1SPeter Feiner 	[VMX_VMCALL]		= "VMX_VMCALL",
5207e207ec1SPeter Feiner 	[VMX_VMCLEAR]		= "VMX_VMCLEAR",
5217e207ec1SPeter Feiner 	[VMX_VMLAUNCH]		= "VMX_VMLAUNCH",
5227e207ec1SPeter Feiner 	[VMX_VMPTRLD]		= "VMX_VMPTRLD",
5237e207ec1SPeter Feiner 	[VMX_VMPTRST]		= "VMX_VMPTRST",
5247e207ec1SPeter Feiner 	[VMX_VMREAD]		= "VMX_VMREAD",
5257e207ec1SPeter Feiner 	[VMX_VMRESUME]		= "VMX_VMRESUME",
5267e207ec1SPeter Feiner 	[VMX_VMWRITE]		= "VMX_VMWRITE",
5277e207ec1SPeter Feiner 	[VMX_VMXOFF]		= "VMX_VMXOFF",
5287e207ec1SPeter Feiner 	[VMX_VMXON]		= "VMX_VMXON",
5297e207ec1SPeter Feiner 	[VMX_CR]		= "VMX_CR",
5307e207ec1SPeter Feiner 	[VMX_DR]		= "VMX_DR",
5317e207ec1SPeter Feiner 	[VMX_IO]		= "VMX_IO",
5327e207ec1SPeter Feiner 	[VMX_RDMSR]		= "VMX_RDMSR",
5337e207ec1SPeter Feiner 	[VMX_WRMSR]		= "VMX_WRMSR",
5347e207ec1SPeter Feiner 	[VMX_FAIL_STATE]	= "VMX_FAIL_STATE",
5357e207ec1SPeter Feiner 	[VMX_FAIL_MSR]		= "VMX_FAIL_MSR",
5367e207ec1SPeter Feiner 	[VMX_MWAIT]		= "VMX_MWAIT",
5377e207ec1SPeter Feiner 	[VMX_MTF]		= "VMX_MTF",
5387e207ec1SPeter Feiner 	[VMX_MONITOR]		= "VMX_MONITOR",
5397e207ec1SPeter Feiner 	[VMX_PAUSE]		= "VMX_PAUSE",
5407e207ec1SPeter Feiner 	[VMX_FAIL_MCHECK]	= "VMX_FAIL_MCHECK",
5417e207ec1SPeter Feiner 	[VMX_TPR_THRESHOLD]	= "VMX_TPR_THRESHOLD",
5427e207ec1SPeter Feiner 	[VMX_APIC_ACCESS]	= "VMX_APIC_ACCESS",
54367fdc49eSArbel Moshe 	[VMX_EOI_INDUCED]	= "VMX_EOI_INDUCED",
5447e207ec1SPeter Feiner 	[VMX_GDTR_IDTR]		= "VMX_GDTR_IDTR",
5457e207ec1SPeter Feiner 	[VMX_LDTR_TR]		= "VMX_LDTR_TR",
5467e207ec1SPeter Feiner 	[VMX_EPT_VIOLATION]	= "VMX_EPT_VIOLATION",
5477e207ec1SPeter Feiner 	[VMX_EPT_MISCONFIG]	= "VMX_EPT_MISCONFIG",
5487e207ec1SPeter Feiner 	[VMX_INVEPT]		= "VMX_INVEPT",
5497e207ec1SPeter Feiner 	[VMX_PREEMPT]		= "VMX_PREEMPT",
5507e207ec1SPeter Feiner 	[VMX_INVVPID]		= "VMX_INVVPID",
5517e207ec1SPeter Feiner 	[VMX_WBINVD]		= "VMX_WBINVD",
5527e207ec1SPeter Feiner 	[VMX_XSETBV]		= "VMX_XSETBV",
5537e207ec1SPeter Feiner 	[VMX_APIC_WRITE]	= "VMX_APIC_WRITE",
5547e207ec1SPeter Feiner 	[VMX_RDRAND]		= "VMX_RDRAND",
5557e207ec1SPeter Feiner 	[VMX_INVPCID]		= "VMX_INVPCID",
5567e207ec1SPeter Feiner 	[VMX_VMFUNC]		= "VMX_VMFUNC",
5577e207ec1SPeter Feiner 	[VMX_RDSEED]		= "VMX_RDSEED",
5587e207ec1SPeter Feiner 	[VMX_PML_FULL]		= "VMX_PML_FULL",
5597e207ec1SPeter Feiner 	[VMX_XSAVES]		= "VMX_XSAVES",
5607e207ec1SPeter Feiner 	[VMX_XRSTORS]		= "VMX_XRSTORS",
5617e207ec1SPeter Feiner };
5627e207ec1SPeter Feiner 
5637e207ec1SPeter Feiner const char *exit_reason_description(u64 reason)
5647e207ec1SPeter Feiner {
5657e207ec1SPeter Feiner 	if (reason >= ARRAY_SIZE(exit_reason_descriptions))
5667e207ec1SPeter Feiner 		return "(unknown)";
5677e207ec1SPeter Feiner 	return exit_reason_descriptions[reason] ? : "(unused)";
5687e207ec1SPeter Feiner }
5697e207ec1SPeter Feiner 
5703ee34093SArthur Chunqi Li void print_vmexit_info()
5719d7eaa29SArthur Chunqi Li {
5729d7eaa29SArthur Chunqi Li 	u64 guest_rip, guest_rsp;
5739d7eaa29SArthur Chunqi Li 	ulong reason = vmcs_read(EXI_REASON) & 0xff;
5749d7eaa29SArthur Chunqi Li 	ulong exit_qual = vmcs_read(EXI_QUALIFICATION);
5759d7eaa29SArthur Chunqi Li 	guest_rip = vmcs_read(GUEST_RIP);
5769d7eaa29SArthur Chunqi Li 	guest_rsp = vmcs_read(GUEST_RSP);
5779d7eaa29SArthur Chunqi Li 	printf("VMEXIT info:\n");
578b006d7ebSAndrew Jones 	printf("\tvmexit reason = %ld\n", reason);
579fd6aada0SRadim Krčmář 	printf("\texit qualification = %#lx\n", exit_qual);
580b006d7ebSAndrew Jones 	printf("\tBit 31 of reason = %lx\n", (vmcs_read(EXI_REASON) >> 31) & 1);
581fd6aada0SRadim Krčmář 	printf("\tguest_rip = %#lx\n", guest_rip);
582fd6aada0SRadim Krčmář 	printf("\tRAX=%#lx    RBX=%#lx    RCX=%#lx    RDX=%#lx\n",
5839d7eaa29SArthur Chunqi Li 		regs.rax, regs.rbx, regs.rcx, regs.rdx);
584fd6aada0SRadim Krčmář 	printf("\tRSP=%#lx    RBP=%#lx    RSI=%#lx    RDI=%#lx\n",
5859d7eaa29SArthur Chunqi Li 		guest_rsp, regs.rbp, regs.rsi, regs.rdi);
586fd6aada0SRadim Krčmář 	printf("\tR8 =%#lx    R9 =%#lx    R10=%#lx    R11=%#lx\n",
5879d7eaa29SArthur Chunqi Li 		regs.r8, regs.r9, regs.r10, regs.r11);
588fd6aada0SRadim Krčmář 	printf("\tR12=%#lx    R13=%#lx    R14=%#lx    R15=%#lx\n",
5899d7eaa29SArthur Chunqi Li 		regs.r12, regs.r13, regs.r14, regs.r15);
5909d7eaa29SArthur Chunqi Li }
5919d7eaa29SArthur Chunqi Li 
5923b50efe3SPeter Feiner void
5933b50efe3SPeter Feiner print_vmentry_failure_info(struct vmentry_failure *failure) {
5943b50efe3SPeter Feiner 	if (failure->early) {
5953b50efe3SPeter Feiner 		printf("Early %s failure: ", failure->instr);
5963b50efe3SPeter Feiner 		switch (failure->flags & VMX_ENTRY_FLAGS) {
597ce154ba8SPaolo Bonzini 		case X86_EFLAGS_CF:
5983b50efe3SPeter Feiner 			printf("current-VMCS pointer is not valid.\n");
5993b50efe3SPeter Feiner 			break;
600ce154ba8SPaolo Bonzini 		case X86_EFLAGS_ZF:
6013b50efe3SPeter Feiner 			printf("error number is %ld. See Intel 30.4.\n",
6023b50efe3SPeter Feiner 			       vmcs_read(VMX_INST_ERROR));
6033b50efe3SPeter Feiner 			break;
6043b50efe3SPeter Feiner 		default:
6053b50efe3SPeter Feiner 			printf("unexpected flags %lx!\n", failure->flags);
6063b50efe3SPeter Feiner 		}
6073b50efe3SPeter Feiner 	} else {
6083b50efe3SPeter Feiner 		u64 reason = vmcs_read(EXI_REASON);
6093b50efe3SPeter Feiner 		u64 qual = vmcs_read(EXI_QUALIFICATION);
6103b50efe3SPeter Feiner 
611fd6aada0SRadim Krčmář 		printf("Non-early %s failure (reason=%#lx, qual=%#lx): ",
6123b50efe3SPeter Feiner 			failure->instr, reason, qual);
6133b50efe3SPeter Feiner 
6143b50efe3SPeter Feiner 		switch (reason & 0xff) {
6153b50efe3SPeter Feiner 		case VMX_FAIL_STATE:
6163b50efe3SPeter Feiner 			printf("invalid guest state\n");
6173b50efe3SPeter Feiner 			break;
6183b50efe3SPeter Feiner 		case VMX_FAIL_MSR:
6193b50efe3SPeter Feiner 			printf("MSR loading\n");
6203b50efe3SPeter Feiner 			break;
6213b50efe3SPeter Feiner 		case VMX_FAIL_MCHECK:
6223b50efe3SPeter Feiner 			printf("machine-check event\n");
6233b50efe3SPeter Feiner 			break;
6243b50efe3SPeter Feiner 		default:
6253b50efe3SPeter Feiner 			printf("unexpected basic exit reason %ld\n",
6263b50efe3SPeter Feiner 			       reason & 0xff);
6273b50efe3SPeter Feiner 		}
6283b50efe3SPeter Feiner 
6293b50efe3SPeter Feiner 		if (!(reason & VMX_ENTRY_FAILURE))
6303b50efe3SPeter Feiner 			printf("\tVMX_ENTRY_FAILURE BIT NOT SET!\n");
6313b50efe3SPeter Feiner 
6323b50efe3SPeter Feiner 		if (reason & 0x7fff0000)
6333b50efe3SPeter Feiner 			printf("\tRESERVED BITS SET!\n");
6343b50efe3SPeter Feiner 	}
6353b50efe3SPeter Feiner }
6363b50efe3SPeter Feiner 
6372f6828d7SDavid Matlack /*
6382f6828d7SDavid Matlack  * VMCLEAR should ensures all VMCS state is flushed to the VMCS
6392f6828d7SDavid Matlack  * region in memory.
6402f6828d7SDavid Matlack  */
6412f6828d7SDavid Matlack static void test_vmclear_flushing(void)
6422f6828d7SDavid Matlack {
6432f6828d7SDavid Matlack 	struct vmcs *vmcs[3] = {};
6442f6828d7SDavid Matlack 	int i;
6452f6828d7SDavid Matlack 
6462f6828d7SDavid Matlack 	for (i = 0; i < ARRAY_SIZE(vmcs); i++) {
6472f6828d7SDavid Matlack 		vmcs[i] = alloc_page();
6482f6828d7SDavid Matlack 	}
6492f6828d7SDavid Matlack 
6506c0ba6e7SLiran Alon 	vmcs[0]->hdr.revision_id = basic.revision;
6512f6828d7SDavid Matlack 	assert(!vmcs_clear(vmcs[0]));
6522f6828d7SDavid Matlack 	assert(!make_vmcs_current(vmcs[0]));
6532f6828d7SDavid Matlack 	set_all_vmcs_fields(0x86);
6542f6828d7SDavid Matlack 
6552f6828d7SDavid Matlack 	assert(!vmcs_clear(vmcs[0]));
6562f6828d7SDavid Matlack 	memcpy(vmcs[1], vmcs[0], basic.size);
6572f6828d7SDavid Matlack 	assert(!make_vmcs_current(vmcs[1]));
658*a299895bSThomas Huth 	report(check_all_vmcs_fields(0x86),
659*a299895bSThomas Huth 	       "test vmclear flush (current VMCS)");
6602f6828d7SDavid Matlack 
6612f6828d7SDavid Matlack 	set_all_vmcs_fields(0x87);
6622f6828d7SDavid Matlack 	assert(!make_vmcs_current(vmcs[0]));
6632f6828d7SDavid Matlack 	assert(!vmcs_clear(vmcs[1]));
6642f6828d7SDavid Matlack 	memcpy(vmcs[2], vmcs[1], basic.size);
6652f6828d7SDavid Matlack 	assert(!make_vmcs_current(vmcs[2]));
666*a299895bSThomas Huth 	report(check_all_vmcs_fields(0x87),
667*a299895bSThomas Huth 	       "test vmclear flush (!current VMCS)");
6682f6828d7SDavid Matlack 
6692f6828d7SDavid Matlack 	for (i = 0; i < ARRAY_SIZE(vmcs); i++) {
6702f6828d7SDavid Matlack 		assert(!vmcs_clear(vmcs[i]));
6712f6828d7SDavid Matlack 		free_page(vmcs[i]);
6722f6828d7SDavid Matlack 	}
6732f6828d7SDavid Matlack }
6743b50efe3SPeter Feiner 
6759d7eaa29SArthur Chunqi Li static void test_vmclear(void)
6769d7eaa29SArthur Chunqi Li {
677daeec979SBandan Das 	struct vmcs *tmp_root;
678e2cf1c9dSEduardo Habkost 	int width = cpuid_maxphyaddr();
679daeec979SBandan Das 
680daeec979SBandan Das 	/*
681daeec979SBandan Das 	 * Note- The tests below do not necessarily have a
682daeec979SBandan Das 	 * valid VMCS, but that's ok since the invalid vmcs
683daeec979SBandan Das 	 * is only used for a specific test and is discarded
684daeec979SBandan Das 	 * without touching its contents
685daeec979SBandan Das 	 */
686daeec979SBandan Das 
687daeec979SBandan Das 	/* Unaligned page access */
688daeec979SBandan Das 	tmp_root = (struct vmcs *)((intptr_t)vmcs_root + 1);
689*a299895bSThomas Huth 	report(vmcs_clear(tmp_root) == 1, "test vmclear with unaligned vmcs");
690daeec979SBandan Das 
691daeec979SBandan Das 	/* gpa bits beyond physical address width are set*/
692daeec979SBandan Das 	tmp_root = (struct vmcs *)((intptr_t)vmcs_root |
693daeec979SBandan Das 				   ((u64)1 << (width+1)));
694*a299895bSThomas Huth 	report(vmcs_clear(tmp_root) == 1,
695*a299895bSThomas Huth 	       "test vmclear with vmcs address bits set beyond physical address width");
696daeec979SBandan Das 
697daeec979SBandan Das 	/* Pass VMXON region */
698c937d495SLiran Alon 	tmp_root = (struct vmcs *)bsp_vmxon_region;
699*a299895bSThomas Huth 	report(vmcs_clear(tmp_root) == 1, "test vmclear with vmxon region");
700daeec979SBandan Das 
701daeec979SBandan Das 	/* Valid VMCS */
702*a299895bSThomas Huth 	report(vmcs_clear(vmcs_root) == 0,
703*a299895bSThomas Huth 	       "test vmclear with valid vmcs region");
704daeec979SBandan Das 
7052f6828d7SDavid Matlack 	test_vmclear_flushing();
7069d7eaa29SArthur Chunqi Li }
7079d7eaa29SArthur Chunqi Li 
7089d7eaa29SArthur Chunqi Li static void __attribute__((__used__)) guest_main(void)
7099d7eaa29SArthur Chunqi Li {
710794c67a9SPeter Feiner 	if (current->v2)
711794c67a9SPeter Feiner 		v2_guest_main();
712794c67a9SPeter Feiner 	else
7139d7eaa29SArthur Chunqi Li 		current->guest_main();
7149d7eaa29SArthur Chunqi Li }
7159d7eaa29SArthur Chunqi Li 
7169d7eaa29SArthur Chunqi Li /* guest_entry */
7179d7eaa29SArthur Chunqi Li asm(
7189d7eaa29SArthur Chunqi Li 	".align	4, 0x90\n\t"
7199d7eaa29SArthur Chunqi Li 	".globl	entry_guest\n\t"
7209d7eaa29SArthur Chunqi Li 	"guest_entry:\n\t"
7219d7eaa29SArthur Chunqi Li 	"	call guest_main\n\t"
7229d7eaa29SArthur Chunqi Li 	"	mov $1, %edi\n\t"
7239d7eaa29SArthur Chunqi Li 	"	call hypercall\n\t"
7249d7eaa29SArthur Chunqi Li );
7259d7eaa29SArthur Chunqi Li 
7266884af61SArthur Chunqi Li /* EPT paging structure related functions */
72769c531c8SPeter Feiner /* split_large_ept_entry: Split a 2M/1G large page into 512 smaller PTEs.
72869c531c8SPeter Feiner 		@ptep : large page table entry to split
72969c531c8SPeter Feiner 		@level : level of ptep (2 or 3)
73069c531c8SPeter Feiner  */
73169c531c8SPeter Feiner static void split_large_ept_entry(unsigned long *ptep, int level)
73269c531c8SPeter Feiner {
73369c531c8SPeter Feiner 	unsigned long *new_pt;
73469c531c8SPeter Feiner 	unsigned long gpa;
73569c531c8SPeter Feiner 	unsigned long pte;
73669c531c8SPeter Feiner 	unsigned long prototype;
73769c531c8SPeter Feiner 	int i;
73869c531c8SPeter Feiner 
73969c531c8SPeter Feiner 	pte = *ptep;
74069c531c8SPeter Feiner 	assert(pte & EPT_PRESENT);
74169c531c8SPeter Feiner 	assert(pte & EPT_LARGE_PAGE);
74269c531c8SPeter Feiner 	assert(level == 2 || level == 3);
74369c531c8SPeter Feiner 
74469c531c8SPeter Feiner 	new_pt = alloc_page();
74569c531c8SPeter Feiner 	assert(new_pt);
74669c531c8SPeter Feiner 
74769c531c8SPeter Feiner 	prototype = pte & ~EPT_ADDR_MASK;
74869c531c8SPeter Feiner 	if (level == 2)
74969c531c8SPeter Feiner 		prototype &= ~EPT_LARGE_PAGE;
75069c531c8SPeter Feiner 
75169c531c8SPeter Feiner 	gpa = pte & EPT_ADDR_MASK;
75269c531c8SPeter Feiner 	for (i = 0; i < EPT_PGDIR_ENTRIES; i++) {
75369c531c8SPeter Feiner 		new_pt[i] = prototype | gpa;
75469c531c8SPeter Feiner 		gpa += 1ul << EPT_LEVEL_SHIFT(level - 1);
75569c531c8SPeter Feiner 	}
75669c531c8SPeter Feiner 
75769c531c8SPeter Feiner 	pte &= ~EPT_LARGE_PAGE;
75869c531c8SPeter Feiner 	pte &= ~EPT_ADDR_MASK;
75969c531c8SPeter Feiner 	pte |= virt_to_phys(new_pt);
76069c531c8SPeter Feiner 
76169c531c8SPeter Feiner 	*ptep = pte;
76269c531c8SPeter Feiner }
76369c531c8SPeter Feiner 
7646884af61SArthur Chunqi Li /* install_ept_entry : Install a page to a given level in EPT
7656884af61SArthur Chunqi Li 		@pml4 : addr of pml4 table
7666884af61SArthur Chunqi Li 		@pte_level : level of PTE to set
7676884af61SArthur Chunqi Li 		@guest_addr : physical address of guest
7686884af61SArthur Chunqi Li 		@pte : pte value to set
7696884af61SArthur Chunqi Li 		@pt_page : address of page table, NULL for a new page
7706884af61SArthur Chunqi Li  */
7716884af61SArthur Chunqi Li void install_ept_entry(unsigned long *pml4,
7726884af61SArthur Chunqi Li 		int pte_level,
7736884af61SArthur Chunqi Li 		unsigned long guest_addr,
7746884af61SArthur Chunqi Li 		unsigned long pte,
7756884af61SArthur Chunqi Li 		unsigned long *pt_page)
7766884af61SArthur Chunqi Li {
7776884af61SArthur Chunqi Li 	int level;
7786884af61SArthur Chunqi Li 	unsigned long *pt = pml4;
7796884af61SArthur Chunqi Li 	unsigned offset;
7806884af61SArthur Chunqi Li 
781dff740c0SPeter Feiner 	/* EPT only uses 48 bits of GPA. */
782dff740c0SPeter Feiner 	assert(guest_addr < (1ul << 48));
783dff740c0SPeter Feiner 
7846884af61SArthur Chunqi Li 	for (level = EPT_PAGE_LEVEL; level > pte_level; --level) {
785a969e087SPeter Feiner 		offset = (guest_addr >> EPT_LEVEL_SHIFT(level))
7866884af61SArthur Chunqi Li 				& EPT_PGDIR_MASK;
7876884af61SArthur Chunqi Li 		if (!(pt[offset] & (EPT_PRESENT))) {
7886884af61SArthur Chunqi Li 			unsigned long *new_pt = pt_page;
7896884af61SArthur Chunqi Li 			if (!new_pt)
7906884af61SArthur Chunqi Li 				new_pt = alloc_page();
7916884af61SArthur Chunqi Li 			else
7926884af61SArthur Chunqi Li 				pt_page = 0;
7936884af61SArthur Chunqi Li 			memset(new_pt, 0, PAGE_SIZE);
7946884af61SArthur Chunqi Li 			pt[offset] = virt_to_phys(new_pt)
7956884af61SArthur Chunqi Li 					| EPT_RA | EPT_WA | EPT_EA;
79669c531c8SPeter Feiner 		} else if (pt[offset] & EPT_LARGE_PAGE)
79769c531c8SPeter Feiner 			split_large_ept_entry(&pt[offset], level);
79800b5c590SPeter Feiner 		pt = phys_to_virt(pt[offset] & EPT_ADDR_MASK);
7996884af61SArthur Chunqi Li 	}
800a969e087SPeter Feiner 	offset = (guest_addr >> EPT_LEVEL_SHIFT(level)) & EPT_PGDIR_MASK;
8016884af61SArthur Chunqi Li 	pt[offset] = pte;
8026884af61SArthur Chunqi Li }
8036884af61SArthur Chunqi Li 
8046884af61SArthur Chunqi Li /* Map a page, @perm is the permission of the page */
8056884af61SArthur Chunqi Li void install_ept(unsigned long *pml4,
8066884af61SArthur Chunqi Li 		unsigned long phys,
8076884af61SArthur Chunqi Li 		unsigned long guest_addr,
8086884af61SArthur Chunqi Li 		u64 perm)
8096884af61SArthur Chunqi Li {
8106884af61SArthur Chunqi Li 	install_ept_entry(pml4, 1, guest_addr, (phys & PAGE_MASK) | perm, 0);
8116884af61SArthur Chunqi Li }
8126884af61SArthur Chunqi Li 
8136884af61SArthur Chunqi Li /* Map a 1G-size page */
8146884af61SArthur Chunqi Li void install_1g_ept(unsigned long *pml4,
8156884af61SArthur Chunqi Li 		unsigned long phys,
8166884af61SArthur Chunqi Li 		unsigned long guest_addr,
8176884af61SArthur Chunqi Li 		u64 perm)
8186884af61SArthur Chunqi Li {
8196884af61SArthur Chunqi Li 	install_ept_entry(pml4, 3, guest_addr,
8206884af61SArthur Chunqi Li 			(phys & PAGE_MASK) | perm | EPT_LARGE_PAGE, 0);
8216884af61SArthur Chunqi Li }
8226884af61SArthur Chunqi Li 
8236884af61SArthur Chunqi Li /* Map a 2M-size page */
8246884af61SArthur Chunqi Li void install_2m_ept(unsigned long *pml4,
8256884af61SArthur Chunqi Li 		unsigned long phys,
8266884af61SArthur Chunqi Li 		unsigned long guest_addr,
8276884af61SArthur Chunqi Li 		u64 perm)
8286884af61SArthur Chunqi Li {
8296884af61SArthur Chunqi Li 	install_ept_entry(pml4, 2, guest_addr,
8306884af61SArthur Chunqi Li 			(phys & PAGE_MASK) | perm | EPT_LARGE_PAGE, 0);
8316884af61SArthur Chunqi Li }
8326884af61SArthur Chunqi Li 
8336884af61SArthur Chunqi Li /* setup_ept_range : Setup a range of 1:1 mapped page to EPT paging structure.
8346884af61SArthur Chunqi Li 		@start : start address of guest page
8356884af61SArthur Chunqi Li 		@len : length of address to be mapped
8366884af61SArthur Chunqi Li 		@map_1g : whether 1G page map is used
8376884af61SArthur Chunqi Li 		@map_2m : whether 2M page map is used
8386884af61SArthur Chunqi Li 		@perm : permission for every page
8396884af61SArthur Chunqi Li  */
840b947e241SJan Kiszka void setup_ept_range(unsigned long *pml4, unsigned long start,
8416884af61SArthur Chunqi Li 		     unsigned long len, int map_1g, int map_2m, u64 perm)
8426884af61SArthur Chunqi Li {
8436884af61SArthur Chunqi Li 	u64 phys = start;
8446884af61SArthur Chunqi Li 	u64 max = (u64)len + (u64)start;
8456884af61SArthur Chunqi Li 
8466884af61SArthur Chunqi Li 	if (map_1g) {
8476884af61SArthur Chunqi Li 		while (phys + PAGE_SIZE_1G <= max) {
8486884af61SArthur Chunqi Li 			install_1g_ept(pml4, phys, phys, perm);
8496884af61SArthur Chunqi Li 			phys += PAGE_SIZE_1G;
8506884af61SArthur Chunqi Li 		}
8516884af61SArthur Chunqi Li 	}
8526884af61SArthur Chunqi Li 	if (map_2m) {
8536884af61SArthur Chunqi Li 		while (phys + PAGE_SIZE_2M <= max) {
8546884af61SArthur Chunqi Li 			install_2m_ept(pml4, phys, phys, perm);
8556884af61SArthur Chunqi Li 			phys += PAGE_SIZE_2M;
8566884af61SArthur Chunqi Li 		}
8576884af61SArthur Chunqi Li 	}
8586884af61SArthur Chunqi Li 	while (phys + PAGE_SIZE <= max) {
8596884af61SArthur Chunqi Li 		install_ept(pml4, phys, phys, perm);
8606884af61SArthur Chunqi Li 		phys += PAGE_SIZE;
8616884af61SArthur Chunqi Li 	}
8626884af61SArthur Chunqi Li }
8636884af61SArthur Chunqi Li 
8646884af61SArthur Chunqi Li /* get_ept_pte : Get the PTE of a given level in EPT,
8656884af61SArthur Chunqi Li     @level == 1 means get the latest level*/
866b4a405c3SRadim Krčmář bool get_ept_pte(unsigned long *pml4, unsigned long guest_addr, int level,
867b4a405c3SRadim Krčmář 		unsigned long *pte)
8686884af61SArthur Chunqi Li {
8696884af61SArthur Chunqi Li 	int l;
870b4a405c3SRadim Krčmář 	unsigned long *pt = pml4, iter_pte;
8716884af61SArthur Chunqi Li 	unsigned offset;
8726884af61SArthur Chunqi Li 
873dff740c0SPeter Feiner 	assert(level >= 1 && level <= 4);
874dff740c0SPeter Feiner 
8752ca6f1f3SPaolo Bonzini 	for (l = EPT_PAGE_LEVEL; ; --l) {
876a969e087SPeter Feiner 		offset = (guest_addr >> EPT_LEVEL_SHIFT(l)) & EPT_PGDIR_MASK;
877b4a405c3SRadim Krčmář 		iter_pte = pt[offset];
8786884af61SArthur Chunqi Li 		if (l == level)
8792ca6f1f3SPaolo Bonzini 			break;
880b4a405c3SRadim Krčmář 		if (l < 4 && (iter_pte & EPT_LARGE_PAGE))
881b4a405c3SRadim Krčmář 			return false;
8828922f1fbSRadim Krčmář 		if (!(iter_pte & (EPT_PRESENT)))
8838922f1fbSRadim Krčmář 			return false;
884b4a405c3SRadim Krčmář 		pt = (unsigned long *)(iter_pte & EPT_ADDR_MASK);
8856884af61SArthur Chunqi Li 	}
886a969e087SPeter Feiner 	offset = (guest_addr >> EPT_LEVEL_SHIFT(l)) & EPT_PGDIR_MASK;
887b4a405c3SRadim Krčmář 	if (pte)
888b4a405c3SRadim Krčmář 		*pte = pt[offset];
889b4a405c3SRadim Krčmář 	return true;
8906884af61SArthur Chunqi Li }
8916884af61SArthur Chunqi Li 
892521820dbSPaolo Bonzini static void clear_ept_ad_pte(unsigned long *pml4, unsigned long guest_addr)
893521820dbSPaolo Bonzini {
894521820dbSPaolo Bonzini 	int l;
895521820dbSPaolo Bonzini 	unsigned long *pt = pml4;
896521820dbSPaolo Bonzini 	u64 pte;
897521820dbSPaolo Bonzini 	unsigned offset;
898521820dbSPaolo Bonzini 
899521820dbSPaolo Bonzini 	for (l = EPT_PAGE_LEVEL; ; --l) {
900521820dbSPaolo Bonzini 		offset = (guest_addr >> EPT_LEVEL_SHIFT(l)) & EPT_PGDIR_MASK;
901521820dbSPaolo Bonzini 		pt[offset] &= ~(EPT_ACCESS_FLAG|EPT_DIRTY_FLAG);
902521820dbSPaolo Bonzini 		pte = pt[offset];
903521820dbSPaolo Bonzini 		if (l == 1 || (l < 4 && (pte & EPT_LARGE_PAGE)))
904521820dbSPaolo Bonzini 			break;
905521820dbSPaolo Bonzini 		pt = (unsigned long *)(pte & EPT_ADDR_MASK);
906521820dbSPaolo Bonzini 	}
907521820dbSPaolo Bonzini }
908521820dbSPaolo Bonzini 
909521820dbSPaolo Bonzini /* clear_ept_ad : Clear EPT A/D bits for the page table walk and the
910521820dbSPaolo Bonzini    final GPA of a guest address.  */
911521820dbSPaolo Bonzini void clear_ept_ad(unsigned long *pml4, u64 guest_cr3,
912521820dbSPaolo Bonzini 		  unsigned long guest_addr)
913521820dbSPaolo Bonzini {
914521820dbSPaolo Bonzini 	int l;
915521820dbSPaolo Bonzini 	unsigned long *pt = (unsigned long *)guest_cr3, gpa;
916521820dbSPaolo Bonzini 	u64 pte, offset_in_page;
917521820dbSPaolo Bonzini 	unsigned offset;
918521820dbSPaolo Bonzini 
919521820dbSPaolo Bonzini 	for (l = EPT_PAGE_LEVEL; ; --l) {
920521820dbSPaolo Bonzini 		offset = (guest_addr >> EPT_LEVEL_SHIFT(l)) & EPT_PGDIR_MASK;
921521820dbSPaolo Bonzini 
922521820dbSPaolo Bonzini 		clear_ept_ad_pte(pml4, (u64) &pt[offset]);
923521820dbSPaolo Bonzini 		pte = pt[offset];
924521820dbSPaolo Bonzini 		if (l == 1 || (l < 4 && (pte & PT_PAGE_SIZE_MASK)))
925521820dbSPaolo Bonzini 			break;
926521820dbSPaolo Bonzini 		if (!(pte & PT_PRESENT_MASK))
927521820dbSPaolo Bonzini 			return;
928521820dbSPaolo Bonzini 		pt = (unsigned long *)(pte & PT_ADDR_MASK);
929521820dbSPaolo Bonzini 	}
930521820dbSPaolo Bonzini 
931521820dbSPaolo Bonzini 	offset = (guest_addr >> EPT_LEVEL_SHIFT(l)) & EPT_PGDIR_MASK;
932521820dbSPaolo Bonzini 	offset_in_page = guest_addr & ((1 << EPT_LEVEL_SHIFT(l)) - 1);
933521820dbSPaolo Bonzini 	gpa = (pt[offset] & PT_ADDR_MASK) | (guest_addr & offset_in_page);
934521820dbSPaolo Bonzini 	clear_ept_ad_pte(pml4, gpa);
935521820dbSPaolo Bonzini }
936521820dbSPaolo Bonzini 
937521820dbSPaolo Bonzini /* check_ept_ad : Check the content of EPT A/D bits for the page table
938521820dbSPaolo Bonzini    walk and the final GPA of a guest address.  */
939521820dbSPaolo Bonzini void check_ept_ad(unsigned long *pml4, u64 guest_cr3,
940521820dbSPaolo Bonzini 		  unsigned long guest_addr, int expected_gpa_ad,
941521820dbSPaolo Bonzini 		  int expected_pt_ad)
942521820dbSPaolo Bonzini {
943521820dbSPaolo Bonzini 	int l;
944521820dbSPaolo Bonzini 	unsigned long *pt = (unsigned long *)guest_cr3, gpa;
945521820dbSPaolo Bonzini 	u64 ept_pte, pte, offset_in_page;
946521820dbSPaolo Bonzini 	unsigned offset;
947521820dbSPaolo Bonzini 	bool bad_pt_ad = false;
948521820dbSPaolo Bonzini 
949521820dbSPaolo Bonzini 	for (l = EPT_PAGE_LEVEL; ; --l) {
950521820dbSPaolo Bonzini 		offset = (guest_addr >> EPT_LEVEL_SHIFT(l)) & EPT_PGDIR_MASK;
951521820dbSPaolo Bonzini 
952b4a405c3SRadim Krčmář 		if (!get_ept_pte(pml4, (u64) &pt[offset], 1, &ept_pte)) {
953b4a405c3SRadim Krčmář 			printf("EPT - guest level %d page table is not mapped.\n", l);
954521820dbSPaolo Bonzini 			return;
955b4a405c3SRadim Krčmář 		}
956521820dbSPaolo Bonzini 
957521820dbSPaolo Bonzini 		if (!bad_pt_ad) {
958521820dbSPaolo Bonzini 			bad_pt_ad |= (ept_pte & (EPT_ACCESS_FLAG|EPT_DIRTY_FLAG)) != expected_pt_ad;
959521820dbSPaolo Bonzini 			if (bad_pt_ad)
960*a299895bSThomas Huth 				report(false,
961*a299895bSThomas Huth 				       "EPT - guest level %d page table A=%d/D=%d",
962*a299895bSThomas Huth 				       l,
963521820dbSPaolo Bonzini 				       !!(expected_pt_ad & EPT_ACCESS_FLAG),
964521820dbSPaolo Bonzini 				       !!(expected_pt_ad & EPT_DIRTY_FLAG));
965521820dbSPaolo Bonzini 		}
966521820dbSPaolo Bonzini 
967521820dbSPaolo Bonzini 		pte = pt[offset];
968521820dbSPaolo Bonzini 		if (l == 1 || (l < 4 && (pte & PT_PAGE_SIZE_MASK)))
969521820dbSPaolo Bonzini 			break;
970521820dbSPaolo Bonzini 		if (!(pte & PT_PRESENT_MASK))
971521820dbSPaolo Bonzini 			return;
972521820dbSPaolo Bonzini 		pt = (unsigned long *)(pte & PT_ADDR_MASK);
973521820dbSPaolo Bonzini 	}
974521820dbSPaolo Bonzini 
975521820dbSPaolo Bonzini 	if (!bad_pt_ad)
976*a299895bSThomas Huth 		report(true, "EPT - guest page table structures A=%d/D=%d",
977521820dbSPaolo Bonzini 		       !!(expected_pt_ad & EPT_ACCESS_FLAG),
978521820dbSPaolo Bonzini 		       !!(expected_pt_ad & EPT_DIRTY_FLAG));
979521820dbSPaolo Bonzini 
980521820dbSPaolo Bonzini 	offset = (guest_addr >> EPT_LEVEL_SHIFT(l)) & EPT_PGDIR_MASK;
981521820dbSPaolo Bonzini 	offset_in_page = guest_addr & ((1 << EPT_LEVEL_SHIFT(l)) - 1);
982521820dbSPaolo Bonzini 	gpa = (pt[offset] & PT_ADDR_MASK) | (guest_addr & offset_in_page);
983521820dbSPaolo Bonzini 
984b4a405c3SRadim Krčmář 	if (!get_ept_pte(pml4, gpa, 1, &ept_pte)) {
985*a299895bSThomas Huth 		report(false, "EPT - guest physical address is not mapped");
986b4a405c3SRadim Krčmář 		return;
987b4a405c3SRadim Krčmář 	}
988*a299895bSThomas Huth 	report((ept_pte & (EPT_ACCESS_FLAG | EPT_DIRTY_FLAG)) == expected_gpa_ad,
989*a299895bSThomas Huth 	       "EPT - guest physical address A=%d/D=%d",
990521820dbSPaolo Bonzini 	       !!(expected_gpa_ad & EPT_ACCESS_FLAG),
991521820dbSPaolo Bonzini 	       !!(expected_gpa_ad & EPT_DIRTY_FLAG));
992521820dbSPaolo Bonzini }
993521820dbSPaolo Bonzini 
994521820dbSPaolo Bonzini 
9952f888fccSBandan Das void ept_sync(int type, u64 eptp)
9962f888fccSBandan Das {
9972f888fccSBandan Das 	switch (type) {
9982f888fccSBandan Das 	case INVEPT_SINGLE:
9992f888fccSBandan Das 		if (ept_vpid.val & EPT_CAP_INVEPT_SINGLE) {
10002f888fccSBandan Das 			invept(INVEPT_SINGLE, eptp);
10012f888fccSBandan Das 			break;
10022f888fccSBandan Das 		}
10032f888fccSBandan Das 		/* else fall through */
10042f888fccSBandan Das 	case INVEPT_GLOBAL:
10052f888fccSBandan Das 		if (ept_vpid.val & EPT_CAP_INVEPT_ALL) {
10062f888fccSBandan Das 			invept(INVEPT_GLOBAL, eptp);
10072f888fccSBandan Das 			break;
10082f888fccSBandan Das 		}
10092f888fccSBandan Das 		/* else fall through */
10102f888fccSBandan Das 	default:
10112f888fccSBandan Das 		printf("WARNING: invept is not supported!\n");
10122f888fccSBandan Das 	}
10132f888fccSBandan Das }
10142f888fccSBandan Das 
1015dff740c0SPeter Feiner void set_ept_pte(unsigned long *pml4, unsigned long guest_addr,
10166884af61SArthur Chunqi Li 		 int level, u64 pte_val)
10176884af61SArthur Chunqi Li {
10186884af61SArthur Chunqi Li 	int l;
10196884af61SArthur Chunqi Li 	unsigned long *pt = pml4;
10206884af61SArthur Chunqi Li 	unsigned offset;
10216884af61SArthur Chunqi Li 
1022dff740c0SPeter Feiner 	assert(level >= 1 && level <= 4);
1023dff740c0SPeter Feiner 
10242ca6f1f3SPaolo Bonzini 	for (l = EPT_PAGE_LEVEL; ; --l) {
1025a969e087SPeter Feiner 		offset = (guest_addr >> EPT_LEVEL_SHIFT(l)) & EPT_PGDIR_MASK;
10262ca6f1f3SPaolo Bonzini 		if (l == level)
10272ca6f1f3SPaolo Bonzini 			break;
1028dff740c0SPeter Feiner 		assert(pt[offset] & EPT_PRESENT);
102900b5c590SPeter Feiner 		pt = (unsigned long *)(pt[offset] & EPT_ADDR_MASK);
10306884af61SArthur Chunqi Li 	}
1031a969e087SPeter Feiner 	offset = (guest_addr >> EPT_LEVEL_SHIFT(l)) & EPT_PGDIR_MASK;
10326884af61SArthur Chunqi Li 	pt[offset] = pte_val;
10336884af61SArthur Chunqi Li }
10346884af61SArthur Chunqi Li 
10358ab53b95SPeter Feiner bool ept_2m_supported(void)
10368ab53b95SPeter Feiner {
10378ab53b95SPeter Feiner 	return ept_vpid.val & EPT_CAP_2M_PAGE;
10388ab53b95SPeter Feiner }
10398ab53b95SPeter Feiner 
10408ab53b95SPeter Feiner bool ept_1g_supported(void)
10418ab53b95SPeter Feiner {
10428ab53b95SPeter Feiner 	return ept_vpid.val & EPT_CAP_1G_PAGE;
10438ab53b95SPeter Feiner }
10448ab53b95SPeter Feiner 
10458ab53b95SPeter Feiner bool ept_huge_pages_supported(int level)
10468ab53b95SPeter Feiner {
10478ab53b95SPeter Feiner 	if (level == 2)
10488ab53b95SPeter Feiner 		return ept_2m_supported();
10498ab53b95SPeter Feiner 	else if (level == 3)
10508ab53b95SPeter Feiner 		return ept_1g_supported();
10518ab53b95SPeter Feiner 	else
10528ab53b95SPeter Feiner 		return false;
10538ab53b95SPeter Feiner }
10548ab53b95SPeter Feiner 
10558ab53b95SPeter Feiner bool ept_execute_only_supported(void)
10568ab53b95SPeter Feiner {
10578ab53b95SPeter Feiner 	return ept_vpid.val & EPT_CAP_WT;
10588ab53b95SPeter Feiner }
10598ab53b95SPeter Feiner 
10608ab53b95SPeter Feiner bool ept_ad_bits_supported(void)
10618ab53b95SPeter Feiner {
10628ab53b95SPeter Feiner 	return ept_vpid.val & EPT_CAP_AD_FLAG;
10638ab53b95SPeter Feiner }
10648ab53b95SPeter Feiner 
1065b093c6ceSWanpeng Li void vpid_sync(int type, u16 vpid)
1066b093c6ceSWanpeng Li {
1067b093c6ceSWanpeng Li 	switch(type) {
1068aedfd771SJim Mattson 	case INVVPID_CONTEXT_GLOBAL:
1069aedfd771SJim Mattson 		if (ept_vpid.val & VPID_CAP_INVVPID_CXTGLB) {
1070aedfd771SJim Mattson 			invvpid(INVVPID_CONTEXT_GLOBAL, vpid, 0);
1071b093c6ceSWanpeng Li 			break;
1072b093c6ceSWanpeng Li 		}
1073b093c6ceSWanpeng Li 	case INVVPID_ALL:
1074b093c6ceSWanpeng Li 		if (ept_vpid.val & VPID_CAP_INVVPID_ALL) {
1075b093c6ceSWanpeng Li 			invvpid(INVVPID_ALL, vpid, 0);
1076b093c6ceSWanpeng Li 			break;
1077b093c6ceSWanpeng Li 		}
1078b093c6ceSWanpeng Li 	default:
1079b093c6ceSWanpeng Li 		printf("WARNING: invvpid is not supported\n");
1080b093c6ceSWanpeng Li 	}
1081b093c6ceSWanpeng Li }
10826884af61SArthur Chunqi Li 
10839d7eaa29SArthur Chunqi Li static void init_vmcs_ctrl(void)
10849d7eaa29SArthur Chunqi Li {
10859d7eaa29SArthur Chunqi Li 	/* 26.2 CHECKS ON VMX CONTROLS AND HOST-STATE AREA */
10869d7eaa29SArthur Chunqi Li 	/* 26.2.1.1 */
10879d7eaa29SArthur Chunqi Li 	vmcs_write(PIN_CONTROLS, ctrl_pin);
10889d7eaa29SArthur Chunqi Li 	/* Disable VMEXIT of IO instruction */
10899d7eaa29SArthur Chunqi Li 	vmcs_write(CPU_EXEC_CTRL0, ctrl_cpu[0]);
10909d7eaa29SArthur Chunqi Li 	if (ctrl_cpu_rev[0].set & CPU_SECONDARY) {
10916884af61SArthur Chunqi Li 		ctrl_cpu[1] = (ctrl_cpu[1] | ctrl_cpu_rev[1].set) &
10926884af61SArthur Chunqi Li 			ctrl_cpu_rev[1].clr;
10939d7eaa29SArthur Chunqi Li 		vmcs_write(CPU_EXEC_CTRL1, ctrl_cpu[1]);
10949d7eaa29SArthur Chunqi Li 	}
10959d7eaa29SArthur Chunqi Li 	vmcs_write(CR3_TARGET_COUNT, 0);
10969d7eaa29SArthur Chunqi Li 	vmcs_write(VPID, ++vpid_cnt);
10979d7eaa29SArthur Chunqi Li }
10989d7eaa29SArthur Chunqi Li 
10999d7eaa29SArthur Chunqi Li static void init_vmcs_host(void)
11009d7eaa29SArthur Chunqi Li {
11019d7eaa29SArthur Chunqi Li 	/* 26.2 CHECKS ON VMX CONTROLS AND HOST-STATE AREA */
11029d7eaa29SArthur Chunqi Li 	/* 26.2.1.2 */
11039d7eaa29SArthur Chunqi Li 	vmcs_write(HOST_EFER, rdmsr(MSR_EFER));
11049d7eaa29SArthur Chunqi Li 
11059d7eaa29SArthur Chunqi Li 	/* 26.2.1.3 */
11069d7eaa29SArthur Chunqi Li 	vmcs_write(ENT_CONTROLS, ctrl_enter);
11079d7eaa29SArthur Chunqi Li 	vmcs_write(EXI_CONTROLS, ctrl_exit);
11089d7eaa29SArthur Chunqi Li 
11099d7eaa29SArthur Chunqi Li 	/* 26.2.2 */
11109d7eaa29SArthur Chunqi Li 	vmcs_write(HOST_CR0, read_cr0());
11119d7eaa29SArthur Chunqi Li 	vmcs_write(HOST_CR3, read_cr3());
11129d7eaa29SArthur Chunqi Li 	vmcs_write(HOST_CR4, read_cr4());
11139d7eaa29SArthur Chunqi Li 	vmcs_write(HOST_SYSENTER_EIP, (u64)(&entry_sysenter));
111469d8fe0eSPaolo Bonzini 	vmcs_write(HOST_SYSENTER_CS,  KERNEL_CS);
11159d7eaa29SArthur Chunqi Li 
11169d7eaa29SArthur Chunqi Li 	/* 26.2.3 */
111769d8fe0eSPaolo Bonzini 	vmcs_write(HOST_SEL_CS, KERNEL_CS);
111869d8fe0eSPaolo Bonzini 	vmcs_write(HOST_SEL_SS, KERNEL_DS);
111969d8fe0eSPaolo Bonzini 	vmcs_write(HOST_SEL_DS, KERNEL_DS);
112069d8fe0eSPaolo Bonzini 	vmcs_write(HOST_SEL_ES, KERNEL_DS);
112169d8fe0eSPaolo Bonzini 	vmcs_write(HOST_SEL_FS, KERNEL_DS);
112269d8fe0eSPaolo Bonzini 	vmcs_write(HOST_SEL_GS, KERNEL_DS);
112369d8fe0eSPaolo Bonzini 	vmcs_write(HOST_SEL_TR, TSS_MAIN);
1124337166aaSJan Kiszka 	vmcs_write(HOST_BASE_TR, tss_descr.base);
1125337166aaSJan Kiszka 	vmcs_write(HOST_BASE_GDTR, gdt64_desc.base);
1126337166aaSJan Kiszka 	vmcs_write(HOST_BASE_IDTR, idt_descr.base);
11279d7eaa29SArthur Chunqi Li 	vmcs_write(HOST_BASE_FS, 0);
11289d7eaa29SArthur Chunqi Li 	vmcs_write(HOST_BASE_GS, 0);
11299d7eaa29SArthur Chunqi Li 
11309d7eaa29SArthur Chunqi Li 	/* Set other vmcs area */
11319d7eaa29SArthur Chunqi Li 	vmcs_write(PF_ERROR_MASK, 0);
11329d7eaa29SArthur Chunqi Li 	vmcs_write(PF_ERROR_MATCH, 0);
11339d7eaa29SArthur Chunqi Li 	vmcs_write(VMCS_LINK_PTR, ~0ul);
11349d7eaa29SArthur Chunqi Li 	vmcs_write(VMCS_LINK_PTR_HI, ~0ul);
11359d7eaa29SArthur Chunqi Li 	vmcs_write(HOST_RIP, (u64)(&vmx_return));
11369d7eaa29SArthur Chunqi Li }
11379d7eaa29SArthur Chunqi Li 
11389d7eaa29SArthur Chunqi Li static void init_vmcs_guest(void)
11399d7eaa29SArthur Chunqi Li {
11409d7eaa29SArthur Chunqi Li 	/* 26.3 CHECKING AND LOADING GUEST STATE */
11419d7eaa29SArthur Chunqi Li 	ulong guest_cr0, guest_cr4, guest_cr3;
11429d7eaa29SArthur Chunqi Li 	/* 26.3.1.1 */
11439d7eaa29SArthur Chunqi Li 	guest_cr0 = read_cr0();
11449d7eaa29SArthur Chunqi Li 	guest_cr4 = read_cr4();
11459d7eaa29SArthur Chunqi Li 	guest_cr3 = read_cr3();
11469d7eaa29SArthur Chunqi Li 	if (ctrl_enter & ENT_GUEST_64) {
11479d7eaa29SArthur Chunqi Li 		guest_cr0 |= X86_CR0_PG;
11489d7eaa29SArthur Chunqi Li 		guest_cr4 |= X86_CR4_PAE;
11499d7eaa29SArthur Chunqi Li 	}
11509d7eaa29SArthur Chunqi Li 	if ((ctrl_enter & ENT_GUEST_64) == 0)
11519d7eaa29SArthur Chunqi Li 		guest_cr4 &= (~X86_CR4_PCIDE);
11529d7eaa29SArthur Chunqi Li 	if (guest_cr0 & X86_CR0_PG)
11539d7eaa29SArthur Chunqi Li 		guest_cr0 |= X86_CR0_PE;
11549d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_CR0, guest_cr0);
11559d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_CR3, guest_cr3);
11569d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_CR4, guest_cr4);
115769d8fe0eSPaolo Bonzini 	vmcs_write(GUEST_SYSENTER_CS,  KERNEL_CS);
11589d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_SYSENTER_ESP,
11599d7eaa29SArthur Chunqi Li 		(u64)(guest_syscall_stack + PAGE_SIZE - 1));
11609d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_SYSENTER_EIP, (u64)(&entry_sysenter));
11619d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_DR7, 0);
11629d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_EFER, rdmsr(MSR_EFER));
11639d7eaa29SArthur Chunqi Li 
11649d7eaa29SArthur Chunqi Li 	/* 26.3.1.2 */
116569d8fe0eSPaolo Bonzini 	vmcs_write(GUEST_SEL_CS, KERNEL_CS);
116669d8fe0eSPaolo Bonzini 	vmcs_write(GUEST_SEL_SS, KERNEL_DS);
116769d8fe0eSPaolo Bonzini 	vmcs_write(GUEST_SEL_DS, KERNEL_DS);
116869d8fe0eSPaolo Bonzini 	vmcs_write(GUEST_SEL_ES, KERNEL_DS);
116969d8fe0eSPaolo Bonzini 	vmcs_write(GUEST_SEL_FS, KERNEL_DS);
117069d8fe0eSPaolo Bonzini 	vmcs_write(GUEST_SEL_GS, KERNEL_DS);
117169d8fe0eSPaolo Bonzini 	vmcs_write(GUEST_SEL_TR, TSS_MAIN);
11729d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_SEL_LDTR, 0);
11739d7eaa29SArthur Chunqi Li 
11749d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_BASE_CS, 0);
11759d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_BASE_ES, 0);
11769d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_BASE_SS, 0);
11779d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_BASE_DS, 0);
11789d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_BASE_FS, 0);
11799d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_BASE_GS, 0);
1180337166aaSJan Kiszka 	vmcs_write(GUEST_BASE_TR, tss_descr.base);
11819d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_BASE_LDTR, 0);
11829d7eaa29SArthur Chunqi Li 
11839d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_LIMIT_CS, 0xFFFFFFFF);
11849d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_LIMIT_DS, 0xFFFFFFFF);
11859d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_LIMIT_ES, 0xFFFFFFFF);
11869d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_LIMIT_SS, 0xFFFFFFFF);
11879d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_LIMIT_FS, 0xFFFFFFFF);
11889d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_LIMIT_GS, 0xFFFFFFFF);
11899d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_LIMIT_LDTR, 0xffff);
1190337166aaSJan Kiszka 	vmcs_write(GUEST_LIMIT_TR, tss_descr.limit);
11919d7eaa29SArthur Chunqi Li 
11929d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_AR_CS, 0xa09b);
11939d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_AR_DS, 0xc093);
11949d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_AR_ES, 0xc093);
11959d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_AR_FS, 0xc093);
11969d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_AR_GS, 0xc093);
11979d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_AR_SS, 0xc093);
11989d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_AR_LDTR, 0x82);
11999d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_AR_TR, 0x8b);
12009d7eaa29SArthur Chunqi Li 
12019d7eaa29SArthur Chunqi Li 	/* 26.3.1.3 */
1202337166aaSJan Kiszka 	vmcs_write(GUEST_BASE_GDTR, gdt64_desc.base);
1203337166aaSJan Kiszka 	vmcs_write(GUEST_BASE_IDTR, idt_descr.base);
1204337166aaSJan Kiszka 	vmcs_write(GUEST_LIMIT_GDTR, gdt64_desc.limit);
1205337166aaSJan Kiszka 	vmcs_write(GUEST_LIMIT_IDTR, idt_descr.limit);
12069d7eaa29SArthur Chunqi Li 
12079d7eaa29SArthur Chunqi Li 	/* 26.3.1.4 */
12089d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_RIP, (u64)(&guest_entry));
12099d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_RSP, (u64)(guest_stack + PAGE_SIZE - 1));
12109d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_RFLAGS, 0x2);
12119d7eaa29SArthur Chunqi Li 
12129d7eaa29SArthur Chunqi Li 	/* 26.3.1.5 */
121317ba0dd0SJan Kiszka 	vmcs_write(GUEST_ACTV_STATE, ACTV_ACTIVE);
12149d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_INTR_STATE, 0);
12159d7eaa29SArthur Chunqi Li }
12169d7eaa29SArthur Chunqi Li 
12179d7eaa29SArthur Chunqi Li static int init_vmcs(struct vmcs **vmcs)
12189d7eaa29SArthur Chunqi Li {
12199d7eaa29SArthur Chunqi Li 	*vmcs = alloc_page();
12206c0ba6e7SLiran Alon 	(*vmcs)->hdr.revision_id = basic.revision;
12219d7eaa29SArthur Chunqi Li 	/* vmclear first to init vmcs */
12229d7eaa29SArthur Chunqi Li 	if (vmcs_clear(*vmcs)) {
12239d7eaa29SArthur Chunqi Li 		printf("%s : vmcs_clear error\n", __func__);
12249d7eaa29SArthur Chunqi Li 		return 1;
12259d7eaa29SArthur Chunqi Li 	}
12269d7eaa29SArthur Chunqi Li 
12279d7eaa29SArthur Chunqi Li 	if (make_vmcs_current(*vmcs)) {
12289d7eaa29SArthur Chunqi Li 		printf("%s : make_vmcs_current error\n", __func__);
12299d7eaa29SArthur Chunqi Li 		return 1;
12309d7eaa29SArthur Chunqi Li 	}
12319d7eaa29SArthur Chunqi Li 
12329d7eaa29SArthur Chunqi Li 	/* All settings to pin/exit/enter/cpu
12339d7eaa29SArthur Chunqi Li 	   control fields should be placed here */
12349d7eaa29SArthur Chunqi Li 	ctrl_pin |= PIN_EXTINT | PIN_NMI | PIN_VIRT_NMI;
12359d7eaa29SArthur Chunqi Li 	ctrl_exit = EXI_LOAD_EFER | EXI_HOST_64;
12369d7eaa29SArthur Chunqi Li 	ctrl_enter = (ENT_LOAD_EFER | ENT_GUEST_64);
12379d7eaa29SArthur Chunqi Li 	/* DIsable IO instruction VMEXIT now */
12389d7eaa29SArthur Chunqi Li 	ctrl_cpu[0] &= (~(CPU_IO | CPU_IO_BITMAP));
12399d7eaa29SArthur Chunqi Li 	ctrl_cpu[1] = 0;
12409d7eaa29SArthur Chunqi Li 
12419d7eaa29SArthur Chunqi Li 	ctrl_pin = (ctrl_pin | ctrl_pin_rev.set) & ctrl_pin_rev.clr;
12429d7eaa29SArthur Chunqi Li 	ctrl_enter = (ctrl_enter | ctrl_enter_rev.set) & ctrl_enter_rev.clr;
12439d7eaa29SArthur Chunqi Li 	ctrl_exit = (ctrl_exit | ctrl_exit_rev.set) & ctrl_exit_rev.clr;
12449d7eaa29SArthur Chunqi Li 	ctrl_cpu[0] = (ctrl_cpu[0] | ctrl_cpu_rev[0].set) & ctrl_cpu_rev[0].clr;
12459d7eaa29SArthur Chunqi Li 
12469d7eaa29SArthur Chunqi Li 	init_vmcs_ctrl();
12479d7eaa29SArthur Chunqi Li 	init_vmcs_host();
12489d7eaa29SArthur Chunqi Li 	init_vmcs_guest();
12499d7eaa29SArthur Chunqi Li 	return 0;
12509d7eaa29SArthur Chunqi Li }
12519d7eaa29SArthur Chunqi Li 
1252883f3fccSLiran Alon void enable_vmx(void)
1253883f3fccSLiran Alon {
1254883f3fccSLiran Alon 	bool vmx_enabled =
1255883f3fccSLiran Alon 		rdmsr(MSR_IA32_FEATURE_CONTROL) &
1256883f3fccSLiran Alon 		FEATURE_CONTROL_VMXON_ENABLED_OUTSIDE_SMX;
1257883f3fccSLiran Alon 
1258883f3fccSLiran Alon 	if (!vmx_enabled) {
1259883f3fccSLiran Alon 		wrmsr(MSR_IA32_FEATURE_CONTROL,
1260883f3fccSLiran Alon 				FEATURE_CONTROL_VMXON_ENABLED_OUTSIDE_SMX |
1261883f3fccSLiran Alon 				FEATURE_CONTROL_LOCKED);
1262883f3fccSLiran Alon 	}
1263883f3fccSLiran Alon }
1264883f3fccSLiran Alon 
1265e836e27cSLiran Alon static void init_vmx_caps(void)
12669d7eaa29SArthur Chunqi Li {
12679d7eaa29SArthur Chunqi Li 	basic.val = rdmsr(MSR_IA32_VMX_BASIC);
12689d7eaa29SArthur Chunqi Li 	ctrl_pin_rev.val = rdmsr(basic.ctrl ? MSR_IA32_VMX_TRUE_PIN
12699d7eaa29SArthur Chunqi Li 			: MSR_IA32_VMX_PINBASED_CTLS);
12709d7eaa29SArthur Chunqi Li 	ctrl_exit_rev.val = rdmsr(basic.ctrl ? MSR_IA32_VMX_TRUE_EXIT
12719d7eaa29SArthur Chunqi Li 			: MSR_IA32_VMX_EXIT_CTLS);
12729d7eaa29SArthur Chunqi Li 	ctrl_enter_rev.val = rdmsr(basic.ctrl ? MSR_IA32_VMX_TRUE_ENTRY
12739d7eaa29SArthur Chunqi Li 			: MSR_IA32_VMX_ENTRY_CTLS);
12749d7eaa29SArthur Chunqi Li 	ctrl_cpu_rev[0].val = rdmsr(basic.ctrl ? MSR_IA32_VMX_TRUE_PROC
12759d7eaa29SArthur Chunqi Li 			: MSR_IA32_VMX_PROCBASED_CTLS);
12766884af61SArthur Chunqi Li 	if ((ctrl_cpu_rev[0].clr & CPU_SECONDARY) != 0)
12779d7eaa29SArthur Chunqi Li 		ctrl_cpu_rev[1].val = rdmsr(MSR_IA32_VMX_PROCBASED_CTLS2);
12786884af61SArthur Chunqi Li 	else
12796884af61SArthur Chunqi Li 		ctrl_cpu_rev[1].val = 0;
12806884af61SArthur Chunqi Li 	if ((ctrl_cpu_rev[1].clr & (CPU_EPT | CPU_VPID)) != 0)
12819d7eaa29SArthur Chunqi Li 		ept_vpid.val = rdmsr(MSR_IA32_VMX_EPT_VPID_CAP);
12826884af61SArthur Chunqi Li 	else
12836884af61SArthur Chunqi Li 		ept_vpid.val = 0;
1284e836e27cSLiran Alon }
1285e836e27cSLiran Alon 
12864f18f5deSLiran Alon void init_vmx(u64 *vmxon_region)
1287e836e27cSLiran Alon {
1288e836e27cSLiran Alon 	ulong fix_cr0_set, fix_cr0_clr;
1289e836e27cSLiran Alon 	ulong fix_cr4_set, fix_cr4_clr;
1290e836e27cSLiran Alon 
1291e836e27cSLiran Alon 	fix_cr0_set =  rdmsr(MSR_IA32_VMX_CR0_FIXED0);
1292e836e27cSLiran Alon 	fix_cr0_clr =  rdmsr(MSR_IA32_VMX_CR0_FIXED1);
1293e836e27cSLiran Alon 	fix_cr4_set =  rdmsr(MSR_IA32_VMX_CR4_FIXED0);
1294e836e27cSLiran Alon 	fix_cr4_clr = rdmsr(MSR_IA32_VMX_CR4_FIXED1);
1295e836e27cSLiran Alon 
12969d7eaa29SArthur Chunqi Li 	write_cr0((read_cr0() & fix_cr0_clr) | fix_cr0_set);
12979d7eaa29SArthur Chunqi Li 	write_cr4((read_cr4() & fix_cr4_clr) | fix_cr4_set | X86_CR4_VMXE);
12989d7eaa29SArthur Chunqi Li 
12999d7eaa29SArthur Chunqi Li 	*vmxon_region = basic.revision;
130093f10d6fSLiran Alon }
13019d7eaa29SArthur Chunqi Li 
130293f10d6fSLiran Alon static void alloc_bsp_vmx_pages(void)
130393f10d6fSLiran Alon {
1304c937d495SLiran Alon 	bsp_vmxon_region = alloc_page();
13059d7eaa29SArthur Chunqi Li 	guest_stack = alloc_page();
13069d7eaa29SArthur Chunqi Li 	guest_syscall_stack = alloc_page();
130793f10d6fSLiran Alon 	vmcs_root = alloc_page();
130893f10d6fSLiran Alon }
130993f10d6fSLiran Alon 
131093f10d6fSLiran Alon static void init_bsp_vmx(void)
131193f10d6fSLiran Alon {
131293f10d6fSLiran Alon 	init_vmx_caps();
131393f10d6fSLiran Alon 	alloc_bsp_vmx_pages();
1314c937d495SLiran Alon 	init_vmx(bsp_vmxon_region);
13159d7eaa29SArthur Chunqi Li }
13169d7eaa29SArthur Chunqi Li 
1317e3f363c4SJan Kiszka static void do_vmxon_off(void *data)
13189d7eaa29SArthur Chunqi Li {
13193b127446SJan Kiszka 	vmx_on();
13203b127446SJan Kiszka 	vmx_off();
132103f37ef2SPaolo Bonzini }
13223b127446SJan Kiszka 
1323e3f363c4SJan Kiszka static void do_write_feature_control(void *data)
13243b127446SJan Kiszka {
13253b127446SJan Kiszka 	wrmsr(MSR_IA32_FEATURE_CONTROL, 0);
132603f37ef2SPaolo Bonzini }
13273b127446SJan Kiszka 
13283b127446SJan Kiszka static int test_vmx_feature_control(void)
13293b127446SJan Kiszka {
13303b127446SJan Kiszka 	u64 ia32_feature_control;
13313b127446SJan Kiszka 	bool vmx_enabled;
13324e38e9dfSLiran Alon 	bool feature_control_locked;
13333b127446SJan Kiszka 
13343b127446SJan Kiszka 	ia32_feature_control = rdmsr(MSR_IA32_FEATURE_CONTROL);
13354e38e9dfSLiran Alon 	vmx_enabled =
13364e38e9dfSLiran Alon 		ia32_feature_control & FEATURE_CONTROL_VMXON_ENABLED_OUTSIDE_SMX;
13374e38e9dfSLiran Alon 	feature_control_locked =
13384e38e9dfSLiran Alon 		ia32_feature_control & FEATURE_CONTROL_LOCKED;
13394e38e9dfSLiran Alon 
13404e38e9dfSLiran Alon 	if (vmx_enabled && feature_control_locked) {
13413b127446SJan Kiszka 		printf("VMX enabled and locked by BIOS\n");
13423b127446SJan Kiszka 		return 0;
13434e38e9dfSLiran Alon 	} else if (feature_control_locked) {
13443b127446SJan Kiszka 		printf("ERROR: VMX locked out by BIOS!?\n");
13453b127446SJan Kiszka 		return 1;
13463b127446SJan Kiszka 	}
13473b127446SJan Kiszka 
13483b127446SJan Kiszka 	wrmsr(MSR_IA32_FEATURE_CONTROL, 0);
1349*a299895bSThomas Huth 	report(test_for_exception(GP_VECTOR, &do_vmxon_off, NULL),
1350*a299895bSThomas Huth 	       "test vmxon with FEATURE_CONTROL cleared");
13513b127446SJan Kiszka 
13524e38e9dfSLiran Alon 	wrmsr(MSR_IA32_FEATURE_CONTROL, FEATURE_CONTROL_VMXON_ENABLED_OUTSIDE_SMX);
1353*a299895bSThomas Huth 	report(test_for_exception(GP_VECTOR, &do_vmxon_off, NULL),
1354*a299895bSThomas Huth 	       "test vmxon without FEATURE_CONTROL lock");
13553b127446SJan Kiszka 
13564e38e9dfSLiran Alon 	wrmsr(MSR_IA32_FEATURE_CONTROL,
13574e38e9dfSLiran Alon 		  FEATURE_CONTROL_VMXON_ENABLED_OUTSIDE_SMX |
13584e38e9dfSLiran Alon 		  FEATURE_CONTROL_LOCKED);
13594e38e9dfSLiran Alon 
13604e38e9dfSLiran Alon 	ia32_feature_control = rdmsr(MSR_IA32_FEATURE_CONTROL);
13614e38e9dfSLiran Alon 	vmx_enabled =
13624e38e9dfSLiran Alon 		ia32_feature_control & FEATURE_CONTROL_VMXON_ENABLED_OUTSIDE_SMX;
1363*a299895bSThomas Huth 	report(vmx_enabled, "test enable VMX in FEATURE_CONTROL");
13643b127446SJan Kiszka 
1365*a299895bSThomas Huth 	report(test_for_exception(GP_VECTOR, &do_write_feature_control, NULL),
1366*a299895bSThomas Huth 	       "test FEATURE_CONTROL lock bit");
13673b127446SJan Kiszka 
13683b127446SJan Kiszka 	return !vmx_enabled;
13699d7eaa29SArthur Chunqi Li }
13709d7eaa29SArthur Chunqi Li 
13719d7eaa29SArthur Chunqi Li static int test_vmxon(void)
13729d7eaa29SArthur Chunqi Li {
1373ce21d809SBandan Das 	int ret, ret1;
1374c937d495SLiran Alon 	u64 *vmxon_region;
1375e2cf1c9dSEduardo Habkost 	int width = cpuid_maxphyaddr();
13769d7eaa29SArthur Chunqi Li 
1377ce21d809SBandan Das 	/* Unaligned page access */
1378c937d495SLiran Alon 	vmxon_region = (u64 *)((intptr_t)bsp_vmxon_region + 1);
1379c937d495SLiran Alon 	ret1 = _vmx_on(vmxon_region);
1380*a299895bSThomas Huth 	report(ret1, "test vmxon with unaligned vmxon region");
1381ce21d809SBandan Das 	if (!ret1) {
1382ce21d809SBandan Das 		ret = 1;
1383ce21d809SBandan Das 		goto out;
1384ce21d809SBandan Das 	}
1385ce21d809SBandan Das 
1386ce21d809SBandan Das 	/* gpa bits beyond physical address width are set*/
1387c937d495SLiran Alon 	vmxon_region = (u64 *)((intptr_t)bsp_vmxon_region | ((u64)1 << (width+1)));
1388c937d495SLiran Alon 	ret1 = _vmx_on(vmxon_region);
1389*a299895bSThomas Huth 	report(ret1, "test vmxon with bits set beyond physical address width");
1390ce21d809SBandan Das 	if (!ret1) {
1391ce21d809SBandan Das 		ret = 1;
1392ce21d809SBandan Das 		goto out;
1393ce21d809SBandan Das 	}
1394ce21d809SBandan Das 
1395ce21d809SBandan Das 	/* invalid revision indentifier */
1396c937d495SLiran Alon 	*bsp_vmxon_region = 0xba9da9;
1397ce21d809SBandan Das 	ret1 = vmx_on();
1398*a299895bSThomas Huth 	report(ret1, "test vmxon with invalid revision identifier");
1399ce21d809SBandan Das 	if (!ret1) {
1400ce21d809SBandan Das 		ret = 1;
1401ce21d809SBandan Das 		goto out;
1402ce21d809SBandan Das 	}
1403ce21d809SBandan Das 
1404ce21d809SBandan Das 	/* and finally a valid region */
1405c937d495SLiran Alon 	*bsp_vmxon_region = basic.revision;
14069d7eaa29SArthur Chunqi Li 	ret = vmx_on();
1407*a299895bSThomas Huth 	report(!ret, "test vmxon with valid vmxon region");
1408ce21d809SBandan Das 
1409ce21d809SBandan Das out:
14109d7eaa29SArthur Chunqi Li 	return ret;
14119d7eaa29SArthur Chunqi Li }
14129d7eaa29SArthur Chunqi Li 
14139d7eaa29SArthur Chunqi Li static void test_vmptrld(void)
14149d7eaa29SArthur Chunqi Li {
1415daeec979SBandan Das 	struct vmcs *vmcs, *tmp_root;
1416e2cf1c9dSEduardo Habkost 	int width = cpuid_maxphyaddr();
14179d7eaa29SArthur Chunqi Li 
14189d7eaa29SArthur Chunqi Li 	vmcs = alloc_page();
14196c0ba6e7SLiran Alon 	vmcs->hdr.revision_id = basic.revision;
1420daeec979SBandan Das 
1421daeec979SBandan Das 	/* Unaligned page access */
1422daeec979SBandan Das 	tmp_root = (struct vmcs *)((intptr_t)vmcs + 1);
1423*a299895bSThomas Huth 	report(make_vmcs_current(tmp_root) == 1,
1424*a299895bSThomas Huth 	       "test vmptrld with unaligned vmcs");
1425daeec979SBandan Das 
1426daeec979SBandan Das 	/* gpa bits beyond physical address width are set*/
1427daeec979SBandan Das 	tmp_root = (struct vmcs *)((intptr_t)vmcs |
1428daeec979SBandan Das 				   ((u64)1 << (width+1)));
1429*a299895bSThomas Huth 	report(make_vmcs_current(tmp_root) == 1,
1430*a299895bSThomas Huth 	       "test vmptrld with vmcs address bits set beyond physical address width");
1431daeec979SBandan Das 
1432daeec979SBandan Das 	/* Pass VMXON region */
14331c90aec0SJim Mattson 	assert(!vmcs_clear(vmcs));
14341c90aec0SJim Mattson 	assert(!make_vmcs_current(vmcs));
1435c937d495SLiran Alon 	tmp_root = (struct vmcs *)bsp_vmxon_region;
1436*a299895bSThomas Huth 	report(make_vmcs_current(tmp_root) == 1,
1437*a299895bSThomas Huth 	       "test vmptrld with vmxon region");
1438*a299895bSThomas Huth 	report(vmcs_read(VMX_INST_ERROR) == VMXERR_VMPTRLD_VMXON_POINTER,
1439*a299895bSThomas Huth 	       "test vmptrld with vmxon region vm-instruction error");
1440daeec979SBandan Das 
1441*a299895bSThomas Huth 	report(make_vmcs_current(vmcs) == 0,
1442*a299895bSThomas Huth 	       "test vmptrld with valid vmcs region");
14439d7eaa29SArthur Chunqi Li }
14449d7eaa29SArthur Chunqi Li 
14459d7eaa29SArthur Chunqi Li static void test_vmptrst(void)
14469d7eaa29SArthur Chunqi Li {
14479d7eaa29SArthur Chunqi Li 	int ret;
14489d7eaa29SArthur Chunqi Li 	struct vmcs *vmcs1, *vmcs2;
14499d7eaa29SArthur Chunqi Li 
14509d7eaa29SArthur Chunqi Li 	vmcs1 = alloc_page();
14519d7eaa29SArthur Chunqi Li 	init_vmcs(&vmcs1);
14529d7eaa29SArthur Chunqi Li 	ret = vmcs_save(&vmcs2);
1453*a299895bSThomas Huth 	report((!ret) && (vmcs1 == vmcs2), "test vmptrst");
14549d7eaa29SArthur Chunqi Li }
14559d7eaa29SArthur Chunqi Li 
145669c8d31cSJan Kiszka struct vmx_ctl_msr {
145769c8d31cSJan Kiszka 	const char *name;
145869c8d31cSJan Kiszka 	u32 index, true_index;
145969c8d31cSJan Kiszka 	u32 default1;
146069c8d31cSJan Kiszka } vmx_ctl_msr[] = {
146169c8d31cSJan Kiszka 	{ "MSR_IA32_VMX_PINBASED_CTLS", MSR_IA32_VMX_PINBASED_CTLS,
146269c8d31cSJan Kiszka 	  MSR_IA32_VMX_TRUE_PIN, 0x16 },
146369c8d31cSJan Kiszka 	{ "MSR_IA32_VMX_PROCBASED_CTLS", MSR_IA32_VMX_PROCBASED_CTLS,
146469c8d31cSJan Kiszka 	  MSR_IA32_VMX_TRUE_PROC, 0x401e172 },
146569c8d31cSJan Kiszka 	{ "MSR_IA32_VMX_PROCBASED_CTLS2", MSR_IA32_VMX_PROCBASED_CTLS2,
146669c8d31cSJan Kiszka 	  MSR_IA32_VMX_PROCBASED_CTLS2, 0 },
146769c8d31cSJan Kiszka 	{ "MSR_IA32_VMX_EXIT_CTLS", MSR_IA32_VMX_EXIT_CTLS,
146869c8d31cSJan Kiszka 	  MSR_IA32_VMX_TRUE_EXIT, 0x36dff },
146969c8d31cSJan Kiszka 	{ "MSR_IA32_VMX_ENTRY_CTLS", MSR_IA32_VMX_ENTRY_CTLS,
147069c8d31cSJan Kiszka 	  MSR_IA32_VMX_TRUE_ENTRY, 0x11ff },
147169c8d31cSJan Kiszka };
147269c8d31cSJan Kiszka 
147369c8d31cSJan Kiszka static void test_vmx_caps(void)
147469c8d31cSJan Kiszka {
147569c8d31cSJan Kiszka 	u64 val, default1, fixed0, fixed1;
147669c8d31cSJan Kiszka 	union vmx_ctrl_msr ctrl, true_ctrl;
147769c8d31cSJan Kiszka 	unsigned int n;
147869c8d31cSJan Kiszka 	bool ok;
147969c8d31cSJan Kiszka 
148069c8d31cSJan Kiszka 	printf("\nTest suite: VMX capability reporting\n");
148169c8d31cSJan Kiszka 
1482*a299895bSThomas Huth 	report((basic.revision & (1ul << 31)) == 0 &&
148369c8d31cSJan Kiszka 	       basic.size > 0 && basic.size <= 4096 &&
148469c8d31cSJan Kiszka 	       (basic.type == 0 || basic.type == 6) &&
1485*a299895bSThomas Huth 	       basic.reserved1 == 0 && basic.reserved2 == 0,
1486*a299895bSThomas Huth 	       "MSR_IA32_VMX_BASIC");
148769c8d31cSJan Kiszka 
148869c8d31cSJan Kiszka 	val = rdmsr(MSR_IA32_VMX_MISC);
1489*a299895bSThomas Huth 	report((!(ctrl_cpu_rev[1].clr & CPU_URG) || val & (1ul << 5)) &&
149069c8d31cSJan Kiszka 	       ((val >> 16) & 0x1ff) <= 256 &&
1491*a299895bSThomas Huth 	       (val & 0x80007e00) == 0,
1492*a299895bSThomas Huth 	       "MSR_IA32_VMX_MISC");
149369c8d31cSJan Kiszka 
149469c8d31cSJan Kiszka 	for (n = 0; n < ARRAY_SIZE(vmx_ctl_msr); n++) {
149569c8d31cSJan Kiszka 		ctrl.val = rdmsr(vmx_ctl_msr[n].index);
149669c8d31cSJan Kiszka 		default1 = vmx_ctl_msr[n].default1;
149769c8d31cSJan Kiszka 		ok = (ctrl.set & default1) == default1;
149869c8d31cSJan Kiszka 		ok = ok && (ctrl.set & ~ctrl.clr) == 0;
149969c8d31cSJan Kiszka 		if (ok && basic.ctrl) {
150069c8d31cSJan Kiszka 			true_ctrl.val = rdmsr(vmx_ctl_msr[n].true_index);
150169c8d31cSJan Kiszka 			ok = ctrl.clr == true_ctrl.clr;
150269c8d31cSJan Kiszka 			ok = ok && ctrl.set == (true_ctrl.set | default1);
150369c8d31cSJan Kiszka 		}
1504*a299895bSThomas Huth 		report(ok, "%s", vmx_ctl_msr[n].name);
150569c8d31cSJan Kiszka 	}
150669c8d31cSJan Kiszka 
150769c8d31cSJan Kiszka 	fixed0 = rdmsr(MSR_IA32_VMX_CR0_FIXED0);
150869c8d31cSJan Kiszka 	fixed1 = rdmsr(MSR_IA32_VMX_CR0_FIXED1);
1509*a299895bSThomas Huth 	report(((fixed0 ^ fixed1) & ~fixed1) == 0,
1510*a299895bSThomas Huth 	       "MSR_IA32_VMX_IA32_VMX_CR0_FIXED0/1");
151169c8d31cSJan Kiszka 
151269c8d31cSJan Kiszka 	fixed0 = rdmsr(MSR_IA32_VMX_CR4_FIXED0);
151369c8d31cSJan Kiszka 	fixed1 = rdmsr(MSR_IA32_VMX_CR4_FIXED1);
1514*a299895bSThomas Huth 	report(((fixed0 ^ fixed1) & ~fixed1) == 0,
1515*a299895bSThomas Huth 	       "MSR_IA32_VMX_IA32_VMX_CR4_FIXED0/1");
151669c8d31cSJan Kiszka 
151769c8d31cSJan Kiszka 	val = rdmsr(MSR_IA32_VMX_VMCS_ENUM);
1518*a299895bSThomas Huth 	report((val & VMCS_FIELD_INDEX_MASK) >= 0x2a &&
1519*a299895bSThomas Huth 	       (val & 0xfffffffffffffc01Ull) == 0,
1520*a299895bSThomas Huth 	       "MSR_IA32_VMX_VMCS_ENUM");
152169c8d31cSJan Kiszka 
152269c8d31cSJan Kiszka 	val = rdmsr(MSR_IA32_VMX_EPT_VPID_CAP);
1523*a299895bSThomas Huth 	report((val & 0xfffff07ef98cbebeUll) == 0,
1524*a299895bSThomas Huth 	       "MSR_IA32_VMX_EPT_VPID_CAP");
152569c8d31cSJan Kiszka }
152669c8d31cSJan Kiszka 
15279d7eaa29SArthur Chunqi Li /* This function can only be called in guest */
15289d7eaa29SArthur Chunqi Li static void __attribute__((__used__)) hypercall(u32 hypercall_no)
15299d7eaa29SArthur Chunqi Li {
15309d7eaa29SArthur Chunqi Li 	u64 val = 0;
15319d7eaa29SArthur Chunqi Li 	val = (hypercall_no & HYPERCALL_MASK) | HYPERCALL_BIT;
15329d7eaa29SArthur Chunqi Li 	hypercall_field = val;
15339d7eaa29SArthur Chunqi Li 	asm volatile("vmcall\n\t");
15349d7eaa29SArthur Chunqi Li }
15359d7eaa29SArthur Chunqi Li 
15367db17e21SThomas Huth static bool is_hypercall(void)
15379d7eaa29SArthur Chunqi Li {
15389d7eaa29SArthur Chunqi Li 	ulong reason, hyper_bit;
15399d7eaa29SArthur Chunqi Li 
15409d7eaa29SArthur Chunqi Li 	reason = vmcs_read(EXI_REASON) & 0xff;
15419d7eaa29SArthur Chunqi Li 	hyper_bit = hypercall_field & HYPERCALL_BIT;
15429d7eaa29SArthur Chunqi Li 	if (reason == VMX_VMCALL && hyper_bit)
15439d7eaa29SArthur Chunqi Li 		return true;
15449d7eaa29SArthur Chunqi Li 	return false;
15459d7eaa29SArthur Chunqi Li }
15469d7eaa29SArthur Chunqi Li 
15477db17e21SThomas Huth static int handle_hypercall(void)
15489d7eaa29SArthur Chunqi Li {
15499d7eaa29SArthur Chunqi Li 	ulong hypercall_no;
15509d7eaa29SArthur Chunqi Li 
15519d7eaa29SArthur Chunqi Li 	hypercall_no = hypercall_field & HYPERCALL_MASK;
15529d7eaa29SArthur Chunqi Li 	hypercall_field = 0;
15539d7eaa29SArthur Chunqi Li 	switch (hypercall_no) {
15549d7eaa29SArthur Chunqi Li 	case HYPERCALL_VMEXIT:
15559d7eaa29SArthur Chunqi Li 		return VMX_TEST_VMEXIT;
1556794c67a9SPeter Feiner 	case HYPERCALL_VMABORT:
1557794c67a9SPeter Feiner 		return VMX_TEST_VMABORT;
1558794c67a9SPeter Feiner 	case HYPERCALL_VMSKIP:
1559794c67a9SPeter Feiner 		return VMX_TEST_VMSKIP;
15609d7eaa29SArthur Chunqi Li 	default:
1561b006d7ebSAndrew Jones 		printf("ERROR : Invalid hypercall number : %ld\n", hypercall_no);
15629d7eaa29SArthur Chunqi Li 	}
15639d7eaa29SArthur Chunqi Li 	return VMX_TEST_EXIT;
15649d7eaa29SArthur Chunqi Li }
15659d7eaa29SArthur Chunqi Li 
1566794c67a9SPeter Feiner static void continue_abort(void)
1567794c67a9SPeter Feiner {
1568794c67a9SPeter Feiner 	assert(!in_guest);
1569794c67a9SPeter Feiner 	printf("Host was here when guest aborted:\n");
1570794c67a9SPeter Feiner 	dump_stack();
1571794c67a9SPeter Feiner 	longjmp(abort_target, 1);
1572794c67a9SPeter Feiner 	abort();
1573794c67a9SPeter Feiner }
1574794c67a9SPeter Feiner 
1575794c67a9SPeter Feiner void __abort_test(void)
1576794c67a9SPeter Feiner {
1577794c67a9SPeter Feiner 	if (in_guest)
1578794c67a9SPeter Feiner 		hypercall(HYPERCALL_VMABORT);
1579794c67a9SPeter Feiner 	else
1580794c67a9SPeter Feiner 		longjmp(abort_target, 1);
1581794c67a9SPeter Feiner 	abort();
1582794c67a9SPeter Feiner }
1583794c67a9SPeter Feiner 
1584794c67a9SPeter Feiner static void continue_skip(void)
1585794c67a9SPeter Feiner {
1586794c67a9SPeter Feiner 	assert(!in_guest);
1587794c67a9SPeter Feiner 	longjmp(abort_target, 1);
1588794c67a9SPeter Feiner 	abort();
1589794c67a9SPeter Feiner }
1590794c67a9SPeter Feiner 
1591794c67a9SPeter Feiner void test_skip(const char *msg)
1592794c67a9SPeter Feiner {
1593794c67a9SPeter Feiner 	printf("%s skipping test: %s\n", in_guest ? "Guest" : "Host", msg);
1594794c67a9SPeter Feiner 	if (in_guest)
1595794c67a9SPeter Feiner 		hypercall(HYPERCALL_VMABORT);
1596794c67a9SPeter Feiner 	else
1597794c67a9SPeter Feiner 		longjmp(abort_target, 1);
1598794c67a9SPeter Feiner 	abort();
1599794c67a9SPeter Feiner }
1600794c67a9SPeter Feiner 
16017db17e21SThomas Huth static int exit_handler(void)
16029d7eaa29SArthur Chunqi Li {
16039d7eaa29SArthur Chunqi Li 	int ret;
16049d7eaa29SArthur Chunqi Li 
16059d7eaa29SArthur Chunqi Li 	current->exits++;
16061d9284d0SArthur Chunqi Li 	regs.rflags = vmcs_read(GUEST_RFLAGS);
16079d7eaa29SArthur Chunqi Li 	if (is_hypercall())
16089d7eaa29SArthur Chunqi Li 		ret = handle_hypercall();
16099d7eaa29SArthur Chunqi Li 	else
16109d7eaa29SArthur Chunqi Li 		ret = current->exit_handler();
16111d9284d0SArthur Chunqi Li 	vmcs_write(GUEST_RFLAGS, regs.rflags);
16123b50efe3SPeter Feiner 
16139d7eaa29SArthur Chunqi Li 	return ret;
16149d7eaa29SArthur Chunqi Li }
16153b50efe3SPeter Feiner 
16163b50efe3SPeter Feiner /*
16173b50efe3SPeter Feiner  * Called if vmlaunch or vmresume fails.
16183b50efe3SPeter Feiner  *	@early    - failure due to "VMX controls and host-state area" (26.2)
16193b50efe3SPeter Feiner  *	@vmlaunch - was this a vmlaunch or vmresume
16203b50efe3SPeter Feiner  *	@rflags   - host rflags
16213b50efe3SPeter Feiner  */
16223b50efe3SPeter Feiner static int
16233b50efe3SPeter Feiner entry_failure_handler(struct vmentry_failure *failure)
16243b50efe3SPeter Feiner {
16253b50efe3SPeter Feiner 	if (current->entry_failure_handler)
16263b50efe3SPeter Feiner 		return current->entry_failure_handler(failure);
16273b50efe3SPeter Feiner 	else
16283b50efe3SPeter Feiner 		return VMX_TEST_EXIT;
16299d7eaa29SArthur Chunqi Li }
16309d7eaa29SArthur Chunqi Li 
1631c76ddf06SPeter Feiner /*
163274f7e9b2SKrish Sadhukhan  * Tries to enter the guest. Returns true if entry succeeded. Otherwise,
1633c76ddf06SPeter Feiner  * populates @failure.
1634c76ddf06SPeter Feiner  */
163574f7e9b2SKrish Sadhukhan static void vmx_enter_guest(struct vmentry_failure *failure)
16369d7eaa29SArthur Chunqi Li {
1637c76ddf06SPeter Feiner 	failure->early = 0;
16384e809db5SPeter Feiner 
1639794c67a9SPeter Feiner 	in_guest = 1;
16409d7eaa29SArthur Chunqi Li 	asm volatile (
1641897d8365SPeter Feiner 		"mov %[HOST_RSP], %%rdi\n\t"
1642897d8365SPeter Feiner 		"vmwrite %%rsp, %%rdi\n\t"
16439d7eaa29SArthur Chunqi Li 		LOAD_GPR_C
164444417388SPaolo Bonzini 		"cmpb $0, %[launched]\n\t"
16459d7eaa29SArthur Chunqi Li 		"jne 1f\n\t"
16469d7eaa29SArthur Chunqi Li 		"vmlaunch\n\t"
16479d7eaa29SArthur Chunqi Li 		"jmp 2f\n\t"
16489d7eaa29SArthur Chunqi Li 		"1: "
16499d7eaa29SArthur Chunqi Li 		"vmresume\n\t"
16509d7eaa29SArthur Chunqi Li 		"2: "
1651f37cf4e2SPeter Feiner 		SAVE_GPR_C
1652897d8365SPeter Feiner 		"pushf\n\t"
1653897d8365SPeter Feiner 		"pop %%rdi\n\t"
1654c76ddf06SPeter Feiner 		"mov %%rdi, %[failure_flags]\n\t"
1655e5adf54bSPaolo Bonzini 		"movl $1, %[failure_early]\n\t"
1656f37cf4e2SPeter Feiner 		"jmp 3f\n\t"
16579d7eaa29SArthur Chunqi Li 		"vmx_return:\n\t"
16589d7eaa29SArthur Chunqi Li 		SAVE_GPR_C
1659f37cf4e2SPeter Feiner 		"3: \n\t"
1660c76ddf06SPeter Feiner 		: [failure_early]"+m"(failure->early),
1661c76ddf06SPeter Feiner 		  [failure_flags]"=m"(failure->flags)
1662897d8365SPeter Feiner 		: [launched]"m"(launched), [HOST_RSP]"i"(HOST_RSP)
1663897d8365SPeter Feiner 		: "rdi", "memory", "cc"
16649d7eaa29SArthur Chunqi Li 	);
1665794c67a9SPeter Feiner 	in_guest = 0;
16663b50efe3SPeter Feiner 
1667c76ddf06SPeter Feiner 	failure->vmlaunch = !launched;
1668c76ddf06SPeter Feiner 	failure->instr = launched ? "vmresume" : "vmlaunch";
1669c76ddf06SPeter Feiner }
1670c76ddf06SPeter Feiner 
16717db17e21SThomas Huth static int vmx_run(void)
1672c76ddf06SPeter Feiner {
1673c76ddf06SPeter Feiner 	while (1) {
1674c76ddf06SPeter Feiner 		u32 ret;
1675c76ddf06SPeter Feiner 		bool entered;
1676c76ddf06SPeter Feiner 		struct vmentry_failure failure;
1677c76ddf06SPeter Feiner 
167874f7e9b2SKrish Sadhukhan 		vmx_enter_guest(&failure);
167974f7e9b2SKrish Sadhukhan 		entered = !failure.early &&
168074f7e9b2SKrish Sadhukhan 			  !(vmcs_read(EXI_REASON) & VMX_ENTRY_FAILURE);
16813b50efe3SPeter Feiner 
16823b50efe3SPeter Feiner 		if (entered) {
16833b50efe3SPeter Feiner 			/*
16843b50efe3SPeter Feiner 			 * VMCS isn't in "launched" state if there's been any
16853b50efe3SPeter Feiner 			 * entry failure (early or otherwise).
16863b50efe3SPeter Feiner 			 */
16879d7eaa29SArthur Chunqi Li 			launched = 1;
16889d7eaa29SArthur Chunqi Li 			ret = exit_handler();
16893b50efe3SPeter Feiner 		} else {
16903b50efe3SPeter Feiner 			ret = entry_failure_handler(&failure);
16919d7eaa29SArthur Chunqi Li 		}
16923b50efe3SPeter Feiner 
16939d7eaa29SArthur Chunqi Li 		switch (ret) {
16943b50efe3SPeter Feiner 		case VMX_TEST_RESUME:
16953b50efe3SPeter Feiner 			continue;
16969d7eaa29SArthur Chunqi Li 		case VMX_TEST_VMEXIT:
1697794c67a9SPeter Feiner 			guest_finished = 1;
16989d7eaa29SArthur Chunqi Li 			return 0;
16993b50efe3SPeter Feiner 		case VMX_TEST_EXIT:
17009d7eaa29SArthur Chunqi Li 			break;
17019d7eaa29SArthur Chunqi Li 		default:
17023b50efe3SPeter Feiner 			printf("ERROR : Invalid %s_handler return val %d.\n",
17033b50efe3SPeter Feiner 			       entered ? "exit" : "entry_failure",
17043b50efe3SPeter Feiner 			       ret);
17059d7eaa29SArthur Chunqi Li 			break;
17069d7eaa29SArthur Chunqi Li 		}
17073b50efe3SPeter Feiner 
17083b50efe3SPeter Feiner 		if (entered)
17093b50efe3SPeter Feiner 			print_vmexit_info();
17103b50efe3SPeter Feiner 		else
17113b50efe3SPeter Feiner 			print_vmentry_failure_info(&failure);
17123b50efe3SPeter Feiner 		abort();
17133b50efe3SPeter Feiner 	}
17149d7eaa29SArthur Chunqi Li }
17159d7eaa29SArthur Chunqi Li 
1716794c67a9SPeter Feiner static void run_teardown_step(struct test_teardown_step *step)
1717794c67a9SPeter Feiner {
1718794c67a9SPeter Feiner 	step->func(step->data);
1719794c67a9SPeter Feiner }
1720794c67a9SPeter Feiner 
17219d7eaa29SArthur Chunqi Li static int test_run(struct vmx_test *test)
17229d7eaa29SArthur Chunqi Li {
1723794c67a9SPeter Feiner 	int r;
1724794c67a9SPeter Feiner 
1725794c67a9SPeter Feiner 	/* Validate V2 interface. */
1726794c67a9SPeter Feiner 	if (test->v2) {
1727794c67a9SPeter Feiner 		int ret = 0;
1728794c67a9SPeter Feiner 		if (test->init || test->guest_main || test->exit_handler ||
1729794c67a9SPeter Feiner 		    test->syscall_handler) {
1730*a299895bSThomas Huth 			report(0, "V2 test cannot specify V1 callbacks.");
1731794c67a9SPeter Feiner 			ret = 1;
1732794c67a9SPeter Feiner 		}
1733794c67a9SPeter Feiner 		if (ret)
1734794c67a9SPeter Feiner 			return ret;
1735794c67a9SPeter Feiner 	}
1736794c67a9SPeter Feiner 
17379d7eaa29SArthur Chunqi Li 	if (test->name == NULL)
17389d7eaa29SArthur Chunqi Li 		test->name = "(no name)";
17399d7eaa29SArthur Chunqi Li 	if (vmx_on()) {
17409d7eaa29SArthur Chunqi Li 		printf("%s : vmxon failed.\n", __func__);
17419d7eaa29SArthur Chunqi Li 		return 1;
17429d7eaa29SArthur Chunqi Li 	}
1743794c67a9SPeter Feiner 
17449d7eaa29SArthur Chunqi Li 	init_vmcs(&(test->vmcs));
17459d7eaa29SArthur Chunqi Li 	/* Directly call test->init is ok here, init_vmcs has done
17469d7eaa29SArthur Chunqi Li 	   vmcs init, vmclear and vmptrld*/
1747c592c151SJan Kiszka 	if (test->init && test->init(test->vmcs) != VMX_TEST_START)
1748a0e30e71SPaolo Bonzini 		goto out;
1749794c67a9SPeter Feiner 	teardown_count = 0;
1750794c67a9SPeter Feiner 	v2_guest_main = NULL;
17519d7eaa29SArthur Chunqi Li 	test->exits = 0;
17529d7eaa29SArthur Chunqi Li 	current = test;
17539d7eaa29SArthur Chunqi Li 	regs = test->guest_regs;
17549d7eaa29SArthur Chunqi Li 	vmcs_write(GUEST_RFLAGS, regs.rflags | 0x2);
17559d7eaa29SArthur Chunqi Li 	launched = 0;
1756794c67a9SPeter Feiner 	guest_finished = 0;
17579d7eaa29SArthur Chunqi Li 	printf("\nTest suite: %s\n", test->name);
1758794c67a9SPeter Feiner 
1759794c67a9SPeter Feiner 	r = setjmp(abort_target);
1760794c67a9SPeter Feiner 	if (r) {
1761794c67a9SPeter Feiner 		assert(!in_guest);
1762794c67a9SPeter Feiner 		goto out;
1763794c67a9SPeter Feiner 	}
1764794c67a9SPeter Feiner 
1765794c67a9SPeter Feiner 
1766794c67a9SPeter Feiner 	if (test->v2)
1767794c67a9SPeter Feiner 		test->v2();
1768794c67a9SPeter Feiner 	else
17699d7eaa29SArthur Chunqi Li 		vmx_run();
1770794c67a9SPeter Feiner 
1771794c67a9SPeter Feiner 	while (teardown_count > 0)
1772794c67a9SPeter Feiner 		run_teardown_step(&teardown_steps[--teardown_count]);
1773794c67a9SPeter Feiner 
1774794c67a9SPeter Feiner 	if (launched && !guest_finished)
1775*a299895bSThomas Huth 		report(0, "Guest didn't run to completion.");
1776794c67a9SPeter Feiner 
1777a0e30e71SPaolo Bonzini out:
17789d7eaa29SArthur Chunqi Li 	if (vmx_off()) {
17799d7eaa29SArthur Chunqi Li 		printf("%s : vmxoff failed.\n", __func__);
17809d7eaa29SArthur Chunqi Li 		return 1;
17819d7eaa29SArthur Chunqi Li 	}
17829d7eaa29SArthur Chunqi Li 	return 0;
17839d7eaa29SArthur Chunqi Li }
17849d7eaa29SArthur Chunqi Li 
1785794c67a9SPeter Feiner /*
1786794c67a9SPeter Feiner  * Add a teardown step. Executed after the test's main function returns.
1787794c67a9SPeter Feiner  * Teardown steps executed in reverse order.
1788794c67a9SPeter Feiner  */
1789794c67a9SPeter Feiner void test_add_teardown(test_teardown_func func, void *data)
1790794c67a9SPeter Feiner {
1791794c67a9SPeter Feiner 	struct test_teardown_step *step;
1792794c67a9SPeter Feiner 
1793794c67a9SPeter Feiner 	TEST_ASSERT_MSG(teardown_count < MAX_TEST_TEARDOWN_STEPS,
1794794c67a9SPeter Feiner 			"There are already %d teardown steps.",
1795794c67a9SPeter Feiner 			teardown_count);
1796794c67a9SPeter Feiner 	step = &teardown_steps[teardown_count++];
1797794c67a9SPeter Feiner 	step->func = func;
1798794c67a9SPeter Feiner 	step->data = data;
1799794c67a9SPeter Feiner }
1800794c67a9SPeter Feiner 
1801794c67a9SPeter Feiner /*
1802794c67a9SPeter Feiner  * Set the target of the first enter_guest call. Can only be called once per
1803794c67a9SPeter Feiner  * test. Must be called before first enter_guest call.
1804794c67a9SPeter Feiner  */
1805794c67a9SPeter Feiner void test_set_guest(test_guest_func func)
1806794c67a9SPeter Feiner {
1807794c67a9SPeter Feiner 	assert(current->v2);
1808794c67a9SPeter Feiner 	TEST_ASSERT_MSG(!v2_guest_main, "Already set guest func.");
1809794c67a9SPeter Feiner 	v2_guest_main = func;
1810794c67a9SPeter Feiner }
1811794c67a9SPeter Feiner 
18124ce739beSMarc Orr static void check_for_guest_termination(void)
18134ce739beSMarc Orr {
18144ce739beSMarc Orr 	if (is_hypercall()) {
18154ce739beSMarc Orr 		int ret;
18164ce739beSMarc Orr 
18174ce739beSMarc Orr 		ret = handle_hypercall();
18184ce739beSMarc Orr 		switch (ret) {
18194ce739beSMarc Orr 		case VMX_TEST_VMEXIT:
18204ce739beSMarc Orr 			guest_finished = 1;
18214ce739beSMarc Orr 			break;
18224ce739beSMarc Orr 		case VMX_TEST_VMABORT:
18234ce739beSMarc Orr 			continue_abort();
18244ce739beSMarc Orr 			break;
18254ce739beSMarc Orr 		case VMX_TEST_VMSKIP:
18264ce739beSMarc Orr 			continue_skip();
18274ce739beSMarc Orr 			break;
18284ce739beSMarc Orr 		default:
18294ce739beSMarc Orr 			printf("ERROR : Invalid handle_hypercall return %d.\n",
18304ce739beSMarc Orr 			       ret);
18314ce739beSMarc Orr 			abort();
18324ce739beSMarc Orr 		}
18334ce739beSMarc Orr 	}
18344ce739beSMarc Orr }
18354ce739beSMarc Orr 
183674f7e9b2SKrish Sadhukhan #define        ABORT_ON_EARLY_VMENTRY_FAIL     0x1
183774f7e9b2SKrish Sadhukhan #define        ABORT_ON_INVALID_GUEST_STATE    0x2
183874f7e9b2SKrish Sadhukhan 
1839794c67a9SPeter Feiner /*
1840794c67a9SPeter Feiner  * Enters the guest (or launches it for the first time). Error to call once the
184174f7e9b2SKrish Sadhukhan  * guest has returned (i.e., run past the end of its guest() function).
1842794c67a9SPeter Feiner  */
184374f7e9b2SKrish Sadhukhan static void __enter_guest(u8 abort_flag, struct vmentry_failure *failure)
1844794c67a9SPeter Feiner {
1845794c67a9SPeter Feiner 	TEST_ASSERT_MSG(v2_guest_main,
1846794c67a9SPeter Feiner 			"Never called test_set_guest_func!");
1847794c67a9SPeter Feiner 
1848794c67a9SPeter Feiner 	TEST_ASSERT_MSG(!guest_finished,
1849794c67a9SPeter Feiner 			"Called enter_guest() after guest returned.");
1850794c67a9SPeter Feiner 
185174f7e9b2SKrish Sadhukhan 	vmx_enter_guest(failure);
185274f7e9b2SKrish Sadhukhan 	if ((abort_flag & ABORT_ON_EARLY_VMENTRY_FAIL && failure->early) ||
185374f7e9b2SKrish Sadhukhan 	    (abort_flag & ABORT_ON_INVALID_GUEST_STATE &&
185474f7e9b2SKrish Sadhukhan 	    vmcs_read(EXI_REASON) & VMX_ENTRY_FAILURE)) {
185574f7e9b2SKrish Sadhukhan 
185674f7e9b2SKrish Sadhukhan 		print_vmentry_failure_info(failure);
1857794c67a9SPeter Feiner 		abort();
1858794c67a9SPeter Feiner 	}
1859794c67a9SPeter Feiner 
1860e9554497SMarc Orr 	if (!failure->early && !(vmcs_read(EXI_REASON) & VMX_ENTRY_FAILURE)) {
1861794c67a9SPeter Feiner 		launched = 1;
18624ce739beSMarc Orr 		check_for_guest_termination();
18634ce739beSMarc Orr 	}
186474f7e9b2SKrish Sadhukhan }
1865794c67a9SPeter Feiner 
18664ce739beSMarc Orr void enter_guest_with_bad_controls(void)
18674ce739beSMarc Orr {
186874f7e9b2SKrish Sadhukhan 	struct vmentry_failure failure = {0};
18694ce739beSMarc Orr 
18704ce739beSMarc Orr 	TEST_ASSERT_MSG(v2_guest_main,
18714ce739beSMarc Orr 			"Never called test_set_guest_func!");
18724ce739beSMarc Orr 
18734ce739beSMarc Orr 	TEST_ASSERT_MSG(!guest_finished,
18744ce739beSMarc Orr 			"Called enter_guest() after guest returned.");
18754ce739beSMarc Orr 
187674f7e9b2SKrish Sadhukhan 	__enter_guest(ABORT_ON_INVALID_GUEST_STATE, &failure);
1877*a299895bSThomas Huth 	report(failure.early, "failure occurred early");
1878*a299895bSThomas Huth 	report((failure.flags & VMX_ENTRY_FLAGS) == X86_EFLAGS_ZF,
1879*a299895bSThomas Huth                "FLAGS set correctly");
1880*a299895bSThomas Huth 	report(vmcs_read(VMX_INST_ERROR) == VMXERR_ENTRY_INVALID_CONTROL_FIELD,
1881*a299895bSThomas Huth 	       "VM-Inst Error # is %d (VM entry with invalid control field(s))",
18824ce739beSMarc Orr 	       VMXERR_ENTRY_INVALID_CONTROL_FIELD);
18834ce739beSMarc Orr 
18844ce739beSMarc Orr 	/*
18854ce739beSMarc Orr 	 * This if statement shouldn't fire, as the entire premise of this
18864ce739beSMarc Orr 	 * function is that VM entry is expected to fail, rather than succeed
18874ce739beSMarc Orr 	 * and execute to termination. However, if the VM entry does
18884ce739beSMarc Orr 	 * unexpectedly succeed, it's nice to check whether the guest has
18894ce739beSMarc Orr 	 * terminated, to reduce the number of error messages.
18904ce739beSMarc Orr 	 */
189174f7e9b2SKrish Sadhukhan 	if (!failure.early)
18924ce739beSMarc Orr 		check_for_guest_termination();
1893794c67a9SPeter Feiner }
1894794c67a9SPeter Feiner 
189574f7e9b2SKrish Sadhukhan void enter_guest(void)
189674f7e9b2SKrish Sadhukhan {
189774f7e9b2SKrish Sadhukhan 	struct vmentry_failure failure = {0};
189874f7e9b2SKrish Sadhukhan 
189974f7e9b2SKrish Sadhukhan 	__enter_guest(ABORT_ON_EARLY_VMENTRY_FAIL |
190074f7e9b2SKrish Sadhukhan 		      ABORT_ON_INVALID_GUEST_STATE, &failure);
190174f7e9b2SKrish Sadhukhan }
190274f7e9b2SKrish Sadhukhan 
190374f7e9b2SKrish Sadhukhan void enter_guest_with_invalid_guest_state(void)
190474f7e9b2SKrish Sadhukhan {
190574f7e9b2SKrish Sadhukhan 	struct vmentry_failure failure = {0};
190674f7e9b2SKrish Sadhukhan 
190774f7e9b2SKrish Sadhukhan 	__enter_guest(ABORT_ON_EARLY_VMENTRY_FAIL, &failure);
190874f7e9b2SKrish Sadhukhan }
190974f7e9b2SKrish Sadhukhan 
19103ee34093SArthur Chunqi Li extern struct vmx_test vmx_tests[];
19119d7eaa29SArthur Chunqi Li 
1912875b97b3SPeter Feiner static bool
1913875b97b3SPeter Feiner test_wanted(const char *name, const char *filters[], int filter_count)
19148029cac7SPeter Feiner {
1915875b97b3SPeter Feiner 	int i;
1916875b97b3SPeter Feiner 	bool positive = false;
1917875b97b3SPeter Feiner 	bool match = false;
1918875b97b3SPeter Feiner 	char clean_name[strlen(name) + 1];
1919875b97b3SPeter Feiner 	char *c;
19208029cac7SPeter Feiner 	const char *n;
19218029cac7SPeter Feiner 
1922875b97b3SPeter Feiner 	/* Replace spaces with underscores. */
1923875b97b3SPeter Feiner 	n = name;
1924875b97b3SPeter Feiner 	c = &clean_name[0];
1925875b97b3SPeter Feiner 	do *c++ = (*n == ' ') ? '_' : *n;
1926875b97b3SPeter Feiner 	while (*n++);
1927875b97b3SPeter Feiner 
1928875b97b3SPeter Feiner 	for (i = 0; i < filter_count; i++) {
1929875b97b3SPeter Feiner 		const char *filter = filters[i];
1930875b97b3SPeter Feiner 
1931875b97b3SPeter Feiner 		if (filter[0] == '-') {
1932875b97b3SPeter Feiner 			if (simple_glob(clean_name, filter + 1))
1933875b97b3SPeter Feiner 				return false;
1934875b97b3SPeter Feiner 		} else {
1935875b97b3SPeter Feiner 			positive = true;
1936875b97b3SPeter Feiner 			match |= simple_glob(clean_name, filter);
1937875b97b3SPeter Feiner 		}
1938875b97b3SPeter Feiner 	}
1939875b97b3SPeter Feiner 
1940875b97b3SPeter Feiner 	if (!positive || match) {
1941875b97b3SPeter Feiner 		matched++;
1942875b97b3SPeter Feiner 		return true;
1943875b97b3SPeter Feiner 	} else {
19448029cac7SPeter Feiner 		return false;
19458029cac7SPeter Feiner 	}
19468029cac7SPeter Feiner }
19478029cac7SPeter Feiner 
1948875b97b3SPeter Feiner int main(int argc, const char *argv[])
19499d7eaa29SArthur Chunqi Li {
19503ee34093SArthur Chunqi Li 	int i = 0;
19519d7eaa29SArthur Chunqi Li 
19529d7eaa29SArthur Chunqi Li 	setup_vm();
1953706cad23SArbel Moshe 	smp_init();
19543ee34093SArthur Chunqi Li 	hypercall_field = 0;
19559d7eaa29SArthur Chunqi Li 
19567371c622SVitaly Kuznetsov 	/* We want xAPIC mode to test MMIO passthrough from L1 (us) to L2.  */
19577371c622SVitaly Kuznetsov 	reset_apic();
19587371c622SVitaly Kuznetsov 
1959c04259ffSDavid Matlack 	argv++;
1960c04259ffSDavid Matlack 	argc--;
1961c04259ffSDavid Matlack 
1962badc98caSKrish Sadhukhan 	if (!this_cpu_has(X86_FEATURE_VMX)) {
19633b127446SJan Kiszka 		printf("WARNING: vmx not supported, add '-cpu host'\n");
19649d7eaa29SArthur Chunqi Li 		goto exit;
19659d7eaa29SArthur Chunqi Li 	}
196693f10d6fSLiran Alon 	init_bsp_vmx();
1967c04259ffSDavid Matlack 	if (test_wanted("test_vmx_feature_control", argv, argc)) {
1968c04259ffSDavid Matlack 		/* Sets MSR_IA32_FEATURE_CONTROL to 0x5 */
19693b127446SJan Kiszka 		if (test_vmx_feature_control() != 0)
19703b127446SJan Kiszka 			goto exit;
1971c04259ffSDavid Matlack 	} else {
1972883f3fccSLiran Alon 		enable_vmx();
1973c04259ffSDavid Matlack 	}
1974c04259ffSDavid Matlack 
1975c04259ffSDavid Matlack 	if (test_wanted("test_vmxon", argv, argc)) {
1976c04259ffSDavid Matlack 		/* Enables VMX */
19779d7eaa29SArthur Chunqi Li 		if (test_vmxon() != 0)
19789d7eaa29SArthur Chunqi Li 			goto exit;
1979c04259ffSDavid Matlack 	} else {
1980c04259ffSDavid Matlack 		if (vmx_on()) {
1981*a299895bSThomas Huth 			report(0, "vmxon");
1982c04259ffSDavid Matlack 			goto exit;
1983c04259ffSDavid Matlack 		}
1984c04259ffSDavid Matlack 	}
1985c04259ffSDavid Matlack 
1986c04259ffSDavid Matlack 	if (test_wanted("test_vmptrld", argv, argc))
19879d7eaa29SArthur Chunqi Li 		test_vmptrld();
1988c04259ffSDavid Matlack 	if (test_wanted("test_vmclear", argv, argc))
19899d7eaa29SArthur Chunqi Li 		test_vmclear();
1990c04259ffSDavid Matlack 	if (test_wanted("test_vmptrst", argv, argc))
19919d7eaa29SArthur Chunqi Li 		test_vmptrst();
1992ecd5b431SDavid Matlack 	if (test_wanted("test_vmwrite_vmread", argv, argc))
1993ecd5b431SDavid Matlack 		test_vmwrite_vmread();
199459161cfaSJim Mattson 	if (test_wanted("test_vmcs_high", argv, argc))
199559161cfaSJim Mattson 		test_vmcs_high();
19966b72cf76SDavid Matlack 	if (test_wanted("test_vmcs_lifecycle", argv, argc))
19976b72cf76SDavid Matlack 		test_vmcs_lifecycle();
1998c04259ffSDavid Matlack 	if (test_wanted("test_vmx_caps", argv, argc))
199969c8d31cSJan Kiszka 		test_vmx_caps();
20009d7eaa29SArthur Chunqi Li 
200134439b1aSPeter Feiner 	/* Balance vmxon from test_vmxon. */
200234439b1aSPeter Feiner 	vmx_off();
200334439b1aSPeter Feiner 
200434439b1aSPeter Feiner 	for (; vmx_tests[i].name != NULL; i++) {
2005c04259ffSDavid Matlack 		if (!test_wanted(vmx_tests[i].name, argv, argc))
20068029cac7SPeter Feiner 			continue;
20079d7eaa29SArthur Chunqi Li 		if (test_run(&vmx_tests[i]))
20089d7eaa29SArthur Chunqi Li 			goto exit;
20098029cac7SPeter Feiner 	}
20108029cac7SPeter Feiner 
20118029cac7SPeter Feiner 	if (!matched)
2012*a299895bSThomas Huth 		report(matched, "command line didn't match any tests!");
20139d7eaa29SArthur Chunqi Li 
20149d7eaa29SArthur Chunqi Li exit:
2015f3cdd159SJan Kiszka 	return report_summary();
20169d7eaa29SArthur Chunqi Li }
2017