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