xref: /openbmc/linux/arch/x86/kvm/svm/nested.c (revision 75020f2d)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Kernel-based Virtual Machine driver for Linux
4  *
5  * AMD SVM support
6  *
7  * Copyright (C) 2006 Qumranet, Inc.
8  * Copyright 2010 Red Hat, Inc. and/or its affiliates.
9  *
10  * Authors:
11  *   Yaniv Kamay  <yaniv@qumranet.com>
12  *   Avi Kivity   <avi@qumranet.com>
13  */
14 
15 #define pr_fmt(fmt) "SVM: " fmt
16 
17 #include <linux/kvm_types.h>
18 #include <linux/kvm_host.h>
19 #include <linux/kernel.h>
20 
21 #include <asm/msr-index.h>
22 #include <asm/debugreg.h>
23 
24 #include "kvm_emulate.h"
25 #include "trace.h"
26 #include "mmu.h"
27 #include "x86.h"
28 #include "cpuid.h"
29 #include "lapic.h"
30 #include "svm.h"
31 
32 #define CC KVM_NESTED_VMENTER_CONSISTENCY_CHECK
33 
34 static void nested_svm_inject_npf_exit(struct kvm_vcpu *vcpu,
35 				       struct x86_exception *fault)
36 {
37 	struct vcpu_svm *svm = to_svm(vcpu);
38 
39 	if (svm->vmcb->control.exit_code != SVM_EXIT_NPF) {
40 		/*
41 		 * TODO: track the cause of the nested page fault, and
42 		 * correctly fill in the high bits of exit_info_1.
43 		 */
44 		svm->vmcb->control.exit_code = SVM_EXIT_NPF;
45 		svm->vmcb->control.exit_code_hi = 0;
46 		svm->vmcb->control.exit_info_1 = (1ULL << 32);
47 		svm->vmcb->control.exit_info_2 = fault->address;
48 	}
49 
50 	svm->vmcb->control.exit_info_1 &= ~0xffffffffULL;
51 	svm->vmcb->control.exit_info_1 |= fault->error_code;
52 
53 	nested_svm_vmexit(svm);
54 }
55 
56 static void svm_inject_page_fault_nested(struct kvm_vcpu *vcpu, struct x86_exception *fault)
57 {
58        struct vcpu_svm *svm = to_svm(vcpu);
59        WARN_ON(!is_guest_mode(vcpu));
60 
61        if (vmcb_is_intercept(&svm->nested.ctl, INTERCEPT_EXCEPTION_OFFSET + PF_VECTOR) &&
62 	   !svm->nested.nested_run_pending) {
63                svm->vmcb->control.exit_code = SVM_EXIT_EXCP_BASE + PF_VECTOR;
64                svm->vmcb->control.exit_code_hi = 0;
65                svm->vmcb->control.exit_info_1 = fault->error_code;
66                svm->vmcb->control.exit_info_2 = fault->address;
67                nested_svm_vmexit(svm);
68        } else {
69                kvm_inject_page_fault(vcpu, fault);
70        }
71 }
72 
73 static u64 nested_svm_get_tdp_pdptr(struct kvm_vcpu *vcpu, int index)
74 {
75 	struct vcpu_svm *svm = to_svm(vcpu);
76 	u64 cr3 = svm->nested.ctl.nested_cr3;
77 	u64 pdpte;
78 	int ret;
79 
80 	ret = kvm_vcpu_read_guest_page(vcpu, gpa_to_gfn(cr3), &pdpte,
81 				       offset_in_page(cr3) + index * 8, 8);
82 	if (ret)
83 		return 0;
84 	return pdpte;
85 }
86 
87 static unsigned long nested_svm_get_tdp_cr3(struct kvm_vcpu *vcpu)
88 {
89 	struct vcpu_svm *svm = to_svm(vcpu);
90 
91 	return svm->nested.ctl.nested_cr3;
92 }
93 
94 static void nested_svm_init_mmu_context(struct kvm_vcpu *vcpu)
95 {
96 	struct vcpu_svm *svm = to_svm(vcpu);
97 
98 	WARN_ON(mmu_is_nested(vcpu));
99 
100 	vcpu->arch.mmu = &vcpu->arch.guest_mmu;
101 	kvm_init_shadow_npt_mmu(vcpu, X86_CR0_PG, svm->vmcb01.ptr->save.cr4,
102 				svm->vmcb01.ptr->save.efer,
103 				svm->nested.ctl.nested_cr3);
104 	vcpu->arch.mmu->get_guest_pgd     = nested_svm_get_tdp_cr3;
105 	vcpu->arch.mmu->get_pdptr         = nested_svm_get_tdp_pdptr;
106 	vcpu->arch.mmu->inject_page_fault = nested_svm_inject_npf_exit;
107 	reset_shadow_zero_bits_mask(vcpu, vcpu->arch.mmu);
108 	vcpu->arch.walk_mmu              = &vcpu->arch.nested_mmu;
109 }
110 
111 static void nested_svm_uninit_mmu_context(struct kvm_vcpu *vcpu)
112 {
113 	vcpu->arch.mmu = &vcpu->arch.root_mmu;
114 	vcpu->arch.walk_mmu = &vcpu->arch.root_mmu;
115 }
116 
117 void recalc_intercepts(struct vcpu_svm *svm)
118 {
119 	struct vmcb_control_area *c, *h, *g;
120 	unsigned int i;
121 
122 	vmcb_mark_dirty(svm->vmcb, VMCB_INTERCEPTS);
123 
124 	if (!is_guest_mode(&svm->vcpu))
125 		return;
126 
127 	c = &svm->vmcb->control;
128 	h = &svm->vmcb01.ptr->control;
129 	g = &svm->nested.ctl;
130 
131 	for (i = 0; i < MAX_INTERCEPT; i++)
132 		c->intercepts[i] = h->intercepts[i];
133 
134 	if (g->int_ctl & V_INTR_MASKING_MASK) {
135 		/* We only want the cr8 intercept bits of L1 */
136 		vmcb_clr_intercept(c, INTERCEPT_CR8_READ);
137 		vmcb_clr_intercept(c, INTERCEPT_CR8_WRITE);
138 
139 		/*
140 		 * Once running L2 with HF_VINTR_MASK, EFLAGS.IF does not
141 		 * affect any interrupt we may want to inject; therefore,
142 		 * interrupt window vmexits are irrelevant to L0.
143 		 */
144 		vmcb_clr_intercept(c, INTERCEPT_VINTR);
145 	}
146 
147 	/* We don't want to see VMMCALLs from a nested guest */
148 	vmcb_clr_intercept(c, INTERCEPT_VMMCALL);
149 
150 	for (i = 0; i < MAX_INTERCEPT; i++)
151 		c->intercepts[i] |= g->intercepts[i];
152 }
153 
154 static void copy_vmcb_control_area(struct vmcb_control_area *dst,
155 				   struct vmcb_control_area *from)
156 {
157 	unsigned int i;
158 
159 	for (i = 0; i < MAX_INTERCEPT; i++)
160 		dst->intercepts[i] = from->intercepts[i];
161 
162 	dst->iopm_base_pa         = from->iopm_base_pa;
163 	dst->msrpm_base_pa        = from->msrpm_base_pa;
164 	dst->tsc_offset           = from->tsc_offset;
165 	/* asid not copied, it is handled manually for svm->vmcb.  */
166 	dst->tlb_ctl              = from->tlb_ctl;
167 	dst->int_ctl              = from->int_ctl;
168 	dst->int_vector           = from->int_vector;
169 	dst->int_state            = from->int_state;
170 	dst->exit_code            = from->exit_code;
171 	dst->exit_code_hi         = from->exit_code_hi;
172 	dst->exit_info_1          = from->exit_info_1;
173 	dst->exit_info_2          = from->exit_info_2;
174 	dst->exit_int_info        = from->exit_int_info;
175 	dst->exit_int_info_err    = from->exit_int_info_err;
176 	dst->nested_ctl           = from->nested_ctl;
177 	dst->event_inj            = from->event_inj;
178 	dst->event_inj_err        = from->event_inj_err;
179 	dst->nested_cr3           = from->nested_cr3;
180 	dst->virt_ext              = from->virt_ext;
181 	dst->pause_filter_count   = from->pause_filter_count;
182 	dst->pause_filter_thresh  = from->pause_filter_thresh;
183 }
184 
185 static bool nested_svm_vmrun_msrpm(struct vcpu_svm *svm)
186 {
187 	/*
188 	 * This function merges the msr permission bitmaps of kvm and the
189 	 * nested vmcb. It is optimized in that it only merges the parts where
190 	 * the kvm msr permission bitmap may contain zero bits
191 	 */
192 	int i;
193 
194 	if (!(vmcb_is_intercept(&svm->nested.ctl, INTERCEPT_MSR_PROT)))
195 		return true;
196 
197 	for (i = 0; i < MSRPM_OFFSETS; i++) {
198 		u32 value, p;
199 		u64 offset;
200 
201 		if (msrpm_offsets[i] == 0xffffffff)
202 			break;
203 
204 		p      = msrpm_offsets[i];
205 		offset = svm->nested.ctl.msrpm_base_pa + (p * 4);
206 
207 		if (kvm_vcpu_read_guest(&svm->vcpu, offset, &value, 4))
208 			return false;
209 
210 		svm->nested.msrpm[p] = svm->msrpm[p] | value;
211 	}
212 
213 	svm->vmcb->control.msrpm_base_pa = __sme_set(__pa(svm->nested.msrpm));
214 
215 	return true;
216 }
217 
218 /*
219  * Bits 11:0 of bitmap address are ignored by hardware
220  */
221 static bool nested_svm_check_bitmap_pa(struct kvm_vcpu *vcpu, u64 pa, u32 size)
222 {
223 	u64 addr = PAGE_ALIGN(pa);
224 
225 	return kvm_vcpu_is_legal_gpa(vcpu, addr) &&
226 	    kvm_vcpu_is_legal_gpa(vcpu, addr + size - 1);
227 }
228 
229 static bool nested_vmcb_check_controls(struct kvm_vcpu *vcpu,
230 				       struct vmcb_control_area *control)
231 {
232 	if (CC(!vmcb_is_intercept(control, INTERCEPT_VMRUN)))
233 		return false;
234 
235 	if (CC(control->asid == 0))
236 		return false;
237 
238 	if (CC((control->nested_ctl & SVM_NESTED_CTL_NP_ENABLE) && !npt_enabled))
239 		return false;
240 
241 	if (CC(!nested_svm_check_bitmap_pa(vcpu, control->msrpm_base_pa,
242 					   MSRPM_SIZE)))
243 		return false;
244 	if (CC(!nested_svm_check_bitmap_pa(vcpu, control->iopm_base_pa,
245 					   IOPM_SIZE)))
246 		return false;
247 
248 	return true;
249 }
250 
251 static bool nested_vmcb_check_cr3_cr4(struct kvm_vcpu *vcpu,
252 				      struct vmcb_save_area *save)
253 {
254 	/*
255 	 * These checks are also performed by KVM_SET_SREGS,
256 	 * except that EFER.LMA is not checked by SVM against
257 	 * CR0.PG && EFER.LME.
258 	 */
259 	if ((save->efer & EFER_LME) && (save->cr0 & X86_CR0_PG)) {
260 		if (CC(!(save->cr4 & X86_CR4_PAE)) ||
261 		    CC(!(save->cr0 & X86_CR0_PE)) ||
262 		    CC(kvm_vcpu_is_illegal_gpa(vcpu, save->cr3)))
263 			return false;
264 	}
265 
266 	if (CC(!kvm_is_valid_cr4(vcpu, save->cr4)))
267 		return false;
268 
269 	return true;
270 }
271 
272 /* Common checks that apply to both L1 and L2 state.  */
273 static bool nested_vmcb_valid_sregs(struct kvm_vcpu *vcpu,
274 				    struct vmcb_save_area *save)
275 {
276 	/*
277 	 * FIXME: these should be done after copying the fields,
278 	 * to avoid TOC/TOU races.  For these save area checks
279 	 * the possible damage is limited since kvm_set_cr0 and
280 	 * kvm_set_cr4 handle failure; EFER_SVME is an exception
281 	 * so it is force-set later in nested_prepare_vmcb_save.
282 	 */
283 	if (CC(!(save->efer & EFER_SVME)))
284 		return false;
285 
286 	if (CC((save->cr0 & X86_CR0_CD) == 0 && (save->cr0 & X86_CR0_NW)) ||
287 	    CC(save->cr0 & ~0xffffffffULL))
288 		return false;
289 
290 	if (CC(!kvm_dr6_valid(save->dr6)) || CC(!kvm_dr7_valid(save->dr7)))
291 		return false;
292 
293 	if (!nested_vmcb_check_cr3_cr4(vcpu, save))
294 		return false;
295 
296 	if (CC(!kvm_valid_efer(vcpu, save->efer)))
297 		return false;
298 
299 	return true;
300 }
301 
302 static void nested_load_control_from_vmcb12(struct vcpu_svm *svm,
303 					    struct vmcb_control_area *control)
304 {
305 	copy_vmcb_control_area(&svm->nested.ctl, control);
306 
307 	/* Copy it here because nested_svm_check_controls will check it.  */
308 	svm->nested.ctl.asid           = control->asid;
309 	svm->nested.ctl.msrpm_base_pa &= ~0x0fffULL;
310 	svm->nested.ctl.iopm_base_pa  &= ~0x0fffULL;
311 }
312 
313 /*
314  * Synchronize fields that are written by the processor, so that
315  * they can be copied back into the vmcb12.
316  */
317 void nested_sync_control_from_vmcb02(struct vcpu_svm *svm)
318 {
319 	u32 mask;
320 	svm->nested.ctl.event_inj      = svm->vmcb->control.event_inj;
321 	svm->nested.ctl.event_inj_err  = svm->vmcb->control.event_inj_err;
322 
323 	/* Only a few fields of int_ctl are written by the processor.  */
324 	mask = V_IRQ_MASK | V_TPR_MASK;
325 	if (!(svm->nested.ctl.int_ctl & V_INTR_MASKING_MASK) &&
326 	    svm_is_intercept(svm, INTERCEPT_VINTR)) {
327 		/*
328 		 * In order to request an interrupt window, L0 is usurping
329 		 * svm->vmcb->control.int_ctl and possibly setting V_IRQ
330 		 * even if it was clear in L1's VMCB.  Restoring it would be
331 		 * wrong.  However, in this case V_IRQ will remain true until
332 		 * interrupt_window_interception calls svm_clear_vintr and
333 		 * restores int_ctl.  We can just leave it aside.
334 		 */
335 		mask &= ~V_IRQ_MASK;
336 	}
337 	svm->nested.ctl.int_ctl        &= ~mask;
338 	svm->nested.ctl.int_ctl        |= svm->vmcb->control.int_ctl & mask;
339 }
340 
341 /*
342  * Transfer any event that L0 or L1 wanted to inject into L2 to
343  * EXIT_INT_INFO.
344  */
345 static void nested_save_pending_event_to_vmcb12(struct vcpu_svm *svm,
346 						struct vmcb *vmcb12)
347 {
348 	struct kvm_vcpu *vcpu = &svm->vcpu;
349 	u32 exit_int_info = 0;
350 	unsigned int nr;
351 
352 	if (vcpu->arch.exception.injected) {
353 		nr = vcpu->arch.exception.nr;
354 		exit_int_info = nr | SVM_EVTINJ_VALID | SVM_EVTINJ_TYPE_EXEPT;
355 
356 		if (vcpu->arch.exception.has_error_code) {
357 			exit_int_info |= SVM_EVTINJ_VALID_ERR;
358 			vmcb12->control.exit_int_info_err =
359 				vcpu->arch.exception.error_code;
360 		}
361 
362 	} else if (vcpu->arch.nmi_injected) {
363 		exit_int_info = SVM_EVTINJ_VALID | SVM_EVTINJ_TYPE_NMI;
364 
365 	} else if (vcpu->arch.interrupt.injected) {
366 		nr = vcpu->arch.interrupt.nr;
367 		exit_int_info = nr | SVM_EVTINJ_VALID;
368 
369 		if (vcpu->arch.interrupt.soft)
370 			exit_int_info |= SVM_EVTINJ_TYPE_SOFT;
371 		else
372 			exit_int_info |= SVM_EVTINJ_TYPE_INTR;
373 	}
374 
375 	vmcb12->control.exit_int_info = exit_int_info;
376 }
377 
378 static inline bool nested_npt_enabled(struct vcpu_svm *svm)
379 {
380 	return svm->nested.ctl.nested_ctl & SVM_NESTED_CTL_NP_ENABLE;
381 }
382 
383 /*
384  * Load guest's/host's cr3 on nested vmentry or vmexit. @nested_npt is true
385  * if we are emulating VM-Entry into a guest with NPT enabled.
386  */
387 static int nested_svm_load_cr3(struct kvm_vcpu *vcpu, unsigned long cr3,
388 			       bool nested_npt)
389 {
390 	if (CC(kvm_vcpu_is_illegal_gpa(vcpu, cr3)))
391 		return -EINVAL;
392 
393 	if (!nested_npt && is_pae_paging(vcpu) &&
394 	    (cr3 != kvm_read_cr3(vcpu) || pdptrs_changed(vcpu))) {
395 		if (CC(!load_pdptrs(vcpu, vcpu->arch.walk_mmu, cr3)))
396 			return -EINVAL;
397 	}
398 
399 	/*
400 	 * TODO: optimize unconditional TLB flush/MMU sync here and in
401 	 * kvm_init_shadow_npt_mmu().
402 	 */
403 	if (!nested_npt)
404 		kvm_mmu_new_pgd(vcpu, cr3, false, false);
405 
406 	vcpu->arch.cr3 = cr3;
407 	kvm_register_mark_available(vcpu, VCPU_EXREG_CR3);
408 
409 	kvm_init_mmu(vcpu, false);
410 
411 	return 0;
412 }
413 
414 void nested_vmcb02_compute_g_pat(struct vcpu_svm *svm)
415 {
416 	if (!svm->nested.vmcb02.ptr)
417 		return;
418 
419 	/* FIXME: merge g_pat from vmcb01 and vmcb12.  */
420 	svm->nested.vmcb02.ptr->save.g_pat = svm->vmcb01.ptr->save.g_pat;
421 }
422 
423 static void nested_vmcb02_prepare_save(struct vcpu_svm *svm, struct vmcb *vmcb12)
424 {
425 	bool new_vmcb12 = false;
426 
427 	nested_vmcb02_compute_g_pat(svm);
428 
429 	/* Load the nested guest state */
430 	if (svm->nested.vmcb12_gpa != svm->nested.last_vmcb12_gpa) {
431 		new_vmcb12 = true;
432 		svm->nested.last_vmcb12_gpa = svm->nested.vmcb12_gpa;
433 	}
434 
435 	if (unlikely(new_vmcb12 || vmcb_is_dirty(vmcb12, VMCB_SEG))) {
436 		svm->vmcb->save.es = vmcb12->save.es;
437 		svm->vmcb->save.cs = vmcb12->save.cs;
438 		svm->vmcb->save.ss = vmcb12->save.ss;
439 		svm->vmcb->save.ds = vmcb12->save.ds;
440 		svm->vmcb->save.cpl = vmcb12->save.cpl;
441 		vmcb_mark_dirty(svm->vmcb, VMCB_SEG);
442 	}
443 
444 	if (unlikely(new_vmcb12 || vmcb_is_dirty(vmcb12, VMCB_DT))) {
445 		svm->vmcb->save.gdtr = vmcb12->save.gdtr;
446 		svm->vmcb->save.idtr = vmcb12->save.idtr;
447 		vmcb_mark_dirty(svm->vmcb, VMCB_DT);
448 	}
449 
450 	kvm_set_rflags(&svm->vcpu, vmcb12->save.rflags | X86_EFLAGS_FIXED);
451 
452 	/*
453 	 * Force-set EFER_SVME even though it is checked earlier on the
454 	 * VMCB12, because the guest can flip the bit between the check
455 	 * and now.  Clearing EFER_SVME would call svm_free_nested.
456 	 */
457 	svm_set_efer(&svm->vcpu, vmcb12->save.efer | EFER_SVME);
458 
459 	svm_set_cr0(&svm->vcpu, vmcb12->save.cr0);
460 	svm_set_cr4(&svm->vcpu, vmcb12->save.cr4);
461 
462 	svm->vcpu.arch.cr2 = vmcb12->save.cr2;
463 
464 	kvm_rax_write(&svm->vcpu, vmcb12->save.rax);
465 	kvm_rsp_write(&svm->vcpu, vmcb12->save.rsp);
466 	kvm_rip_write(&svm->vcpu, vmcb12->save.rip);
467 
468 	/* In case we don't even reach vcpu_run, the fields are not updated */
469 	svm->vmcb->save.rax = vmcb12->save.rax;
470 	svm->vmcb->save.rsp = vmcb12->save.rsp;
471 	svm->vmcb->save.rip = vmcb12->save.rip;
472 
473 	/* These bits will be set properly on the first execution when new_vmc12 is true */
474 	if (unlikely(new_vmcb12 || vmcb_is_dirty(vmcb12, VMCB_DR))) {
475 		svm->vmcb->save.dr7 = vmcb12->save.dr7 | DR7_FIXED_1;
476 		svm->vcpu.arch.dr6  = vmcb12->save.dr6 | DR6_ACTIVE_LOW;
477 		vmcb_mark_dirty(svm->vmcb, VMCB_DR);
478 	}
479 }
480 
481 static void nested_vmcb02_prepare_control(struct vcpu_svm *svm)
482 {
483 	const u32 mask = V_INTR_MASKING_MASK | V_GIF_ENABLE_MASK | V_GIF_MASK;
484 
485 	/*
486 	 * Filled at exit: exit_code, exit_code_hi, exit_info_1, exit_info_2,
487 	 * exit_int_info, exit_int_info_err, next_rip, insn_len, insn_bytes.
488 	 */
489 
490 	/*
491 	 * Also covers avic_vapic_bar, avic_backing_page, avic_logical_id,
492 	 * avic_physical_id.
493 	 */
494 	WARN_ON(svm->vmcb01.ptr->control.int_ctl & AVIC_ENABLE_MASK);
495 
496 	/* Copied from vmcb01.  msrpm_base can be overwritten later.  */
497 	svm->vmcb->control.nested_ctl = svm->vmcb01.ptr->control.nested_ctl;
498 	svm->vmcb->control.iopm_base_pa = svm->vmcb01.ptr->control.iopm_base_pa;
499 	svm->vmcb->control.msrpm_base_pa = svm->vmcb01.ptr->control.msrpm_base_pa;
500 
501 	/* Done at vmrun: asid.  */
502 
503 	/* Also overwritten later if necessary.  */
504 	svm->vmcb->control.tlb_ctl = TLB_CONTROL_DO_NOTHING;
505 
506 	/* nested_cr3.  */
507 	if (nested_npt_enabled(svm))
508 		nested_svm_init_mmu_context(&svm->vcpu);
509 
510 	svm->vmcb->control.tsc_offset = svm->vcpu.arch.tsc_offset =
511 		svm->vcpu.arch.l1_tsc_offset + svm->nested.ctl.tsc_offset;
512 
513 	svm->vmcb->control.int_ctl             =
514 		(svm->nested.ctl.int_ctl & ~mask) |
515 		(svm->vmcb01.ptr->control.int_ctl & mask);
516 
517 	svm->vmcb->control.virt_ext            = svm->nested.ctl.virt_ext;
518 	svm->vmcb->control.int_vector          = svm->nested.ctl.int_vector;
519 	svm->vmcb->control.int_state           = svm->nested.ctl.int_state;
520 	svm->vmcb->control.event_inj           = svm->nested.ctl.event_inj;
521 	svm->vmcb->control.event_inj_err       = svm->nested.ctl.event_inj_err;
522 
523 	svm->vmcb->control.pause_filter_count  = svm->nested.ctl.pause_filter_count;
524 	svm->vmcb->control.pause_filter_thresh = svm->nested.ctl.pause_filter_thresh;
525 
526 	/* Enter Guest-Mode */
527 	enter_guest_mode(&svm->vcpu);
528 
529 	/*
530 	 * Merge guest and host intercepts - must be called with vcpu in
531 	 * guest-mode to take effect.
532 	 */
533 	recalc_intercepts(svm);
534 }
535 
536 static void nested_svm_copy_common_state(struct vmcb *from_vmcb, struct vmcb *to_vmcb)
537 {
538 	/*
539 	 * Some VMCB state is shared between L1 and L2 and thus has to be
540 	 * moved at the time of nested vmrun and vmexit.
541 	 *
542 	 * VMLOAD/VMSAVE state would also belong in this category, but KVM
543 	 * always performs VMLOAD and VMSAVE from the VMCB01.
544 	 */
545 	to_vmcb->save.spec_ctrl = from_vmcb->save.spec_ctrl;
546 }
547 
548 int enter_svm_guest_mode(struct kvm_vcpu *vcpu, u64 vmcb12_gpa,
549 			 struct vmcb *vmcb12)
550 {
551 	struct vcpu_svm *svm = to_svm(vcpu);
552 	int ret;
553 
554 	trace_kvm_nested_vmrun(svm->vmcb->save.rip, vmcb12_gpa,
555 			       vmcb12->save.rip,
556 			       vmcb12->control.int_ctl,
557 			       vmcb12->control.event_inj,
558 			       vmcb12->control.nested_ctl);
559 
560 	trace_kvm_nested_intercepts(vmcb12->control.intercepts[INTERCEPT_CR] & 0xffff,
561 				    vmcb12->control.intercepts[INTERCEPT_CR] >> 16,
562 				    vmcb12->control.intercepts[INTERCEPT_EXCEPTION],
563 				    vmcb12->control.intercepts[INTERCEPT_WORD3],
564 				    vmcb12->control.intercepts[INTERCEPT_WORD4],
565 				    vmcb12->control.intercepts[INTERCEPT_WORD5]);
566 
567 
568 	svm->nested.vmcb12_gpa = vmcb12_gpa;
569 
570 	WARN_ON(svm->vmcb == svm->nested.vmcb02.ptr);
571 
572 	nested_svm_copy_common_state(svm->vmcb01.ptr, svm->nested.vmcb02.ptr);
573 
574 	svm_switch_vmcb(svm, &svm->nested.vmcb02);
575 	nested_vmcb02_prepare_control(svm);
576 	nested_vmcb02_prepare_save(svm, vmcb12);
577 
578 	ret = nested_svm_load_cr3(&svm->vcpu, vmcb12->save.cr3,
579 				  nested_npt_enabled(svm));
580 	if (ret)
581 		return ret;
582 
583 	if (!npt_enabled)
584 		vcpu->arch.mmu->inject_page_fault = svm_inject_page_fault_nested;
585 
586 	svm_set_gif(svm, true);
587 
588 	return 0;
589 }
590 
591 int nested_svm_vmrun(struct kvm_vcpu *vcpu)
592 {
593 	struct vcpu_svm *svm = to_svm(vcpu);
594 	int ret;
595 	struct vmcb *vmcb12;
596 	struct kvm_host_map map;
597 	u64 vmcb12_gpa;
598 
599 	++vcpu->stat.nested_run;
600 
601 	if (is_smm(vcpu)) {
602 		kvm_queue_exception(vcpu, UD_VECTOR);
603 		return 1;
604 	}
605 
606 	vmcb12_gpa = svm->vmcb->save.rax;
607 	ret = kvm_vcpu_map(vcpu, gpa_to_gfn(vmcb12_gpa), &map);
608 	if (ret == -EINVAL) {
609 		kvm_inject_gp(vcpu, 0);
610 		return 1;
611 	} else if (ret) {
612 		return kvm_skip_emulated_instruction(vcpu);
613 	}
614 
615 	ret = kvm_skip_emulated_instruction(vcpu);
616 
617 	vmcb12 = map.hva;
618 
619 	if (WARN_ON_ONCE(!svm->nested.initialized))
620 		return -EINVAL;
621 
622 	nested_load_control_from_vmcb12(svm, &vmcb12->control);
623 
624 	if (!nested_vmcb_valid_sregs(vcpu, &vmcb12->save) ||
625 	    !nested_vmcb_check_controls(vcpu, &svm->nested.ctl)) {
626 		vmcb12->control.exit_code    = SVM_EXIT_ERR;
627 		vmcb12->control.exit_code_hi = 0;
628 		vmcb12->control.exit_info_1  = 0;
629 		vmcb12->control.exit_info_2  = 0;
630 		goto out;
631 	}
632 
633 
634 	/* Clear internal status */
635 	kvm_clear_exception_queue(vcpu);
636 	kvm_clear_interrupt_queue(vcpu);
637 
638 	/*
639 	 * Since vmcb01 is not in use, we can use it to store some of the L1
640 	 * state.
641 	 */
642 	svm->vmcb01.ptr->save.efer   = vcpu->arch.efer;
643 	svm->vmcb01.ptr->save.cr0    = kvm_read_cr0(vcpu);
644 	svm->vmcb01.ptr->save.cr4    = vcpu->arch.cr4;
645 	svm->vmcb01.ptr->save.rflags = kvm_get_rflags(vcpu);
646 	svm->vmcb01.ptr->save.rip    = kvm_rip_read(vcpu);
647 
648 	if (!npt_enabled)
649 		svm->vmcb01.ptr->save.cr3 = kvm_read_cr3(vcpu);
650 
651 	svm->nested.nested_run_pending = 1;
652 
653 	if (enter_svm_guest_mode(vcpu, vmcb12_gpa, vmcb12))
654 		goto out_exit_err;
655 
656 	if (nested_svm_vmrun_msrpm(svm))
657 		goto out;
658 
659 out_exit_err:
660 	svm->nested.nested_run_pending = 0;
661 
662 	svm->vmcb->control.exit_code    = SVM_EXIT_ERR;
663 	svm->vmcb->control.exit_code_hi = 0;
664 	svm->vmcb->control.exit_info_1  = 0;
665 	svm->vmcb->control.exit_info_2  = 0;
666 
667 	nested_svm_vmexit(svm);
668 
669 out:
670 	kvm_vcpu_unmap(vcpu, &map, true);
671 
672 	return ret;
673 }
674 
675 void nested_svm_vmloadsave(struct vmcb *from_vmcb, struct vmcb *to_vmcb)
676 {
677 	to_vmcb->save.fs = from_vmcb->save.fs;
678 	to_vmcb->save.gs = from_vmcb->save.gs;
679 	to_vmcb->save.tr = from_vmcb->save.tr;
680 	to_vmcb->save.ldtr = from_vmcb->save.ldtr;
681 	to_vmcb->save.kernel_gs_base = from_vmcb->save.kernel_gs_base;
682 	to_vmcb->save.star = from_vmcb->save.star;
683 	to_vmcb->save.lstar = from_vmcb->save.lstar;
684 	to_vmcb->save.cstar = from_vmcb->save.cstar;
685 	to_vmcb->save.sfmask = from_vmcb->save.sfmask;
686 	to_vmcb->save.sysenter_cs = from_vmcb->save.sysenter_cs;
687 	to_vmcb->save.sysenter_esp = from_vmcb->save.sysenter_esp;
688 	to_vmcb->save.sysenter_eip = from_vmcb->save.sysenter_eip;
689 }
690 
691 int nested_svm_vmexit(struct vcpu_svm *svm)
692 {
693 	struct kvm_vcpu *vcpu = &svm->vcpu;
694 	struct vmcb *vmcb12;
695 	struct vmcb *vmcb = svm->vmcb;
696 	struct kvm_host_map map;
697 	int rc;
698 
699 	/* Triple faults in L2 should never escape. */
700 	WARN_ON_ONCE(kvm_check_request(KVM_REQ_TRIPLE_FAULT, vcpu));
701 
702 	rc = kvm_vcpu_map(vcpu, gpa_to_gfn(svm->nested.vmcb12_gpa), &map);
703 	if (rc) {
704 		if (rc == -EINVAL)
705 			kvm_inject_gp(vcpu, 0);
706 		return 1;
707 	}
708 
709 	vmcb12 = map.hva;
710 
711 	/* Exit Guest-Mode */
712 	leave_guest_mode(vcpu);
713 	svm->nested.vmcb12_gpa = 0;
714 	WARN_ON_ONCE(svm->nested.nested_run_pending);
715 
716 	kvm_clear_request(KVM_REQ_GET_NESTED_STATE_PAGES, vcpu);
717 
718 	/* in case we halted in L2 */
719 	svm->vcpu.arch.mp_state = KVM_MP_STATE_RUNNABLE;
720 
721 	/* Give the current vmcb to the guest */
722 
723 	vmcb12->save.es     = vmcb->save.es;
724 	vmcb12->save.cs     = vmcb->save.cs;
725 	vmcb12->save.ss     = vmcb->save.ss;
726 	vmcb12->save.ds     = vmcb->save.ds;
727 	vmcb12->save.gdtr   = vmcb->save.gdtr;
728 	vmcb12->save.idtr   = vmcb->save.idtr;
729 	vmcb12->save.efer   = svm->vcpu.arch.efer;
730 	vmcb12->save.cr0    = kvm_read_cr0(vcpu);
731 	vmcb12->save.cr3    = kvm_read_cr3(vcpu);
732 	vmcb12->save.cr2    = vmcb->save.cr2;
733 	vmcb12->save.cr4    = svm->vcpu.arch.cr4;
734 	vmcb12->save.rflags = kvm_get_rflags(vcpu);
735 	vmcb12->save.rip    = kvm_rip_read(vcpu);
736 	vmcb12->save.rsp    = kvm_rsp_read(vcpu);
737 	vmcb12->save.rax    = kvm_rax_read(vcpu);
738 	vmcb12->save.dr7    = vmcb->save.dr7;
739 	vmcb12->save.dr6    = svm->vcpu.arch.dr6;
740 	vmcb12->save.cpl    = vmcb->save.cpl;
741 
742 	vmcb12->control.int_state         = vmcb->control.int_state;
743 	vmcb12->control.exit_code         = vmcb->control.exit_code;
744 	vmcb12->control.exit_code_hi      = vmcb->control.exit_code_hi;
745 	vmcb12->control.exit_info_1       = vmcb->control.exit_info_1;
746 	vmcb12->control.exit_info_2       = vmcb->control.exit_info_2;
747 
748 	if (vmcb12->control.exit_code != SVM_EXIT_ERR)
749 		nested_save_pending_event_to_vmcb12(svm, vmcb12);
750 
751 	if (svm->nrips_enabled)
752 		vmcb12->control.next_rip  = vmcb->control.next_rip;
753 
754 	vmcb12->control.int_ctl           = svm->nested.ctl.int_ctl;
755 	vmcb12->control.tlb_ctl           = svm->nested.ctl.tlb_ctl;
756 	vmcb12->control.event_inj         = svm->nested.ctl.event_inj;
757 	vmcb12->control.event_inj_err     = svm->nested.ctl.event_inj_err;
758 
759 	vmcb12->control.pause_filter_count =
760 		svm->vmcb->control.pause_filter_count;
761 	vmcb12->control.pause_filter_thresh =
762 		svm->vmcb->control.pause_filter_thresh;
763 
764 	nested_svm_copy_common_state(svm->nested.vmcb02.ptr, svm->vmcb01.ptr);
765 
766 	svm_switch_vmcb(svm, &svm->vmcb01);
767 
768 	/*
769 	 * On vmexit the  GIF is set to false and
770 	 * no event can be injected in L1.
771 	 */
772 	svm_set_gif(svm, false);
773 	svm->vmcb->control.exit_int_info = 0;
774 
775 	svm->vcpu.arch.tsc_offset = svm->vcpu.arch.l1_tsc_offset;
776 	if (svm->vmcb->control.tsc_offset != svm->vcpu.arch.tsc_offset) {
777 		svm->vmcb->control.tsc_offset = svm->vcpu.arch.tsc_offset;
778 		vmcb_mark_dirty(svm->vmcb, VMCB_INTERCEPTS);
779 	}
780 
781 	svm->nested.ctl.nested_cr3 = 0;
782 
783 	/*
784 	 * Restore processor state that had been saved in vmcb01
785 	 */
786 	kvm_set_rflags(vcpu, svm->vmcb->save.rflags);
787 	svm_set_efer(vcpu, svm->vmcb->save.efer);
788 	svm_set_cr0(vcpu, svm->vmcb->save.cr0 | X86_CR0_PE);
789 	svm_set_cr4(vcpu, svm->vmcb->save.cr4);
790 	kvm_rax_write(vcpu, svm->vmcb->save.rax);
791 	kvm_rsp_write(vcpu, svm->vmcb->save.rsp);
792 	kvm_rip_write(vcpu, svm->vmcb->save.rip);
793 
794 	svm->vcpu.arch.dr7 = DR7_FIXED_1;
795 	kvm_update_dr7(&svm->vcpu);
796 
797 	trace_kvm_nested_vmexit_inject(vmcb12->control.exit_code,
798 				       vmcb12->control.exit_info_1,
799 				       vmcb12->control.exit_info_2,
800 				       vmcb12->control.exit_int_info,
801 				       vmcb12->control.exit_int_info_err,
802 				       KVM_ISA_SVM);
803 
804 	kvm_vcpu_unmap(vcpu, &map, true);
805 
806 	nested_svm_uninit_mmu_context(vcpu);
807 
808 	rc = nested_svm_load_cr3(vcpu, svm->vmcb->save.cr3, false);
809 	if (rc)
810 		return 1;
811 
812 	/*
813 	 * Drop what we picked up for L2 via svm_complete_interrupts() so it
814 	 * doesn't end up in L1.
815 	 */
816 	svm->vcpu.arch.nmi_injected = false;
817 	kvm_clear_exception_queue(vcpu);
818 	kvm_clear_interrupt_queue(vcpu);
819 
820 	/*
821 	 * If we are here following the completion of a VMRUN that
822 	 * is being single-stepped, queue the pending #DB intercept
823 	 * right now so that it an be accounted for before we execute
824 	 * L1's next instruction.
825 	 */
826 	if (unlikely(svm->vmcb->save.rflags & X86_EFLAGS_TF))
827 		kvm_queue_exception(&(svm->vcpu), DB_VECTOR);
828 
829 	return 0;
830 }
831 
832 static void nested_svm_triple_fault(struct kvm_vcpu *vcpu)
833 {
834 	nested_svm_simple_vmexit(to_svm(vcpu), SVM_EXIT_SHUTDOWN);
835 }
836 
837 int svm_allocate_nested(struct vcpu_svm *svm)
838 {
839 	struct page *vmcb02_page;
840 
841 	if (svm->nested.initialized)
842 		return 0;
843 
844 	vmcb02_page = alloc_page(GFP_KERNEL_ACCOUNT | __GFP_ZERO);
845 	if (!vmcb02_page)
846 		return -ENOMEM;
847 	svm->nested.vmcb02.ptr = page_address(vmcb02_page);
848 	svm->nested.vmcb02.pa = __sme_set(page_to_pfn(vmcb02_page) << PAGE_SHIFT);
849 
850 	svm->nested.msrpm = svm_vcpu_alloc_msrpm();
851 	if (!svm->nested.msrpm)
852 		goto err_free_vmcb02;
853 	svm_vcpu_init_msrpm(&svm->vcpu, svm->nested.msrpm);
854 
855 	svm->nested.initialized = true;
856 	return 0;
857 
858 err_free_vmcb02:
859 	__free_page(vmcb02_page);
860 	return -ENOMEM;
861 }
862 
863 void svm_free_nested(struct vcpu_svm *svm)
864 {
865 	if (!svm->nested.initialized)
866 		return;
867 
868 	svm_vcpu_free_msrpm(svm->nested.msrpm);
869 	svm->nested.msrpm = NULL;
870 
871 	__free_page(virt_to_page(svm->nested.vmcb02.ptr));
872 	svm->nested.vmcb02.ptr = NULL;
873 
874 	/*
875 	 * When last_vmcb12_gpa matches the current vmcb12 gpa,
876 	 * some vmcb12 fields are not loaded if they are marked clean
877 	 * in the vmcb12, since in this case they are up to date already.
878 	 *
879 	 * When the vmcb02 is freed, this optimization becomes invalid.
880 	 */
881 	svm->nested.last_vmcb12_gpa = INVALID_GPA;
882 
883 	svm->nested.initialized = false;
884 }
885 
886 /*
887  * Forcibly leave nested mode in order to be able to reset the VCPU later on.
888  */
889 void svm_leave_nested(struct vcpu_svm *svm)
890 {
891 	struct kvm_vcpu *vcpu = &svm->vcpu;
892 
893 	if (is_guest_mode(vcpu)) {
894 		svm->nested.nested_run_pending = 0;
895 		svm->nested.vmcb12_gpa = INVALID_GPA;
896 
897 		leave_guest_mode(vcpu);
898 
899 		svm_switch_vmcb(svm, &svm->vmcb01);
900 
901 		nested_svm_uninit_mmu_context(vcpu);
902 		vmcb_mark_all_dirty(svm->vmcb);
903 	}
904 
905 	kvm_clear_request(KVM_REQ_GET_NESTED_STATE_PAGES, vcpu);
906 }
907 
908 static int nested_svm_exit_handled_msr(struct vcpu_svm *svm)
909 {
910 	u32 offset, msr, value;
911 	int write, mask;
912 
913 	if (!(vmcb_is_intercept(&svm->nested.ctl, INTERCEPT_MSR_PROT)))
914 		return NESTED_EXIT_HOST;
915 
916 	msr    = svm->vcpu.arch.regs[VCPU_REGS_RCX];
917 	offset = svm_msrpm_offset(msr);
918 	write  = svm->vmcb->control.exit_info_1 & 1;
919 	mask   = 1 << ((2 * (msr & 0xf)) + write);
920 
921 	if (offset == MSR_INVALID)
922 		return NESTED_EXIT_DONE;
923 
924 	/* Offset is in 32 bit units but need in 8 bit units */
925 	offset *= 4;
926 
927 	if (kvm_vcpu_read_guest(&svm->vcpu, svm->nested.ctl.msrpm_base_pa + offset, &value, 4))
928 		return NESTED_EXIT_DONE;
929 
930 	return (value & mask) ? NESTED_EXIT_DONE : NESTED_EXIT_HOST;
931 }
932 
933 static int nested_svm_intercept_ioio(struct vcpu_svm *svm)
934 {
935 	unsigned port, size, iopm_len;
936 	u16 val, mask;
937 	u8 start_bit;
938 	u64 gpa;
939 
940 	if (!(vmcb_is_intercept(&svm->nested.ctl, INTERCEPT_IOIO_PROT)))
941 		return NESTED_EXIT_HOST;
942 
943 	port = svm->vmcb->control.exit_info_1 >> 16;
944 	size = (svm->vmcb->control.exit_info_1 & SVM_IOIO_SIZE_MASK) >>
945 		SVM_IOIO_SIZE_SHIFT;
946 	gpa  = svm->nested.ctl.iopm_base_pa + (port / 8);
947 	start_bit = port % 8;
948 	iopm_len = (start_bit + size > 8) ? 2 : 1;
949 	mask = (0xf >> (4 - size)) << start_bit;
950 	val = 0;
951 
952 	if (kvm_vcpu_read_guest(&svm->vcpu, gpa, &val, iopm_len))
953 		return NESTED_EXIT_DONE;
954 
955 	return (val & mask) ? NESTED_EXIT_DONE : NESTED_EXIT_HOST;
956 }
957 
958 static int nested_svm_intercept(struct vcpu_svm *svm)
959 {
960 	u32 exit_code = svm->vmcb->control.exit_code;
961 	int vmexit = NESTED_EXIT_HOST;
962 
963 	switch (exit_code) {
964 	case SVM_EXIT_MSR:
965 		vmexit = nested_svm_exit_handled_msr(svm);
966 		break;
967 	case SVM_EXIT_IOIO:
968 		vmexit = nested_svm_intercept_ioio(svm);
969 		break;
970 	case SVM_EXIT_READ_CR0 ... SVM_EXIT_WRITE_CR8: {
971 		if (vmcb_is_intercept(&svm->nested.ctl, exit_code))
972 			vmexit = NESTED_EXIT_DONE;
973 		break;
974 	}
975 	case SVM_EXIT_READ_DR0 ... SVM_EXIT_WRITE_DR7: {
976 		if (vmcb_is_intercept(&svm->nested.ctl, exit_code))
977 			vmexit = NESTED_EXIT_DONE;
978 		break;
979 	}
980 	case SVM_EXIT_EXCP_BASE ... SVM_EXIT_EXCP_BASE + 0x1f: {
981 		/*
982 		 * Host-intercepted exceptions have been checked already in
983 		 * nested_svm_exit_special.  There is nothing to do here,
984 		 * the vmexit is injected by svm_check_nested_events.
985 		 */
986 		vmexit = NESTED_EXIT_DONE;
987 		break;
988 	}
989 	case SVM_EXIT_ERR: {
990 		vmexit = NESTED_EXIT_DONE;
991 		break;
992 	}
993 	default: {
994 		if (vmcb_is_intercept(&svm->nested.ctl, exit_code))
995 			vmexit = NESTED_EXIT_DONE;
996 	}
997 	}
998 
999 	return vmexit;
1000 }
1001 
1002 int nested_svm_exit_handled(struct vcpu_svm *svm)
1003 {
1004 	int vmexit;
1005 
1006 	vmexit = nested_svm_intercept(svm);
1007 
1008 	if (vmexit == NESTED_EXIT_DONE)
1009 		nested_svm_vmexit(svm);
1010 
1011 	return vmexit;
1012 }
1013 
1014 int nested_svm_check_permissions(struct kvm_vcpu *vcpu)
1015 {
1016 	if (!(vcpu->arch.efer & EFER_SVME) || !is_paging(vcpu)) {
1017 		kvm_queue_exception(vcpu, UD_VECTOR);
1018 		return 1;
1019 	}
1020 
1021 	if (to_svm(vcpu)->vmcb->save.cpl) {
1022 		kvm_inject_gp(vcpu, 0);
1023 		return 1;
1024 	}
1025 
1026 	return 0;
1027 }
1028 
1029 static bool nested_exit_on_exception(struct vcpu_svm *svm)
1030 {
1031 	unsigned int nr = svm->vcpu.arch.exception.nr;
1032 
1033 	return (svm->nested.ctl.intercepts[INTERCEPT_EXCEPTION] & BIT(nr));
1034 }
1035 
1036 static void nested_svm_inject_exception_vmexit(struct vcpu_svm *svm)
1037 {
1038 	unsigned int nr = svm->vcpu.arch.exception.nr;
1039 
1040 	svm->vmcb->control.exit_code = SVM_EXIT_EXCP_BASE + nr;
1041 	svm->vmcb->control.exit_code_hi = 0;
1042 
1043 	if (svm->vcpu.arch.exception.has_error_code)
1044 		svm->vmcb->control.exit_info_1 = svm->vcpu.arch.exception.error_code;
1045 
1046 	/*
1047 	 * EXITINFO2 is undefined for all exception intercepts other
1048 	 * than #PF.
1049 	 */
1050 	if (nr == PF_VECTOR) {
1051 		if (svm->vcpu.arch.exception.nested_apf)
1052 			svm->vmcb->control.exit_info_2 = svm->vcpu.arch.apf.nested_apf_token;
1053 		else if (svm->vcpu.arch.exception.has_payload)
1054 			svm->vmcb->control.exit_info_2 = svm->vcpu.arch.exception.payload;
1055 		else
1056 			svm->vmcb->control.exit_info_2 = svm->vcpu.arch.cr2;
1057 	} else if (nr == DB_VECTOR) {
1058 		/* See inject_pending_event.  */
1059 		kvm_deliver_exception_payload(&svm->vcpu);
1060 		if (svm->vcpu.arch.dr7 & DR7_GD) {
1061 			svm->vcpu.arch.dr7 &= ~DR7_GD;
1062 			kvm_update_dr7(&svm->vcpu);
1063 		}
1064 	} else
1065 		WARN_ON(svm->vcpu.arch.exception.has_payload);
1066 
1067 	nested_svm_vmexit(svm);
1068 }
1069 
1070 static inline bool nested_exit_on_init(struct vcpu_svm *svm)
1071 {
1072 	return vmcb_is_intercept(&svm->nested.ctl, INTERCEPT_INIT);
1073 }
1074 
1075 static int svm_check_nested_events(struct kvm_vcpu *vcpu)
1076 {
1077 	struct vcpu_svm *svm = to_svm(vcpu);
1078 	bool block_nested_events =
1079 		kvm_event_needs_reinjection(vcpu) || svm->nested.nested_run_pending;
1080 	struct kvm_lapic *apic = vcpu->arch.apic;
1081 
1082 	if (lapic_in_kernel(vcpu) &&
1083 	    test_bit(KVM_APIC_INIT, &apic->pending_events)) {
1084 		if (block_nested_events)
1085 			return -EBUSY;
1086 		if (!nested_exit_on_init(svm))
1087 			return 0;
1088 		nested_svm_simple_vmexit(svm, SVM_EXIT_INIT);
1089 		return 0;
1090 	}
1091 
1092 	if (vcpu->arch.exception.pending) {
1093 		/*
1094 		 * Only a pending nested run can block a pending exception.
1095 		 * Otherwise an injected NMI/interrupt should either be
1096 		 * lost or delivered to the nested hypervisor in the EXITINTINFO
1097 		 * vmcb field, while delivering the pending exception.
1098 		 */
1099 		if (svm->nested.nested_run_pending)
1100                         return -EBUSY;
1101 		if (!nested_exit_on_exception(svm))
1102 			return 0;
1103 		nested_svm_inject_exception_vmexit(svm);
1104 		return 0;
1105 	}
1106 
1107 	if (vcpu->arch.smi_pending && !svm_smi_blocked(vcpu)) {
1108 		if (block_nested_events)
1109 			return -EBUSY;
1110 		if (!nested_exit_on_smi(svm))
1111 			return 0;
1112 		nested_svm_simple_vmexit(svm, SVM_EXIT_SMI);
1113 		return 0;
1114 	}
1115 
1116 	if (vcpu->arch.nmi_pending && !svm_nmi_blocked(vcpu)) {
1117 		if (block_nested_events)
1118 			return -EBUSY;
1119 		if (!nested_exit_on_nmi(svm))
1120 			return 0;
1121 		nested_svm_simple_vmexit(svm, SVM_EXIT_NMI);
1122 		return 0;
1123 	}
1124 
1125 	if (kvm_cpu_has_interrupt(vcpu) && !svm_interrupt_blocked(vcpu)) {
1126 		if (block_nested_events)
1127 			return -EBUSY;
1128 		if (!nested_exit_on_intr(svm))
1129 			return 0;
1130 		trace_kvm_nested_intr_vmexit(svm->vmcb->save.rip);
1131 		nested_svm_simple_vmexit(svm, SVM_EXIT_INTR);
1132 		return 0;
1133 	}
1134 
1135 	return 0;
1136 }
1137 
1138 int nested_svm_exit_special(struct vcpu_svm *svm)
1139 {
1140 	u32 exit_code = svm->vmcb->control.exit_code;
1141 
1142 	switch (exit_code) {
1143 	case SVM_EXIT_INTR:
1144 	case SVM_EXIT_NMI:
1145 	case SVM_EXIT_NPF:
1146 		return NESTED_EXIT_HOST;
1147 	case SVM_EXIT_EXCP_BASE ... SVM_EXIT_EXCP_BASE + 0x1f: {
1148 		u32 excp_bits = 1 << (exit_code - SVM_EXIT_EXCP_BASE);
1149 
1150 		if (svm->vmcb01.ptr->control.intercepts[INTERCEPT_EXCEPTION] &
1151 		    excp_bits)
1152 			return NESTED_EXIT_HOST;
1153 		else if (exit_code == SVM_EXIT_EXCP_BASE + PF_VECTOR &&
1154 			 svm->vcpu.arch.apf.host_apf_flags)
1155 			/* Trap async PF even if not shadowing */
1156 			return NESTED_EXIT_HOST;
1157 		break;
1158 	}
1159 	default:
1160 		break;
1161 	}
1162 
1163 	return NESTED_EXIT_CONTINUE;
1164 }
1165 
1166 static int svm_get_nested_state(struct kvm_vcpu *vcpu,
1167 				struct kvm_nested_state __user *user_kvm_nested_state,
1168 				u32 user_data_size)
1169 {
1170 	struct vcpu_svm *svm;
1171 	struct kvm_nested_state kvm_state = {
1172 		.flags = 0,
1173 		.format = KVM_STATE_NESTED_FORMAT_SVM,
1174 		.size = sizeof(kvm_state),
1175 	};
1176 	struct vmcb __user *user_vmcb = (struct vmcb __user *)
1177 		&user_kvm_nested_state->data.svm[0];
1178 
1179 	if (!vcpu)
1180 		return kvm_state.size + KVM_STATE_NESTED_SVM_VMCB_SIZE;
1181 
1182 	svm = to_svm(vcpu);
1183 
1184 	if (user_data_size < kvm_state.size)
1185 		goto out;
1186 
1187 	/* First fill in the header and copy it out.  */
1188 	if (is_guest_mode(vcpu)) {
1189 		kvm_state.hdr.svm.vmcb_pa = svm->nested.vmcb12_gpa;
1190 		kvm_state.size += KVM_STATE_NESTED_SVM_VMCB_SIZE;
1191 		kvm_state.flags |= KVM_STATE_NESTED_GUEST_MODE;
1192 
1193 		if (svm->nested.nested_run_pending)
1194 			kvm_state.flags |= KVM_STATE_NESTED_RUN_PENDING;
1195 	}
1196 
1197 	if (gif_set(svm))
1198 		kvm_state.flags |= KVM_STATE_NESTED_GIF_SET;
1199 
1200 	if (copy_to_user(user_kvm_nested_state, &kvm_state, sizeof(kvm_state)))
1201 		return -EFAULT;
1202 
1203 	if (!is_guest_mode(vcpu))
1204 		goto out;
1205 
1206 	/*
1207 	 * Copy over the full size of the VMCB rather than just the size
1208 	 * of the structs.
1209 	 */
1210 	if (clear_user(user_vmcb, KVM_STATE_NESTED_SVM_VMCB_SIZE))
1211 		return -EFAULT;
1212 	if (copy_to_user(&user_vmcb->control, &svm->nested.ctl,
1213 			 sizeof(user_vmcb->control)))
1214 		return -EFAULT;
1215 	if (copy_to_user(&user_vmcb->save, &svm->vmcb01.ptr->save,
1216 			 sizeof(user_vmcb->save)))
1217 		return -EFAULT;
1218 out:
1219 	return kvm_state.size;
1220 }
1221 
1222 static int svm_set_nested_state(struct kvm_vcpu *vcpu,
1223 				struct kvm_nested_state __user *user_kvm_nested_state,
1224 				struct kvm_nested_state *kvm_state)
1225 {
1226 	struct vcpu_svm *svm = to_svm(vcpu);
1227 	struct vmcb __user *user_vmcb = (struct vmcb __user *)
1228 		&user_kvm_nested_state->data.svm[0];
1229 	struct vmcb_control_area *ctl;
1230 	struct vmcb_save_area *save;
1231 	int ret;
1232 	u32 cr0;
1233 
1234 	BUILD_BUG_ON(sizeof(struct vmcb_control_area) + sizeof(struct vmcb_save_area) >
1235 		     KVM_STATE_NESTED_SVM_VMCB_SIZE);
1236 
1237 	if (kvm_state->format != KVM_STATE_NESTED_FORMAT_SVM)
1238 		return -EINVAL;
1239 
1240 	if (kvm_state->flags & ~(KVM_STATE_NESTED_GUEST_MODE |
1241 				 KVM_STATE_NESTED_RUN_PENDING |
1242 				 KVM_STATE_NESTED_GIF_SET))
1243 		return -EINVAL;
1244 
1245 	/*
1246 	 * If in guest mode, vcpu->arch.efer actually refers to the L2 guest's
1247 	 * EFER.SVME, but EFER.SVME still has to be 1 for VMRUN to succeed.
1248 	 */
1249 	if (!(vcpu->arch.efer & EFER_SVME)) {
1250 		/* GIF=1 and no guest mode are required if SVME=0.  */
1251 		if (kvm_state->flags != KVM_STATE_NESTED_GIF_SET)
1252 			return -EINVAL;
1253 	}
1254 
1255 	/* SMM temporarily disables SVM, so we cannot be in guest mode.  */
1256 	if (is_smm(vcpu) && (kvm_state->flags & KVM_STATE_NESTED_GUEST_MODE))
1257 		return -EINVAL;
1258 
1259 	if (!(kvm_state->flags & KVM_STATE_NESTED_GUEST_MODE)) {
1260 		svm_leave_nested(svm);
1261 		svm_set_gif(svm, !!(kvm_state->flags & KVM_STATE_NESTED_GIF_SET));
1262 		return 0;
1263 	}
1264 
1265 	if (!page_address_valid(vcpu, kvm_state->hdr.svm.vmcb_pa))
1266 		return -EINVAL;
1267 	if (kvm_state->size < sizeof(*kvm_state) + KVM_STATE_NESTED_SVM_VMCB_SIZE)
1268 		return -EINVAL;
1269 
1270 	ret  = -ENOMEM;
1271 	ctl  = kzalloc(sizeof(*ctl),  GFP_KERNEL_ACCOUNT);
1272 	save = kzalloc(sizeof(*save), GFP_KERNEL_ACCOUNT);
1273 	if (!ctl || !save)
1274 		goto out_free;
1275 
1276 	ret = -EFAULT;
1277 	if (copy_from_user(ctl, &user_vmcb->control, sizeof(*ctl)))
1278 		goto out_free;
1279 	if (copy_from_user(save, &user_vmcb->save, sizeof(*save)))
1280 		goto out_free;
1281 
1282 	ret = -EINVAL;
1283 	if (!nested_vmcb_check_controls(vcpu, ctl))
1284 		goto out_free;
1285 
1286 	/*
1287 	 * Processor state contains L2 state.  Check that it is
1288 	 * valid for guest mode (see nested_vmcb_check_save).
1289 	 */
1290 	cr0 = kvm_read_cr0(vcpu);
1291         if (((cr0 & X86_CR0_CD) == 0) && (cr0 & X86_CR0_NW))
1292 		goto out_free;
1293 
1294 	/*
1295 	 * Validate host state saved from before VMRUN (see
1296 	 * nested_svm_check_permissions).
1297 	 */
1298 	if (!(save->cr0 & X86_CR0_PG) ||
1299 	    !(save->cr0 & X86_CR0_PE) ||
1300 	    (save->rflags & X86_EFLAGS_VM) ||
1301 	    !nested_vmcb_valid_sregs(vcpu, save))
1302 		goto out_free;
1303 
1304 	/*
1305 	 * All checks done, we can enter guest mode. Userspace provides
1306 	 * vmcb12.control, which will be combined with L1 and stored into
1307 	 * vmcb02, and the L1 save state which we store in vmcb01.
1308 	 * L2 registers if needed are moved from the current VMCB to VMCB02.
1309 	 */
1310 
1311 	if (is_guest_mode(vcpu))
1312 		svm_leave_nested(svm);
1313 	else
1314 		svm->nested.vmcb02.ptr->save = svm->vmcb01.ptr->save;
1315 
1316 	svm_set_gif(svm, !!(kvm_state->flags & KVM_STATE_NESTED_GIF_SET));
1317 
1318 	svm->nested.nested_run_pending =
1319 		!!(kvm_state->flags & KVM_STATE_NESTED_RUN_PENDING);
1320 
1321 	svm->nested.vmcb12_gpa = kvm_state->hdr.svm.vmcb_pa;
1322 
1323 	svm->vmcb01.ptr->save.es = save->es;
1324 	svm->vmcb01.ptr->save.cs = save->cs;
1325 	svm->vmcb01.ptr->save.ss = save->ss;
1326 	svm->vmcb01.ptr->save.ds = save->ds;
1327 	svm->vmcb01.ptr->save.gdtr = save->gdtr;
1328 	svm->vmcb01.ptr->save.idtr = save->idtr;
1329 	svm->vmcb01.ptr->save.rflags = save->rflags | X86_EFLAGS_FIXED;
1330 	svm->vmcb01.ptr->save.efer = save->efer;
1331 	svm->vmcb01.ptr->save.cr0 = save->cr0;
1332 	svm->vmcb01.ptr->save.cr3 = save->cr3;
1333 	svm->vmcb01.ptr->save.cr4 = save->cr4;
1334 	svm->vmcb01.ptr->save.rax = save->rax;
1335 	svm->vmcb01.ptr->save.rsp = save->rsp;
1336 	svm->vmcb01.ptr->save.rip = save->rip;
1337 	svm->vmcb01.ptr->save.cpl = 0;
1338 
1339 	nested_load_control_from_vmcb12(svm, ctl);
1340 
1341 	svm_switch_vmcb(svm, &svm->nested.vmcb02);
1342 
1343 	nested_vmcb02_prepare_control(svm);
1344 
1345 	kvm_make_request(KVM_REQ_GET_NESTED_STATE_PAGES, vcpu);
1346 	ret = 0;
1347 out_free:
1348 	kfree(save);
1349 	kfree(ctl);
1350 
1351 	return ret;
1352 }
1353 
1354 static bool svm_get_nested_state_pages(struct kvm_vcpu *vcpu)
1355 {
1356 	struct vcpu_svm *svm = to_svm(vcpu);
1357 
1358 	if (WARN_ON(!is_guest_mode(vcpu)))
1359 		return true;
1360 
1361 	if (nested_svm_load_cr3(&svm->vcpu, vcpu->arch.cr3,
1362 				nested_npt_enabled(svm)))
1363 		return false;
1364 
1365 	if (!nested_svm_vmrun_msrpm(svm)) {
1366 		vcpu->run->exit_reason = KVM_EXIT_INTERNAL_ERROR;
1367 		vcpu->run->internal.suberror =
1368 			KVM_INTERNAL_ERROR_EMULATION;
1369 		vcpu->run->internal.ndata = 0;
1370 		return false;
1371 	}
1372 
1373 	return true;
1374 }
1375 
1376 struct kvm_x86_nested_ops svm_nested_ops = {
1377 	.check_events = svm_check_nested_events,
1378 	.triple_fault = nested_svm_triple_fault,
1379 	.get_nested_state_pages = svm_get_nested_state_pages,
1380 	.get_state = svm_get_nested_state,
1381 	.set_state = svm_set_nested_state,
1382 };
1383