Home | History | Annotate | Line # | Download | only in x86
nvmm_x86_vmx.c revision 1.68
      1 /*	$NetBSD: nvmm_x86_vmx.c,v 1.68 2020/08/11 15:27:46 maxv Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 2018-2020 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Maxime Villard.
      9  *
     10  * Redistribution and use in source and binary forms, with or without
     11  * modification, are permitted provided that the following conditions
     12  * are met:
     13  * 1. Redistributions of source code must retain the above copyright
     14  *    notice, this list of conditions and the following disclaimer.
     15  * 2. Redistributions in binary form must reproduce the above copyright
     16  *    notice, this list of conditions and the following disclaimer in the
     17  *    documentation and/or other materials provided with the distribution.
     18  *
     19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  * POSSIBILITY OF SUCH DAMAGE.
     30  */
     31 
     32 #include <sys/cdefs.h>
     33 __KERNEL_RCSID(0, "$NetBSD: nvmm_x86_vmx.c,v 1.68 2020/08/11 15:27:46 maxv Exp $");
     34 
     35 #include <sys/param.h>
     36 #include <sys/systm.h>
     37 #include <sys/kernel.h>
     38 #include <sys/kmem.h>
     39 #include <sys/cpu.h>
     40 #include <sys/xcall.h>
     41 #include <sys/mman.h>
     42 #include <sys/bitops.h>
     43 
     44 #include <uvm/uvm.h>
     45 #include <uvm/uvm_page.h>
     46 
     47 #include <x86/cputypes.h>
     48 #include <x86/specialreg.h>
     49 #include <x86/pmap.h>
     50 #include <x86/dbregs.h>
     51 #include <x86/cpu_counter.h>
     52 #include <machine/cpuvar.h>
     53 
     54 #include <dev/nvmm/nvmm.h>
     55 #include <dev/nvmm/nvmm_internal.h>
     56 #include <dev/nvmm/x86/nvmm_x86.h>
     57 
     58 int _vmx_vmxon(paddr_t *pa);
     59 int _vmx_vmxoff(void);
     60 int vmx_vmlaunch(uint64_t *gprs);
     61 int vmx_vmresume(uint64_t *gprs);
     62 
     63 #define vmx_vmxon(a) \
     64 	if (__predict_false(_vmx_vmxon(a) != 0)) { \
     65 		panic("%s: VMXON failed", __func__); \
     66 	}
     67 #define vmx_vmxoff() \
     68 	if (__predict_false(_vmx_vmxoff() != 0)) { \
     69 		panic("%s: VMXOFF failed", __func__); \
     70 	}
     71 
     72 struct ept_desc {
     73 	uint64_t eptp;
     74 	uint64_t mbz;
     75 } __packed;
     76 
     77 struct vpid_desc {
     78 	uint64_t vpid;
     79 	uint64_t addr;
     80 } __packed;
     81 
     82 static inline void
     83 vmx_invept(uint64_t op, struct ept_desc *desc)
     84 {
     85 	asm volatile (
     86 		"invept		%[desc],%[op];"
     87 		"jz		vmx_insn_failvalid;"
     88 		"jc		vmx_insn_failinvalid;"
     89 		:
     90 		: [desc] "m" (*desc), [op] "r" (op)
     91 		: "memory", "cc"
     92 	);
     93 }
     94 
     95 static inline void
     96 vmx_invvpid(uint64_t op, struct vpid_desc *desc)
     97 {
     98 	asm volatile (
     99 		"invvpid	%[desc],%[op];"
    100 		"jz		vmx_insn_failvalid;"
    101 		"jc		vmx_insn_failinvalid;"
    102 		:
    103 		: [desc] "m" (*desc), [op] "r" (op)
    104 		: "memory", "cc"
    105 	);
    106 }
    107 
    108 static inline uint64_t
    109 vmx_vmread(uint64_t field)
    110 {
    111 	uint64_t value;
    112 
    113 	asm volatile (
    114 		"vmread		%[field],%[value];"
    115 		"jz		vmx_insn_failvalid;"
    116 		"jc		vmx_insn_failinvalid;"
    117 		: [value] "=r" (value)
    118 		: [field] "r" (field)
    119 		: "cc"
    120 	);
    121 
    122 	return value;
    123 }
    124 
    125 static inline void
    126 vmx_vmwrite(uint64_t field, uint64_t value)
    127 {
    128 	asm volatile (
    129 		"vmwrite	%[value],%[field];"
    130 		"jz		vmx_insn_failvalid;"
    131 		"jc		vmx_insn_failinvalid;"
    132 		:
    133 		: [field] "r" (field), [value] "r" (value)
    134 		: "cc"
    135 	);
    136 }
    137 
    138 #ifdef DIAGNOSTIC
    139 static inline paddr_t
    140 vmx_vmptrst(void)
    141 {
    142 	paddr_t pa;
    143 
    144 	asm volatile (
    145 		"vmptrst	%[pa];"
    146 		:
    147 		: [pa] "m" (*(paddr_t *)&pa)
    148 		: "memory"
    149 	);
    150 
    151 	return pa;
    152 }
    153 #endif
    154 
    155 static inline void
    156 vmx_vmptrld(paddr_t *pa)
    157 {
    158 	asm volatile (
    159 		"vmptrld	%[pa];"
    160 		"jz		vmx_insn_failvalid;"
    161 		"jc		vmx_insn_failinvalid;"
    162 		:
    163 		: [pa] "m" (*pa)
    164 		: "memory", "cc"
    165 	);
    166 }
    167 
    168 static inline void
    169 vmx_vmclear(paddr_t *pa)
    170 {
    171 	asm volatile (
    172 		"vmclear	%[pa];"
    173 		"jz		vmx_insn_failvalid;"
    174 		"jc		vmx_insn_failinvalid;"
    175 		:
    176 		: [pa] "m" (*pa)
    177 		: "memory", "cc"
    178 	);
    179 }
    180 
    181 static inline void
    182 vmx_cli(void)
    183 {
    184 	asm volatile ("cli" ::: "memory");
    185 }
    186 
    187 static inline void
    188 vmx_sti(void)
    189 {
    190 	asm volatile ("sti" ::: "memory");
    191 }
    192 
    193 #define MSR_IA32_FEATURE_CONTROL	0x003A
    194 #define		IA32_FEATURE_CONTROL_LOCK	__BIT(0)
    195 #define		IA32_FEATURE_CONTROL_IN_SMX	__BIT(1)
    196 #define		IA32_FEATURE_CONTROL_OUT_SMX	__BIT(2)
    197 
    198 #define MSR_IA32_VMX_BASIC		0x0480
    199 #define		IA32_VMX_BASIC_IDENT		__BITS(30,0)
    200 #define		IA32_VMX_BASIC_DATA_SIZE	__BITS(44,32)
    201 #define		IA32_VMX_BASIC_MEM_WIDTH	__BIT(48)
    202 #define		IA32_VMX_BASIC_DUAL		__BIT(49)
    203 #define		IA32_VMX_BASIC_MEM_TYPE		__BITS(53,50)
    204 #define			MEM_TYPE_UC		0
    205 #define			MEM_TYPE_WB		6
    206 #define		IA32_VMX_BASIC_IO_REPORT	__BIT(54)
    207 #define		IA32_VMX_BASIC_TRUE_CTLS	__BIT(55)
    208 
    209 #define MSR_IA32_VMX_PINBASED_CTLS		0x0481
    210 #define MSR_IA32_VMX_PROCBASED_CTLS		0x0482
    211 #define MSR_IA32_VMX_EXIT_CTLS			0x0483
    212 #define MSR_IA32_VMX_ENTRY_CTLS			0x0484
    213 #define MSR_IA32_VMX_PROCBASED_CTLS2		0x048B
    214 
    215 #define MSR_IA32_VMX_TRUE_PINBASED_CTLS		0x048D
    216 #define MSR_IA32_VMX_TRUE_PROCBASED_CTLS	0x048E
    217 #define MSR_IA32_VMX_TRUE_EXIT_CTLS		0x048F
    218 #define MSR_IA32_VMX_TRUE_ENTRY_CTLS		0x0490
    219 
    220 #define MSR_IA32_VMX_CR0_FIXED0			0x0486
    221 #define MSR_IA32_VMX_CR0_FIXED1			0x0487
    222 #define MSR_IA32_VMX_CR4_FIXED0			0x0488
    223 #define MSR_IA32_VMX_CR4_FIXED1			0x0489
    224 
    225 #define MSR_IA32_VMX_EPT_VPID_CAP	0x048C
    226 #define		IA32_VMX_EPT_VPID_XO			__BIT(0)
    227 #define		IA32_VMX_EPT_VPID_WALKLENGTH_4		__BIT(6)
    228 #define		IA32_VMX_EPT_VPID_UC			__BIT(8)
    229 #define		IA32_VMX_EPT_VPID_WB			__BIT(14)
    230 #define		IA32_VMX_EPT_VPID_2MB			__BIT(16)
    231 #define		IA32_VMX_EPT_VPID_1GB			__BIT(17)
    232 #define		IA32_VMX_EPT_VPID_INVEPT		__BIT(20)
    233 #define		IA32_VMX_EPT_VPID_FLAGS_AD		__BIT(21)
    234 #define		IA32_VMX_EPT_VPID_ADVANCED_VMEXIT_INFO	__BIT(22)
    235 #define		IA32_VMX_EPT_VPID_SHSTK			__BIT(23)
    236 #define		IA32_VMX_EPT_VPID_INVEPT_CONTEXT	__BIT(25)
    237 #define		IA32_VMX_EPT_VPID_INVEPT_ALL		__BIT(26)
    238 #define		IA32_VMX_EPT_VPID_INVVPID		__BIT(32)
    239 #define		IA32_VMX_EPT_VPID_INVVPID_ADDR		__BIT(40)
    240 #define		IA32_VMX_EPT_VPID_INVVPID_CONTEXT	__BIT(41)
    241 #define		IA32_VMX_EPT_VPID_INVVPID_ALL		__BIT(42)
    242 #define		IA32_VMX_EPT_VPID_INVVPID_CONTEXT_NOG	__BIT(43)
    243 
    244 /* -------------------------------------------------------------------------- */
    245 
    246 /* 16-bit control fields */
    247 #define VMCS_VPID				0x00000000
    248 #define VMCS_PIR_VECTOR				0x00000002
    249 #define VMCS_EPTP_INDEX				0x00000004
    250 /* 16-bit guest-state fields */
    251 #define VMCS_GUEST_ES_SELECTOR			0x00000800
    252 #define VMCS_GUEST_CS_SELECTOR			0x00000802
    253 #define VMCS_GUEST_SS_SELECTOR			0x00000804
    254 #define VMCS_GUEST_DS_SELECTOR			0x00000806
    255 #define VMCS_GUEST_FS_SELECTOR			0x00000808
    256 #define VMCS_GUEST_GS_SELECTOR			0x0000080A
    257 #define VMCS_GUEST_LDTR_SELECTOR		0x0000080C
    258 #define VMCS_GUEST_TR_SELECTOR			0x0000080E
    259 #define VMCS_GUEST_INTR_STATUS			0x00000810
    260 #define VMCS_PML_INDEX				0x00000812
    261 /* 16-bit host-state fields */
    262 #define VMCS_HOST_ES_SELECTOR			0x00000C00
    263 #define VMCS_HOST_CS_SELECTOR			0x00000C02
    264 #define VMCS_HOST_SS_SELECTOR			0x00000C04
    265 #define VMCS_HOST_DS_SELECTOR			0x00000C06
    266 #define VMCS_HOST_FS_SELECTOR			0x00000C08
    267 #define VMCS_HOST_GS_SELECTOR			0x00000C0A
    268 #define VMCS_HOST_TR_SELECTOR			0x00000C0C
    269 /* 64-bit control fields */
    270 #define VMCS_IO_BITMAP_A			0x00002000
    271 #define VMCS_IO_BITMAP_B			0x00002002
    272 #define VMCS_MSR_BITMAP				0x00002004
    273 #define VMCS_EXIT_MSR_STORE_ADDRESS		0x00002006
    274 #define VMCS_EXIT_MSR_LOAD_ADDRESS		0x00002008
    275 #define VMCS_ENTRY_MSR_LOAD_ADDRESS		0x0000200A
    276 #define VMCS_EXECUTIVE_VMCS			0x0000200C
    277 #define VMCS_PML_ADDRESS			0x0000200E
    278 #define VMCS_TSC_OFFSET				0x00002010
    279 #define VMCS_VIRTUAL_APIC			0x00002012
    280 #define VMCS_APIC_ACCESS			0x00002014
    281 #define VMCS_PIR_DESC				0x00002016
    282 #define VMCS_VM_CONTROL				0x00002018
    283 #define VMCS_EPTP				0x0000201A
    284 #define		EPTP_TYPE			__BITS(2,0)
    285 #define			EPTP_TYPE_UC		0
    286 #define			EPTP_TYPE_WB		6
    287 #define		EPTP_WALKLEN			__BITS(5,3)
    288 #define		EPTP_FLAGS_AD			__BIT(6)
    289 #define		EPTP_SSS			__BIT(7)
    290 #define		EPTP_PHYSADDR			__BITS(63,12)
    291 #define VMCS_EOI_EXIT0				0x0000201C
    292 #define VMCS_EOI_EXIT1				0x0000201E
    293 #define VMCS_EOI_EXIT2				0x00002020
    294 #define VMCS_EOI_EXIT3				0x00002022
    295 #define VMCS_EPTP_LIST				0x00002024
    296 #define VMCS_VMREAD_BITMAP			0x00002026
    297 #define VMCS_VMWRITE_BITMAP			0x00002028
    298 #define VMCS_VIRTUAL_EXCEPTION			0x0000202A
    299 #define VMCS_XSS_EXIT_BITMAP			0x0000202C
    300 #define VMCS_ENCLS_EXIT_BITMAP			0x0000202E
    301 #define VMCS_SUBPAGE_PERM_TABLE_PTR		0x00002030
    302 #define VMCS_TSC_MULTIPLIER			0x00002032
    303 #define VMCS_ENCLV_EXIT_BITMAP			0x00002036
    304 /* 64-bit read-only fields */
    305 #define VMCS_GUEST_PHYSICAL_ADDRESS		0x00002400
    306 /* 64-bit guest-state fields */
    307 #define VMCS_LINK_POINTER			0x00002800
    308 #define VMCS_GUEST_IA32_DEBUGCTL		0x00002802
    309 #define VMCS_GUEST_IA32_PAT			0x00002804
    310 #define VMCS_GUEST_IA32_EFER			0x00002806
    311 #define VMCS_GUEST_IA32_PERF_GLOBAL_CTRL	0x00002808
    312 #define VMCS_GUEST_PDPTE0			0x0000280A
    313 #define VMCS_GUEST_PDPTE1			0x0000280C
    314 #define VMCS_GUEST_PDPTE2			0x0000280E
    315 #define VMCS_GUEST_PDPTE3			0x00002810
    316 #define VMCS_GUEST_BNDCFGS			0x00002812
    317 #define VMCS_GUEST_RTIT_CTL			0x00002814
    318 #define VMCS_GUEST_PKRS				0x00002818
    319 /* 64-bit host-state fields */
    320 #define VMCS_HOST_IA32_PAT			0x00002C00
    321 #define VMCS_HOST_IA32_EFER			0x00002C02
    322 #define VMCS_HOST_IA32_PERF_GLOBAL_CTRL		0x00002C04
    323 #define VMCS_HOST_IA32_PKRS			0x00002C06
    324 /* 32-bit control fields */
    325 #define VMCS_PINBASED_CTLS			0x00004000
    326 #define		PIN_CTLS_INT_EXITING		__BIT(0)
    327 #define		PIN_CTLS_NMI_EXITING		__BIT(3)
    328 #define		PIN_CTLS_VIRTUAL_NMIS		__BIT(5)
    329 #define		PIN_CTLS_ACTIVATE_PREEMPT_TIMER	__BIT(6)
    330 #define		PIN_CTLS_PROCESS_POSTED_INTS	__BIT(7)
    331 #define VMCS_PROCBASED_CTLS			0x00004002
    332 #define		PROC_CTLS_INT_WINDOW_EXITING	__BIT(2)
    333 #define		PROC_CTLS_USE_TSC_OFFSETTING	__BIT(3)
    334 #define		PROC_CTLS_HLT_EXITING		__BIT(7)
    335 #define		PROC_CTLS_INVLPG_EXITING	__BIT(9)
    336 #define		PROC_CTLS_MWAIT_EXITING		__BIT(10)
    337 #define		PROC_CTLS_RDPMC_EXITING		__BIT(11)
    338 #define		PROC_CTLS_RDTSC_EXITING		__BIT(12)
    339 #define		PROC_CTLS_RCR3_EXITING		__BIT(15)
    340 #define		PROC_CTLS_LCR3_EXITING		__BIT(16)
    341 #define		PROC_CTLS_RCR8_EXITING		__BIT(19)
    342 #define		PROC_CTLS_LCR8_EXITING		__BIT(20)
    343 #define		PROC_CTLS_USE_TPR_SHADOW	__BIT(21)
    344 #define		PROC_CTLS_NMI_WINDOW_EXITING	__BIT(22)
    345 #define		PROC_CTLS_DR_EXITING		__BIT(23)
    346 #define		PROC_CTLS_UNCOND_IO_EXITING	__BIT(24)
    347 #define		PROC_CTLS_USE_IO_BITMAPS	__BIT(25)
    348 #define		PROC_CTLS_MONITOR_TRAP_FLAG	__BIT(27)
    349 #define		PROC_CTLS_USE_MSR_BITMAPS	__BIT(28)
    350 #define		PROC_CTLS_MONITOR_EXITING	__BIT(29)
    351 #define		PROC_CTLS_PAUSE_EXITING		__BIT(30)
    352 #define		PROC_CTLS_ACTIVATE_CTLS2	__BIT(31)
    353 #define VMCS_EXCEPTION_BITMAP			0x00004004
    354 #define VMCS_PF_ERROR_MASK			0x00004006
    355 #define VMCS_PF_ERROR_MATCH			0x00004008
    356 #define VMCS_CR3_TARGET_COUNT			0x0000400A
    357 #define VMCS_EXIT_CTLS				0x0000400C
    358 #define		EXIT_CTLS_SAVE_DEBUG_CONTROLS	__BIT(2)
    359 #define		EXIT_CTLS_HOST_LONG_MODE	__BIT(9)
    360 #define		EXIT_CTLS_LOAD_PERFGLOBALCTRL	__BIT(12)
    361 #define		EXIT_CTLS_ACK_INTERRUPT		__BIT(15)
    362 #define		EXIT_CTLS_SAVE_PAT		__BIT(18)
    363 #define		EXIT_CTLS_LOAD_PAT		__BIT(19)
    364 #define		EXIT_CTLS_SAVE_EFER		__BIT(20)
    365 #define		EXIT_CTLS_LOAD_EFER		__BIT(21)
    366 #define		EXIT_CTLS_SAVE_PREEMPT_TIMER	__BIT(22)
    367 #define		EXIT_CTLS_CLEAR_BNDCFGS		__BIT(23)
    368 #define		EXIT_CTLS_CONCEAL_PT		__BIT(24)
    369 #define		EXIT_CTLS_CLEAR_RTIT_CTL	__BIT(25)
    370 #define		EXIT_CTLS_LOAD_CET		__BIT(28)
    371 #define		EXIT_CTLS_LOAD_PKRS		__BIT(29)
    372 #define VMCS_EXIT_MSR_STORE_COUNT		0x0000400E
    373 #define VMCS_EXIT_MSR_LOAD_COUNT		0x00004010
    374 #define VMCS_ENTRY_CTLS				0x00004012
    375 #define		ENTRY_CTLS_LOAD_DEBUG_CONTROLS	__BIT(2)
    376 #define		ENTRY_CTLS_LONG_MODE		__BIT(9)
    377 #define		ENTRY_CTLS_SMM			__BIT(10)
    378 #define		ENTRY_CTLS_DISABLE_DUAL		__BIT(11)
    379 #define		ENTRY_CTLS_LOAD_PERFGLOBALCTRL	__BIT(13)
    380 #define		ENTRY_CTLS_LOAD_PAT		__BIT(14)
    381 #define		ENTRY_CTLS_LOAD_EFER		__BIT(15)
    382 #define		ENTRY_CTLS_LOAD_BNDCFGS		__BIT(16)
    383 #define		ENTRY_CTLS_CONCEAL_PT		__BIT(17)
    384 #define		ENTRY_CTLS_LOAD_RTIT_CTL	__BIT(18)
    385 #define		ENTRY_CTLS_LOAD_CET		__BIT(20)
    386 #define		ENTRY_CTLS_LOAD_PKRS		__BIT(22)
    387 #define VMCS_ENTRY_MSR_LOAD_COUNT		0x00004014
    388 #define VMCS_ENTRY_INTR_INFO			0x00004016
    389 #define		INTR_INFO_VECTOR		__BITS(7,0)
    390 #define		INTR_INFO_TYPE			__BITS(10,8)
    391 #define			INTR_TYPE_EXT_INT	0
    392 #define			INTR_TYPE_NMI		2
    393 #define			INTR_TYPE_HW_EXC	3
    394 #define			INTR_TYPE_SW_INT	4
    395 #define			INTR_TYPE_PRIV_SW_EXC	5
    396 #define			INTR_TYPE_SW_EXC	6
    397 #define			INTR_TYPE_OTHER		7
    398 #define		INTR_INFO_ERROR			__BIT(11)
    399 #define		INTR_INFO_VALID			__BIT(31)
    400 #define VMCS_ENTRY_EXCEPTION_ERROR		0x00004018
    401 #define VMCS_ENTRY_INSTRUCTION_LENGTH		0x0000401A
    402 #define VMCS_TPR_THRESHOLD			0x0000401C
    403 #define VMCS_PROCBASED_CTLS2			0x0000401E
    404 #define		PROC_CTLS2_VIRT_APIC_ACCESSES	__BIT(0)
    405 #define		PROC_CTLS2_ENABLE_EPT		__BIT(1)
    406 #define		PROC_CTLS2_DESC_TABLE_EXITING	__BIT(2)
    407 #define		PROC_CTLS2_ENABLE_RDTSCP	__BIT(3)
    408 #define		PROC_CTLS2_VIRT_X2APIC		__BIT(4)
    409 #define		PROC_CTLS2_ENABLE_VPID		__BIT(5)
    410 #define		PROC_CTLS2_WBINVD_EXITING	__BIT(6)
    411 #define		PROC_CTLS2_UNRESTRICTED_GUEST	__BIT(7)
    412 #define		PROC_CTLS2_APIC_REG_VIRT	__BIT(8)
    413 #define		PROC_CTLS2_VIRT_INT_DELIVERY	__BIT(9)
    414 #define		PROC_CTLS2_PAUSE_LOOP_EXITING	__BIT(10)
    415 #define		PROC_CTLS2_RDRAND_EXITING	__BIT(11)
    416 #define		PROC_CTLS2_INVPCID_ENABLE	__BIT(12)
    417 #define		PROC_CTLS2_VMFUNC_ENABLE	__BIT(13)
    418 #define		PROC_CTLS2_VMCS_SHADOWING	__BIT(14)
    419 #define		PROC_CTLS2_ENCLS_EXITING	__BIT(15)
    420 #define		PROC_CTLS2_RDSEED_EXITING	__BIT(16)
    421 #define		PROC_CTLS2_PML_ENABLE		__BIT(17)
    422 #define		PROC_CTLS2_EPT_VIOLATION	__BIT(18)
    423 #define		PROC_CTLS2_CONCEAL_VMX_FROM_PT	__BIT(19)
    424 #define		PROC_CTLS2_XSAVES_ENABLE	__BIT(20)
    425 #define		PROC_CTLS2_MODE_BASED_EXEC_EPT	__BIT(22)
    426 #define		PROC_CTLS2_SUBPAGE_PERMISSIONS	__BIT(23)
    427 #define		PROC_CTLS2_PT_USES_GPA		__BIT(24)
    428 #define		PROC_CTLS2_USE_TSC_SCALING	__BIT(25)
    429 #define		PROC_CTLS2_WAIT_PAUSE_ENABLE	__BIT(26)
    430 #define		PROC_CTLS2_ENCLV_EXITING	__BIT(28)
    431 #define VMCS_PLE_GAP				0x00004020
    432 #define VMCS_PLE_WINDOW				0x00004022
    433 /* 32-bit read-only data fields */
    434 #define VMCS_INSTRUCTION_ERROR			0x00004400
    435 #define VMCS_EXIT_REASON			0x00004402
    436 #define VMCS_EXIT_INTR_INFO			0x00004404
    437 #define VMCS_EXIT_INTR_ERRCODE			0x00004406
    438 #define VMCS_IDT_VECTORING_INFO			0x00004408
    439 #define VMCS_IDT_VECTORING_ERROR		0x0000440A
    440 #define VMCS_EXIT_INSTRUCTION_LENGTH		0x0000440C
    441 #define VMCS_EXIT_INSTRUCTION_INFO		0x0000440E
    442 /* 32-bit guest-state fields */
    443 #define VMCS_GUEST_ES_LIMIT			0x00004800
    444 #define VMCS_GUEST_CS_LIMIT			0x00004802
    445 #define VMCS_GUEST_SS_LIMIT			0x00004804
    446 #define VMCS_GUEST_DS_LIMIT			0x00004806
    447 #define VMCS_GUEST_FS_LIMIT			0x00004808
    448 #define VMCS_GUEST_GS_LIMIT			0x0000480A
    449 #define VMCS_GUEST_LDTR_LIMIT			0x0000480C
    450 #define VMCS_GUEST_TR_LIMIT			0x0000480E
    451 #define VMCS_GUEST_GDTR_LIMIT			0x00004810
    452 #define VMCS_GUEST_IDTR_LIMIT			0x00004812
    453 #define VMCS_GUEST_ES_ACCESS_RIGHTS		0x00004814
    454 #define VMCS_GUEST_CS_ACCESS_RIGHTS		0x00004816
    455 #define VMCS_GUEST_SS_ACCESS_RIGHTS		0x00004818
    456 #define VMCS_GUEST_DS_ACCESS_RIGHTS		0x0000481A
    457 #define VMCS_GUEST_FS_ACCESS_RIGHTS		0x0000481C
    458 #define VMCS_GUEST_GS_ACCESS_RIGHTS		0x0000481E
    459 #define VMCS_GUEST_LDTR_ACCESS_RIGHTS		0x00004820
    460 #define VMCS_GUEST_TR_ACCESS_RIGHTS		0x00004822
    461 #define VMCS_GUEST_INTERRUPTIBILITY		0x00004824
    462 #define		INT_STATE_STI			__BIT(0)
    463 #define		INT_STATE_MOVSS			__BIT(1)
    464 #define		INT_STATE_SMI			__BIT(2)
    465 #define		INT_STATE_NMI			__BIT(3)
    466 #define		INT_STATE_ENCLAVE		__BIT(4)
    467 #define VMCS_GUEST_ACTIVITY			0x00004826
    468 #define VMCS_GUEST_SMBASE			0x00004828
    469 #define VMCS_GUEST_IA32_SYSENTER_CS		0x0000482A
    470 #define VMCS_PREEMPTION_TIMER_VALUE		0x0000482E
    471 /* 32-bit host state fields */
    472 #define VMCS_HOST_IA32_SYSENTER_CS		0x00004C00
    473 /* Natural-Width control fields */
    474 #define VMCS_CR0_MASK				0x00006000
    475 #define VMCS_CR4_MASK				0x00006002
    476 #define VMCS_CR0_SHADOW				0x00006004
    477 #define VMCS_CR4_SHADOW				0x00006006
    478 #define VMCS_CR3_TARGET0			0x00006008
    479 #define VMCS_CR3_TARGET1			0x0000600A
    480 #define VMCS_CR3_TARGET2			0x0000600C
    481 #define VMCS_CR3_TARGET3			0x0000600E
    482 /* Natural-Width read-only fields */
    483 #define VMCS_EXIT_QUALIFICATION			0x00006400
    484 #define VMCS_IO_RCX				0x00006402
    485 #define VMCS_IO_RSI				0x00006404
    486 #define VMCS_IO_RDI				0x00006406
    487 #define VMCS_IO_RIP				0x00006408
    488 #define VMCS_GUEST_LINEAR_ADDRESS		0x0000640A
    489 /* Natural-Width guest-state fields */
    490 #define VMCS_GUEST_CR0				0x00006800
    491 #define VMCS_GUEST_CR3				0x00006802
    492 #define VMCS_GUEST_CR4				0x00006804
    493 #define VMCS_GUEST_ES_BASE			0x00006806
    494 #define VMCS_GUEST_CS_BASE			0x00006808
    495 #define VMCS_GUEST_SS_BASE			0x0000680A
    496 #define VMCS_GUEST_DS_BASE			0x0000680C
    497 #define VMCS_GUEST_FS_BASE			0x0000680E
    498 #define VMCS_GUEST_GS_BASE			0x00006810
    499 #define VMCS_GUEST_LDTR_BASE			0x00006812
    500 #define VMCS_GUEST_TR_BASE			0x00006814
    501 #define VMCS_GUEST_GDTR_BASE			0x00006816
    502 #define VMCS_GUEST_IDTR_BASE			0x00006818
    503 #define VMCS_GUEST_DR7				0x0000681A
    504 #define VMCS_GUEST_RSP				0x0000681C
    505 #define VMCS_GUEST_RIP				0x0000681E
    506 #define VMCS_GUEST_RFLAGS			0x00006820
    507 #define VMCS_GUEST_PENDING_DBG_EXCEPTIONS	0x00006822
    508 #define VMCS_GUEST_IA32_SYSENTER_ESP		0x00006824
    509 #define VMCS_GUEST_IA32_SYSENTER_EIP		0x00006826
    510 #define VMCS_GUEST_IA32_S_CET			0x00006828
    511 #define VMCS_GUEST_SSP				0x0000682A
    512 #define VMCS_GUEST_IA32_INTR_SSP_TABLE		0x0000682C
    513 /* Natural-Width host-state fields */
    514 #define VMCS_HOST_CR0				0x00006C00
    515 #define VMCS_HOST_CR3				0x00006C02
    516 #define VMCS_HOST_CR4				0x00006C04
    517 #define VMCS_HOST_FS_BASE			0x00006C06
    518 #define VMCS_HOST_GS_BASE			0x00006C08
    519 #define VMCS_HOST_TR_BASE			0x00006C0A
    520 #define VMCS_HOST_GDTR_BASE			0x00006C0C
    521 #define VMCS_HOST_IDTR_BASE			0x00006C0E
    522 #define VMCS_HOST_IA32_SYSENTER_ESP		0x00006C10
    523 #define VMCS_HOST_IA32_SYSENTER_EIP		0x00006C12
    524 #define VMCS_HOST_RSP				0x00006C14
    525 #define VMCS_HOST_RIP				0x00006C16
    526 #define VMCS_HOST_IA32_S_CET			0x00006C18
    527 #define VMCS_HOST_SSP				0x00006C1A
    528 #define VMCS_HOST_IA32_INTR_SSP_TABLE		0x00006C1C
    529 
    530 /* VMX basic exit reasons. */
    531 #define VMCS_EXITCODE_EXC_NMI			0
    532 #define VMCS_EXITCODE_EXT_INT			1
    533 #define VMCS_EXITCODE_SHUTDOWN			2
    534 #define VMCS_EXITCODE_INIT			3
    535 #define VMCS_EXITCODE_SIPI			4
    536 #define VMCS_EXITCODE_SMI			5
    537 #define VMCS_EXITCODE_OTHER_SMI			6
    538 #define VMCS_EXITCODE_INT_WINDOW		7
    539 #define VMCS_EXITCODE_NMI_WINDOW		8
    540 #define VMCS_EXITCODE_TASK_SWITCH		9
    541 #define VMCS_EXITCODE_CPUID			10
    542 #define VMCS_EXITCODE_GETSEC			11
    543 #define VMCS_EXITCODE_HLT			12
    544 #define VMCS_EXITCODE_INVD			13
    545 #define VMCS_EXITCODE_INVLPG			14
    546 #define VMCS_EXITCODE_RDPMC			15
    547 #define VMCS_EXITCODE_RDTSC			16
    548 #define VMCS_EXITCODE_RSM			17
    549 #define VMCS_EXITCODE_VMCALL			18
    550 #define VMCS_EXITCODE_VMCLEAR			19
    551 #define VMCS_EXITCODE_VMLAUNCH			20
    552 #define VMCS_EXITCODE_VMPTRLD			21
    553 #define VMCS_EXITCODE_VMPTRST			22
    554 #define VMCS_EXITCODE_VMREAD			23
    555 #define VMCS_EXITCODE_VMRESUME			24
    556 #define VMCS_EXITCODE_VMWRITE			25
    557 #define VMCS_EXITCODE_VMXOFF			26
    558 #define VMCS_EXITCODE_VMXON			27
    559 #define VMCS_EXITCODE_CR			28
    560 #define VMCS_EXITCODE_DR			29
    561 #define VMCS_EXITCODE_IO			30
    562 #define VMCS_EXITCODE_RDMSR			31
    563 #define VMCS_EXITCODE_WRMSR			32
    564 #define VMCS_EXITCODE_FAIL_GUEST_INVALID	33
    565 #define VMCS_EXITCODE_FAIL_MSR_INVALID		34
    566 #define VMCS_EXITCODE_MWAIT			36
    567 #define VMCS_EXITCODE_TRAP_FLAG			37
    568 #define VMCS_EXITCODE_MONITOR			39
    569 #define VMCS_EXITCODE_PAUSE			40
    570 #define VMCS_EXITCODE_FAIL_MACHINE_CHECK	41
    571 #define VMCS_EXITCODE_TPR_BELOW			43
    572 #define VMCS_EXITCODE_APIC_ACCESS		44
    573 #define VMCS_EXITCODE_VEOI			45
    574 #define VMCS_EXITCODE_GDTR_IDTR			46
    575 #define VMCS_EXITCODE_LDTR_TR			47
    576 #define VMCS_EXITCODE_EPT_VIOLATION		48
    577 #define VMCS_EXITCODE_EPT_MISCONFIG		49
    578 #define VMCS_EXITCODE_INVEPT			50
    579 #define VMCS_EXITCODE_RDTSCP			51
    580 #define VMCS_EXITCODE_PREEMPT_TIMEOUT		52
    581 #define VMCS_EXITCODE_INVVPID			53
    582 #define VMCS_EXITCODE_WBINVD			54
    583 #define VMCS_EXITCODE_XSETBV			55
    584 #define VMCS_EXITCODE_APIC_WRITE		56
    585 #define VMCS_EXITCODE_RDRAND			57
    586 #define VMCS_EXITCODE_INVPCID			58
    587 #define VMCS_EXITCODE_VMFUNC			59
    588 #define VMCS_EXITCODE_ENCLS			60
    589 #define VMCS_EXITCODE_RDSEED			61
    590 #define VMCS_EXITCODE_PAGE_LOG_FULL		62
    591 #define VMCS_EXITCODE_XSAVES			63
    592 #define VMCS_EXITCODE_XRSTORS			64
    593 #define VMCS_EXITCODE_SPP			66
    594 #define VMCS_EXITCODE_UMWAIT			67
    595 #define VMCS_EXITCODE_TPAUSE			68
    596 
    597 /* -------------------------------------------------------------------------- */
    598 
    599 static void vmx_vcpu_state_provide(struct nvmm_cpu *, uint64_t);
    600 static void vmx_vcpu_state_commit(struct nvmm_cpu *);
    601 
    602 #define VMX_MSRLIST_STAR		0
    603 #define VMX_MSRLIST_LSTAR		1
    604 #define VMX_MSRLIST_CSTAR		2
    605 #define VMX_MSRLIST_SFMASK		3
    606 #define VMX_MSRLIST_KERNELGSBASE	4
    607 #define VMX_MSRLIST_EXIT_NMSR		5
    608 #define VMX_MSRLIST_L1DFLUSH		5
    609 
    610 /* On entry, we may do +1 to include L1DFLUSH. */
    611 static size_t vmx_msrlist_entry_nmsr __read_mostly = VMX_MSRLIST_EXIT_NMSR;
    612 
    613 struct vmxon {
    614 	uint32_t ident;
    615 #define VMXON_IDENT_REVISION	__BITS(30,0)
    616 
    617 	uint8_t data[PAGE_SIZE - 4];
    618 } __packed;
    619 
    620 CTASSERT(sizeof(struct vmxon) == PAGE_SIZE);
    621 
    622 struct vmxoncpu {
    623 	vaddr_t va;
    624 	paddr_t pa;
    625 };
    626 
    627 static struct vmxoncpu vmxoncpu[MAXCPUS];
    628 
    629 struct vmcs {
    630 	uint32_t ident;
    631 #define VMCS_IDENT_REVISION	__BITS(30,0)
    632 #define VMCS_IDENT_SHADOW	__BIT(31)
    633 
    634 	uint32_t abort;
    635 	uint8_t data[PAGE_SIZE - 8];
    636 } __packed;
    637 
    638 CTASSERT(sizeof(struct vmcs) == PAGE_SIZE);
    639 
    640 struct msr_entry {
    641 	uint32_t msr;
    642 	uint32_t rsvd;
    643 	uint64_t val;
    644 } __packed;
    645 
    646 #define VPID_MAX	0xFFFF
    647 
    648 /* Make sure we never run out of VPIDs. */
    649 CTASSERT(VPID_MAX-1 >= NVMM_MAX_MACHINES * NVMM_MAX_VCPUS);
    650 
    651 static uint64_t vmx_tlb_flush_op __read_mostly;
    652 static uint64_t vmx_ept_flush_op __read_mostly;
    653 static uint64_t vmx_eptp_type __read_mostly;
    654 
    655 static uint64_t vmx_pinbased_ctls __read_mostly;
    656 static uint64_t vmx_procbased_ctls __read_mostly;
    657 static uint64_t vmx_procbased_ctls2 __read_mostly;
    658 static uint64_t vmx_entry_ctls __read_mostly;
    659 static uint64_t vmx_exit_ctls __read_mostly;
    660 
    661 static uint64_t vmx_cr0_fixed0 __read_mostly;
    662 static uint64_t vmx_cr0_fixed1 __read_mostly;
    663 static uint64_t vmx_cr4_fixed0 __read_mostly;
    664 static uint64_t vmx_cr4_fixed1 __read_mostly;
    665 
    666 extern bool pmap_ept_has_ad;
    667 
    668 #define VMX_PINBASED_CTLS_ONE	\
    669 	(PIN_CTLS_INT_EXITING| \
    670 	 PIN_CTLS_NMI_EXITING| \
    671 	 PIN_CTLS_VIRTUAL_NMIS)
    672 
    673 #define VMX_PINBASED_CTLS_ZERO	0
    674 
    675 #define VMX_PROCBASED_CTLS_ONE	\
    676 	(PROC_CTLS_USE_TSC_OFFSETTING| \
    677 	 PROC_CTLS_HLT_EXITING| \
    678 	 PROC_CTLS_MWAIT_EXITING | \
    679 	 PROC_CTLS_RDPMC_EXITING | \
    680 	 PROC_CTLS_RCR8_EXITING | \
    681 	 PROC_CTLS_LCR8_EXITING | \
    682 	 PROC_CTLS_UNCOND_IO_EXITING | /* no I/O bitmap */ \
    683 	 PROC_CTLS_USE_MSR_BITMAPS | \
    684 	 PROC_CTLS_MONITOR_EXITING | \
    685 	 PROC_CTLS_ACTIVATE_CTLS2)
    686 
    687 #define VMX_PROCBASED_CTLS_ZERO	\
    688 	(PROC_CTLS_RCR3_EXITING| \
    689 	 PROC_CTLS_LCR3_EXITING)
    690 
    691 #define VMX_PROCBASED_CTLS2_ONE	\
    692 	(PROC_CTLS2_ENABLE_EPT| \
    693 	 PROC_CTLS2_ENABLE_VPID| \
    694 	 PROC_CTLS2_UNRESTRICTED_GUEST)
    695 
    696 #define VMX_PROCBASED_CTLS2_ZERO	0
    697 
    698 #define VMX_ENTRY_CTLS_ONE	\
    699 	(ENTRY_CTLS_LOAD_DEBUG_CONTROLS| \
    700 	 ENTRY_CTLS_LOAD_EFER| \
    701 	 ENTRY_CTLS_LOAD_PAT)
    702 
    703 #define VMX_ENTRY_CTLS_ZERO	\
    704 	(ENTRY_CTLS_SMM| \
    705 	 ENTRY_CTLS_DISABLE_DUAL)
    706 
    707 #define VMX_EXIT_CTLS_ONE	\
    708 	(EXIT_CTLS_SAVE_DEBUG_CONTROLS| \
    709 	 EXIT_CTLS_HOST_LONG_MODE| \
    710 	 EXIT_CTLS_SAVE_PAT| \
    711 	 EXIT_CTLS_LOAD_PAT| \
    712 	 EXIT_CTLS_SAVE_EFER| \
    713 	 EXIT_CTLS_LOAD_EFER)
    714 
    715 #define VMX_EXIT_CTLS_ZERO	0
    716 
    717 static uint8_t *vmx_asidmap __read_mostly;
    718 static uint32_t vmx_maxasid __read_mostly;
    719 static kmutex_t vmx_asidlock __cacheline_aligned;
    720 
    721 #define VMX_XCR0_MASK_DEFAULT	(XCR0_X87|XCR0_SSE)
    722 static uint64_t vmx_xcr0_mask __read_mostly;
    723 
    724 #define VMX_NCPUIDS	32
    725 
    726 #define VMCS_NPAGES	1
    727 #define VMCS_SIZE	(VMCS_NPAGES * PAGE_SIZE)
    728 
    729 #define MSRBM_NPAGES	1
    730 #define MSRBM_SIZE	(MSRBM_NPAGES * PAGE_SIZE)
    731 
    732 #define EFER_TLB_FLUSH \
    733 	(EFER_NXE|EFER_LMA|EFER_LME)
    734 #define CR0_TLB_FLUSH \
    735 	(CR0_PG|CR0_WP|CR0_CD|CR0_NW)
    736 #define CR4_TLB_FLUSH \
    737 	(CR4_PGE|CR4_PAE|CR4_PSE)
    738 
    739 /* -------------------------------------------------------------------------- */
    740 
    741 struct vmx_machdata {
    742 	volatile uint64_t mach_htlb_gen;
    743 };
    744 
    745 static const size_t vmx_vcpu_conf_sizes[NVMM_X86_VCPU_NCONF] = {
    746 	[NVMM_VCPU_CONF_MD(NVMM_VCPU_CONF_CPUID)] =
    747 	    sizeof(struct nvmm_vcpu_conf_cpuid),
    748 	[NVMM_VCPU_CONF_MD(NVMM_VCPU_CONF_TPR)] =
    749 	    sizeof(struct nvmm_vcpu_conf_tpr)
    750 };
    751 
    752 struct vmx_cpudata {
    753 	/* General */
    754 	uint64_t asid;
    755 	bool gtlb_want_flush;
    756 	bool gtsc_want_update;
    757 	uint64_t vcpu_htlb_gen;
    758 	kcpuset_t *htlb_want_flush;
    759 
    760 	/* VMCS */
    761 	struct vmcs *vmcs;
    762 	paddr_t vmcs_pa;
    763 	size_t vmcs_refcnt;
    764 	struct cpu_info *vmcs_ci;
    765 	bool vmcs_launched;
    766 
    767 	/* MSR bitmap */
    768 	uint8_t *msrbm;
    769 	paddr_t msrbm_pa;
    770 
    771 	/* Host state */
    772 	uint64_t hxcr0;
    773 	uint64_t star;
    774 	uint64_t lstar;
    775 	uint64_t cstar;
    776 	uint64_t sfmask;
    777 	uint64_t kernelgsbase;
    778 
    779 	/* Intr state */
    780 	bool int_window_exit;
    781 	bool nmi_window_exit;
    782 	bool evt_pending;
    783 
    784 	/* Guest state */
    785 	struct msr_entry *gmsr;
    786 	paddr_t gmsr_pa;
    787 	uint64_t gmsr_misc_enable;
    788 	uint64_t gcr2;
    789 	uint64_t gcr8;
    790 	uint64_t gxcr0;
    791 	uint64_t gprs[NVMM_X64_NGPR];
    792 	uint64_t drs[NVMM_X64_NDR];
    793 	uint64_t gtsc;
    794 	struct xsave_header gfpu __aligned(64);
    795 
    796 	/* VCPU configuration. */
    797 	bool cpuidpresent[VMX_NCPUIDS];
    798 	struct nvmm_vcpu_conf_cpuid cpuid[VMX_NCPUIDS];
    799 	struct nvmm_vcpu_conf_tpr tpr;
    800 };
    801 
    802 static const struct {
    803 	uint64_t selector;
    804 	uint64_t attrib;
    805 	uint64_t limit;
    806 	uint64_t base;
    807 } vmx_guest_segs[NVMM_X64_NSEG] = {
    808 	[NVMM_X64_SEG_ES] = {
    809 		VMCS_GUEST_ES_SELECTOR,
    810 		VMCS_GUEST_ES_ACCESS_RIGHTS,
    811 		VMCS_GUEST_ES_LIMIT,
    812 		VMCS_GUEST_ES_BASE
    813 	},
    814 	[NVMM_X64_SEG_CS] = {
    815 		VMCS_GUEST_CS_SELECTOR,
    816 		VMCS_GUEST_CS_ACCESS_RIGHTS,
    817 		VMCS_GUEST_CS_LIMIT,
    818 		VMCS_GUEST_CS_BASE
    819 	},
    820 	[NVMM_X64_SEG_SS] = {
    821 		VMCS_GUEST_SS_SELECTOR,
    822 		VMCS_GUEST_SS_ACCESS_RIGHTS,
    823 		VMCS_GUEST_SS_LIMIT,
    824 		VMCS_GUEST_SS_BASE
    825 	},
    826 	[NVMM_X64_SEG_DS] = {
    827 		VMCS_GUEST_DS_SELECTOR,
    828 		VMCS_GUEST_DS_ACCESS_RIGHTS,
    829 		VMCS_GUEST_DS_LIMIT,
    830 		VMCS_GUEST_DS_BASE
    831 	},
    832 	[NVMM_X64_SEG_FS] = {
    833 		VMCS_GUEST_FS_SELECTOR,
    834 		VMCS_GUEST_FS_ACCESS_RIGHTS,
    835 		VMCS_GUEST_FS_LIMIT,
    836 		VMCS_GUEST_FS_BASE
    837 	},
    838 	[NVMM_X64_SEG_GS] = {
    839 		VMCS_GUEST_GS_SELECTOR,
    840 		VMCS_GUEST_GS_ACCESS_RIGHTS,
    841 		VMCS_GUEST_GS_LIMIT,
    842 		VMCS_GUEST_GS_BASE
    843 	},
    844 	[NVMM_X64_SEG_GDT] = {
    845 		0, /* doesn't exist */
    846 		0, /* doesn't exist */
    847 		VMCS_GUEST_GDTR_LIMIT,
    848 		VMCS_GUEST_GDTR_BASE
    849 	},
    850 	[NVMM_X64_SEG_IDT] = {
    851 		0, /* doesn't exist */
    852 		0, /* doesn't exist */
    853 		VMCS_GUEST_IDTR_LIMIT,
    854 		VMCS_GUEST_IDTR_BASE
    855 	},
    856 	[NVMM_X64_SEG_LDT] = {
    857 		VMCS_GUEST_LDTR_SELECTOR,
    858 		VMCS_GUEST_LDTR_ACCESS_RIGHTS,
    859 		VMCS_GUEST_LDTR_LIMIT,
    860 		VMCS_GUEST_LDTR_BASE
    861 	},
    862 	[NVMM_X64_SEG_TR] = {
    863 		VMCS_GUEST_TR_SELECTOR,
    864 		VMCS_GUEST_TR_ACCESS_RIGHTS,
    865 		VMCS_GUEST_TR_LIMIT,
    866 		VMCS_GUEST_TR_BASE
    867 	}
    868 };
    869 
    870 /* -------------------------------------------------------------------------- */
    871 
    872 static uint64_t
    873 vmx_get_revision(void)
    874 {
    875 	uint64_t msr;
    876 
    877 	msr = rdmsr(MSR_IA32_VMX_BASIC);
    878 	msr &= IA32_VMX_BASIC_IDENT;
    879 
    880 	return msr;
    881 }
    882 
    883 static void
    884 vmx_vmclear_ipi(void *arg1, void *arg2)
    885 {
    886 	paddr_t vmcs_pa = (paddr_t)arg1;
    887 	vmx_vmclear(&vmcs_pa);
    888 }
    889 
    890 static void
    891 vmx_vmclear_remote(struct cpu_info *ci, paddr_t vmcs_pa)
    892 {
    893 	uint64_t xc;
    894 	int bound;
    895 
    896 	KASSERT(kpreempt_disabled());
    897 
    898 	bound = curlwp_bind();
    899 	kpreempt_enable();
    900 
    901 	xc = xc_unicast(XC_HIGHPRI, vmx_vmclear_ipi, (void *)vmcs_pa, NULL, ci);
    902 	xc_wait(xc);
    903 
    904 	kpreempt_disable();
    905 	curlwp_bindx(bound);
    906 }
    907 
    908 static void
    909 vmx_vmcs_enter(struct nvmm_cpu *vcpu)
    910 {
    911 	struct vmx_cpudata *cpudata = vcpu->cpudata;
    912 	struct cpu_info *vmcs_ci;
    913 
    914 	cpudata->vmcs_refcnt++;
    915 	if (cpudata->vmcs_refcnt > 1) {
    916 		KASSERT(kpreempt_disabled());
    917 		KASSERT(vmx_vmptrst() == cpudata->vmcs_pa);
    918 		return;
    919 	}
    920 
    921 	vmcs_ci = cpudata->vmcs_ci;
    922 	cpudata->vmcs_ci = (void *)0x00FFFFFFFFFFFFFF; /* clobber */
    923 
    924 	kpreempt_disable();
    925 
    926 	if (vmcs_ci == NULL) {
    927 		/* This VMCS is loaded for the first time. */
    928 		vmx_vmclear(&cpudata->vmcs_pa);
    929 		cpudata->vmcs_launched = false;
    930 	} else if (vmcs_ci != curcpu()) {
    931 		/* This VMCS is active on a remote CPU. */
    932 		vmx_vmclear_remote(vmcs_ci, cpudata->vmcs_pa);
    933 		cpudata->vmcs_launched = false;
    934 	} else {
    935 		/* This VMCS is active on curcpu, nothing to do. */
    936 	}
    937 
    938 	vmx_vmptrld(&cpudata->vmcs_pa);
    939 }
    940 
    941 static void
    942 vmx_vmcs_leave(struct nvmm_cpu *vcpu)
    943 {
    944 	struct vmx_cpudata *cpudata = vcpu->cpudata;
    945 
    946 	KASSERT(kpreempt_disabled());
    947 	KASSERT(vmx_vmptrst() == cpudata->vmcs_pa);
    948 	KASSERT(cpudata->vmcs_refcnt > 0);
    949 	cpudata->vmcs_refcnt--;
    950 
    951 	if (cpudata->vmcs_refcnt > 0) {
    952 		return;
    953 	}
    954 
    955 	cpudata->vmcs_ci = curcpu();
    956 	kpreempt_enable();
    957 }
    958 
    959 static void
    960 vmx_vmcs_destroy(struct nvmm_cpu *vcpu)
    961 {
    962 	struct vmx_cpudata *cpudata = vcpu->cpudata;
    963 
    964 	KASSERT(kpreempt_disabled());
    965 	KASSERT(vmx_vmptrst() == cpudata->vmcs_pa);
    966 	KASSERT(cpudata->vmcs_refcnt == 1);
    967 	cpudata->vmcs_refcnt--;
    968 
    969 	vmx_vmclear(&cpudata->vmcs_pa);
    970 	kpreempt_enable();
    971 }
    972 
    973 /* -------------------------------------------------------------------------- */
    974 
    975 static void
    976 vmx_event_waitexit_enable(struct nvmm_cpu *vcpu, bool nmi)
    977 {
    978 	struct vmx_cpudata *cpudata = vcpu->cpudata;
    979 	uint64_t ctls1;
    980 
    981 	ctls1 = vmx_vmread(VMCS_PROCBASED_CTLS);
    982 
    983 	if (nmi) {
    984 		// XXX INT_STATE_NMI?
    985 		ctls1 |= PROC_CTLS_NMI_WINDOW_EXITING;
    986 		cpudata->nmi_window_exit = true;
    987 	} else {
    988 		ctls1 |= PROC_CTLS_INT_WINDOW_EXITING;
    989 		cpudata->int_window_exit = true;
    990 	}
    991 
    992 	vmx_vmwrite(VMCS_PROCBASED_CTLS, ctls1);
    993 }
    994 
    995 static void
    996 vmx_event_waitexit_disable(struct nvmm_cpu *vcpu, bool nmi)
    997 {
    998 	struct vmx_cpudata *cpudata = vcpu->cpudata;
    999 	uint64_t ctls1;
   1000 
   1001 	ctls1 = vmx_vmread(VMCS_PROCBASED_CTLS);
   1002 
   1003 	if (nmi) {
   1004 		ctls1 &= ~PROC_CTLS_NMI_WINDOW_EXITING;
   1005 		cpudata->nmi_window_exit = false;
   1006 	} else {
   1007 		ctls1 &= ~PROC_CTLS_INT_WINDOW_EXITING;
   1008 		cpudata->int_window_exit = false;
   1009 	}
   1010 
   1011 	vmx_vmwrite(VMCS_PROCBASED_CTLS, ctls1);
   1012 }
   1013 
   1014 static inline int
   1015 vmx_event_has_error(uint8_t vector)
   1016 {
   1017 	switch (vector) {
   1018 	case 8:		/* #DF */
   1019 	case 10:	/* #TS */
   1020 	case 11:	/* #NP */
   1021 	case 12:	/* #SS */
   1022 	case 13:	/* #GP */
   1023 	case 14:	/* #PF */
   1024 	case 17:	/* #AC */
   1025 	case 30:	/* #SX */
   1026 		return 1;
   1027 	default:
   1028 		return 0;
   1029 	}
   1030 }
   1031 
   1032 static int
   1033 vmx_vcpu_inject(struct nvmm_cpu *vcpu)
   1034 {
   1035 	struct nvmm_comm_page *comm = vcpu->comm;
   1036 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1037 	int type = 0, err = 0, ret = EINVAL;
   1038 	u_int evtype;
   1039 	uint8_t vector;
   1040 	uint64_t info, error;
   1041 
   1042 	evtype = comm->event.type;
   1043 	vector = comm->event.vector;
   1044 	error = comm->event.u.excp.error;
   1045 	__insn_barrier();
   1046 
   1047 	vmx_vmcs_enter(vcpu);
   1048 
   1049 	switch (evtype) {
   1050 	case NVMM_VCPU_EVENT_EXCP:
   1051 		if (vector == 2 || vector >= 32)
   1052 			goto out;
   1053 		if (vector == 3 || vector == 0)
   1054 			goto out;
   1055 		type = INTR_TYPE_HW_EXC;
   1056 		err = vmx_event_has_error(vector);
   1057 		break;
   1058 	case NVMM_VCPU_EVENT_INTR:
   1059 		type = INTR_TYPE_EXT_INT;
   1060 		if (vector == 2) {
   1061 			type = INTR_TYPE_NMI;
   1062 			vmx_event_waitexit_enable(vcpu, true);
   1063 		}
   1064 		err = 0;
   1065 		break;
   1066 	default:
   1067 		goto out;
   1068 	}
   1069 
   1070 	info =
   1071 	    __SHIFTIN((uint64_t)vector, INTR_INFO_VECTOR) |
   1072 	    __SHIFTIN((uint64_t)type, INTR_INFO_TYPE) |
   1073 	    __SHIFTIN((uint64_t)err, INTR_INFO_ERROR) |
   1074 	    __SHIFTIN((uint64_t)1, INTR_INFO_VALID);
   1075 	vmx_vmwrite(VMCS_ENTRY_INTR_INFO, info);
   1076 	vmx_vmwrite(VMCS_ENTRY_EXCEPTION_ERROR, error);
   1077 
   1078 	cpudata->evt_pending = true;
   1079 	ret = 0;
   1080 
   1081 out:
   1082 	vmx_vmcs_leave(vcpu);
   1083 	return ret;
   1084 }
   1085 
   1086 static void
   1087 vmx_inject_ud(struct nvmm_cpu *vcpu)
   1088 {
   1089 	struct nvmm_comm_page *comm = vcpu->comm;
   1090 	int ret __diagused;
   1091 
   1092 	comm->event.type = NVMM_VCPU_EVENT_EXCP;
   1093 	comm->event.vector = 6;
   1094 	comm->event.u.excp.error = 0;
   1095 
   1096 	ret = vmx_vcpu_inject(vcpu);
   1097 	KASSERT(ret == 0);
   1098 }
   1099 
   1100 static void
   1101 vmx_inject_gp(struct nvmm_cpu *vcpu)
   1102 {
   1103 	struct nvmm_comm_page *comm = vcpu->comm;
   1104 	int ret __diagused;
   1105 
   1106 	comm->event.type = NVMM_VCPU_EVENT_EXCP;
   1107 	comm->event.vector = 13;
   1108 	comm->event.u.excp.error = 0;
   1109 
   1110 	ret = vmx_vcpu_inject(vcpu);
   1111 	KASSERT(ret == 0);
   1112 }
   1113 
   1114 static inline int
   1115 vmx_vcpu_event_commit(struct nvmm_cpu *vcpu)
   1116 {
   1117 	if (__predict_true(!vcpu->comm->event_commit)) {
   1118 		return 0;
   1119 	}
   1120 	vcpu->comm->event_commit = false;
   1121 	return vmx_vcpu_inject(vcpu);
   1122 }
   1123 
   1124 static inline void
   1125 vmx_inkernel_advance(void)
   1126 {
   1127 	uint64_t rip, inslen, intstate;
   1128 
   1129 	/*
   1130 	 * Maybe we should also apply single-stepping and debug exceptions.
   1131 	 * Matters for guest-ring3, because it can execute 'cpuid' under a
   1132 	 * debugger.
   1133 	 */
   1134 	inslen = vmx_vmread(VMCS_EXIT_INSTRUCTION_LENGTH);
   1135 	rip = vmx_vmread(VMCS_GUEST_RIP);
   1136 	vmx_vmwrite(VMCS_GUEST_RIP, rip + inslen);
   1137 	intstate = vmx_vmread(VMCS_GUEST_INTERRUPTIBILITY);
   1138 	vmx_vmwrite(VMCS_GUEST_INTERRUPTIBILITY,
   1139 	    intstate & ~(INT_STATE_STI|INT_STATE_MOVSS));
   1140 }
   1141 
   1142 static void
   1143 vmx_exit_invalid(struct nvmm_vcpu_exit *exit, uint64_t code)
   1144 {
   1145 	exit->u.inv.hwcode = code;
   1146 	exit->reason = NVMM_VCPU_EXIT_INVALID;
   1147 }
   1148 
   1149 static void
   1150 vmx_exit_exc_nmi(struct nvmm_machine *mach, struct nvmm_cpu *vcpu,
   1151     struct nvmm_vcpu_exit *exit)
   1152 {
   1153 	uint64_t qual;
   1154 
   1155 	qual = vmx_vmread(VMCS_EXIT_INTR_INFO);
   1156 
   1157 	if ((qual & INTR_INFO_VALID) == 0) {
   1158 		goto error;
   1159 	}
   1160 	if (__SHIFTOUT(qual, INTR_INFO_TYPE) != INTR_TYPE_NMI) {
   1161 		goto error;
   1162 	}
   1163 
   1164 	exit->reason = NVMM_VCPU_EXIT_NONE;
   1165 	return;
   1166 
   1167 error:
   1168 	vmx_exit_invalid(exit, VMCS_EXITCODE_EXC_NMI);
   1169 }
   1170 
   1171 #define VMX_CPUID_MAX_BASIC		0x16
   1172 #define VMX_CPUID_MAX_HYPERVISOR	0x40000000
   1173 #define VMX_CPUID_MAX_EXTENDED		0x80000008
   1174 static uint32_t vmx_cpuid_max_basic __read_mostly;
   1175 
   1176 static void
   1177 vmx_inkernel_exec_cpuid(struct vmx_cpudata *cpudata, uint64_t eax, uint64_t ecx)
   1178 {
   1179 	u_int descs[4];
   1180 
   1181 	x86_cpuid2(eax, ecx, descs);
   1182 	cpudata->gprs[NVMM_X64_GPR_RAX] = descs[0];
   1183 	cpudata->gprs[NVMM_X64_GPR_RBX] = descs[1];
   1184 	cpudata->gprs[NVMM_X64_GPR_RCX] = descs[2];
   1185 	cpudata->gprs[NVMM_X64_GPR_RDX] = descs[3];
   1186 }
   1187 
   1188 static void
   1189 vmx_inkernel_handle_cpuid(struct nvmm_machine *mach, struct nvmm_cpu *vcpu,
   1190     uint64_t eax, uint64_t ecx)
   1191 {
   1192 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1193 	unsigned int ncpus;
   1194 	uint64_t cr4;
   1195 
   1196 	if (eax < 0x40000000) {
   1197 		if (__predict_false(eax > vmx_cpuid_max_basic)) {
   1198 			eax = vmx_cpuid_max_basic;
   1199 			vmx_inkernel_exec_cpuid(cpudata, eax, ecx);
   1200 		}
   1201 	} else if (eax < 0x80000000) {
   1202 		if (__predict_false(eax > VMX_CPUID_MAX_HYPERVISOR)) {
   1203 			eax = vmx_cpuid_max_basic;
   1204 			vmx_inkernel_exec_cpuid(cpudata, eax, ecx);
   1205 		}
   1206 	}
   1207 
   1208 	switch (eax) {
   1209 	case 0x00000000:
   1210 		cpudata->gprs[NVMM_X64_GPR_RAX] = vmx_cpuid_max_basic;
   1211 		break;
   1212 	case 0x00000001:
   1213 		cpudata->gprs[NVMM_X64_GPR_RAX] &= nvmm_cpuid_00000001.eax;
   1214 
   1215 		cpudata->gprs[NVMM_X64_GPR_RBX] &= ~CPUID_LOCAL_APIC_ID;
   1216 		cpudata->gprs[NVMM_X64_GPR_RBX] |= __SHIFTIN(vcpu->cpuid,
   1217 		    CPUID_LOCAL_APIC_ID);
   1218 
   1219 		cpudata->gprs[NVMM_X64_GPR_RCX] &= nvmm_cpuid_00000001.ecx;
   1220 		cpudata->gprs[NVMM_X64_GPR_RCX] |= CPUID2_RAZ;
   1221 		if (vmx_procbased_ctls2 & PROC_CTLS2_INVPCID_ENABLE) {
   1222 			cpudata->gprs[NVMM_X64_GPR_RCX] |= CPUID2_PCID;
   1223 		}
   1224 
   1225 		cpudata->gprs[NVMM_X64_GPR_RDX] &= nvmm_cpuid_00000001.edx;
   1226 
   1227 		/* CPUID2_OSXSAVE depends on CR4. */
   1228 		cr4 = vmx_vmread(VMCS_GUEST_CR4);
   1229 		if (!(cr4 & CR4_OSXSAVE)) {
   1230 			cpudata->gprs[NVMM_X64_GPR_RCX] &= ~CPUID2_OSXSAVE;
   1231 		}
   1232 		break;
   1233 	case 0x00000002:
   1234 		break;
   1235 	case 0x00000003:
   1236 		cpudata->gprs[NVMM_X64_GPR_RAX] = 0;
   1237 		cpudata->gprs[NVMM_X64_GPR_RBX] = 0;
   1238 		cpudata->gprs[NVMM_X64_GPR_RCX] = 0;
   1239 		cpudata->gprs[NVMM_X64_GPR_RDX] = 0;
   1240 		break;
   1241 	case 0x00000004: /* Deterministic Cache Parameters */
   1242 		break; /* TODO? */
   1243 	case 0x00000005: /* MONITOR/MWAIT */
   1244 	case 0x00000006: /* Thermal and Power Management */
   1245 		cpudata->gprs[NVMM_X64_GPR_RAX] = 0;
   1246 		cpudata->gprs[NVMM_X64_GPR_RBX] = 0;
   1247 		cpudata->gprs[NVMM_X64_GPR_RCX] = 0;
   1248 		cpudata->gprs[NVMM_X64_GPR_RDX] = 0;
   1249 		break;
   1250 	case 0x00000007: /* Structured Extended Feature Flags Enumeration */
   1251 		cpudata->gprs[NVMM_X64_GPR_RAX] &= nvmm_cpuid_00000007.eax;
   1252 		cpudata->gprs[NVMM_X64_GPR_RBX] &= nvmm_cpuid_00000007.ebx;
   1253 		cpudata->gprs[NVMM_X64_GPR_RCX] &= nvmm_cpuid_00000007.ecx;
   1254 		cpudata->gprs[NVMM_X64_GPR_RDX] &= nvmm_cpuid_00000007.edx;
   1255 		if (vmx_procbased_ctls2 & PROC_CTLS2_INVPCID_ENABLE) {
   1256 			cpudata->gprs[NVMM_X64_GPR_RBX] |= CPUID_SEF_INVPCID;
   1257 		}
   1258 		break;
   1259 	case 0x00000008: /* Empty */
   1260 	case 0x00000009: /* Direct Cache Access Information */
   1261 		cpudata->gprs[NVMM_X64_GPR_RAX] = 0;
   1262 		cpudata->gprs[NVMM_X64_GPR_RBX] = 0;
   1263 		cpudata->gprs[NVMM_X64_GPR_RCX] = 0;
   1264 		cpudata->gprs[NVMM_X64_GPR_RDX] = 0;
   1265 		break;
   1266 	case 0x0000000A: /* Architectural Performance Monitoring */
   1267 		cpudata->gprs[NVMM_X64_GPR_RAX] = 0;
   1268 		cpudata->gprs[NVMM_X64_GPR_RBX] = 0;
   1269 		cpudata->gprs[NVMM_X64_GPR_RCX] = 0;
   1270 		cpudata->gprs[NVMM_X64_GPR_RDX] = 0;
   1271 		break;
   1272 	case 0x0000000B: /* Extended Topology Enumeration */
   1273 		switch (ecx) {
   1274 		case 0: /* Threads */
   1275 			cpudata->gprs[NVMM_X64_GPR_RAX] = 0;
   1276 			cpudata->gprs[NVMM_X64_GPR_RBX] = 0;
   1277 			cpudata->gprs[NVMM_X64_GPR_RCX] =
   1278 			    __SHIFTIN(ecx, CPUID_TOP_LVLNUM) |
   1279 			    __SHIFTIN(CPUID_TOP_LVLTYPE_SMT, CPUID_TOP_LVLTYPE);
   1280 			cpudata->gprs[NVMM_X64_GPR_RDX] = vcpu->cpuid;
   1281 			break;
   1282 		case 1: /* Cores */
   1283 			ncpus = atomic_load_relaxed(&mach->ncpus);
   1284 			cpudata->gprs[NVMM_X64_GPR_RAX] = ilog2(ncpus);
   1285 			cpudata->gprs[NVMM_X64_GPR_RBX] = ncpus;
   1286 			cpudata->gprs[NVMM_X64_GPR_RCX] =
   1287 			    __SHIFTIN(ecx, CPUID_TOP_LVLNUM) |
   1288 			    __SHIFTIN(CPUID_TOP_LVLTYPE_CORE, CPUID_TOP_LVLTYPE);
   1289 			cpudata->gprs[NVMM_X64_GPR_RDX] = vcpu->cpuid;
   1290 			break;
   1291 		default:
   1292 			cpudata->gprs[NVMM_X64_GPR_RAX] = 0;
   1293 			cpudata->gprs[NVMM_X64_GPR_RBX] = 0;
   1294 			cpudata->gprs[NVMM_X64_GPR_RCX] = 0; /* LVLTYPE_INVAL */
   1295 			cpudata->gprs[NVMM_X64_GPR_RDX] = 0;
   1296 			break;
   1297 		}
   1298 		break;
   1299 	case 0x0000000C: /* Empty */
   1300 		cpudata->gprs[NVMM_X64_GPR_RAX] = 0;
   1301 		cpudata->gprs[NVMM_X64_GPR_RBX] = 0;
   1302 		cpudata->gprs[NVMM_X64_GPR_RCX] = 0;
   1303 		cpudata->gprs[NVMM_X64_GPR_RDX] = 0;
   1304 		break;
   1305 	case 0x0000000D: /* Processor Extended State Enumeration */
   1306 		if (vmx_xcr0_mask == 0) {
   1307 			break;
   1308 		}
   1309 		switch (ecx) {
   1310 		case 0:
   1311 			cpudata->gprs[NVMM_X64_GPR_RAX] = vmx_xcr0_mask & 0xFFFFFFFF;
   1312 			if (cpudata->gxcr0 & XCR0_SSE) {
   1313 				cpudata->gprs[NVMM_X64_GPR_RBX] = sizeof(struct fxsave);
   1314 			} else {
   1315 				cpudata->gprs[NVMM_X64_GPR_RBX] = sizeof(struct save87);
   1316 			}
   1317 			cpudata->gprs[NVMM_X64_GPR_RBX] += 64; /* XSAVE header */
   1318 			cpudata->gprs[NVMM_X64_GPR_RCX] = sizeof(struct fxsave) + 64;
   1319 			cpudata->gprs[NVMM_X64_GPR_RDX] = vmx_xcr0_mask >> 32;
   1320 			break;
   1321 		case 1:
   1322 			cpudata->gprs[NVMM_X64_GPR_RAX] &=
   1323 			    (CPUID_PES1_XSAVEOPT | CPUID_PES1_XSAVEC |
   1324 			     CPUID_PES1_XGETBV);
   1325 			cpudata->gprs[NVMM_X64_GPR_RBX] = 0;
   1326 			cpudata->gprs[NVMM_X64_GPR_RCX] = 0;
   1327 			cpudata->gprs[NVMM_X64_GPR_RDX] = 0;
   1328 			break;
   1329 		default:
   1330 			cpudata->gprs[NVMM_X64_GPR_RAX] = 0;
   1331 			cpudata->gprs[NVMM_X64_GPR_RBX] = 0;
   1332 			cpudata->gprs[NVMM_X64_GPR_RCX] = 0;
   1333 			cpudata->gprs[NVMM_X64_GPR_RDX] = 0;
   1334 			break;
   1335 		}
   1336 		break;
   1337 	case 0x0000000E: /* Empty */
   1338 	case 0x0000000F: /* Intel RDT Monitoring Enumeration */
   1339 	case 0x00000010: /* Intel RDT Allocation Enumeration */
   1340 		cpudata->gprs[NVMM_X64_GPR_RAX] = 0;
   1341 		cpudata->gprs[NVMM_X64_GPR_RBX] = 0;
   1342 		cpudata->gprs[NVMM_X64_GPR_RCX] = 0;
   1343 		cpudata->gprs[NVMM_X64_GPR_RDX] = 0;
   1344 		break;
   1345 	case 0x00000011: /* Empty */
   1346 	case 0x00000012: /* Intel SGX Capability Enumeration */
   1347 	case 0x00000013: /* Empty */
   1348 	case 0x00000014: /* Intel Processor Trace Enumeration */
   1349 		cpudata->gprs[NVMM_X64_GPR_RAX] = 0;
   1350 		cpudata->gprs[NVMM_X64_GPR_RBX] = 0;
   1351 		cpudata->gprs[NVMM_X64_GPR_RCX] = 0;
   1352 		cpudata->gprs[NVMM_X64_GPR_RDX] = 0;
   1353 		break;
   1354 	case 0x00000015: /* TSC and Nominal Core Crystal Clock Information */
   1355 	case 0x00000016: /* Processor Frequency Information */
   1356 		break;
   1357 
   1358 	case 0x40000000: /* Hypervisor Information */
   1359 		cpudata->gprs[NVMM_X64_GPR_RAX] = VMX_CPUID_MAX_HYPERVISOR;
   1360 		cpudata->gprs[NVMM_X64_GPR_RBX] = 0;
   1361 		cpudata->gprs[NVMM_X64_GPR_RCX] = 0;
   1362 		cpudata->gprs[NVMM_X64_GPR_RDX] = 0;
   1363 		memcpy(&cpudata->gprs[NVMM_X64_GPR_RBX], "___ ", 4);
   1364 		memcpy(&cpudata->gprs[NVMM_X64_GPR_RCX], "NVMM", 4);
   1365 		memcpy(&cpudata->gprs[NVMM_X64_GPR_RDX], " ___", 4);
   1366 		break;
   1367 
   1368 	case 0x80000001:
   1369 		cpudata->gprs[NVMM_X64_GPR_RAX] &= nvmm_cpuid_80000001.eax;
   1370 		cpudata->gprs[NVMM_X64_GPR_RBX] &= nvmm_cpuid_80000001.ebx;
   1371 		cpudata->gprs[NVMM_X64_GPR_RCX] &= nvmm_cpuid_80000001.ecx;
   1372 		cpudata->gprs[NVMM_X64_GPR_RDX] &= nvmm_cpuid_80000001.edx;
   1373 		break;
   1374 	case 0x80000002: /* Processor Brand String */
   1375 	case 0x80000003: /* Processor Brand String */
   1376 	case 0x80000004: /* Processor Brand String */
   1377 	case 0x80000005: /* Reserved Zero */
   1378 	case 0x80000006: /* Cache Information */
   1379 	case 0x80000007: /* TSC Information */
   1380 	case 0x80000008: /* Address Sizes */
   1381 		break;
   1382 
   1383 	default:
   1384 		break;
   1385 	}
   1386 }
   1387 
   1388 static void
   1389 vmx_exit_insn(struct nvmm_vcpu_exit *exit, uint64_t reason)
   1390 {
   1391 	uint64_t inslen, rip;
   1392 
   1393 	inslen = vmx_vmread(VMCS_EXIT_INSTRUCTION_LENGTH);
   1394 	rip = vmx_vmread(VMCS_GUEST_RIP);
   1395 	exit->u.insn.npc = rip + inslen;
   1396 	exit->reason = reason;
   1397 }
   1398 
   1399 static void
   1400 vmx_exit_cpuid(struct nvmm_machine *mach, struct nvmm_cpu *vcpu,
   1401     struct nvmm_vcpu_exit *exit)
   1402 {
   1403 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1404 	struct nvmm_vcpu_conf_cpuid *cpuid;
   1405 	uint64_t eax, ecx;
   1406 	size_t i;
   1407 
   1408 	eax = cpudata->gprs[NVMM_X64_GPR_RAX];
   1409 	ecx = cpudata->gprs[NVMM_X64_GPR_RCX];
   1410 	vmx_inkernel_exec_cpuid(cpudata, eax, ecx);
   1411 	vmx_inkernel_handle_cpuid(mach, vcpu, eax, ecx);
   1412 
   1413 	for (i = 0; i < VMX_NCPUIDS; i++) {
   1414 		if (!cpudata->cpuidpresent[i]) {
   1415 			continue;
   1416 		}
   1417 		cpuid = &cpudata->cpuid[i];
   1418 		if (cpuid->leaf != eax) {
   1419 			continue;
   1420 		}
   1421 
   1422 		if (cpuid->exit) {
   1423 			vmx_exit_insn(exit, NVMM_VCPU_EXIT_CPUID);
   1424 			return;
   1425 		}
   1426 		KASSERT(cpuid->mask);
   1427 
   1428 		/* del */
   1429 		cpudata->gprs[NVMM_X64_GPR_RAX] &= ~cpuid->u.mask.del.eax;
   1430 		cpudata->gprs[NVMM_X64_GPR_RBX] &= ~cpuid->u.mask.del.ebx;
   1431 		cpudata->gprs[NVMM_X64_GPR_RCX] &= ~cpuid->u.mask.del.ecx;
   1432 		cpudata->gprs[NVMM_X64_GPR_RDX] &= ~cpuid->u.mask.del.edx;
   1433 
   1434 		/* set */
   1435 		cpudata->gprs[NVMM_X64_GPR_RAX] |= cpuid->u.mask.set.eax;
   1436 		cpudata->gprs[NVMM_X64_GPR_RBX] |= cpuid->u.mask.set.ebx;
   1437 		cpudata->gprs[NVMM_X64_GPR_RCX] |= cpuid->u.mask.set.ecx;
   1438 		cpudata->gprs[NVMM_X64_GPR_RDX] |= cpuid->u.mask.set.edx;
   1439 
   1440 		break;
   1441 	}
   1442 
   1443 	vmx_inkernel_advance();
   1444 	exit->reason = NVMM_VCPU_EXIT_NONE;
   1445 }
   1446 
   1447 static void
   1448 vmx_exit_hlt(struct nvmm_machine *mach, struct nvmm_cpu *vcpu,
   1449     struct nvmm_vcpu_exit *exit)
   1450 {
   1451 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1452 	uint64_t rflags;
   1453 
   1454 	if (cpudata->int_window_exit) {
   1455 		rflags = vmx_vmread(VMCS_GUEST_RFLAGS);
   1456 		if (rflags & PSL_I) {
   1457 			vmx_event_waitexit_disable(vcpu, false);
   1458 		}
   1459 	}
   1460 
   1461 	vmx_inkernel_advance();
   1462 	exit->reason = NVMM_VCPU_EXIT_HALTED;
   1463 }
   1464 
   1465 #define VMX_QUAL_CR_NUM		__BITS(3,0)
   1466 #define VMX_QUAL_CR_TYPE	__BITS(5,4)
   1467 #define		CR_TYPE_WRITE	0
   1468 #define		CR_TYPE_READ	1
   1469 #define		CR_TYPE_CLTS	2
   1470 #define		CR_TYPE_LMSW	3
   1471 #define VMX_QUAL_CR_LMSW_OPMEM	__BIT(6)
   1472 #define VMX_QUAL_CR_GPR		__BITS(11,8)
   1473 #define VMX_QUAL_CR_LMSW_SRC	__BIT(31,16)
   1474 
   1475 static inline int
   1476 vmx_check_cr(uint64_t crval, uint64_t fixed0, uint64_t fixed1)
   1477 {
   1478 	/* Bits set to 1 in fixed0 are fixed to 1. */
   1479 	if ((crval & fixed0) != fixed0) {
   1480 		return -1;
   1481 	}
   1482 	/* Bits set to 0 in fixed1 are fixed to 0. */
   1483 	if (crval & ~fixed1) {
   1484 		return -1;
   1485 	}
   1486 	return 0;
   1487 }
   1488 
   1489 static int
   1490 vmx_inkernel_handle_cr0(struct nvmm_machine *mach, struct nvmm_cpu *vcpu,
   1491     uint64_t qual)
   1492 {
   1493 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1494 	uint64_t type, gpr, cr0;
   1495 	uint64_t efer, ctls1;
   1496 
   1497 	type = __SHIFTOUT(qual, VMX_QUAL_CR_TYPE);
   1498 	if (type != CR_TYPE_WRITE) {
   1499 		return -1;
   1500 	}
   1501 
   1502 	gpr = __SHIFTOUT(qual, VMX_QUAL_CR_GPR);
   1503 	KASSERT(gpr < 16);
   1504 
   1505 	if (gpr == NVMM_X64_GPR_RSP) {
   1506 		gpr = vmx_vmread(VMCS_GUEST_RSP);
   1507 	} else {
   1508 		gpr = cpudata->gprs[gpr];
   1509 	}
   1510 
   1511 	cr0 = gpr | CR0_NE | CR0_ET;
   1512 	cr0 &= ~(CR0_NW|CR0_CD);
   1513 
   1514 	if (vmx_check_cr(cr0, vmx_cr0_fixed0, vmx_cr0_fixed1) == -1) {
   1515 		return -1;
   1516 	}
   1517 
   1518 	/*
   1519 	 * XXX Handle 32bit PAE paging, need to set PDPTEs, fetched manually
   1520 	 * from CR3.
   1521 	 */
   1522 
   1523 	if (cr0 & CR0_PG) {
   1524 		ctls1 = vmx_vmread(VMCS_ENTRY_CTLS);
   1525 		efer = vmx_vmread(VMCS_GUEST_IA32_EFER);
   1526 		if (efer & EFER_LME) {
   1527 			ctls1 |= ENTRY_CTLS_LONG_MODE;
   1528 			efer |= EFER_LMA;
   1529 		} else {
   1530 			ctls1 &= ~ENTRY_CTLS_LONG_MODE;
   1531 			efer &= ~EFER_LMA;
   1532 		}
   1533 		vmx_vmwrite(VMCS_GUEST_IA32_EFER, efer);
   1534 		vmx_vmwrite(VMCS_ENTRY_CTLS, ctls1);
   1535 	}
   1536 
   1537 	vmx_vmwrite(VMCS_GUEST_CR0, cr0);
   1538 	vmx_inkernel_advance();
   1539 	return 0;
   1540 }
   1541 
   1542 static int
   1543 vmx_inkernel_handle_cr4(struct nvmm_machine *mach, struct nvmm_cpu *vcpu,
   1544     uint64_t qual)
   1545 {
   1546 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1547 	uint64_t type, gpr, cr4;
   1548 
   1549 	type = __SHIFTOUT(qual, VMX_QUAL_CR_TYPE);
   1550 	if (type != CR_TYPE_WRITE) {
   1551 		return -1;
   1552 	}
   1553 
   1554 	gpr = __SHIFTOUT(qual, VMX_QUAL_CR_GPR);
   1555 	KASSERT(gpr < 16);
   1556 
   1557 	if (gpr == NVMM_X64_GPR_RSP) {
   1558 		gpr = vmx_vmread(VMCS_GUEST_RSP);
   1559 	} else {
   1560 		gpr = cpudata->gprs[gpr];
   1561 	}
   1562 
   1563 	cr4 = gpr | CR4_VMXE;
   1564 
   1565 	if (vmx_check_cr(cr4, vmx_cr4_fixed0, vmx_cr4_fixed1) == -1) {
   1566 		return -1;
   1567 	}
   1568 
   1569 	vmx_vmwrite(VMCS_GUEST_CR4, cr4);
   1570 	vmx_inkernel_advance();
   1571 	return 0;
   1572 }
   1573 
   1574 static int
   1575 vmx_inkernel_handle_cr8(struct nvmm_machine *mach, struct nvmm_cpu *vcpu,
   1576     uint64_t qual, struct nvmm_vcpu_exit *exit)
   1577 {
   1578 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1579 	uint64_t type, gpr;
   1580 	bool write;
   1581 
   1582 	type = __SHIFTOUT(qual, VMX_QUAL_CR_TYPE);
   1583 	if (type == CR_TYPE_WRITE) {
   1584 		write = true;
   1585 	} else if (type == CR_TYPE_READ) {
   1586 		write = false;
   1587 	} else {
   1588 		return -1;
   1589 	}
   1590 
   1591 	gpr = __SHIFTOUT(qual, VMX_QUAL_CR_GPR);
   1592 	KASSERT(gpr < 16);
   1593 
   1594 	if (write) {
   1595 		if (gpr == NVMM_X64_GPR_RSP) {
   1596 			cpudata->gcr8 = vmx_vmread(VMCS_GUEST_RSP);
   1597 		} else {
   1598 			cpudata->gcr8 = cpudata->gprs[gpr];
   1599 		}
   1600 		if (cpudata->tpr.exit_changed) {
   1601 			exit->reason = NVMM_VCPU_EXIT_TPR_CHANGED;
   1602 		}
   1603 	} else {
   1604 		if (gpr == NVMM_X64_GPR_RSP) {
   1605 			vmx_vmwrite(VMCS_GUEST_RSP, cpudata->gcr8);
   1606 		} else {
   1607 			cpudata->gprs[gpr] = cpudata->gcr8;
   1608 		}
   1609 	}
   1610 
   1611 	vmx_inkernel_advance();
   1612 	return 0;
   1613 }
   1614 
   1615 static void
   1616 vmx_exit_cr(struct nvmm_machine *mach, struct nvmm_cpu *vcpu,
   1617     struct nvmm_vcpu_exit *exit)
   1618 {
   1619 	uint64_t qual;
   1620 	int ret;
   1621 
   1622 	exit->reason = NVMM_VCPU_EXIT_NONE;
   1623 
   1624 	qual = vmx_vmread(VMCS_EXIT_QUALIFICATION);
   1625 
   1626 	switch (__SHIFTOUT(qual, VMX_QUAL_CR_NUM)) {
   1627 	case 0:
   1628 		ret = vmx_inkernel_handle_cr0(mach, vcpu, qual);
   1629 		break;
   1630 	case 4:
   1631 		ret = vmx_inkernel_handle_cr4(mach, vcpu, qual);
   1632 		break;
   1633 	case 8:
   1634 		ret = vmx_inkernel_handle_cr8(mach, vcpu, qual, exit);
   1635 		break;
   1636 	default:
   1637 		ret = -1;
   1638 		break;
   1639 	}
   1640 
   1641 	if (ret == -1) {
   1642 		vmx_inject_gp(vcpu);
   1643 	}
   1644 }
   1645 
   1646 #define VMX_QUAL_IO_SIZE	__BITS(2,0)
   1647 #define		IO_SIZE_8	0
   1648 #define		IO_SIZE_16	1
   1649 #define		IO_SIZE_32	3
   1650 #define VMX_QUAL_IO_IN		__BIT(3)
   1651 #define VMX_QUAL_IO_STR		__BIT(4)
   1652 #define VMX_QUAL_IO_REP		__BIT(5)
   1653 #define VMX_QUAL_IO_DX		__BIT(6)
   1654 #define VMX_QUAL_IO_PORT	__BITS(31,16)
   1655 
   1656 #define VMX_INFO_IO_ADRSIZE	__BITS(9,7)
   1657 #define		IO_ADRSIZE_16	0
   1658 #define		IO_ADRSIZE_32	1
   1659 #define		IO_ADRSIZE_64	2
   1660 #define VMX_INFO_IO_SEG		__BITS(17,15)
   1661 
   1662 static void
   1663 vmx_exit_io(struct nvmm_machine *mach, struct nvmm_cpu *vcpu,
   1664     struct nvmm_vcpu_exit *exit)
   1665 {
   1666 	uint64_t qual, info, inslen, rip;
   1667 
   1668 	qual = vmx_vmread(VMCS_EXIT_QUALIFICATION);
   1669 	info = vmx_vmread(VMCS_EXIT_INSTRUCTION_INFO);
   1670 
   1671 	exit->reason = NVMM_VCPU_EXIT_IO;
   1672 
   1673 	exit->u.io.in = (qual & VMX_QUAL_IO_IN) != 0;
   1674 	exit->u.io.port = __SHIFTOUT(qual, VMX_QUAL_IO_PORT);
   1675 
   1676 	KASSERT(__SHIFTOUT(info, VMX_INFO_IO_SEG) < 6);
   1677 	exit->u.io.seg = __SHIFTOUT(info, VMX_INFO_IO_SEG);
   1678 
   1679 	if (__SHIFTOUT(info, VMX_INFO_IO_ADRSIZE) == IO_ADRSIZE_64) {
   1680 		exit->u.io.address_size = 8;
   1681 	} else if (__SHIFTOUT(info, VMX_INFO_IO_ADRSIZE) == IO_ADRSIZE_32) {
   1682 		exit->u.io.address_size = 4;
   1683 	} else if (__SHIFTOUT(info, VMX_INFO_IO_ADRSIZE) == IO_ADRSIZE_16) {
   1684 		exit->u.io.address_size = 2;
   1685 	}
   1686 
   1687 	if (__SHIFTOUT(qual, VMX_QUAL_IO_SIZE) == IO_SIZE_32) {
   1688 		exit->u.io.operand_size = 4;
   1689 	} else if (__SHIFTOUT(qual, VMX_QUAL_IO_SIZE) == IO_SIZE_16) {
   1690 		exit->u.io.operand_size = 2;
   1691 	} else if (__SHIFTOUT(qual, VMX_QUAL_IO_SIZE) == IO_SIZE_8) {
   1692 		exit->u.io.operand_size = 1;
   1693 	}
   1694 
   1695 	exit->u.io.rep = (qual & VMX_QUAL_IO_REP) != 0;
   1696 	exit->u.io.str = (qual & VMX_QUAL_IO_STR) != 0;
   1697 
   1698 	if (exit->u.io.in && exit->u.io.str) {
   1699 		exit->u.io.seg = NVMM_X64_SEG_ES;
   1700 	}
   1701 
   1702 	inslen = vmx_vmread(VMCS_EXIT_INSTRUCTION_LENGTH);
   1703 	rip = vmx_vmread(VMCS_GUEST_RIP);
   1704 	exit->u.io.npc = rip + inslen;
   1705 
   1706 	vmx_vcpu_state_provide(vcpu,
   1707 	    NVMM_X64_STATE_GPRS | NVMM_X64_STATE_SEGS |
   1708 	    NVMM_X64_STATE_CRS | NVMM_X64_STATE_MSRS);
   1709 }
   1710 
   1711 static const uint64_t msr_ignore_list[] = {
   1712 	MSR_BIOS_SIGN,
   1713 	MSR_IA32_PLATFORM_ID
   1714 };
   1715 
   1716 static bool
   1717 vmx_inkernel_handle_msr(struct nvmm_machine *mach, struct nvmm_cpu *vcpu,
   1718     struct nvmm_vcpu_exit *exit)
   1719 {
   1720 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1721 	uint64_t val;
   1722 	size_t i;
   1723 
   1724 	if (exit->reason == NVMM_VCPU_EXIT_RDMSR) {
   1725 		if (exit->u.rdmsr.msr == MSR_CR_PAT) {
   1726 			val = vmx_vmread(VMCS_GUEST_IA32_PAT);
   1727 			cpudata->gprs[NVMM_X64_GPR_RAX] = (val & 0xFFFFFFFF);
   1728 			cpudata->gprs[NVMM_X64_GPR_RDX] = (val >> 32);
   1729 			goto handled;
   1730 		}
   1731 		if (exit->u.rdmsr.msr == MSR_MISC_ENABLE) {
   1732 			val = cpudata->gmsr_misc_enable;
   1733 			cpudata->gprs[NVMM_X64_GPR_RAX] = (val & 0xFFFFFFFF);
   1734 			cpudata->gprs[NVMM_X64_GPR_RDX] = (val >> 32);
   1735 			goto handled;
   1736 		}
   1737 		if (exit->u.rdmsr.msr == MSR_IA32_ARCH_CAPABILITIES) {
   1738 			u_int descs[4];
   1739 			if (cpuid_level < 7) {
   1740 				goto error;
   1741 			}
   1742 			x86_cpuid(7, descs);
   1743 			if (!(descs[3] & CPUID_SEF_ARCH_CAP)) {
   1744 				goto error;
   1745 			}
   1746 			val = rdmsr(MSR_IA32_ARCH_CAPABILITIES);
   1747 			val &= (IA32_ARCH_RDCL_NO |
   1748 			    IA32_ARCH_SSB_NO |
   1749 			    IA32_ARCH_MDS_NO |
   1750 			    IA32_ARCH_TAA_NO);
   1751 			cpudata->gprs[NVMM_X64_GPR_RAX] = (val & 0xFFFFFFFF);
   1752 			cpudata->gprs[NVMM_X64_GPR_RDX] = (val >> 32);
   1753 			goto handled;
   1754 		}
   1755 		for (i = 0; i < __arraycount(msr_ignore_list); i++) {
   1756 			if (msr_ignore_list[i] != exit->u.rdmsr.msr)
   1757 				continue;
   1758 			val = 0;
   1759 			cpudata->gprs[NVMM_X64_GPR_RAX] = (val & 0xFFFFFFFF);
   1760 			cpudata->gprs[NVMM_X64_GPR_RDX] = (val >> 32);
   1761 			goto handled;
   1762 		}
   1763 	} else {
   1764 		if (exit->u.wrmsr.msr == MSR_TSC) {
   1765 			cpudata->gtsc = exit->u.wrmsr.val;
   1766 			cpudata->gtsc_want_update = true;
   1767 			goto handled;
   1768 		}
   1769 		if (exit->u.wrmsr.msr == MSR_CR_PAT) {
   1770 			val = exit->u.wrmsr.val;
   1771 			if (__predict_false(!nvmm_x86_pat_validate(val))) {
   1772 				goto error;
   1773 			}
   1774 			vmx_vmwrite(VMCS_GUEST_IA32_PAT, val);
   1775 			goto handled;
   1776 		}
   1777 		if (exit->u.wrmsr.msr == MSR_MISC_ENABLE) {
   1778 			/* Don't care. */
   1779 			goto handled;
   1780 		}
   1781 		for (i = 0; i < __arraycount(msr_ignore_list); i++) {
   1782 			if (msr_ignore_list[i] != exit->u.wrmsr.msr)
   1783 				continue;
   1784 			goto handled;
   1785 		}
   1786 	}
   1787 
   1788 	return false;
   1789 
   1790 handled:
   1791 	vmx_inkernel_advance();
   1792 	return true;
   1793 
   1794 error:
   1795 	vmx_inject_gp(vcpu);
   1796 	return true;
   1797 }
   1798 
   1799 static void
   1800 vmx_exit_rdmsr(struct nvmm_machine *mach, struct nvmm_cpu *vcpu,
   1801     struct nvmm_vcpu_exit *exit)
   1802 {
   1803 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1804 	uint64_t inslen, rip;
   1805 
   1806 	exit->reason = NVMM_VCPU_EXIT_RDMSR;
   1807 	exit->u.rdmsr.msr = (cpudata->gprs[NVMM_X64_GPR_RCX] & 0xFFFFFFFF);
   1808 
   1809 	if (vmx_inkernel_handle_msr(mach, vcpu, exit)) {
   1810 		exit->reason = NVMM_VCPU_EXIT_NONE;
   1811 		return;
   1812 	}
   1813 
   1814 	inslen = vmx_vmread(VMCS_EXIT_INSTRUCTION_LENGTH);
   1815 	rip = vmx_vmread(VMCS_GUEST_RIP);
   1816 	exit->u.rdmsr.npc = rip + inslen;
   1817 
   1818 	vmx_vcpu_state_provide(vcpu, NVMM_X64_STATE_GPRS);
   1819 }
   1820 
   1821 static void
   1822 vmx_exit_wrmsr(struct nvmm_machine *mach, struct nvmm_cpu *vcpu,
   1823     struct nvmm_vcpu_exit *exit)
   1824 {
   1825 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1826 	uint64_t rdx, rax, inslen, rip;
   1827 
   1828 	rdx = cpudata->gprs[NVMM_X64_GPR_RDX];
   1829 	rax = cpudata->gprs[NVMM_X64_GPR_RAX];
   1830 
   1831 	exit->reason = NVMM_VCPU_EXIT_WRMSR;
   1832 	exit->u.wrmsr.msr = (cpudata->gprs[NVMM_X64_GPR_RCX] & 0xFFFFFFFF);
   1833 	exit->u.wrmsr.val = (rdx << 32) | (rax & 0xFFFFFFFF);
   1834 
   1835 	if (vmx_inkernel_handle_msr(mach, vcpu, exit)) {
   1836 		exit->reason = NVMM_VCPU_EXIT_NONE;
   1837 		return;
   1838 	}
   1839 
   1840 	inslen = vmx_vmread(VMCS_EXIT_INSTRUCTION_LENGTH);
   1841 	rip = vmx_vmread(VMCS_GUEST_RIP);
   1842 	exit->u.wrmsr.npc = rip + inslen;
   1843 
   1844 	vmx_vcpu_state_provide(vcpu, NVMM_X64_STATE_GPRS);
   1845 }
   1846 
   1847 static void
   1848 vmx_exit_xsetbv(struct nvmm_machine *mach, struct nvmm_cpu *vcpu,
   1849     struct nvmm_vcpu_exit *exit)
   1850 {
   1851 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1852 	uint64_t val;
   1853 
   1854 	exit->reason = NVMM_VCPU_EXIT_NONE;
   1855 
   1856 	val = (cpudata->gprs[NVMM_X64_GPR_RDX] << 32) |
   1857 	    (cpudata->gprs[NVMM_X64_GPR_RAX] & 0xFFFFFFFF);
   1858 
   1859 	if (__predict_false(cpudata->gprs[NVMM_X64_GPR_RCX] != 0)) {
   1860 		goto error;
   1861 	} else if (__predict_false((val & ~vmx_xcr0_mask) != 0)) {
   1862 		goto error;
   1863 	} else if (__predict_false((val & XCR0_X87) == 0)) {
   1864 		goto error;
   1865 	}
   1866 
   1867 	cpudata->gxcr0 = val;
   1868 	if (vmx_xcr0_mask != 0) {
   1869 		wrxcr(0, cpudata->gxcr0);
   1870 	}
   1871 
   1872 	vmx_inkernel_advance();
   1873 	return;
   1874 
   1875 error:
   1876 	vmx_inject_gp(vcpu);
   1877 }
   1878 
   1879 #define VMX_EPT_VIOLATION_READ		__BIT(0)
   1880 #define VMX_EPT_VIOLATION_WRITE		__BIT(1)
   1881 #define VMX_EPT_VIOLATION_EXECUTE	__BIT(2)
   1882 
   1883 static void
   1884 vmx_exit_epf(struct nvmm_machine *mach, struct nvmm_cpu *vcpu,
   1885     struct nvmm_vcpu_exit *exit)
   1886 {
   1887 	uint64_t perm;
   1888 	gpaddr_t gpa;
   1889 
   1890 	gpa = vmx_vmread(VMCS_GUEST_PHYSICAL_ADDRESS);
   1891 
   1892 	exit->reason = NVMM_VCPU_EXIT_MEMORY;
   1893 	perm = vmx_vmread(VMCS_EXIT_QUALIFICATION);
   1894 	if (perm & VMX_EPT_VIOLATION_WRITE)
   1895 		exit->u.mem.prot = PROT_WRITE;
   1896 	else if (perm & VMX_EPT_VIOLATION_EXECUTE)
   1897 		exit->u.mem.prot = PROT_EXEC;
   1898 	else
   1899 		exit->u.mem.prot = PROT_READ;
   1900 	exit->u.mem.gpa = gpa;
   1901 	exit->u.mem.inst_len = 0;
   1902 
   1903 	vmx_vcpu_state_provide(vcpu,
   1904 	    NVMM_X64_STATE_GPRS | NVMM_X64_STATE_SEGS |
   1905 	    NVMM_X64_STATE_CRS | NVMM_X64_STATE_MSRS);
   1906 }
   1907 
   1908 /* -------------------------------------------------------------------------- */
   1909 
   1910 static void
   1911 vmx_vcpu_guest_fpu_enter(struct nvmm_cpu *vcpu)
   1912 {
   1913 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1914 
   1915 	fpu_kern_enter();
   1916 	fpu_area_restore(&cpudata->gfpu, vmx_xcr0_mask);
   1917 
   1918 	if (vmx_xcr0_mask != 0) {
   1919 		cpudata->hxcr0 = rdxcr(0);
   1920 		wrxcr(0, cpudata->gxcr0);
   1921 	}
   1922 }
   1923 
   1924 static void
   1925 vmx_vcpu_guest_fpu_leave(struct nvmm_cpu *vcpu)
   1926 {
   1927 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1928 
   1929 	if (vmx_xcr0_mask != 0) {
   1930 		cpudata->gxcr0 = rdxcr(0);
   1931 		wrxcr(0, cpudata->hxcr0);
   1932 	}
   1933 
   1934 	fpu_area_save(&cpudata->gfpu, vmx_xcr0_mask);
   1935 	fpu_kern_leave();
   1936 }
   1937 
   1938 static void
   1939 vmx_vcpu_guest_dbregs_enter(struct nvmm_cpu *vcpu)
   1940 {
   1941 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1942 
   1943 	x86_dbregs_save(curlwp);
   1944 
   1945 	ldr7(0);
   1946 
   1947 	ldr0(cpudata->drs[NVMM_X64_DR_DR0]);
   1948 	ldr1(cpudata->drs[NVMM_X64_DR_DR1]);
   1949 	ldr2(cpudata->drs[NVMM_X64_DR_DR2]);
   1950 	ldr3(cpudata->drs[NVMM_X64_DR_DR3]);
   1951 	ldr6(cpudata->drs[NVMM_X64_DR_DR6]);
   1952 }
   1953 
   1954 static void
   1955 vmx_vcpu_guest_dbregs_leave(struct nvmm_cpu *vcpu)
   1956 {
   1957 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1958 
   1959 	cpudata->drs[NVMM_X64_DR_DR0] = rdr0();
   1960 	cpudata->drs[NVMM_X64_DR_DR1] = rdr1();
   1961 	cpudata->drs[NVMM_X64_DR_DR2] = rdr2();
   1962 	cpudata->drs[NVMM_X64_DR_DR3] = rdr3();
   1963 	cpudata->drs[NVMM_X64_DR_DR6] = rdr6();
   1964 
   1965 	x86_dbregs_restore(curlwp);
   1966 }
   1967 
   1968 static void
   1969 vmx_vcpu_guest_misc_enter(struct nvmm_cpu *vcpu)
   1970 {
   1971 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1972 
   1973 	/* This gets restored automatically by the CPU. */
   1974 	vmx_vmwrite(VMCS_HOST_IDTR_BASE, (uint64_t)curcpu()->ci_idtvec.iv_idt);
   1975 	vmx_vmwrite(VMCS_HOST_FS_BASE, rdmsr(MSR_FSBASE));
   1976 	vmx_vmwrite(VMCS_HOST_CR3, rcr3());
   1977 	vmx_vmwrite(VMCS_HOST_CR4, rcr4());
   1978 
   1979 	cpudata->kernelgsbase = rdmsr(MSR_KERNELGSBASE);
   1980 }
   1981 
   1982 static void
   1983 vmx_vcpu_guest_misc_leave(struct nvmm_cpu *vcpu)
   1984 {
   1985 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   1986 
   1987 	wrmsr(MSR_STAR, cpudata->star);
   1988 	wrmsr(MSR_LSTAR, cpudata->lstar);
   1989 	wrmsr(MSR_CSTAR, cpudata->cstar);
   1990 	wrmsr(MSR_SFMASK, cpudata->sfmask);
   1991 	wrmsr(MSR_KERNELGSBASE, cpudata->kernelgsbase);
   1992 }
   1993 
   1994 /* -------------------------------------------------------------------------- */
   1995 
   1996 #define VMX_INVVPID_ADDRESS		0
   1997 #define VMX_INVVPID_CONTEXT		1
   1998 #define VMX_INVVPID_ALL			2
   1999 #define VMX_INVVPID_CONTEXT_NOGLOBAL	3
   2000 
   2001 #define VMX_INVEPT_CONTEXT		1
   2002 #define VMX_INVEPT_ALL			2
   2003 
   2004 static inline void
   2005 vmx_gtlb_catchup(struct nvmm_cpu *vcpu, int hcpu)
   2006 {
   2007 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   2008 
   2009 	if (vcpu->hcpu_last != hcpu) {
   2010 		cpudata->gtlb_want_flush = true;
   2011 	}
   2012 }
   2013 
   2014 static inline void
   2015 vmx_htlb_catchup(struct nvmm_cpu *vcpu, int hcpu)
   2016 {
   2017 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   2018 	struct ept_desc ept_desc;
   2019 
   2020 	if (__predict_true(!kcpuset_isset(cpudata->htlb_want_flush, hcpu))) {
   2021 		return;
   2022 	}
   2023 
   2024 	ept_desc.eptp = vmx_vmread(VMCS_EPTP);
   2025 	ept_desc.mbz = 0;
   2026 	vmx_invept(vmx_ept_flush_op, &ept_desc);
   2027 	kcpuset_clear(cpudata->htlb_want_flush, hcpu);
   2028 }
   2029 
   2030 static inline uint64_t
   2031 vmx_htlb_flush(struct vmx_machdata *machdata, struct vmx_cpudata *cpudata)
   2032 {
   2033 	struct ept_desc ept_desc;
   2034 	uint64_t machgen;
   2035 
   2036 	machgen = machdata->mach_htlb_gen;
   2037 	if (__predict_true(machgen == cpudata->vcpu_htlb_gen)) {
   2038 		return machgen;
   2039 	}
   2040 
   2041 	kcpuset_copy(cpudata->htlb_want_flush, kcpuset_running);
   2042 
   2043 	ept_desc.eptp = vmx_vmread(VMCS_EPTP);
   2044 	ept_desc.mbz = 0;
   2045 	vmx_invept(vmx_ept_flush_op, &ept_desc);
   2046 
   2047 	return machgen;
   2048 }
   2049 
   2050 static inline void
   2051 vmx_htlb_flush_ack(struct vmx_cpudata *cpudata, uint64_t machgen)
   2052 {
   2053 	cpudata->vcpu_htlb_gen = machgen;
   2054 	kcpuset_clear(cpudata->htlb_want_flush, cpu_number());
   2055 }
   2056 
   2057 static inline void
   2058 vmx_exit_evt(struct vmx_cpudata *cpudata)
   2059 {
   2060 	uint64_t info, err, inslen;
   2061 
   2062 	cpudata->evt_pending = false;
   2063 
   2064 	info = vmx_vmread(VMCS_IDT_VECTORING_INFO);
   2065 	if (__predict_true((info & INTR_INFO_VALID) == 0)) {
   2066 		return;
   2067 	}
   2068 	err = vmx_vmread(VMCS_IDT_VECTORING_ERROR);
   2069 
   2070 	vmx_vmwrite(VMCS_ENTRY_INTR_INFO, info);
   2071 	vmx_vmwrite(VMCS_ENTRY_EXCEPTION_ERROR, err);
   2072 
   2073 	switch (__SHIFTOUT(info, INTR_INFO_TYPE)) {
   2074 	case INTR_TYPE_SW_INT:
   2075 	case INTR_TYPE_PRIV_SW_EXC:
   2076 	case INTR_TYPE_SW_EXC:
   2077 		inslen = vmx_vmread(VMCS_EXIT_INSTRUCTION_LENGTH);
   2078 		vmx_vmwrite(VMCS_ENTRY_INSTRUCTION_LENGTH, inslen);
   2079 	}
   2080 
   2081 	cpudata->evt_pending = true;
   2082 }
   2083 
   2084 static int
   2085 vmx_vcpu_run(struct nvmm_machine *mach, struct nvmm_cpu *vcpu,
   2086     struct nvmm_vcpu_exit *exit)
   2087 {
   2088 	struct nvmm_comm_page *comm = vcpu->comm;
   2089 	struct vmx_machdata *machdata = mach->machdata;
   2090 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   2091 	struct vpid_desc vpid_desc;
   2092 	struct cpu_info *ci;
   2093 	uint64_t exitcode;
   2094 	uint64_t intstate;
   2095 	uint64_t machgen;
   2096 	int hcpu, ret;
   2097 	bool launched;
   2098 
   2099 	vmx_vmcs_enter(vcpu);
   2100 
   2101 	if (__predict_false(vmx_vcpu_event_commit(vcpu) != 0)) {
   2102 		vmx_vmcs_leave(vcpu);
   2103 		return EINVAL;
   2104 	}
   2105 	vmx_vcpu_state_commit(vcpu);
   2106 	comm->state_cached = 0;
   2107 
   2108 	ci = curcpu();
   2109 	hcpu = cpu_number();
   2110 	launched = cpudata->vmcs_launched;
   2111 
   2112 	vmx_gtlb_catchup(vcpu, hcpu);
   2113 	vmx_htlb_catchup(vcpu, hcpu);
   2114 
   2115 	if (vcpu->hcpu_last != hcpu) {
   2116 		vmx_vmwrite(VMCS_HOST_TR_SELECTOR, ci->ci_tss_sel);
   2117 		vmx_vmwrite(VMCS_HOST_TR_BASE, (uint64_t)ci->ci_tss);
   2118 		vmx_vmwrite(VMCS_HOST_GDTR_BASE, (uint64_t)ci->ci_gdt);
   2119 		vmx_vmwrite(VMCS_HOST_GS_BASE, rdmsr(MSR_GSBASE));
   2120 		cpudata->gtsc_want_update = true;
   2121 		vcpu->hcpu_last = hcpu;
   2122 	}
   2123 
   2124 	vmx_vcpu_guest_dbregs_enter(vcpu);
   2125 	vmx_vcpu_guest_misc_enter(vcpu);
   2126 	vmx_vcpu_guest_fpu_enter(vcpu);
   2127 
   2128 	while (1) {
   2129 		if (cpudata->gtlb_want_flush) {
   2130 			vpid_desc.vpid = cpudata->asid;
   2131 			vpid_desc.addr = 0;
   2132 			vmx_invvpid(vmx_tlb_flush_op, &vpid_desc);
   2133 			cpudata->gtlb_want_flush = false;
   2134 		}
   2135 
   2136 		if (__predict_false(cpudata->gtsc_want_update)) {
   2137 			vmx_vmwrite(VMCS_TSC_OFFSET, cpudata->gtsc - rdtsc());
   2138 			cpudata->gtsc_want_update = false;
   2139 		}
   2140 
   2141 		vmx_cli();
   2142 		machgen = vmx_htlb_flush(machdata, cpudata);
   2143 		lcr2(cpudata->gcr2);
   2144 		if (launched) {
   2145 			ret = vmx_vmresume(cpudata->gprs);
   2146 		} else {
   2147 			ret = vmx_vmlaunch(cpudata->gprs);
   2148 		}
   2149 		cpudata->gcr2 = rcr2();
   2150 		vmx_htlb_flush_ack(cpudata, machgen);
   2151 		vmx_sti();
   2152 
   2153 		if (__predict_false(ret != 0)) {
   2154 			vmx_exit_invalid(exit, -1);
   2155 			break;
   2156 		}
   2157 		vmx_exit_evt(cpudata);
   2158 
   2159 		launched = true;
   2160 
   2161 		exitcode = vmx_vmread(VMCS_EXIT_REASON);
   2162 		exitcode &= __BITS(15,0);
   2163 
   2164 		switch (exitcode) {
   2165 		case VMCS_EXITCODE_EXC_NMI:
   2166 			vmx_exit_exc_nmi(mach, vcpu, exit);
   2167 			break;
   2168 		case VMCS_EXITCODE_EXT_INT:
   2169 			exit->reason = NVMM_VCPU_EXIT_NONE;
   2170 			break;
   2171 		case VMCS_EXITCODE_CPUID:
   2172 			vmx_exit_cpuid(mach, vcpu, exit);
   2173 			break;
   2174 		case VMCS_EXITCODE_HLT:
   2175 			vmx_exit_hlt(mach, vcpu, exit);
   2176 			break;
   2177 		case VMCS_EXITCODE_CR:
   2178 			vmx_exit_cr(mach, vcpu, exit);
   2179 			break;
   2180 		case VMCS_EXITCODE_IO:
   2181 			vmx_exit_io(mach, vcpu, exit);
   2182 			break;
   2183 		case VMCS_EXITCODE_RDMSR:
   2184 			vmx_exit_rdmsr(mach, vcpu, exit);
   2185 			break;
   2186 		case VMCS_EXITCODE_WRMSR:
   2187 			vmx_exit_wrmsr(mach, vcpu, exit);
   2188 			break;
   2189 		case VMCS_EXITCODE_SHUTDOWN:
   2190 			exit->reason = NVMM_VCPU_EXIT_SHUTDOWN;
   2191 			break;
   2192 		case VMCS_EXITCODE_MONITOR:
   2193 			vmx_exit_insn(exit, NVMM_VCPU_EXIT_MONITOR);
   2194 			break;
   2195 		case VMCS_EXITCODE_MWAIT:
   2196 			vmx_exit_insn(exit, NVMM_VCPU_EXIT_MWAIT);
   2197 			break;
   2198 		case VMCS_EXITCODE_XSETBV:
   2199 			vmx_exit_xsetbv(mach, vcpu, exit);
   2200 			break;
   2201 		case VMCS_EXITCODE_RDPMC:
   2202 		case VMCS_EXITCODE_RDTSCP:
   2203 		case VMCS_EXITCODE_INVVPID:
   2204 		case VMCS_EXITCODE_INVEPT:
   2205 		case VMCS_EXITCODE_VMCALL:
   2206 		case VMCS_EXITCODE_VMCLEAR:
   2207 		case VMCS_EXITCODE_VMLAUNCH:
   2208 		case VMCS_EXITCODE_VMPTRLD:
   2209 		case VMCS_EXITCODE_VMPTRST:
   2210 		case VMCS_EXITCODE_VMREAD:
   2211 		case VMCS_EXITCODE_VMRESUME:
   2212 		case VMCS_EXITCODE_VMWRITE:
   2213 		case VMCS_EXITCODE_VMXOFF:
   2214 		case VMCS_EXITCODE_VMXON:
   2215 			vmx_inject_ud(vcpu);
   2216 			exit->reason = NVMM_VCPU_EXIT_NONE;
   2217 			break;
   2218 		case VMCS_EXITCODE_EPT_VIOLATION:
   2219 			vmx_exit_epf(mach, vcpu, exit);
   2220 			break;
   2221 		case VMCS_EXITCODE_INT_WINDOW:
   2222 			vmx_event_waitexit_disable(vcpu, false);
   2223 			exit->reason = NVMM_VCPU_EXIT_INT_READY;
   2224 			break;
   2225 		case VMCS_EXITCODE_NMI_WINDOW:
   2226 			vmx_event_waitexit_disable(vcpu, true);
   2227 			exit->reason = NVMM_VCPU_EXIT_NMI_READY;
   2228 			break;
   2229 		default:
   2230 			vmx_exit_invalid(exit, exitcode);
   2231 			break;
   2232 		}
   2233 
   2234 		/* If no reason to return to userland, keep rolling. */
   2235 		if (nvmm_return_needed()) {
   2236 			break;
   2237 		}
   2238 		if (exit->reason != NVMM_VCPU_EXIT_NONE) {
   2239 			break;
   2240 		}
   2241 	}
   2242 
   2243 	cpudata->vmcs_launched = launched;
   2244 
   2245 	cpudata->gtsc = vmx_vmread(VMCS_TSC_OFFSET) + rdtsc();
   2246 
   2247 	vmx_vcpu_guest_fpu_leave(vcpu);
   2248 	vmx_vcpu_guest_misc_leave(vcpu);
   2249 	vmx_vcpu_guest_dbregs_leave(vcpu);
   2250 
   2251 	exit->exitstate.rflags = vmx_vmread(VMCS_GUEST_RFLAGS);
   2252 	exit->exitstate.cr8 = cpudata->gcr8;
   2253 	intstate = vmx_vmread(VMCS_GUEST_INTERRUPTIBILITY);
   2254 	exit->exitstate.int_shadow =
   2255 	    (intstate & (INT_STATE_STI|INT_STATE_MOVSS)) != 0;
   2256 	exit->exitstate.int_window_exiting = cpudata->int_window_exit;
   2257 	exit->exitstate.nmi_window_exiting = cpudata->nmi_window_exit;
   2258 	exit->exitstate.evt_pending = cpudata->evt_pending;
   2259 
   2260 	vmx_vmcs_leave(vcpu);
   2261 
   2262 	return 0;
   2263 }
   2264 
   2265 /* -------------------------------------------------------------------------- */
   2266 
   2267 static int
   2268 vmx_memalloc(paddr_t *pa, vaddr_t *va, size_t npages)
   2269 {
   2270 	struct pglist pglist;
   2271 	paddr_t _pa;
   2272 	vaddr_t _va;
   2273 	size_t i;
   2274 	int ret;
   2275 
   2276 	ret = uvm_pglistalloc(npages * PAGE_SIZE, 0, ~0UL, PAGE_SIZE, 0,
   2277 	    &pglist, 1, 0);
   2278 	if (ret != 0)
   2279 		return ENOMEM;
   2280 	_pa = VM_PAGE_TO_PHYS(TAILQ_FIRST(&pglist));
   2281 	_va = uvm_km_alloc(kernel_map, npages * PAGE_SIZE, 0,
   2282 	    UVM_KMF_VAONLY | UVM_KMF_NOWAIT);
   2283 	if (_va == 0)
   2284 		goto error;
   2285 
   2286 	for (i = 0; i < npages; i++) {
   2287 		pmap_kenter_pa(_va + i * PAGE_SIZE, _pa + i * PAGE_SIZE,
   2288 		    VM_PROT_READ | VM_PROT_WRITE, PMAP_WRITE_BACK);
   2289 	}
   2290 	pmap_update(pmap_kernel());
   2291 
   2292 	memset((void *)_va, 0, npages * PAGE_SIZE);
   2293 
   2294 	*pa = _pa;
   2295 	*va = _va;
   2296 	return 0;
   2297 
   2298 error:
   2299 	for (i = 0; i < npages; i++) {
   2300 		uvm_pagefree(PHYS_TO_VM_PAGE(_pa + i * PAGE_SIZE));
   2301 	}
   2302 	return ENOMEM;
   2303 }
   2304 
   2305 static void
   2306 vmx_memfree(paddr_t pa, vaddr_t va, size_t npages)
   2307 {
   2308 	size_t i;
   2309 
   2310 	pmap_kremove(va, npages * PAGE_SIZE);
   2311 	pmap_update(pmap_kernel());
   2312 	uvm_km_free(kernel_map, va, npages * PAGE_SIZE, UVM_KMF_VAONLY);
   2313 	for (i = 0; i < npages; i++) {
   2314 		uvm_pagefree(PHYS_TO_VM_PAGE(pa + i * PAGE_SIZE));
   2315 	}
   2316 }
   2317 
   2318 /* -------------------------------------------------------------------------- */
   2319 
   2320 static void
   2321 vmx_vcpu_msr_allow(uint8_t *bitmap, uint64_t msr, bool read, bool write)
   2322 {
   2323 	uint64_t byte;
   2324 	uint8_t bitoff;
   2325 
   2326 	if (msr < 0x00002000) {
   2327 		/* Range 1 */
   2328 		byte = ((msr - 0x00000000) / 8) + 0;
   2329 	} else if (msr >= 0xC0000000 && msr < 0xC0002000) {
   2330 		/* Range 2 */
   2331 		byte = ((msr - 0xC0000000) / 8) + 1024;
   2332 	} else {
   2333 		panic("%s: wrong range", __func__);
   2334 	}
   2335 
   2336 	bitoff = (msr & 0x7);
   2337 
   2338 	if (read) {
   2339 		bitmap[byte] &= ~__BIT(bitoff);
   2340 	}
   2341 	if (write) {
   2342 		bitmap[2048 + byte] &= ~__BIT(bitoff);
   2343 	}
   2344 }
   2345 
   2346 #define VMX_SEG_ATTRIB_TYPE		__BITS(3,0)
   2347 #define VMX_SEG_ATTRIB_S		__BIT(4)
   2348 #define VMX_SEG_ATTRIB_DPL		__BITS(6,5)
   2349 #define VMX_SEG_ATTRIB_P		__BIT(7)
   2350 #define VMX_SEG_ATTRIB_AVL		__BIT(12)
   2351 #define VMX_SEG_ATTRIB_L		__BIT(13)
   2352 #define VMX_SEG_ATTRIB_DEF		__BIT(14)
   2353 #define VMX_SEG_ATTRIB_G		__BIT(15)
   2354 #define VMX_SEG_ATTRIB_UNUSABLE		__BIT(16)
   2355 
   2356 static void
   2357 vmx_vcpu_setstate_seg(const struct nvmm_x64_state_seg *segs, int idx)
   2358 {
   2359 	uint64_t attrib;
   2360 
   2361 	attrib =
   2362 	    __SHIFTIN(segs[idx].attrib.type, VMX_SEG_ATTRIB_TYPE) |
   2363 	    __SHIFTIN(segs[idx].attrib.s, VMX_SEG_ATTRIB_S) |
   2364 	    __SHIFTIN(segs[idx].attrib.dpl, VMX_SEG_ATTRIB_DPL) |
   2365 	    __SHIFTIN(segs[idx].attrib.p, VMX_SEG_ATTRIB_P) |
   2366 	    __SHIFTIN(segs[idx].attrib.avl, VMX_SEG_ATTRIB_AVL) |
   2367 	    __SHIFTIN(segs[idx].attrib.l, VMX_SEG_ATTRIB_L) |
   2368 	    __SHIFTIN(segs[idx].attrib.def, VMX_SEG_ATTRIB_DEF) |
   2369 	    __SHIFTIN(segs[idx].attrib.g, VMX_SEG_ATTRIB_G) |
   2370 	    (!segs[idx].attrib.p ? VMX_SEG_ATTRIB_UNUSABLE : 0);
   2371 
   2372 	if (idx != NVMM_X64_SEG_GDT && idx != NVMM_X64_SEG_IDT) {
   2373 		vmx_vmwrite(vmx_guest_segs[idx].selector, segs[idx].selector);
   2374 		vmx_vmwrite(vmx_guest_segs[idx].attrib, attrib);
   2375 	}
   2376 	vmx_vmwrite(vmx_guest_segs[idx].limit, segs[idx].limit);
   2377 	vmx_vmwrite(vmx_guest_segs[idx].base, segs[idx].base);
   2378 }
   2379 
   2380 static void
   2381 vmx_vcpu_getstate_seg(struct nvmm_x64_state_seg *segs, int idx)
   2382 {
   2383 	uint64_t selector = 0, attrib = 0, base, limit;
   2384 
   2385 	if (idx != NVMM_X64_SEG_GDT && idx != NVMM_X64_SEG_IDT) {
   2386 		selector = vmx_vmread(vmx_guest_segs[idx].selector);
   2387 		attrib = vmx_vmread(vmx_guest_segs[idx].attrib);
   2388 	}
   2389 	limit = vmx_vmread(vmx_guest_segs[idx].limit);
   2390 	base = vmx_vmread(vmx_guest_segs[idx].base);
   2391 
   2392 	segs[idx].selector = selector;
   2393 	segs[idx].limit = limit;
   2394 	segs[idx].base = base;
   2395 	segs[idx].attrib.type = __SHIFTOUT(attrib, VMX_SEG_ATTRIB_TYPE);
   2396 	segs[idx].attrib.s = __SHIFTOUT(attrib, VMX_SEG_ATTRIB_S);
   2397 	segs[idx].attrib.dpl = __SHIFTOUT(attrib, VMX_SEG_ATTRIB_DPL);
   2398 	segs[idx].attrib.p = __SHIFTOUT(attrib, VMX_SEG_ATTRIB_P);
   2399 	segs[idx].attrib.avl = __SHIFTOUT(attrib, VMX_SEG_ATTRIB_AVL);
   2400 	segs[idx].attrib.l = __SHIFTOUT(attrib, VMX_SEG_ATTRIB_L);
   2401 	segs[idx].attrib.def = __SHIFTOUT(attrib, VMX_SEG_ATTRIB_DEF);
   2402 	segs[idx].attrib.g = __SHIFTOUT(attrib, VMX_SEG_ATTRIB_G);
   2403 	if (attrib & VMX_SEG_ATTRIB_UNUSABLE) {
   2404 		segs[idx].attrib.p = 0;
   2405 	}
   2406 }
   2407 
   2408 static inline bool
   2409 vmx_state_tlb_flush(const struct nvmm_x64_state *state, uint64_t flags)
   2410 {
   2411 	uint64_t cr0, cr3, cr4, efer;
   2412 
   2413 	if (flags & NVMM_X64_STATE_CRS) {
   2414 		cr0 = vmx_vmread(VMCS_GUEST_CR0);
   2415 		if ((cr0 ^ state->crs[NVMM_X64_CR_CR0]) & CR0_TLB_FLUSH) {
   2416 			return true;
   2417 		}
   2418 		cr3 = vmx_vmread(VMCS_GUEST_CR3);
   2419 		if (cr3 != state->crs[NVMM_X64_CR_CR3]) {
   2420 			return true;
   2421 		}
   2422 		cr4 = vmx_vmread(VMCS_GUEST_CR4);
   2423 		if ((cr4 ^ state->crs[NVMM_X64_CR_CR4]) & CR4_TLB_FLUSH) {
   2424 			return true;
   2425 		}
   2426 	}
   2427 
   2428 	if (flags & NVMM_X64_STATE_MSRS) {
   2429 		efer = vmx_vmread(VMCS_GUEST_IA32_EFER);
   2430 		if ((efer ^
   2431 		     state->msrs[NVMM_X64_MSR_EFER]) & EFER_TLB_FLUSH) {
   2432 			return true;
   2433 		}
   2434 	}
   2435 
   2436 	return false;
   2437 }
   2438 
   2439 static void
   2440 vmx_vcpu_setstate(struct nvmm_cpu *vcpu)
   2441 {
   2442 	struct nvmm_comm_page *comm = vcpu->comm;
   2443 	const struct nvmm_x64_state *state = &comm->state;
   2444 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   2445 	struct fxsave *fpustate;
   2446 	uint64_t ctls1, intstate;
   2447 	uint64_t flags;
   2448 
   2449 	flags = comm->state_wanted;
   2450 
   2451 	vmx_vmcs_enter(vcpu);
   2452 
   2453 	if (vmx_state_tlb_flush(state, flags)) {
   2454 		cpudata->gtlb_want_flush = true;
   2455 	}
   2456 
   2457 	if (flags & NVMM_X64_STATE_SEGS) {
   2458 		vmx_vcpu_setstate_seg(state->segs, NVMM_X64_SEG_CS);
   2459 		vmx_vcpu_setstate_seg(state->segs, NVMM_X64_SEG_DS);
   2460 		vmx_vcpu_setstate_seg(state->segs, NVMM_X64_SEG_ES);
   2461 		vmx_vcpu_setstate_seg(state->segs, NVMM_X64_SEG_FS);
   2462 		vmx_vcpu_setstate_seg(state->segs, NVMM_X64_SEG_GS);
   2463 		vmx_vcpu_setstate_seg(state->segs, NVMM_X64_SEG_SS);
   2464 		vmx_vcpu_setstate_seg(state->segs, NVMM_X64_SEG_GDT);
   2465 		vmx_vcpu_setstate_seg(state->segs, NVMM_X64_SEG_IDT);
   2466 		vmx_vcpu_setstate_seg(state->segs, NVMM_X64_SEG_LDT);
   2467 		vmx_vcpu_setstate_seg(state->segs, NVMM_X64_SEG_TR);
   2468 	}
   2469 
   2470 	CTASSERT(sizeof(cpudata->gprs) == sizeof(state->gprs));
   2471 	if (flags & NVMM_X64_STATE_GPRS) {
   2472 		memcpy(cpudata->gprs, state->gprs, sizeof(state->gprs));
   2473 
   2474 		vmx_vmwrite(VMCS_GUEST_RIP, state->gprs[NVMM_X64_GPR_RIP]);
   2475 		vmx_vmwrite(VMCS_GUEST_RSP, state->gprs[NVMM_X64_GPR_RSP]);
   2476 		vmx_vmwrite(VMCS_GUEST_RFLAGS, state->gprs[NVMM_X64_GPR_RFLAGS]);
   2477 	}
   2478 
   2479 	if (flags & NVMM_X64_STATE_CRS) {
   2480 		/*
   2481 		 * CR0_NE and CR4_VMXE are mandatory.
   2482 		 */
   2483 		vmx_vmwrite(VMCS_GUEST_CR0,
   2484 		    state->crs[NVMM_X64_CR_CR0] | CR0_NE);
   2485 		cpudata->gcr2 = state->crs[NVMM_X64_CR_CR2];
   2486 		vmx_vmwrite(VMCS_GUEST_CR3, state->crs[NVMM_X64_CR_CR3]); // XXX PDPTE?
   2487 		vmx_vmwrite(VMCS_GUEST_CR4,
   2488 		    state->crs[NVMM_X64_CR_CR4] | CR4_VMXE);
   2489 		cpudata->gcr8 = state->crs[NVMM_X64_CR_CR8];
   2490 
   2491 		if (vmx_xcr0_mask != 0) {
   2492 			/* Clear illegal XCR0 bits, set mandatory X87 bit. */
   2493 			cpudata->gxcr0 = state->crs[NVMM_X64_CR_XCR0];
   2494 			cpudata->gxcr0 &= vmx_xcr0_mask;
   2495 			cpudata->gxcr0 |= XCR0_X87;
   2496 		}
   2497 	}
   2498 
   2499 	CTASSERT(sizeof(cpudata->drs) == sizeof(state->drs));
   2500 	if (flags & NVMM_X64_STATE_DRS) {
   2501 		memcpy(cpudata->drs, state->drs, sizeof(state->drs));
   2502 
   2503 		cpudata->drs[NVMM_X64_DR_DR6] &= 0xFFFFFFFF;
   2504 		vmx_vmwrite(VMCS_GUEST_DR7, cpudata->drs[NVMM_X64_DR_DR7]);
   2505 	}
   2506 
   2507 	if (flags & NVMM_X64_STATE_MSRS) {
   2508 		cpudata->gmsr[VMX_MSRLIST_STAR].val =
   2509 		    state->msrs[NVMM_X64_MSR_STAR];
   2510 		cpudata->gmsr[VMX_MSRLIST_LSTAR].val =
   2511 		    state->msrs[NVMM_X64_MSR_LSTAR];
   2512 		cpudata->gmsr[VMX_MSRLIST_CSTAR].val =
   2513 		    state->msrs[NVMM_X64_MSR_CSTAR];
   2514 		cpudata->gmsr[VMX_MSRLIST_SFMASK].val =
   2515 		    state->msrs[NVMM_X64_MSR_SFMASK];
   2516 		cpudata->gmsr[VMX_MSRLIST_KERNELGSBASE].val =
   2517 		    state->msrs[NVMM_X64_MSR_KERNELGSBASE];
   2518 
   2519 		vmx_vmwrite(VMCS_GUEST_IA32_EFER,
   2520 		    state->msrs[NVMM_X64_MSR_EFER]);
   2521 		vmx_vmwrite(VMCS_GUEST_IA32_PAT,
   2522 		    state->msrs[NVMM_X64_MSR_PAT]);
   2523 		vmx_vmwrite(VMCS_GUEST_IA32_SYSENTER_CS,
   2524 		    state->msrs[NVMM_X64_MSR_SYSENTER_CS]);
   2525 		vmx_vmwrite(VMCS_GUEST_IA32_SYSENTER_ESP,
   2526 		    state->msrs[NVMM_X64_MSR_SYSENTER_ESP]);
   2527 		vmx_vmwrite(VMCS_GUEST_IA32_SYSENTER_EIP,
   2528 		    state->msrs[NVMM_X64_MSR_SYSENTER_EIP]);
   2529 
   2530 		cpudata->gtsc = state->msrs[NVMM_X64_MSR_TSC];
   2531 		cpudata->gtsc_want_update = true;
   2532 
   2533 		/* ENTRY_CTLS_LONG_MODE must match EFER_LMA. */
   2534 		ctls1 = vmx_vmread(VMCS_ENTRY_CTLS);
   2535 		if (state->msrs[NVMM_X64_MSR_EFER] & EFER_LMA) {
   2536 			ctls1 |= ENTRY_CTLS_LONG_MODE;
   2537 		} else {
   2538 			ctls1 &= ~ENTRY_CTLS_LONG_MODE;
   2539 		}
   2540 		vmx_vmwrite(VMCS_ENTRY_CTLS, ctls1);
   2541 	}
   2542 
   2543 	if (flags & NVMM_X64_STATE_INTR) {
   2544 		intstate = vmx_vmread(VMCS_GUEST_INTERRUPTIBILITY);
   2545 		intstate &= ~(INT_STATE_STI|INT_STATE_MOVSS);
   2546 		if (state->intr.int_shadow) {
   2547 			intstate |= INT_STATE_MOVSS;
   2548 		}
   2549 		vmx_vmwrite(VMCS_GUEST_INTERRUPTIBILITY, intstate);
   2550 
   2551 		if (state->intr.int_window_exiting) {
   2552 			vmx_event_waitexit_enable(vcpu, false);
   2553 		} else {
   2554 			vmx_event_waitexit_disable(vcpu, false);
   2555 		}
   2556 
   2557 		if (state->intr.nmi_window_exiting) {
   2558 			vmx_event_waitexit_enable(vcpu, true);
   2559 		} else {
   2560 			vmx_event_waitexit_disable(vcpu, true);
   2561 		}
   2562 	}
   2563 
   2564 	CTASSERT(sizeof(cpudata->gfpu.xsh_fxsave) == sizeof(state->fpu));
   2565 	if (flags & NVMM_X64_STATE_FPU) {
   2566 		memcpy(cpudata->gfpu.xsh_fxsave, &state->fpu,
   2567 		    sizeof(state->fpu));
   2568 
   2569 		fpustate = (struct fxsave *)cpudata->gfpu.xsh_fxsave;
   2570 		fpustate->fx_mxcsr_mask &= x86_fpu_mxcsr_mask;
   2571 		fpustate->fx_mxcsr &= fpustate->fx_mxcsr_mask;
   2572 
   2573 		if (vmx_xcr0_mask != 0) {
   2574 			/* Reset XSTATE_BV, to force a reload. */
   2575 			cpudata->gfpu.xsh_xstate_bv = vmx_xcr0_mask;
   2576 		}
   2577 	}
   2578 
   2579 	vmx_vmcs_leave(vcpu);
   2580 
   2581 	comm->state_wanted = 0;
   2582 	comm->state_cached |= flags;
   2583 }
   2584 
   2585 static void
   2586 vmx_vcpu_getstate(struct nvmm_cpu *vcpu)
   2587 {
   2588 	struct nvmm_comm_page *comm = vcpu->comm;
   2589 	struct nvmm_x64_state *state = &comm->state;
   2590 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   2591 	uint64_t intstate, flags;
   2592 
   2593 	flags = comm->state_wanted;
   2594 
   2595 	vmx_vmcs_enter(vcpu);
   2596 
   2597 	if (flags & NVMM_X64_STATE_SEGS) {
   2598 		vmx_vcpu_getstate_seg(state->segs, NVMM_X64_SEG_CS);
   2599 		vmx_vcpu_getstate_seg(state->segs, NVMM_X64_SEG_DS);
   2600 		vmx_vcpu_getstate_seg(state->segs, NVMM_X64_SEG_ES);
   2601 		vmx_vcpu_getstate_seg(state->segs, NVMM_X64_SEG_FS);
   2602 		vmx_vcpu_getstate_seg(state->segs, NVMM_X64_SEG_GS);
   2603 		vmx_vcpu_getstate_seg(state->segs, NVMM_X64_SEG_SS);
   2604 		vmx_vcpu_getstate_seg(state->segs, NVMM_X64_SEG_GDT);
   2605 		vmx_vcpu_getstate_seg(state->segs, NVMM_X64_SEG_IDT);
   2606 		vmx_vcpu_getstate_seg(state->segs, NVMM_X64_SEG_LDT);
   2607 		vmx_vcpu_getstate_seg(state->segs, NVMM_X64_SEG_TR);
   2608 	}
   2609 
   2610 	CTASSERT(sizeof(cpudata->gprs) == sizeof(state->gprs));
   2611 	if (flags & NVMM_X64_STATE_GPRS) {
   2612 		memcpy(state->gprs, cpudata->gprs, sizeof(state->gprs));
   2613 
   2614 		state->gprs[NVMM_X64_GPR_RIP] = vmx_vmread(VMCS_GUEST_RIP);
   2615 		state->gprs[NVMM_X64_GPR_RSP] = vmx_vmread(VMCS_GUEST_RSP);
   2616 		state->gprs[NVMM_X64_GPR_RFLAGS] = vmx_vmread(VMCS_GUEST_RFLAGS);
   2617 	}
   2618 
   2619 	if (flags & NVMM_X64_STATE_CRS) {
   2620 		state->crs[NVMM_X64_CR_CR0] = vmx_vmread(VMCS_GUEST_CR0);
   2621 		state->crs[NVMM_X64_CR_CR2] = cpudata->gcr2;
   2622 		state->crs[NVMM_X64_CR_CR3] = vmx_vmread(VMCS_GUEST_CR3);
   2623 		state->crs[NVMM_X64_CR_CR4] = vmx_vmread(VMCS_GUEST_CR4);
   2624 		state->crs[NVMM_X64_CR_CR8] = cpudata->gcr8;
   2625 		state->crs[NVMM_X64_CR_XCR0] = cpudata->gxcr0;
   2626 
   2627 		/* Hide VMXE. */
   2628 		state->crs[NVMM_X64_CR_CR4] &= ~CR4_VMXE;
   2629 	}
   2630 
   2631 	CTASSERT(sizeof(cpudata->drs) == sizeof(state->drs));
   2632 	if (flags & NVMM_X64_STATE_DRS) {
   2633 		memcpy(state->drs, cpudata->drs, sizeof(state->drs));
   2634 
   2635 		state->drs[NVMM_X64_DR_DR7] = vmx_vmread(VMCS_GUEST_DR7);
   2636 	}
   2637 
   2638 	if (flags & NVMM_X64_STATE_MSRS) {
   2639 		state->msrs[NVMM_X64_MSR_STAR] =
   2640 		    cpudata->gmsr[VMX_MSRLIST_STAR].val;
   2641 		state->msrs[NVMM_X64_MSR_LSTAR] =
   2642 		    cpudata->gmsr[VMX_MSRLIST_LSTAR].val;
   2643 		state->msrs[NVMM_X64_MSR_CSTAR] =
   2644 		    cpudata->gmsr[VMX_MSRLIST_CSTAR].val;
   2645 		state->msrs[NVMM_X64_MSR_SFMASK] =
   2646 		    cpudata->gmsr[VMX_MSRLIST_SFMASK].val;
   2647 		state->msrs[NVMM_X64_MSR_KERNELGSBASE] =
   2648 		    cpudata->gmsr[VMX_MSRLIST_KERNELGSBASE].val;
   2649 		state->msrs[NVMM_X64_MSR_EFER] =
   2650 		    vmx_vmread(VMCS_GUEST_IA32_EFER);
   2651 		state->msrs[NVMM_X64_MSR_PAT] =
   2652 		    vmx_vmread(VMCS_GUEST_IA32_PAT);
   2653 		state->msrs[NVMM_X64_MSR_SYSENTER_CS] =
   2654 		    vmx_vmread(VMCS_GUEST_IA32_SYSENTER_CS);
   2655 		state->msrs[NVMM_X64_MSR_SYSENTER_ESP] =
   2656 		    vmx_vmread(VMCS_GUEST_IA32_SYSENTER_ESP);
   2657 		state->msrs[NVMM_X64_MSR_SYSENTER_EIP] =
   2658 		    vmx_vmread(VMCS_GUEST_IA32_SYSENTER_EIP);
   2659 		state->msrs[NVMM_X64_MSR_TSC] = cpudata->gtsc;
   2660 	}
   2661 
   2662 	if (flags & NVMM_X64_STATE_INTR) {
   2663 		intstate = vmx_vmread(VMCS_GUEST_INTERRUPTIBILITY);
   2664 		state->intr.int_shadow =
   2665 		    (intstate & (INT_STATE_STI|INT_STATE_MOVSS)) != 0;
   2666 		state->intr.int_window_exiting = cpudata->int_window_exit;
   2667 		state->intr.nmi_window_exiting = cpudata->nmi_window_exit;
   2668 		state->intr.evt_pending = cpudata->evt_pending;
   2669 	}
   2670 
   2671 	CTASSERT(sizeof(cpudata->gfpu.xsh_fxsave) == sizeof(state->fpu));
   2672 	if (flags & NVMM_X64_STATE_FPU) {
   2673 		memcpy(&state->fpu, cpudata->gfpu.xsh_fxsave,
   2674 		    sizeof(state->fpu));
   2675 	}
   2676 
   2677 	vmx_vmcs_leave(vcpu);
   2678 
   2679 	comm->state_wanted = 0;
   2680 	comm->state_cached |= flags;
   2681 }
   2682 
   2683 static void
   2684 vmx_vcpu_state_provide(struct nvmm_cpu *vcpu, uint64_t flags)
   2685 {
   2686 	vcpu->comm->state_wanted = flags;
   2687 	vmx_vcpu_getstate(vcpu);
   2688 }
   2689 
   2690 static void
   2691 vmx_vcpu_state_commit(struct nvmm_cpu *vcpu)
   2692 {
   2693 	vcpu->comm->state_wanted = vcpu->comm->state_commit;
   2694 	vcpu->comm->state_commit = 0;
   2695 	vmx_vcpu_setstate(vcpu);
   2696 }
   2697 
   2698 /* -------------------------------------------------------------------------- */
   2699 
   2700 static void
   2701 vmx_asid_alloc(struct nvmm_cpu *vcpu)
   2702 {
   2703 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   2704 	size_t i, oct, bit;
   2705 
   2706 	mutex_enter(&vmx_asidlock);
   2707 
   2708 	for (i = 0; i < vmx_maxasid; i++) {
   2709 		oct = i / 8;
   2710 		bit = i % 8;
   2711 
   2712 		if (vmx_asidmap[oct] & __BIT(bit)) {
   2713 			continue;
   2714 		}
   2715 
   2716 		cpudata->asid = i;
   2717 
   2718 		vmx_asidmap[oct] |= __BIT(bit);
   2719 		vmx_vmwrite(VMCS_VPID, i);
   2720 		mutex_exit(&vmx_asidlock);
   2721 		return;
   2722 	}
   2723 
   2724 	mutex_exit(&vmx_asidlock);
   2725 
   2726 	panic("%s: impossible", __func__);
   2727 }
   2728 
   2729 static void
   2730 vmx_asid_free(struct nvmm_cpu *vcpu)
   2731 {
   2732 	size_t oct, bit;
   2733 	uint64_t asid;
   2734 
   2735 	asid = vmx_vmread(VMCS_VPID);
   2736 
   2737 	oct = asid / 8;
   2738 	bit = asid % 8;
   2739 
   2740 	mutex_enter(&vmx_asidlock);
   2741 	vmx_asidmap[oct] &= ~__BIT(bit);
   2742 	mutex_exit(&vmx_asidlock);
   2743 }
   2744 
   2745 static void
   2746 vmx_vcpu_init(struct nvmm_machine *mach, struct nvmm_cpu *vcpu)
   2747 {
   2748 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   2749 	struct vmcs *vmcs = cpudata->vmcs;
   2750 	struct msr_entry *gmsr = cpudata->gmsr;
   2751 	extern uint8_t vmx_resume_rip;
   2752 	uint64_t rev, eptp;
   2753 
   2754 	rev = vmx_get_revision();
   2755 
   2756 	memset(vmcs, 0, VMCS_SIZE);
   2757 	vmcs->ident = __SHIFTIN(rev, VMCS_IDENT_REVISION);
   2758 	vmcs->abort = 0;
   2759 
   2760 	vmx_vmcs_enter(vcpu);
   2761 
   2762 	/* No link pointer. */
   2763 	vmx_vmwrite(VMCS_LINK_POINTER, 0xFFFFFFFFFFFFFFFF);
   2764 
   2765 	/* Install the CTLSs. */
   2766 	vmx_vmwrite(VMCS_PINBASED_CTLS, vmx_pinbased_ctls);
   2767 	vmx_vmwrite(VMCS_PROCBASED_CTLS, vmx_procbased_ctls);
   2768 	vmx_vmwrite(VMCS_PROCBASED_CTLS2, vmx_procbased_ctls2);
   2769 	vmx_vmwrite(VMCS_ENTRY_CTLS, vmx_entry_ctls);
   2770 	vmx_vmwrite(VMCS_EXIT_CTLS, vmx_exit_ctls);
   2771 
   2772 	/* Allow direct access to certain MSRs. */
   2773 	memset(cpudata->msrbm, 0xFF, MSRBM_SIZE);
   2774 	vmx_vcpu_msr_allow(cpudata->msrbm, MSR_EFER, true, true);
   2775 	vmx_vcpu_msr_allow(cpudata->msrbm, MSR_STAR, true, true);
   2776 	vmx_vcpu_msr_allow(cpudata->msrbm, MSR_LSTAR, true, true);
   2777 	vmx_vcpu_msr_allow(cpudata->msrbm, MSR_CSTAR, true, true);
   2778 	vmx_vcpu_msr_allow(cpudata->msrbm, MSR_SFMASK, true, true);
   2779 	vmx_vcpu_msr_allow(cpudata->msrbm, MSR_KERNELGSBASE, true, true);
   2780 	vmx_vcpu_msr_allow(cpudata->msrbm, MSR_SYSENTER_CS, true, true);
   2781 	vmx_vcpu_msr_allow(cpudata->msrbm, MSR_SYSENTER_ESP, true, true);
   2782 	vmx_vcpu_msr_allow(cpudata->msrbm, MSR_SYSENTER_EIP, true, true);
   2783 	vmx_vcpu_msr_allow(cpudata->msrbm, MSR_FSBASE, true, true);
   2784 	vmx_vcpu_msr_allow(cpudata->msrbm, MSR_GSBASE, true, true);
   2785 	vmx_vcpu_msr_allow(cpudata->msrbm, MSR_TSC, true, false);
   2786 	vmx_vmwrite(VMCS_MSR_BITMAP, (uint64_t)cpudata->msrbm_pa);
   2787 
   2788 	/*
   2789 	 * List of Guest MSRs loaded on VMENTRY, saved on VMEXIT. This
   2790 	 * includes the L1D_FLUSH MSR, to mitigate L1TF.
   2791 	 */
   2792 	gmsr[VMX_MSRLIST_STAR].msr = MSR_STAR;
   2793 	gmsr[VMX_MSRLIST_STAR].val = 0;
   2794 	gmsr[VMX_MSRLIST_LSTAR].msr = MSR_LSTAR;
   2795 	gmsr[VMX_MSRLIST_LSTAR].val = 0;
   2796 	gmsr[VMX_MSRLIST_CSTAR].msr = MSR_CSTAR;
   2797 	gmsr[VMX_MSRLIST_CSTAR].val = 0;
   2798 	gmsr[VMX_MSRLIST_SFMASK].msr = MSR_SFMASK;
   2799 	gmsr[VMX_MSRLIST_SFMASK].val = 0;
   2800 	gmsr[VMX_MSRLIST_KERNELGSBASE].msr = MSR_KERNELGSBASE;
   2801 	gmsr[VMX_MSRLIST_KERNELGSBASE].val = 0;
   2802 	gmsr[VMX_MSRLIST_L1DFLUSH].msr = MSR_IA32_FLUSH_CMD;
   2803 	gmsr[VMX_MSRLIST_L1DFLUSH].val = IA32_FLUSH_CMD_L1D_FLUSH;
   2804 	vmx_vmwrite(VMCS_ENTRY_MSR_LOAD_ADDRESS, cpudata->gmsr_pa);
   2805 	vmx_vmwrite(VMCS_EXIT_MSR_STORE_ADDRESS, cpudata->gmsr_pa);
   2806 	vmx_vmwrite(VMCS_ENTRY_MSR_LOAD_COUNT, vmx_msrlist_entry_nmsr);
   2807 	vmx_vmwrite(VMCS_EXIT_MSR_STORE_COUNT, VMX_MSRLIST_EXIT_NMSR);
   2808 
   2809 	/* Force CR0_NW and CR0_CD to zero, CR0_ET to one. */
   2810 	vmx_vmwrite(VMCS_CR0_MASK, CR0_NW|CR0_CD|CR0_ET);
   2811 	vmx_vmwrite(VMCS_CR0_SHADOW, CR0_ET);
   2812 
   2813 	/* Force CR4_VMXE to zero. */
   2814 	vmx_vmwrite(VMCS_CR4_MASK, CR4_VMXE);
   2815 
   2816 	/* Set the Host state for resuming. */
   2817 	vmx_vmwrite(VMCS_HOST_RIP, (uint64_t)&vmx_resume_rip);
   2818 	vmx_vmwrite(VMCS_HOST_CS_SELECTOR, GSEL(GCODE_SEL, SEL_KPL));
   2819 	vmx_vmwrite(VMCS_HOST_SS_SELECTOR, GSEL(GDATA_SEL, SEL_KPL));
   2820 	vmx_vmwrite(VMCS_HOST_DS_SELECTOR, GSEL(GDATA_SEL, SEL_KPL));
   2821 	vmx_vmwrite(VMCS_HOST_ES_SELECTOR, GSEL(GDATA_SEL, SEL_KPL));
   2822 	vmx_vmwrite(VMCS_HOST_FS_SELECTOR, 0);
   2823 	vmx_vmwrite(VMCS_HOST_GS_SELECTOR, 0);
   2824 	vmx_vmwrite(VMCS_HOST_IA32_SYSENTER_CS, 0);
   2825 	vmx_vmwrite(VMCS_HOST_IA32_SYSENTER_ESP, 0);
   2826 	vmx_vmwrite(VMCS_HOST_IA32_SYSENTER_EIP, 0);
   2827 	vmx_vmwrite(VMCS_HOST_IA32_PAT, rdmsr(MSR_CR_PAT));
   2828 	vmx_vmwrite(VMCS_HOST_IA32_EFER, rdmsr(MSR_EFER));
   2829 	vmx_vmwrite(VMCS_HOST_CR0, rcr0() & ~CR0_TS);
   2830 
   2831 	/* Generate ASID. */
   2832 	vmx_asid_alloc(vcpu);
   2833 
   2834 	/* Enable Extended Paging, 4-Level. */
   2835 	eptp =
   2836 	    __SHIFTIN(vmx_eptp_type, EPTP_TYPE) |
   2837 	    __SHIFTIN(4-1, EPTP_WALKLEN) |
   2838 	    (pmap_ept_has_ad ? EPTP_FLAGS_AD : 0) |
   2839 	    mach->vm->vm_map.pmap->pm_pdirpa[0];
   2840 	vmx_vmwrite(VMCS_EPTP, eptp);
   2841 
   2842 	/* Init IA32_MISC_ENABLE. */
   2843 	cpudata->gmsr_misc_enable = rdmsr(MSR_MISC_ENABLE);
   2844 	cpudata->gmsr_misc_enable &=
   2845 	    ~(IA32_MISC_PERFMON_EN|IA32_MISC_EISST_EN|IA32_MISC_MWAIT_EN);
   2846 	cpudata->gmsr_misc_enable |=
   2847 	    (IA32_MISC_BTS_UNAVAIL|IA32_MISC_PEBS_UNAVAIL);
   2848 
   2849 	/* Init XSAVE header. */
   2850 	cpudata->gfpu.xsh_xstate_bv = vmx_xcr0_mask;
   2851 	cpudata->gfpu.xsh_xcomp_bv = 0;
   2852 
   2853 	/* These MSRs are static. */
   2854 	cpudata->star = rdmsr(MSR_STAR);
   2855 	cpudata->lstar = rdmsr(MSR_LSTAR);
   2856 	cpudata->cstar = rdmsr(MSR_CSTAR);
   2857 	cpudata->sfmask = rdmsr(MSR_SFMASK);
   2858 
   2859 	/* Install the RESET state. */
   2860 	memcpy(&vcpu->comm->state, &nvmm_x86_reset_state,
   2861 	    sizeof(nvmm_x86_reset_state));
   2862 	vcpu->comm->state_wanted = NVMM_X64_STATE_ALL;
   2863 	vcpu->comm->state_cached = 0;
   2864 	vmx_vcpu_setstate(vcpu);
   2865 
   2866 	vmx_vmcs_leave(vcpu);
   2867 }
   2868 
   2869 static int
   2870 vmx_vcpu_create(struct nvmm_machine *mach, struct nvmm_cpu *vcpu)
   2871 {
   2872 	struct vmx_cpudata *cpudata;
   2873 	int error;
   2874 
   2875 	/* Allocate the VMX cpudata. */
   2876 	cpudata = (struct vmx_cpudata *)uvm_km_alloc(kernel_map,
   2877 	    roundup(sizeof(*cpudata), PAGE_SIZE), 0,
   2878 	    UVM_KMF_WIRED|UVM_KMF_ZERO);
   2879 	vcpu->cpudata = cpudata;
   2880 
   2881 	/* VMCS */
   2882 	error = vmx_memalloc(&cpudata->vmcs_pa, (vaddr_t *)&cpudata->vmcs,
   2883 	    VMCS_NPAGES);
   2884 	if (error)
   2885 		goto error;
   2886 
   2887 	/* MSR Bitmap */
   2888 	error = vmx_memalloc(&cpudata->msrbm_pa, (vaddr_t *)&cpudata->msrbm,
   2889 	    MSRBM_NPAGES);
   2890 	if (error)
   2891 		goto error;
   2892 
   2893 	/* Guest MSR List */
   2894 	error = vmx_memalloc(&cpudata->gmsr_pa, (vaddr_t *)&cpudata->gmsr, 1);
   2895 	if (error)
   2896 		goto error;
   2897 
   2898 	kcpuset_create(&cpudata->htlb_want_flush, true);
   2899 
   2900 	/* Init the VCPU info. */
   2901 	vmx_vcpu_init(mach, vcpu);
   2902 
   2903 	return 0;
   2904 
   2905 error:
   2906 	if (cpudata->vmcs_pa) {
   2907 		vmx_memfree(cpudata->vmcs_pa, (vaddr_t)cpudata->vmcs,
   2908 		    VMCS_NPAGES);
   2909 	}
   2910 	if (cpudata->msrbm_pa) {
   2911 		vmx_memfree(cpudata->msrbm_pa, (vaddr_t)cpudata->msrbm,
   2912 		    MSRBM_NPAGES);
   2913 	}
   2914 	if (cpudata->gmsr_pa) {
   2915 		vmx_memfree(cpudata->gmsr_pa, (vaddr_t)cpudata->gmsr, 1);
   2916 	}
   2917 
   2918 	kmem_free(cpudata, sizeof(*cpudata));
   2919 	return error;
   2920 }
   2921 
   2922 static void
   2923 vmx_vcpu_destroy(struct nvmm_machine *mach, struct nvmm_cpu *vcpu)
   2924 {
   2925 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   2926 
   2927 	vmx_vmcs_enter(vcpu);
   2928 	vmx_asid_free(vcpu);
   2929 	vmx_vmcs_destroy(vcpu);
   2930 
   2931 	kcpuset_destroy(cpudata->htlb_want_flush);
   2932 
   2933 	vmx_memfree(cpudata->vmcs_pa, (vaddr_t)cpudata->vmcs, VMCS_NPAGES);
   2934 	vmx_memfree(cpudata->msrbm_pa, (vaddr_t)cpudata->msrbm, MSRBM_NPAGES);
   2935 	vmx_memfree(cpudata->gmsr_pa, (vaddr_t)cpudata->gmsr, 1);
   2936 	uvm_km_free(kernel_map, (vaddr_t)cpudata,
   2937 	    roundup(sizeof(*cpudata), PAGE_SIZE), UVM_KMF_WIRED);
   2938 }
   2939 
   2940 /* -------------------------------------------------------------------------- */
   2941 
   2942 static int
   2943 vmx_vcpu_configure_cpuid(struct vmx_cpudata *cpudata, void *data)
   2944 {
   2945 	struct nvmm_vcpu_conf_cpuid *cpuid = data;
   2946 	size_t i;
   2947 
   2948 	if (__predict_false(cpuid->mask && cpuid->exit)) {
   2949 		return EINVAL;
   2950 	}
   2951 	if (__predict_false(cpuid->mask &&
   2952 	    ((cpuid->u.mask.set.eax & cpuid->u.mask.del.eax) ||
   2953 	     (cpuid->u.mask.set.ebx & cpuid->u.mask.del.ebx) ||
   2954 	     (cpuid->u.mask.set.ecx & cpuid->u.mask.del.ecx) ||
   2955 	     (cpuid->u.mask.set.edx & cpuid->u.mask.del.edx)))) {
   2956 		return EINVAL;
   2957 	}
   2958 
   2959 	/* If unset, delete, to restore the default behavior. */
   2960 	if (!cpuid->mask && !cpuid->exit) {
   2961 		for (i = 0; i < VMX_NCPUIDS; i++) {
   2962 			if (!cpudata->cpuidpresent[i]) {
   2963 				continue;
   2964 			}
   2965 			if (cpudata->cpuid[i].leaf == cpuid->leaf) {
   2966 				cpudata->cpuidpresent[i] = false;
   2967 			}
   2968 		}
   2969 		return 0;
   2970 	}
   2971 
   2972 	/* If already here, replace. */
   2973 	for (i = 0; i < VMX_NCPUIDS; i++) {
   2974 		if (!cpudata->cpuidpresent[i]) {
   2975 			continue;
   2976 		}
   2977 		if (cpudata->cpuid[i].leaf == cpuid->leaf) {
   2978 			memcpy(&cpudata->cpuid[i], cpuid,
   2979 			    sizeof(struct nvmm_vcpu_conf_cpuid));
   2980 			return 0;
   2981 		}
   2982 	}
   2983 
   2984 	/* Not here, insert. */
   2985 	for (i = 0; i < VMX_NCPUIDS; i++) {
   2986 		if (!cpudata->cpuidpresent[i]) {
   2987 			cpudata->cpuidpresent[i] = true;
   2988 			memcpy(&cpudata->cpuid[i], cpuid,
   2989 			    sizeof(struct nvmm_vcpu_conf_cpuid));
   2990 			return 0;
   2991 		}
   2992 	}
   2993 
   2994 	return ENOBUFS;
   2995 }
   2996 
   2997 static int
   2998 vmx_vcpu_configure_tpr(struct vmx_cpudata *cpudata, void *data)
   2999 {
   3000 	struct nvmm_vcpu_conf_tpr *tpr = data;
   3001 
   3002 	memcpy(&cpudata->tpr, tpr, sizeof(*tpr));
   3003 	return 0;
   3004 }
   3005 
   3006 static int
   3007 vmx_vcpu_configure(struct nvmm_cpu *vcpu, uint64_t op, void *data)
   3008 {
   3009 	struct vmx_cpudata *cpudata = vcpu->cpudata;
   3010 
   3011 	switch (op) {
   3012 	case NVMM_VCPU_CONF_MD(NVMM_VCPU_CONF_CPUID):
   3013 		return vmx_vcpu_configure_cpuid(cpudata, data);
   3014 	case NVMM_VCPU_CONF_MD(NVMM_VCPU_CONF_TPR):
   3015 		return vmx_vcpu_configure_tpr(cpudata, data);
   3016 	default:
   3017 		return EINVAL;
   3018 	}
   3019 }
   3020 
   3021 /* -------------------------------------------------------------------------- */
   3022 
   3023 static void
   3024 vmx_tlb_flush(struct pmap *pm)
   3025 {
   3026 	struct nvmm_machine *mach = pm->pm_data;
   3027 	struct vmx_machdata *machdata = mach->machdata;
   3028 
   3029 	atomic_inc_64(&machdata->mach_htlb_gen);
   3030 
   3031 	/* Generates IPIs, which cause #VMEXITs. */
   3032 	pmap_tlb_shootdown(pmap_kernel(), -1, PTE_G, TLBSHOOT_NVMM);
   3033 }
   3034 
   3035 static void
   3036 vmx_machine_create(struct nvmm_machine *mach)
   3037 {
   3038 	struct pmap *pmap = mach->vm->vm_map.pmap;
   3039 	struct vmx_machdata *machdata;
   3040 
   3041 	/* Convert to EPT. */
   3042 	pmap_ept_transform(pmap);
   3043 
   3044 	/* Fill in pmap info. */
   3045 	pmap->pm_data = (void *)mach;
   3046 	pmap->pm_tlb_flush = vmx_tlb_flush;
   3047 
   3048 	machdata = kmem_zalloc(sizeof(struct vmx_machdata), KM_SLEEP);
   3049 	mach->machdata = machdata;
   3050 
   3051 	/* Start with an hTLB flush everywhere. */
   3052 	machdata->mach_htlb_gen = 1;
   3053 }
   3054 
   3055 static void
   3056 vmx_machine_destroy(struct nvmm_machine *mach)
   3057 {
   3058 	struct vmx_machdata *machdata = mach->machdata;
   3059 
   3060 	kmem_free(machdata, sizeof(struct vmx_machdata));
   3061 }
   3062 
   3063 static int
   3064 vmx_machine_configure(struct nvmm_machine *mach, uint64_t op, void *data)
   3065 {
   3066 	panic("%s: impossible", __func__);
   3067 }
   3068 
   3069 /* -------------------------------------------------------------------------- */
   3070 
   3071 #define CTLS_ONE_ALLOWED(msrval, bitoff) \
   3072 	((msrval & __BIT(32 + bitoff)) != 0)
   3073 #define CTLS_ZERO_ALLOWED(msrval, bitoff) \
   3074 	((msrval & __BIT(bitoff)) == 0)
   3075 
   3076 static int
   3077 vmx_check_ctls(uint64_t msr_ctls, uint64_t msr_true_ctls, uint64_t set_one)
   3078 {
   3079 	uint64_t basic, val, true_val;
   3080 	bool has_true;
   3081 	size_t i;
   3082 
   3083 	basic = rdmsr(MSR_IA32_VMX_BASIC);
   3084 	has_true = (basic & IA32_VMX_BASIC_TRUE_CTLS) != 0;
   3085 
   3086 	val = rdmsr(msr_ctls);
   3087 	if (has_true) {
   3088 		true_val = rdmsr(msr_true_ctls);
   3089 	} else {
   3090 		true_val = val;
   3091 	}
   3092 
   3093 	for (i = 0; i < 32; i++) {
   3094 		if (!(set_one & __BIT(i))) {
   3095 			continue;
   3096 		}
   3097 		if (!CTLS_ONE_ALLOWED(true_val, i)) {
   3098 			return -1;
   3099 		}
   3100 	}
   3101 
   3102 	return 0;
   3103 }
   3104 
   3105 static int
   3106 vmx_init_ctls(uint64_t msr_ctls, uint64_t msr_true_ctls,
   3107     uint64_t set_one, uint64_t set_zero, uint64_t *res)
   3108 {
   3109 	uint64_t basic, val, true_val;
   3110 	bool one_allowed, zero_allowed, has_true;
   3111 	size_t i;
   3112 
   3113 	basic = rdmsr(MSR_IA32_VMX_BASIC);
   3114 	has_true = (basic & IA32_VMX_BASIC_TRUE_CTLS) != 0;
   3115 
   3116 	val = rdmsr(msr_ctls);
   3117 	if (has_true) {
   3118 		true_val = rdmsr(msr_true_ctls);
   3119 	} else {
   3120 		true_val = val;
   3121 	}
   3122 
   3123 	for (i = 0; i < 32; i++) {
   3124 		one_allowed = CTLS_ONE_ALLOWED(true_val, i);
   3125 		zero_allowed = CTLS_ZERO_ALLOWED(true_val, i);
   3126 
   3127 		if (zero_allowed && !one_allowed) {
   3128 			if (set_one & __BIT(i))
   3129 				return -1;
   3130 			*res &= ~__BIT(i);
   3131 		} else if (one_allowed && !zero_allowed) {
   3132 			if (set_zero & __BIT(i))
   3133 				return -1;
   3134 			*res |= __BIT(i);
   3135 		} else {
   3136 			if (set_zero & __BIT(i)) {
   3137 				*res &= ~__BIT(i);
   3138 			} else if (set_one & __BIT(i)) {
   3139 				*res |= __BIT(i);
   3140 			} else if (!has_true) {
   3141 				*res &= ~__BIT(i);
   3142 			} else if (CTLS_ZERO_ALLOWED(val, i)) {
   3143 				*res &= ~__BIT(i);
   3144 			} else if (CTLS_ONE_ALLOWED(val, i)) {
   3145 				*res |= __BIT(i);
   3146 			} else {
   3147 				return -1;
   3148 			}
   3149 		}
   3150 	}
   3151 
   3152 	return 0;
   3153 }
   3154 
   3155 static bool
   3156 vmx_ident(void)
   3157 {
   3158 	uint64_t msr;
   3159 	int ret;
   3160 
   3161 	if (!(cpu_feature[1] & CPUID2_VMX)) {
   3162 		return false;
   3163 	}
   3164 
   3165 	msr = rdmsr(MSR_IA32_FEATURE_CONTROL);
   3166 	if ((msr & IA32_FEATURE_CONTROL_LOCK) == 0) {
   3167 		printf("NVMM: VMX disabled in BIOS\n");
   3168 		return false;
   3169 	}
   3170 	if ((msr & IA32_FEATURE_CONTROL_OUT_SMX) == 0) {
   3171 		printf("NVMM: VMX disabled in BIOS\n");
   3172 		return false;
   3173 	}
   3174 
   3175 	msr = rdmsr(MSR_IA32_VMX_BASIC);
   3176 	if ((msr & IA32_VMX_BASIC_IO_REPORT) == 0) {
   3177 		printf("NVMM: I/O reporting not supported\n");
   3178 		return false;
   3179 	}
   3180 	if (__SHIFTOUT(msr, IA32_VMX_BASIC_MEM_TYPE) != MEM_TYPE_WB) {
   3181 		printf("NVMM: WB memory not supported\n");
   3182 		return false;
   3183 	}
   3184 
   3185 	/* PG and PE are reported, even if Unrestricted Guests is supported. */
   3186 	vmx_cr0_fixed0 = rdmsr(MSR_IA32_VMX_CR0_FIXED0) & ~(CR0_PG|CR0_PE);
   3187 	vmx_cr0_fixed1 = rdmsr(MSR_IA32_VMX_CR0_FIXED1) | (CR0_PG|CR0_PE);
   3188 	ret = vmx_check_cr(rcr0(), vmx_cr0_fixed0, vmx_cr0_fixed1);
   3189 	if (ret == -1) {
   3190 		printf("NVMM: CR0 requirements not satisfied\n");
   3191 		return false;
   3192 	}
   3193 
   3194 	vmx_cr4_fixed0 = rdmsr(MSR_IA32_VMX_CR4_FIXED0);
   3195 	vmx_cr4_fixed1 = rdmsr(MSR_IA32_VMX_CR4_FIXED1);
   3196 	ret = vmx_check_cr(rcr4() | CR4_VMXE, vmx_cr4_fixed0, vmx_cr4_fixed1);
   3197 	if (ret == -1) {
   3198 		printf("NVMM: CR4 requirements not satisfied\n");
   3199 		return false;
   3200 	}
   3201 
   3202 	/* Init the CTLSs right now, and check for errors. */
   3203 	ret = vmx_init_ctls(
   3204 	    MSR_IA32_VMX_PINBASED_CTLS, MSR_IA32_VMX_TRUE_PINBASED_CTLS,
   3205 	    VMX_PINBASED_CTLS_ONE, VMX_PINBASED_CTLS_ZERO,
   3206 	    &vmx_pinbased_ctls);
   3207 	if (ret == -1) {
   3208 		printf("NVMM: pin-based-ctls requirements not satisfied\n");
   3209 		return false;
   3210 	}
   3211 	ret = vmx_init_ctls(
   3212 	    MSR_IA32_VMX_PROCBASED_CTLS, MSR_IA32_VMX_TRUE_PROCBASED_CTLS,
   3213 	    VMX_PROCBASED_CTLS_ONE, VMX_PROCBASED_CTLS_ZERO,
   3214 	    &vmx_procbased_ctls);
   3215 	if (ret == -1) {
   3216 		printf("NVMM: proc-based-ctls requirements not satisfied\n");
   3217 		return false;
   3218 	}
   3219 	ret = vmx_init_ctls(
   3220 	    MSR_IA32_VMX_PROCBASED_CTLS2, MSR_IA32_VMX_PROCBASED_CTLS2,
   3221 	    VMX_PROCBASED_CTLS2_ONE, VMX_PROCBASED_CTLS2_ZERO,
   3222 	    &vmx_procbased_ctls2);
   3223 	if (ret == -1) {
   3224 		printf("NVMM: proc-based-ctls2 requirements not satisfied\n");
   3225 		return false;
   3226 	}
   3227 	ret = vmx_check_ctls(
   3228 	    MSR_IA32_VMX_PROCBASED_CTLS2, MSR_IA32_VMX_PROCBASED_CTLS2,
   3229 	    PROC_CTLS2_INVPCID_ENABLE);
   3230 	if (ret != -1) {
   3231 		vmx_procbased_ctls2 |= PROC_CTLS2_INVPCID_ENABLE;
   3232 	}
   3233 	ret = vmx_init_ctls(
   3234 	    MSR_IA32_VMX_ENTRY_CTLS, MSR_IA32_VMX_TRUE_ENTRY_CTLS,
   3235 	    VMX_ENTRY_CTLS_ONE, VMX_ENTRY_CTLS_ZERO,
   3236 	    &vmx_entry_ctls);
   3237 	if (ret == -1) {
   3238 		printf("NVMM: entry-ctls requirements not satisfied\n");
   3239 		return false;
   3240 	}
   3241 	ret = vmx_init_ctls(
   3242 	    MSR_IA32_VMX_EXIT_CTLS, MSR_IA32_VMX_TRUE_EXIT_CTLS,
   3243 	    VMX_EXIT_CTLS_ONE, VMX_EXIT_CTLS_ZERO,
   3244 	    &vmx_exit_ctls);
   3245 	if (ret == -1) {
   3246 		printf("NVMM: exit-ctls requirements not satisfied\n");
   3247 		return false;
   3248 	}
   3249 
   3250 	msr = rdmsr(MSR_IA32_VMX_EPT_VPID_CAP);
   3251 	if ((msr & IA32_VMX_EPT_VPID_WALKLENGTH_4) == 0) {
   3252 		printf("NVMM: 4-level page tree not supported\n");
   3253 		return false;
   3254 	}
   3255 	if ((msr & IA32_VMX_EPT_VPID_INVEPT) == 0) {
   3256 		printf("NVMM: INVEPT not supported\n");
   3257 		return false;
   3258 	}
   3259 	if ((msr & IA32_VMX_EPT_VPID_INVVPID) == 0) {
   3260 		printf("NVMM: INVVPID not supported\n");
   3261 		return false;
   3262 	}
   3263 	if ((msr & IA32_VMX_EPT_VPID_FLAGS_AD) != 0) {
   3264 		pmap_ept_has_ad = true;
   3265 	} else {
   3266 		pmap_ept_has_ad = false;
   3267 	}
   3268 	if (!(msr & IA32_VMX_EPT_VPID_UC) && !(msr & IA32_VMX_EPT_VPID_WB)) {
   3269 		printf("NVMM: EPT UC/WB memory types not supported\n");
   3270 		return false;
   3271 	}
   3272 
   3273 	return true;
   3274 }
   3275 
   3276 static void
   3277 vmx_init_asid(uint32_t maxasid)
   3278 {
   3279 	size_t allocsz;
   3280 
   3281 	mutex_init(&vmx_asidlock, MUTEX_DEFAULT, IPL_NONE);
   3282 
   3283 	vmx_maxasid = maxasid;
   3284 	allocsz = roundup(maxasid, 8) / 8;
   3285 	vmx_asidmap = kmem_zalloc(allocsz, KM_SLEEP);
   3286 
   3287 	/* ASID 0 is reserved for the host. */
   3288 	vmx_asidmap[0] |= __BIT(0);
   3289 }
   3290 
   3291 static void
   3292 vmx_change_cpu(void *arg1, void *arg2)
   3293 {
   3294 	struct cpu_info *ci = curcpu();
   3295 	bool enable = arg1 != NULL;
   3296 	uint64_t cr4;
   3297 
   3298 	if (!enable) {
   3299 		vmx_vmxoff();
   3300 	}
   3301 
   3302 	cr4 = rcr4();
   3303 	if (enable) {
   3304 		cr4 |= CR4_VMXE;
   3305 	} else {
   3306 		cr4 &= ~CR4_VMXE;
   3307 	}
   3308 	lcr4(cr4);
   3309 
   3310 	if (enable) {
   3311 		vmx_vmxon(&vmxoncpu[cpu_index(ci)].pa);
   3312 	}
   3313 }
   3314 
   3315 static void
   3316 vmx_init_l1tf(void)
   3317 {
   3318 	u_int descs[4];
   3319 	uint64_t msr;
   3320 
   3321 	if (cpuid_level < 7) {
   3322 		return;
   3323 	}
   3324 
   3325 	x86_cpuid(7, descs);
   3326 
   3327 	if (descs[3] & CPUID_SEF_ARCH_CAP) {
   3328 		msr = rdmsr(MSR_IA32_ARCH_CAPABILITIES);
   3329 		if (msr & IA32_ARCH_SKIP_L1DFL_VMENTRY) {
   3330 			/* No mitigation needed. */
   3331 			return;
   3332 		}
   3333 	}
   3334 
   3335 	if (descs[3] & CPUID_SEF_L1D_FLUSH) {
   3336 		/* Enable hardware mitigation. */
   3337 		vmx_msrlist_entry_nmsr += 1;
   3338 	}
   3339 }
   3340 
   3341 static void
   3342 vmx_init(void)
   3343 {
   3344 	CPU_INFO_ITERATOR cii;
   3345 	struct cpu_info *ci;
   3346 	uint64_t xc, msr;
   3347 	struct vmxon *vmxon;
   3348 	uint32_t revision;
   3349 	paddr_t pa;
   3350 	vaddr_t va;
   3351 	int error;
   3352 
   3353 	/* Init the ASID bitmap (VPID). */
   3354 	vmx_init_asid(VPID_MAX);
   3355 
   3356 	/* Init the XCR0 mask. */
   3357 	vmx_xcr0_mask = VMX_XCR0_MASK_DEFAULT & x86_xsave_features;
   3358 
   3359 	/* Init the max CPUID leaves. */
   3360 	vmx_cpuid_max_basic = uimin(cpuid_level, VMX_CPUID_MAX_BASIC);
   3361 
   3362 	/* Init the TLB flush op, the EPT flush op and the EPTP type. */
   3363 	msr = rdmsr(MSR_IA32_VMX_EPT_VPID_CAP);
   3364 	if ((msr & IA32_VMX_EPT_VPID_INVVPID_CONTEXT) != 0) {
   3365 		vmx_tlb_flush_op = VMX_INVVPID_CONTEXT;
   3366 	} else {
   3367 		vmx_tlb_flush_op = VMX_INVVPID_ALL;
   3368 	}
   3369 	if ((msr & IA32_VMX_EPT_VPID_INVEPT_CONTEXT) != 0) {
   3370 		vmx_ept_flush_op = VMX_INVEPT_CONTEXT;
   3371 	} else {
   3372 		vmx_ept_flush_op = VMX_INVEPT_ALL;
   3373 	}
   3374 	if ((msr & IA32_VMX_EPT_VPID_WB) != 0) {
   3375 		vmx_eptp_type = EPTP_TYPE_WB;
   3376 	} else {
   3377 		vmx_eptp_type = EPTP_TYPE_UC;
   3378 	}
   3379 
   3380 	/* Init the L1TF mitigation. */
   3381 	vmx_init_l1tf();
   3382 
   3383 	memset(vmxoncpu, 0, sizeof(vmxoncpu));
   3384 	revision = vmx_get_revision();
   3385 
   3386 	for (CPU_INFO_FOREACH(cii, ci)) {
   3387 		error = vmx_memalloc(&pa, &va, 1);
   3388 		if (error) {
   3389 			panic("%s: out of memory", __func__);
   3390 		}
   3391 		vmxoncpu[cpu_index(ci)].pa = pa;
   3392 		vmxoncpu[cpu_index(ci)].va = va;
   3393 
   3394 		vmxon = (struct vmxon *)vmxoncpu[cpu_index(ci)].va;
   3395 		vmxon->ident = __SHIFTIN(revision, VMXON_IDENT_REVISION);
   3396 	}
   3397 
   3398 	xc = xc_broadcast(0, vmx_change_cpu, (void *)true, NULL);
   3399 	xc_wait(xc);
   3400 }
   3401 
   3402 static void
   3403 vmx_fini_asid(void)
   3404 {
   3405 	size_t allocsz;
   3406 
   3407 	allocsz = roundup(vmx_maxasid, 8) / 8;
   3408 	kmem_free(vmx_asidmap, allocsz);
   3409 
   3410 	mutex_destroy(&vmx_asidlock);
   3411 }
   3412 
   3413 static void
   3414 vmx_fini(void)
   3415 {
   3416 	uint64_t xc;
   3417 	size_t i;
   3418 
   3419 	xc = xc_broadcast(0, vmx_change_cpu, (void *)false, NULL);
   3420 	xc_wait(xc);
   3421 
   3422 	for (i = 0; i < MAXCPUS; i++) {
   3423 		if (vmxoncpu[i].pa != 0)
   3424 			vmx_memfree(vmxoncpu[i].pa, vmxoncpu[i].va, 1);
   3425 	}
   3426 
   3427 	vmx_fini_asid();
   3428 }
   3429 
   3430 static void
   3431 vmx_capability(struct nvmm_capability *cap)
   3432 {
   3433 	cap->arch.mach_conf_support = 0;
   3434 	cap->arch.vcpu_conf_support =
   3435 	    NVMM_CAP_ARCH_VCPU_CONF_CPUID |
   3436 	    NVMM_CAP_ARCH_VCPU_CONF_TPR;
   3437 	cap->arch.xcr0_mask = vmx_xcr0_mask;
   3438 	cap->arch.mxcsr_mask = x86_fpu_mxcsr_mask;
   3439 	cap->arch.conf_cpuid_maxops = VMX_NCPUIDS;
   3440 }
   3441 
   3442 const struct nvmm_impl nvmm_x86_vmx = {
   3443 	.name = "x86-vmx",
   3444 	.ident = vmx_ident,
   3445 	.init = vmx_init,
   3446 	.fini = vmx_fini,
   3447 	.capability = vmx_capability,
   3448 	.mach_conf_max = NVMM_X86_MACH_NCONF,
   3449 	.mach_conf_sizes = NULL,
   3450 	.vcpu_conf_max = NVMM_X86_VCPU_NCONF,
   3451 	.vcpu_conf_sizes = vmx_vcpu_conf_sizes,
   3452 	.state_size = sizeof(struct nvmm_x64_state),
   3453 	.machine_create = vmx_machine_create,
   3454 	.machine_destroy = vmx_machine_destroy,
   3455 	.machine_configure = vmx_machine_configure,
   3456 	.vcpu_create = vmx_vcpu_create,
   3457 	.vcpu_destroy = vmx_vcpu_destroy,
   3458 	.vcpu_configure = vmx_vcpu_configure,
   3459 	.vcpu_setstate = vmx_vcpu_setstate,
   3460 	.vcpu_getstate = vmx_vcpu_getstate,
   3461 	.vcpu_inject = vmx_vcpu_inject,
   3462 	.vcpu_run = vmx_vcpu_run
   3463 };
   3464