nested.c 35.0 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21
// SPDX-License-Identifier: GPL-2.0-only
/*
 * Kernel-based Virtual Machine driver for Linux
 *
 * AMD SVM support
 *
 * Copyright (C) 2006 Qumranet, Inc.
 * Copyright 2010 Red Hat, Inc. and/or its affiliates.
 *
 * Authors:
 *   Yaniv Kamay  <yaniv@qumranet.com>
 *   Avi Kivity   <avi@qumranet.com>
 */

#define pr_fmt(fmt) "SVM: " fmt

#include <linux/kvm_types.h>
#include <linux/kvm_host.h>
#include <linux/kernel.h>

#include <asm/msr-index.h>
22
#include <asm/debugreg.h>
23 24 25 26 27

#include "kvm_emulate.h"
#include "trace.h"
#include "mmu.h"
#include "x86.h"
28
#include "cpuid.h"
29
#include "lapic.h"
30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53
#include "svm.h"

static void nested_svm_inject_npf_exit(struct kvm_vcpu *vcpu,
				       struct x86_exception *fault)
{
	struct vcpu_svm *svm = to_svm(vcpu);

	if (svm->vmcb->control.exit_code != SVM_EXIT_NPF) {
		/*
		 * TODO: track the cause of the nested page fault, and
		 * correctly fill in the high bits of exit_info_1.
		 */
		svm->vmcb->control.exit_code = SVM_EXIT_NPF;
		svm->vmcb->control.exit_code_hi = 0;
		svm->vmcb->control.exit_info_1 = (1ULL << 32);
		svm->vmcb->control.exit_info_2 = fault->address;
	}

	svm->vmcb->control.exit_info_1 &= ~0xffffffffULL;
	svm->vmcb->control.exit_info_1 |= fault->error_code;

	nested_svm_vmexit(svm);
}

54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70
static void svm_inject_page_fault_nested(struct kvm_vcpu *vcpu, struct x86_exception *fault)
{
       struct vcpu_svm *svm = to_svm(vcpu);
       WARN_ON(!is_guest_mode(vcpu));

       if (vmcb_is_intercept(&svm->nested.ctl, INTERCEPT_EXCEPTION_OFFSET + PF_VECTOR) &&
	   !svm->nested.nested_run_pending) {
               svm->vmcb->control.exit_code = SVM_EXIT_EXCP_BASE + PF_VECTOR;
               svm->vmcb->control.exit_code_hi = 0;
               svm->vmcb->control.exit_info_1 = fault->error_code;
               svm->vmcb->control.exit_info_2 = fault->address;
               nested_svm_vmexit(svm);
       } else {
               kvm_inject_page_fault(vcpu, fault);
       }
}

71 72 73
static u64 nested_svm_get_tdp_pdptr(struct kvm_vcpu *vcpu, int index)
{
	struct vcpu_svm *svm = to_svm(vcpu);
74
	u64 cr3 = svm->nested.ctl.nested_cr3;
75 76 77
	u64 pdpte;
	int ret;

78
	ret = kvm_vcpu_read_guest_page(vcpu, gpa_to_gfn(cr3), &pdpte,
79 80 81 82 83 84 85 86 87 88
				       offset_in_page(cr3) + index * 8, 8);
	if (ret)
		return 0;
	return pdpte;
}

static unsigned long nested_svm_get_tdp_cr3(struct kvm_vcpu *vcpu)
{
	struct vcpu_svm *svm = to_svm(vcpu);

89
	return svm->nested.ctl.nested_cr3;
90 91 92 93
}

static void nested_svm_init_mmu_context(struct kvm_vcpu *vcpu)
{
94 95
	struct vcpu_svm *svm = to_svm(vcpu);

96 97 98
	WARN_ON(mmu_is_nested(vcpu));

	vcpu->arch.mmu = &vcpu->arch.guest_mmu;
99 100
	kvm_init_shadow_npt_mmu(vcpu, X86_CR0_PG, svm->vmcb01.ptr->save.cr4,
				svm->vmcb01.ptr->save.efer,
101
				svm->nested.ctl.nested_cr3);
102 103 104 105 106 107 108 109 110 111 112 113 114 115 116
	vcpu->arch.mmu->get_guest_pgd     = nested_svm_get_tdp_cr3;
	vcpu->arch.mmu->get_pdptr         = nested_svm_get_tdp_pdptr;
	vcpu->arch.mmu->inject_page_fault = nested_svm_inject_npf_exit;
	reset_shadow_zero_bits_mask(vcpu, vcpu->arch.mmu);
	vcpu->arch.walk_mmu              = &vcpu->arch.nested_mmu;
}

static void nested_svm_uninit_mmu_context(struct kvm_vcpu *vcpu)
{
	vcpu->arch.mmu = &vcpu->arch.root_mmu;
	vcpu->arch.walk_mmu = &vcpu->arch.root_mmu;
}

void recalc_intercepts(struct vcpu_svm *svm)
{
117
	struct vmcb_control_area *c, *h, *g;
118
	unsigned int i;
119

120
	vmcb_mark_dirty(svm->vmcb, VMCB_INTERCEPTS);
121 122 123 124 125

	if (!is_guest_mode(&svm->vcpu))
		return;

	c = &svm->vmcb->control;
126
	h = &svm->vmcb01.ptr->control;
127
	g = &svm->nested.ctl;
128

129 130 131
	for (i = 0; i < MAX_INTERCEPT; i++)
		c->intercepts[i] = h->intercepts[i];

P
Paolo Bonzini 已提交
132
	if (g->int_ctl & V_INTR_MASKING_MASK) {
133
		/* We only want the cr8 intercept bits of L1 */
134 135
		vmcb_clr_intercept(c, INTERCEPT_CR8_READ);
		vmcb_clr_intercept(c, INTERCEPT_CR8_WRITE);
136 137 138 139 140 141

		/*
		 * Once running L2 with HF_VINTR_MASK, EFLAGS.IF does not
		 * affect any interrupt we may want to inject; therefore,
		 * interrupt window vmexits are irrelevant to L0.
		 */
142
		vmcb_clr_intercept(c, INTERCEPT_VINTR);
143 144 145
	}

	/* We don't want to see VMMCALLs from a nested guest */
146
	vmcb_clr_intercept(c, INTERCEPT_VMMCALL);
147

148 149
	for (i = 0; i < MAX_INTERCEPT; i++)
		c->intercepts[i] |= g->intercepts[i];
150 151
}

152 153
static void copy_vmcb_control_area(struct vmcb_control_area *dst,
				   struct vmcb_control_area *from)
154
{
155 156 157 158 159
	unsigned int i;

	for (i = 0; i < MAX_INTERCEPT; i++)
		dst->intercepts[i] = from->intercepts[i];

160 161 162
	dst->iopm_base_pa         = from->iopm_base_pa;
	dst->msrpm_base_pa        = from->msrpm_base_pa;
	dst->tsc_offset           = from->tsc_offset;
163
	/* asid not copied, it is handled manually for svm->vmcb.  */
164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191
	dst->tlb_ctl              = from->tlb_ctl;
	dst->int_ctl              = from->int_ctl;
	dst->int_vector           = from->int_vector;
	dst->int_state            = from->int_state;
	dst->exit_code            = from->exit_code;
	dst->exit_code_hi         = from->exit_code_hi;
	dst->exit_info_1          = from->exit_info_1;
	dst->exit_info_2          = from->exit_info_2;
	dst->exit_int_info        = from->exit_int_info;
	dst->exit_int_info_err    = from->exit_int_info_err;
	dst->nested_ctl           = from->nested_ctl;
	dst->event_inj            = from->event_inj;
	dst->event_inj_err        = from->event_inj_err;
	dst->nested_cr3           = from->nested_cr3;
	dst->virt_ext              = from->virt_ext;
	dst->pause_filter_count   = from->pause_filter_count;
	dst->pause_filter_thresh  = from->pause_filter_thresh;
}

static bool nested_svm_vmrun_msrpm(struct vcpu_svm *svm)
{
	/*
	 * This function merges the msr permission bitmaps of kvm and the
	 * nested vmcb. It is optimized in that it only merges the parts where
	 * the kvm msr permission bitmap may contain zero bits
	 */
	int i;

192
	if (!(vmcb_is_intercept(&svm->nested.ctl, INTERCEPT_MSR_PROT)))
193 194 195 196 197 198 199 200 201 202
		return true;

	for (i = 0; i < MSRPM_OFFSETS; i++) {
		u32 value, p;
		u64 offset;

		if (msrpm_offsets[i] == 0xffffffff)
			break;

		p      = msrpm_offsets[i];
203
		offset = svm->nested.ctl.msrpm_base_pa + (p * 4);
204 205 206 207 208 209 210 211 212 213 214 215

		if (kvm_vcpu_read_guest(&svm->vcpu, offset, &value, 4))
			return false;

		svm->nested.msrpm[p] = svm->msrpm[p] | value;
	}

	svm->vmcb->control.msrpm_base_pa = __sme_set(__pa(svm->nested.msrpm));

	return true;
}

216 217 218
static bool svm_get_nested_state_pages(struct kvm_vcpu *vcpu)
{
	struct vcpu_svm *svm = to_svm(vcpu);
219

220 221 222
	if (WARN_ON(!is_guest_mode(vcpu)))
		return true;

223 224 225 226 227 228 229 230 231 232 233
	if (!nested_svm_vmrun_msrpm(svm)) {
		vcpu->run->exit_reason = KVM_EXIT_INTERNAL_ERROR;
		vcpu->run->internal.suberror =
			KVM_INTERNAL_ERROR_EMULATION;
		vcpu->run->internal.ndata = 0;
		return false;
	}

	return true;
}

234
static bool nested_vmcb_check_controls(struct vmcb_control_area *control)
235
{
236
	if ((vmcb_is_intercept(control, INTERCEPT_VMRUN)) == 0)
237 238
		return false;

239
	if (control->asid == 0)
240 241
		return false;

242 243
	if ((control->nested_ctl & SVM_NESTED_CTL_NP_ENABLE) &&
	    !npt_enabled)
244 245
		return false;

246 247 248
	return true;
}

249
static bool nested_vmcb_checks(struct vcpu_svm *svm, struct vmcb *vmcb12)
250
{
251
	struct kvm_vcpu *vcpu = &svm->vcpu;
252 253 254
	bool vmcb12_lma;

	if ((vmcb12->save.efer & EFER_SVME) == 0)
255 256
		return false;

257
	if (((vmcb12->save.cr0 & X86_CR0_CD) == 0) && (vmcb12->save.cr0 & X86_CR0_NW))
258 259
		return false;

260
	if (!kvm_dr6_valid(vmcb12->save.dr6) || !kvm_dr7_valid(vmcb12->save.dr7))
261 262
		return false;

263
	vmcb12_lma = (vmcb12->save.efer & EFER_LME) && (vmcb12->save.cr0 & X86_CR0_PG);
264

265
	if (vmcb12_lma) {
266 267
		if (!(vmcb12->save.cr4 & X86_CR4_PAE) ||
		    !(vmcb12->save.cr0 & X86_CR0_PE) ||
268
		    kvm_vcpu_is_illegal_gpa(vcpu, vmcb12->save.cr3))
269 270
			return false;
	}
271
	if (!kvm_is_valid_cr4(&svm->vcpu, vmcb12->save.cr4))
272 273
		return false;

274
	return nested_vmcb_check_controls(&vmcb12->control);
275 276
}

277 278
static void nested_load_control_from_vmcb12(struct vcpu_svm *svm,
					    struct vmcb_control_area *control)
279
{
280
	copy_vmcb_control_area(&svm->nested.ctl, control);
281

282 283
	/* Copy it here because nested_svm_check_controls will check it.  */
	svm->nested.ctl.asid           = control->asid;
284 285
	svm->nested.ctl.msrpm_base_pa &= ~0x0fffULL;
	svm->nested.ctl.iopm_base_pa  &= ~0x0fffULL;
286 287
}

288 289
/*
 * Synchronize fields that are written by the processor, so that
290
 * they can be copied back into the vmcb12.
291
 */
292
void nested_sync_control_from_vmcb02(struct vcpu_svm *svm)
293 294 295 296 297 298 299 300
{
	u32 mask;
	svm->nested.ctl.event_inj      = svm->vmcb->control.event_inj;
	svm->nested.ctl.event_inj_err  = svm->vmcb->control.event_inj_err;

	/* Only a few fields of int_ctl are written by the processor.  */
	mask = V_IRQ_MASK | V_TPR_MASK;
	if (!(svm->nested.ctl.int_ctl & V_INTR_MASKING_MASK) &&
301
	    svm_is_intercept(svm, INTERCEPT_VINTR)) {
302 303 304 305 306 307 308 309 310 311 312 313 314 315
		/*
		 * In order to request an interrupt window, L0 is usurping
		 * svm->vmcb->control.int_ctl and possibly setting V_IRQ
		 * even if it was clear in L1's VMCB.  Restoring it would be
		 * wrong.  However, in this case V_IRQ will remain true until
		 * interrupt_window_interception calls svm_clear_vintr and
		 * restores int_ctl.  We can just leave it aside.
		 */
		mask &= ~V_IRQ_MASK;
	}
	svm->nested.ctl.int_ctl        &= ~mask;
	svm->nested.ctl.int_ctl        |= svm->vmcb->control.int_ctl & mask;
}

316 317 318 319
/*
 * Transfer any event that L0 or L1 wanted to inject into L2 to
 * EXIT_INT_INFO.
 */
320 321
static void nested_save_pending_event_to_vmcb12(struct vcpu_svm *svm,
						struct vmcb *vmcb12)
322 323 324 325 326 327 328 329 330 331 332
{
	struct kvm_vcpu *vcpu = &svm->vcpu;
	u32 exit_int_info = 0;
	unsigned int nr;

	if (vcpu->arch.exception.injected) {
		nr = vcpu->arch.exception.nr;
		exit_int_info = nr | SVM_EVTINJ_VALID | SVM_EVTINJ_TYPE_EXEPT;

		if (vcpu->arch.exception.has_error_code) {
			exit_int_info |= SVM_EVTINJ_VALID_ERR;
333
			vmcb12->control.exit_int_info_err =
334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349
				vcpu->arch.exception.error_code;
		}

	} else if (vcpu->arch.nmi_injected) {
		exit_int_info = SVM_EVTINJ_VALID | SVM_EVTINJ_TYPE_NMI;

	} else if (vcpu->arch.interrupt.injected) {
		nr = vcpu->arch.interrupt.nr;
		exit_int_info = nr | SVM_EVTINJ_VALID;

		if (vcpu->arch.interrupt.soft)
			exit_int_info |= SVM_EVTINJ_TYPE_SOFT;
		else
			exit_int_info |= SVM_EVTINJ_TYPE_INTR;
	}

350
	vmcb12->control.exit_int_info = exit_int_info;
351 352
}

353 354 355 356 357 358
static inline bool nested_npt_enabled(struct vcpu_svm *svm)
{
	return svm->nested.ctl.nested_ctl & SVM_NESTED_CTL_NP_ENABLE;
}

/*
359 360
 * Load guest's/host's cr3 on nested vmentry or vmexit. @nested_npt is true
 * if we are emulating VM-Entry into a guest with NPT enabled.
361 362 363 364
 */
static int nested_svm_load_cr3(struct kvm_vcpu *vcpu, unsigned long cr3,
			       bool nested_npt)
{
365
	if (kvm_vcpu_is_illegal_gpa(vcpu, cr3))
366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386
		return -EINVAL;

	if (!nested_npt && is_pae_paging(vcpu) &&
	    (cr3 != kvm_read_cr3(vcpu) || pdptrs_changed(vcpu))) {
		if (!load_pdptrs(vcpu, vcpu->arch.walk_mmu, cr3))
			return -EINVAL;
	}

	/*
	 * TODO: optimize unconditional TLB flush/MMU sync here and in
	 * kvm_init_shadow_npt_mmu().
	 */
	if (!nested_npt)
		kvm_mmu_new_pgd(vcpu, cr3, false, false);

	vcpu->arch.cr3 = cr3;
	kvm_register_mark_available(vcpu, VCPU_EXREG_CR3);

	kvm_init_mmu(vcpu, false);

	return 0;
387 388
}

389 390 391 392 393 394 395 396 397
void nested_vmcb02_compute_g_pat(struct vcpu_svm *svm)
{
	if (!svm->nested.vmcb02.ptr)
		return;

	/* FIXME: merge g_pat from vmcb01 and vmcb12.  */
	svm->nested.vmcb02.ptr->save.g_pat = svm->vmcb01.ptr->save.g_pat;
}

398
static void nested_vmcb02_prepare_save(struct vcpu_svm *svm, struct vmcb *vmcb12)
399
{
400 401
	nested_vmcb02_compute_g_pat(svm);

402
	/* Load the nested guest state */
403 404 405 406
	svm->vmcb->save.es = vmcb12->save.es;
	svm->vmcb->save.cs = vmcb12->save.cs;
	svm->vmcb->save.ss = vmcb12->save.ss;
	svm->vmcb->save.ds = vmcb12->save.ds;
407 408 409
	svm->vmcb->save.cpl = vmcb12->save.cpl;
	vmcb_mark_dirty(svm->vmcb, VMCB_SEG);

410 411
	svm->vmcb->save.gdtr = vmcb12->save.gdtr;
	svm->vmcb->save.idtr = vmcb12->save.idtr;
412 413
	vmcb_mark_dirty(svm->vmcb, VMCB_DT);

P
Paolo Bonzini 已提交
414
	kvm_set_rflags(&svm->vcpu, vmcb12->save.rflags | X86_EFLAGS_FIXED);
415 416 417
	svm_set_efer(&svm->vcpu, vmcb12->save.efer);
	svm_set_cr0(&svm->vcpu, vmcb12->save.cr0);
	svm_set_cr4(&svm->vcpu, vmcb12->save.cr4);
418 419

	svm->vcpu.arch.cr2 = vmcb12->save.cr2;
420 421 422
	kvm_rax_write(&svm->vcpu, vmcb12->save.rax);
	kvm_rsp_write(&svm->vcpu, vmcb12->save.rsp);
	kvm_rip_write(&svm->vcpu, vmcb12->save.rip);
423 424

	/* In case we don't even reach vcpu_run, the fields are not updated */
425
	svm->vmcb->save.cr2 = svm->vcpu.arch.cr2;
426 427 428
	svm->vmcb->save.rax = vmcb12->save.rax;
	svm->vmcb->save.rsp = vmcb12->save.rsp;
	svm->vmcb->save.rip = vmcb12->save.rip;
429

P
Paolo Bonzini 已提交
430
	svm->vmcb->save.dr7 = vmcb12->save.dr7 | DR7_FIXED_1;
431
	svm->vcpu.arch.dr6  = vmcb12->save.dr6 | DR6_ACTIVE_LOW;
432
	vmcb_mark_dirty(svm->vmcb, VMCB_DR);
433
}
434

435
static void nested_vmcb02_prepare_control(struct vcpu_svm *svm)
436
{
437
	const u32 mask = V_INTR_MASKING_MASK | V_GIF_ENABLE_MASK | V_GIF_MASK;
438

439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458
	/*
	 * Filled at exit: exit_code, exit_code_hi, exit_info_1, exit_info_2,
	 * exit_int_info, exit_int_info_err, next_rip, insn_len, insn_bytes.
	 */

	/*
	 * Also covers avic_vapic_bar, avic_backing_page, avic_logical_id,
	 * avic_physical_id.
	 */
	WARN_ON(svm->vmcb01.ptr->control.int_ctl & AVIC_ENABLE_MASK);

	/* Copied from vmcb01.  msrpm_base can be overwritten later.  */
	svm->vmcb->control.nested_ctl = svm->vmcb01.ptr->control.nested_ctl;
	svm->vmcb->control.iopm_base_pa = svm->vmcb01.ptr->control.iopm_base_pa;
	svm->vmcb->control.msrpm_base_pa = svm->vmcb01.ptr->control.msrpm_base_pa;

	/* Done at vmrun: asid.  */

	/* Also overwritten later if necessary.  */
	svm->vmcb->control.tlb_ctl = TLB_CONTROL_DO_NOTHING;
459

460
	/* nested_cr3.  */
461
	if (nested_npt_enabled(svm))
462 463
		nested_svm_init_mmu_context(&svm->vcpu);

464
	svm->vmcb->control.tsc_offset = svm->vcpu.arch.tsc_offset =
465
		svm->vcpu.arch.l1_tsc_offset + svm->nested.ctl.tsc_offset;
466

467 468
	svm->vmcb->control.int_ctl             =
		(svm->nested.ctl.int_ctl & ~mask) |
469
		(svm->vmcb01.ptr->control.int_ctl & mask);
470

471 472 473 474 475
	svm->vmcb->control.virt_ext            = svm->nested.ctl.virt_ext;
	svm->vmcb->control.int_vector          = svm->nested.ctl.int_vector;
	svm->vmcb->control.int_state           = svm->nested.ctl.int_state;
	svm->vmcb->control.event_inj           = svm->nested.ctl.event_inj;
	svm->vmcb->control.event_inj_err       = svm->nested.ctl.event_inj_err;
476

477 478
	svm->vmcb->control.pause_filter_count  = svm->nested.ctl.pause_filter_count;
	svm->vmcb->control.pause_filter_thresh = svm->nested.ctl.pause_filter_thresh;
479 480 481 482 483

	/* Enter Guest-Mode */
	enter_guest_mode(&svm->vcpu);

	/*
484 485
	 * Merge guest and host intercepts - must be called with vcpu in
	 * guest-mode to take effect.
486 487
	 */
	recalc_intercepts(svm);
488 489
}

490 491
int enter_svm_guest_mode(struct vcpu_svm *svm, u64 vmcb12_gpa,
			 struct vmcb *vmcb12)
492
{
493 494
	int ret;

495 496 497 498 499 500 501 502 503 504 505 506 507 508
	trace_kvm_nested_vmrun(svm->vmcb->save.rip, vmcb12_gpa,
			       vmcb12->save.rip,
			       vmcb12->control.int_ctl,
			       vmcb12->control.event_inj,
			       vmcb12->control.nested_ctl);

	trace_kvm_nested_intercepts(vmcb12->control.intercepts[INTERCEPT_CR] & 0xffff,
				    vmcb12->control.intercepts[INTERCEPT_CR] >> 16,
				    vmcb12->control.intercepts[INTERCEPT_EXCEPTION],
				    vmcb12->control.intercepts[INTERCEPT_WORD3],
				    vmcb12->control.intercepts[INTERCEPT_WORD4],
				    vmcb12->control.intercepts[INTERCEPT_WORD5]);


509
	svm->nested.vmcb12_gpa = vmcb12_gpa;
510 511 512 513

	WARN_ON(svm->vmcb == svm->nested.vmcb02.ptr);

	nested_svm_vmloadsave(svm->vmcb01.ptr, svm->nested.vmcb02.ptr);
514
	nested_load_control_from_vmcb12(svm, &vmcb12->control);
515 516

	svm_switch_vmcb(svm, &svm->nested.vmcb02);
517 518
	nested_vmcb02_prepare_control(svm);
	nested_vmcb02_prepare_save(svm, vmcb12);
519

520
	ret = nested_svm_load_cr3(&svm->vcpu, vmcb12->save.cr3,
521 522 523 524
				  nested_npt_enabled(svm));
	if (ret)
		return ret;

525 526 527
	if (!npt_enabled)
		svm->vcpu.arch.mmu->inject_page_fault = svm_inject_page_fault_nested;

P
Paolo Bonzini 已提交
528
	svm_set_gif(svm, true);
529 530

	return 0;
531 532 533 534 535
}

int nested_svm_vmrun(struct vcpu_svm *svm)
{
	int ret;
536
	struct vmcb *vmcb12;
537
	struct kvm_host_map map;
538
	u64 vmcb12_gpa;
539

540 541
	++svm->vcpu.stat.nested_run;

542 543 544 545
	if (is_smm(&svm->vcpu)) {
		kvm_queue_exception(&svm->vcpu, UD_VECTOR);
		return 1;
	}
546

547 548
	vmcb12_gpa = svm->vmcb->save.rax;
	ret = kvm_vcpu_map(&svm->vcpu, gpa_to_gfn(vmcb12_gpa), &map);
549 550 551 552 553 554 555 556 557
	if (ret == -EINVAL) {
		kvm_inject_gp(&svm->vcpu, 0);
		return 1;
	} else if (ret) {
		return kvm_skip_emulated_instruction(&svm->vcpu);
	}

	ret = kvm_skip_emulated_instruction(&svm->vcpu);

558
	vmcb12 = map.hva;
559

560 561 562
	if (WARN_ON_ONCE(!svm->nested.initialized))
		return -EINVAL;

563 564 565 566 567
	if (!nested_vmcb_checks(svm, vmcb12)) {
		vmcb12->control.exit_code    = SVM_EXIT_ERR;
		vmcb12->control.exit_code_hi = 0;
		vmcb12->control.exit_info_1  = 0;
		vmcb12->control.exit_info_2  = 0;
568
		goto out;
569 570 571 572 573 574 575 576
	}


	/* Clear internal status */
	kvm_clear_exception_queue(&svm->vcpu);
	kvm_clear_interrupt_queue(&svm->vcpu);

	/*
577 578
	 * Since vmcb01 is not in use, we can use it to store some of the L1
	 * state.
579
	 */
580 581 582 583 584 585 586 587
	svm->vmcb01.ptr->save.efer   = svm->vcpu.arch.efer;
	svm->vmcb01.ptr->save.cr0    = kvm_read_cr0(&svm->vcpu);
	svm->vmcb01.ptr->save.cr4    = svm->vcpu.arch.cr4;
	svm->vmcb01.ptr->save.rflags = kvm_get_rflags(&svm->vcpu);
	svm->vmcb01.ptr->save.rip    = kvm_rip_read(&svm->vcpu);

	if (!npt_enabled)
		svm->vmcb01.ptr->save.cr3 = kvm_read_cr3(&svm->vcpu);
588

589
	svm->nested.nested_run_pending = 1;
590

591
	if (enter_svm_guest_mode(svm, vmcb12_gpa, vmcb12))
592
		goto out_exit_err;
593

594 595
	if (nested_svm_vmrun_msrpm(svm))
		goto out;
596

597 598 599 600 601 602 603 604 605
out_exit_err:
	svm->nested.nested_run_pending = 0;

	svm->vmcb->control.exit_code    = SVM_EXIT_ERR;
	svm->vmcb->control.exit_code_hi = 0;
	svm->vmcb->control.exit_info_1  = 0;
	svm->vmcb->control.exit_info_2  = 0;

	nested_svm_vmexit(svm);
606

607 608 609
out:
	kvm_vcpu_unmap(&svm->vcpu, &map, true);

610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631
	return ret;
}

void nested_svm_vmloadsave(struct vmcb *from_vmcb, struct vmcb *to_vmcb)
{
	to_vmcb->save.fs = from_vmcb->save.fs;
	to_vmcb->save.gs = from_vmcb->save.gs;
	to_vmcb->save.tr = from_vmcb->save.tr;
	to_vmcb->save.ldtr = from_vmcb->save.ldtr;
	to_vmcb->save.kernel_gs_base = from_vmcb->save.kernel_gs_base;
	to_vmcb->save.star = from_vmcb->save.star;
	to_vmcb->save.lstar = from_vmcb->save.lstar;
	to_vmcb->save.cstar = from_vmcb->save.cstar;
	to_vmcb->save.sfmask = from_vmcb->save.sfmask;
	to_vmcb->save.sysenter_cs = from_vmcb->save.sysenter_cs;
	to_vmcb->save.sysenter_esp = from_vmcb->save.sysenter_esp;
	to_vmcb->save.sysenter_eip = from_vmcb->save.sysenter_eip;
}

int nested_svm_vmexit(struct vcpu_svm *svm)
{
	int rc;
632
	struct vmcb *vmcb12;
633 634 635
	struct vmcb *vmcb = svm->vmcb;
	struct kvm_host_map map;

636
	rc = kvm_vcpu_map(&svm->vcpu, gpa_to_gfn(svm->nested.vmcb12_gpa), &map);
637 638 639 640 641 642
	if (rc) {
		if (rc == -EINVAL)
			kvm_inject_gp(&svm->vcpu, 0);
		return 1;
	}

643
	vmcb12 = map.hva;
644 645 646

	/* Exit Guest-Mode */
	leave_guest_mode(&svm->vcpu);
647
	svm->nested.vmcb12_gpa = 0;
648
	WARN_ON_ONCE(svm->nested.nested_run_pending);
649

650 651
	kvm_clear_request(KVM_REQ_GET_NESTED_STATE_PAGES, &svm->vcpu);

652 653 654
	/* in case we halted in L2 */
	svm->vcpu.arch.mp_state = KVM_MP_STATE_RUNNABLE;

655 656
	/* Give the current vmcb to the guest */

657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682
	vmcb12->save.es     = vmcb->save.es;
	vmcb12->save.cs     = vmcb->save.cs;
	vmcb12->save.ss     = vmcb->save.ss;
	vmcb12->save.ds     = vmcb->save.ds;
	vmcb12->save.gdtr   = vmcb->save.gdtr;
	vmcb12->save.idtr   = vmcb->save.idtr;
	vmcb12->save.efer   = svm->vcpu.arch.efer;
	vmcb12->save.cr0    = kvm_read_cr0(&svm->vcpu);
	vmcb12->save.cr3    = kvm_read_cr3(&svm->vcpu);
	vmcb12->save.cr2    = vmcb->save.cr2;
	vmcb12->save.cr4    = svm->vcpu.arch.cr4;
	vmcb12->save.rflags = kvm_get_rflags(&svm->vcpu);
	vmcb12->save.rip    = kvm_rip_read(&svm->vcpu);
	vmcb12->save.rsp    = kvm_rsp_read(&svm->vcpu);
	vmcb12->save.rax    = kvm_rax_read(&svm->vcpu);
	vmcb12->save.dr7    = vmcb->save.dr7;
	vmcb12->save.dr6    = svm->vcpu.arch.dr6;
	vmcb12->save.cpl    = vmcb->save.cpl;

	vmcb12->control.int_state         = vmcb->control.int_state;
	vmcb12->control.exit_code         = vmcb->control.exit_code;
	vmcb12->control.exit_code_hi      = vmcb->control.exit_code_hi;
	vmcb12->control.exit_info_1       = vmcb->control.exit_info_1;
	vmcb12->control.exit_info_2       = vmcb->control.exit_info_2;

	if (vmcb12->control.exit_code != SVM_EXIT_ERR)
683
		nested_save_pending_event_to_vmcb12(svm, vmcb12);
684 685

	if (svm->nrips_enabled)
686
		vmcb12->control.next_rip  = vmcb->control.next_rip;
687

688 689 690 691
	vmcb12->control.int_ctl           = svm->nested.ctl.int_ctl;
	vmcb12->control.tlb_ctl           = svm->nested.ctl.tlb_ctl;
	vmcb12->control.event_inj         = svm->nested.ctl.event_inj;
	vmcb12->control.event_inj_err     = svm->nested.ctl.event_inj_err;
692

693
	vmcb12->control.pause_filter_count =
694
		svm->vmcb->control.pause_filter_count;
695
	vmcb12->control.pause_filter_thresh =
696 697
		svm->vmcb->control.pause_filter_thresh;

698 699 700
	nested_svm_vmloadsave(svm->nested.vmcb02.ptr, svm->vmcb01.ptr);

	svm_switch_vmcb(svm, &svm->vmcb01);
701

702 703 704 705
	/*
	 * On vmexit the  GIF is set to false and
	 * no event can be injected in L1.
	 */
706
	svm_set_gif(svm, false);
707
	svm->vmcb->control.exit_int_info = 0;
708

709 710 711 712 713
	svm->vcpu.arch.tsc_offset = svm->vcpu.arch.l1_tsc_offset;
	if (svm->vmcb->control.tsc_offset != svm->vcpu.arch.tsc_offset) {
		svm->vmcb->control.tsc_offset = svm->vcpu.arch.tsc_offset;
		vmcb_mark_dirty(svm->vmcb, VMCB_INTERCEPTS);
	}
714

715
	svm->nested.ctl.nested_cr3 = 0;
716

717 718 719
	/*
	 * Restore processor state that had been saved in vmcb01
	 */
720
	kvm_set_rflags(&svm->vcpu, svm->vmcb->save.rflags);
721 722 723 724 725 726 727 728 729
	svm_set_efer(&svm->vcpu, svm->vmcb->save.efer);
	svm_set_cr0(&svm->vcpu, svm->vmcb->save.cr0 | X86_CR0_PE);
	svm_set_cr4(&svm->vcpu, svm->vmcb->save.cr4);
	kvm_rax_write(&svm->vcpu, svm->vmcb->save.rax);
	kvm_rsp_write(&svm->vcpu, svm->vmcb->save.rsp);
	kvm_rip_write(&svm->vcpu, svm->vmcb->save.rip);

	svm->vcpu.arch.dr7 = DR7_FIXED_1;
	kvm_update_dr7(&svm->vcpu);
730

731 732 733 734 735
	trace_kvm_nested_vmexit_inject(vmcb12->control.exit_code,
				       vmcb12->control.exit_info_1,
				       vmcb12->control.exit_info_2,
				       vmcb12->control.exit_int_info,
				       vmcb12->control.exit_int_info_err,
736 737
				       KVM_ISA_SVM);

738 739 740
	kvm_vcpu_unmap(&svm->vcpu, &map, true);

	nested_svm_uninit_mmu_context(&svm->vcpu);
741

742
	rc = nested_svm_load_cr3(&svm->vcpu, svm->vmcb->save.cr3, false);
743 744
	if (rc)
		return 1;
745

746 747 748 749 750 751 752 753 754 755 756
	/*
	 * Drop what we picked up for L2 via svm_complete_interrupts() so it
	 * doesn't end up in L1.
	 */
	svm->vcpu.arch.nmi_injected = false;
	kvm_clear_exception_queue(&svm->vcpu);
	kvm_clear_interrupt_queue(&svm->vcpu);

	return 0;
}

757 758
int svm_allocate_nested(struct vcpu_svm *svm)
{
759
	struct page *vmcb02_page;
760 761 762 763

	if (svm->nested.initialized)
		return 0;

764 765
	vmcb02_page = alloc_page(GFP_KERNEL_ACCOUNT | __GFP_ZERO);
	if (!vmcb02_page)
766
		return -ENOMEM;
767 768
	svm->nested.vmcb02.ptr = page_address(vmcb02_page);
	svm->nested.vmcb02.pa = __sme_set(page_to_pfn(vmcb02_page) << PAGE_SHIFT);
769 770 771

	svm->nested.msrpm = svm_vcpu_alloc_msrpm();
	if (!svm->nested.msrpm)
772
		goto err_free_vmcb02;
773 774 775 776 777
	svm_vcpu_init_msrpm(&svm->vcpu, svm->nested.msrpm);

	svm->nested.initialized = true;
	return 0;

778 779
err_free_vmcb02:
	__free_page(vmcb02_page);
780 781 782 783 784 785 786 787 788 789 790
	return -ENOMEM;
}

void svm_free_nested(struct vcpu_svm *svm)
{
	if (!svm->nested.initialized)
		return;

	svm_vcpu_free_msrpm(svm->nested.msrpm);
	svm->nested.msrpm = NULL;

791 792
	__free_page(virt_to_page(svm->nested.vmcb02.ptr));
	svm->nested.vmcb02.ptr = NULL;
793 794 795 796

	svm->nested.initialized = false;
}

797 798 799 800 801 802 803 804
/*
 * Forcibly leave nested mode in order to be able to reset the VCPU later on.
 */
void svm_leave_nested(struct vcpu_svm *svm)
{
	if (is_guest_mode(&svm->vcpu)) {
		svm->nested.nested_run_pending = 0;
		leave_guest_mode(&svm->vcpu);
805 806 807

		svm_switch_vmcb(svm, &svm->nested.vmcb02);

808
		nested_svm_uninit_mmu_context(&svm->vcpu);
809
		vmcb_mark_all_dirty(svm->vmcb);
810
	}
811 812

	kvm_clear_request(KVM_REQ_GET_NESTED_STATE_PAGES, &svm->vcpu);
813 814
}

815 816 817 818 819
static int nested_svm_exit_handled_msr(struct vcpu_svm *svm)
{
	u32 offset, msr, value;
	int write, mask;

820
	if (!(vmcb_is_intercept(&svm->nested.ctl, INTERCEPT_MSR_PROT)))
821 822 823 824 825 826 827 828 829 830 831 832 833
		return NESTED_EXIT_HOST;

	msr    = svm->vcpu.arch.regs[VCPU_REGS_RCX];
	offset = svm_msrpm_offset(msr);
	write  = svm->vmcb->control.exit_info_1 & 1;
	mask   = 1 << ((2 * (msr & 0xf)) + write);

	if (offset == MSR_INVALID)
		return NESTED_EXIT_DONE;

	/* Offset is in 32 bit units but need in 8 bit units */
	offset *= 4;

834
	if (kvm_vcpu_read_guest(&svm->vcpu, svm->nested.ctl.msrpm_base_pa + offset, &value, 4))
835 836 837 838 839 840 841 842 843 844 845 846
		return NESTED_EXIT_DONE;

	return (value & mask) ? NESTED_EXIT_DONE : NESTED_EXIT_HOST;
}

static int nested_svm_intercept_ioio(struct vcpu_svm *svm)
{
	unsigned port, size, iopm_len;
	u16 val, mask;
	u8 start_bit;
	u64 gpa;

847
	if (!(vmcb_is_intercept(&svm->nested.ctl, INTERCEPT_IOIO_PROT)))
848 849 850 851 852
		return NESTED_EXIT_HOST;

	port = svm->vmcb->control.exit_info_1 >> 16;
	size = (svm->vmcb->control.exit_info_1 & SVM_IOIO_SIZE_MASK) >>
		SVM_IOIO_SIZE_SHIFT;
853
	gpa  = svm->nested.ctl.iopm_base_pa + (port / 8);
854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877
	start_bit = port % 8;
	iopm_len = (start_bit + size > 8) ? 2 : 1;
	mask = (0xf >> (4 - size)) << start_bit;
	val = 0;

	if (kvm_vcpu_read_guest(&svm->vcpu, gpa, &val, iopm_len))
		return NESTED_EXIT_DONE;

	return (val & mask) ? NESTED_EXIT_DONE : NESTED_EXIT_HOST;
}

static int nested_svm_intercept(struct vcpu_svm *svm)
{
	u32 exit_code = svm->vmcb->control.exit_code;
	int vmexit = NESTED_EXIT_HOST;

	switch (exit_code) {
	case SVM_EXIT_MSR:
		vmexit = nested_svm_exit_handled_msr(svm);
		break;
	case SVM_EXIT_IOIO:
		vmexit = nested_svm_intercept_ioio(svm);
		break;
	case SVM_EXIT_READ_CR0 ... SVM_EXIT_WRITE_CR8: {
878
		if (vmcb_is_intercept(&svm->nested.ctl, exit_code))
879 880 881 882
			vmexit = NESTED_EXIT_DONE;
		break;
	}
	case SVM_EXIT_READ_DR0 ... SVM_EXIT_WRITE_DR7: {
883
		if (vmcb_is_intercept(&svm->nested.ctl, exit_code))
884 885 886 887
			vmexit = NESTED_EXIT_DONE;
		break;
	}
	case SVM_EXIT_EXCP_BASE ... SVM_EXIT_EXCP_BASE + 0x1f: {
888 889 890 891 892 893
		/*
		 * Host-intercepted exceptions have been checked already in
		 * nested_svm_exit_special.  There is nothing to do here,
		 * the vmexit is injected by svm_check_nested_events.
		 */
		vmexit = NESTED_EXIT_DONE;
894 895 896 897 898 899 900
		break;
	}
	case SVM_EXIT_ERR: {
		vmexit = NESTED_EXIT_DONE;
		break;
	}
	default: {
901
		if (vmcb_is_intercept(&svm->nested.ctl, exit_code))
902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936
			vmexit = NESTED_EXIT_DONE;
	}
	}

	return vmexit;
}

int nested_svm_exit_handled(struct vcpu_svm *svm)
{
	int vmexit;

	vmexit = nested_svm_intercept(svm);

	if (vmexit == NESTED_EXIT_DONE)
		nested_svm_vmexit(svm);

	return vmexit;
}

int nested_svm_check_permissions(struct vcpu_svm *svm)
{
	if (!(svm->vcpu.arch.efer & EFER_SVME) ||
	    !is_paging(&svm->vcpu)) {
		kvm_queue_exception(&svm->vcpu, UD_VECTOR);
		return 1;
	}

	if (svm->vmcb->save.cpl) {
		kvm_inject_gp(&svm->vcpu, 0);
		return 1;
	}

	return 0;
}

937
static bool nested_exit_on_exception(struct vcpu_svm *svm)
938
{
939
	unsigned int nr = svm->vcpu.arch.exception.nr;
940

941
	return (svm->nested.ctl.intercepts[INTERCEPT_EXCEPTION] & BIT(nr));
942
}
943

944 945 946
static void nested_svm_inject_exception_vmexit(struct vcpu_svm *svm)
{
	unsigned int nr = svm->vcpu.arch.exception.nr;
947 948 949

	svm->vmcb->control.exit_code = SVM_EXIT_EXCP_BASE + nr;
	svm->vmcb->control.exit_code_hi = 0;
950 951 952

	if (svm->vcpu.arch.exception.has_error_code)
		svm->vmcb->control.exit_info_1 = svm->vcpu.arch.exception.error_code;
953 954 955 956 957

	/*
	 * EXITINFO2 is undefined for all exception intercepts other
	 * than #PF.
	 */
958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973
	if (nr == PF_VECTOR) {
		if (svm->vcpu.arch.exception.nested_apf)
			svm->vmcb->control.exit_info_2 = svm->vcpu.arch.apf.nested_apf_token;
		else if (svm->vcpu.arch.exception.has_payload)
			svm->vmcb->control.exit_info_2 = svm->vcpu.arch.exception.payload;
		else
			svm->vmcb->control.exit_info_2 = svm->vcpu.arch.cr2;
	} else if (nr == DB_VECTOR) {
		/* See inject_pending_event.  */
		kvm_deliver_exception_payload(&svm->vcpu);
		if (svm->vcpu.arch.dr7 & DR7_GD) {
			svm->vcpu.arch.dr7 &= ~DR7_GD;
			kvm_update_dr7(&svm->vcpu);
		}
	} else
		WARN_ON(svm->vcpu.arch.exception.has_payload);
974

975
	nested_svm_vmexit(svm);
976 977
}

978 979 980 981 982 983 984 985 986
static void nested_svm_smi(struct vcpu_svm *svm)
{
	svm->vmcb->control.exit_code = SVM_EXIT_SMI;
	svm->vmcb->control.exit_info_1 = 0;
	svm->vmcb->control.exit_info_2 = 0;

	nested_svm_vmexit(svm);
}

987 988 989 990 991 992 993 994 995
static void nested_svm_nmi(struct vcpu_svm *svm)
{
	svm->vmcb->control.exit_code = SVM_EXIT_NMI;
	svm->vmcb->control.exit_info_1 = 0;
	svm->vmcb->control.exit_info_2 = 0;

	nested_svm_vmexit(svm);
}

996 997
static void nested_svm_intr(struct vcpu_svm *svm)
{
998 999
	trace_kvm_nested_intr_vmexit(svm->vmcb->save.rip);

1000 1001 1002 1003
	svm->vmcb->control.exit_code   = SVM_EXIT_INTR;
	svm->vmcb->control.exit_info_1 = 0;
	svm->vmcb->control.exit_info_2 = 0;

1004
	nested_svm_vmexit(svm);
1005 1006
}

1007 1008
static inline bool nested_exit_on_init(struct vcpu_svm *svm)
{
1009
	return vmcb_is_intercept(&svm->nested.ctl, INTERCEPT_INIT);
1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021
}

static void nested_svm_init(struct vcpu_svm *svm)
{
	svm->vmcb->control.exit_code   = SVM_EXIT_INIT;
	svm->vmcb->control.exit_info_1 = 0;
	svm->vmcb->control.exit_info_2 = 0;

	nested_svm_vmexit(svm);
}


1022
static int svm_check_nested_events(struct kvm_vcpu *vcpu)
1023 1024 1025
{
	struct vcpu_svm *svm = to_svm(vcpu);
	bool block_nested_events =
P
Paolo Bonzini 已提交
1026
		kvm_event_needs_reinjection(vcpu) || svm->nested.nested_run_pending;
1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037
	struct kvm_lapic *apic = vcpu->arch.apic;

	if (lapic_in_kernel(vcpu) &&
	    test_bit(KVM_APIC_INIT, &apic->pending_events)) {
		if (block_nested_events)
			return -EBUSY;
		if (!nested_exit_on_init(svm))
			return 0;
		nested_svm_init(svm);
		return 0;
	}
1038

1039 1040 1041 1042 1043 1044 1045 1046 1047
	if (vcpu->arch.exception.pending) {
		if (block_nested_events)
                        return -EBUSY;
		if (!nested_exit_on_exception(svm))
			return 0;
		nested_svm_inject_exception_vmexit(svm);
		return 0;
	}

1048
	if (vcpu->arch.smi_pending && !svm_smi_blocked(vcpu)) {
1049 1050
		if (block_nested_events)
			return -EBUSY;
1051 1052
		if (!nested_exit_on_smi(svm))
			return 0;
1053 1054 1055 1056
		nested_svm_smi(svm);
		return 0;
	}

1057
	if (vcpu->arch.nmi_pending && !svm_nmi_blocked(vcpu)) {
1058 1059
		if (block_nested_events)
			return -EBUSY;
1060 1061
		if (!nested_exit_on_nmi(svm))
			return 0;
1062 1063 1064 1065
		nested_svm_nmi(svm);
		return 0;
	}

1066
	if (kvm_cpu_has_interrupt(vcpu) && !svm_interrupt_blocked(vcpu)) {
1067 1068
		if (block_nested_events)
			return -EBUSY;
1069 1070
		if (!nested_exit_on_intr(svm))
			return 0;
1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085
		nested_svm_intr(svm);
		return 0;
	}

	return 0;
}

int nested_svm_exit_special(struct vcpu_svm *svm)
{
	u32 exit_code = svm->vmcb->control.exit_code;

	switch (exit_code) {
	case SVM_EXIT_INTR:
	case SVM_EXIT_NMI:
	case SVM_EXIT_NPF:
1086 1087 1088 1089
		return NESTED_EXIT_HOST;
	case SVM_EXIT_EXCP_BASE ... SVM_EXIT_EXCP_BASE + 0x1f: {
		u32 excp_bits = 1 << (exit_code - SVM_EXIT_EXCP_BASE);

1090 1091
		if (svm->vmcb01.ptr->control.intercepts[INTERCEPT_EXCEPTION] &
		    excp_bits)
1092
			return NESTED_EXIT_HOST;
1093
		else if (exit_code == SVM_EXIT_EXCP_BASE + PF_VECTOR &&
1094
			 svm->vcpu.arch.apf.host_apf_flags)
1095
			/* Trap async PF even if not shadowing */
1096 1097
			return NESTED_EXIT_HOST;
		break;
1098
	}
1099 1100 1101 1102 1103 1104
	default:
		break;
	}

	return NESTED_EXIT_CONTINUE;
}
1105

1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128
static int svm_get_nested_state(struct kvm_vcpu *vcpu,
				struct kvm_nested_state __user *user_kvm_nested_state,
				u32 user_data_size)
{
	struct vcpu_svm *svm;
	struct kvm_nested_state kvm_state = {
		.flags = 0,
		.format = KVM_STATE_NESTED_FORMAT_SVM,
		.size = sizeof(kvm_state),
	};
	struct vmcb __user *user_vmcb = (struct vmcb __user *)
		&user_kvm_nested_state->data.svm[0];

	if (!vcpu)
		return kvm_state.size + KVM_STATE_NESTED_SVM_VMCB_SIZE;

	svm = to_svm(vcpu);

	if (user_data_size < kvm_state.size)
		goto out;

	/* First fill in the header and copy it out.  */
	if (is_guest_mode(vcpu)) {
1129
		kvm_state.hdr.svm.vmcb_pa = svm->nested.vmcb12_gpa;
1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154
		kvm_state.size += KVM_STATE_NESTED_SVM_VMCB_SIZE;
		kvm_state.flags |= KVM_STATE_NESTED_GUEST_MODE;

		if (svm->nested.nested_run_pending)
			kvm_state.flags |= KVM_STATE_NESTED_RUN_PENDING;
	}

	if (gif_set(svm))
		kvm_state.flags |= KVM_STATE_NESTED_GIF_SET;

	if (copy_to_user(user_kvm_nested_state, &kvm_state, sizeof(kvm_state)))
		return -EFAULT;

	if (!is_guest_mode(vcpu))
		goto out;

	/*
	 * Copy over the full size of the VMCB rather than just the size
	 * of the structs.
	 */
	if (clear_user(user_vmcb, KVM_STATE_NESTED_SVM_VMCB_SIZE))
		return -EFAULT;
	if (copy_to_user(&user_vmcb->control, &svm->nested.ctl,
			 sizeof(user_vmcb->control)))
		return -EFAULT;
1155
	if (copy_to_user(&user_vmcb->save, &svm->vmcb01.ptr->save,
1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168
			 sizeof(user_vmcb->save)))
		return -EFAULT;
out:
	return kvm_state.size;
}

static int svm_set_nested_state(struct kvm_vcpu *vcpu,
				struct kvm_nested_state __user *user_kvm_nested_state,
				struct kvm_nested_state *kvm_state)
{
	struct vcpu_svm *svm = to_svm(vcpu);
	struct vmcb __user *user_vmcb = (struct vmcb __user *)
		&user_kvm_nested_state->data.svm[0];
1169 1170 1171
	struct vmcb_control_area *ctl;
	struct vmcb_save_area *save;
	int ret;
1172 1173
	u32 cr0;

1174 1175 1176
	BUILD_BUG_ON(sizeof(struct vmcb_control_area) + sizeof(struct vmcb_save_area) >
		     KVM_STATE_NESTED_SVM_VMCB_SIZE);

1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200
	if (kvm_state->format != KVM_STATE_NESTED_FORMAT_SVM)
		return -EINVAL;

	if (kvm_state->flags & ~(KVM_STATE_NESTED_GUEST_MODE |
				 KVM_STATE_NESTED_RUN_PENDING |
				 KVM_STATE_NESTED_GIF_SET))
		return -EINVAL;

	/*
	 * If in guest mode, vcpu->arch.efer actually refers to the L2 guest's
	 * EFER.SVME, but EFER.SVME still has to be 1 for VMRUN to succeed.
	 */
	if (!(vcpu->arch.efer & EFER_SVME)) {
		/* GIF=1 and no guest mode are required if SVME=0.  */
		if (kvm_state->flags != KVM_STATE_NESTED_GIF_SET)
			return -EINVAL;
	}

	/* SMM temporarily disables SVM, so we cannot be in guest mode.  */
	if (is_smm(vcpu) && (kvm_state->flags & KVM_STATE_NESTED_GUEST_MODE))
		return -EINVAL;

	if (!(kvm_state->flags & KVM_STATE_NESTED_GUEST_MODE)) {
		svm_leave_nested(svm);
1201 1202
		svm_set_gif(svm, !!(kvm_state->flags & KVM_STATE_NESTED_GIF_SET));
		return 0;
1203 1204 1205 1206 1207 1208 1209
	}

	if (!page_address_valid(vcpu, kvm_state->hdr.svm.vmcb_pa))
		return -EINVAL;
	if (kvm_state->size < sizeof(*kvm_state) + KVM_STATE_NESTED_SVM_VMCB_SIZE)
		return -EINVAL;

1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224
	ret  = -ENOMEM;
	ctl  = kzalloc(sizeof(*ctl),  GFP_KERNEL);
	save = kzalloc(sizeof(*save), GFP_KERNEL);
	if (!ctl || !save)
		goto out_free;

	ret = -EFAULT;
	if (copy_from_user(ctl, &user_vmcb->control, sizeof(*ctl)))
		goto out_free;
	if (copy_from_user(save, &user_vmcb->save, sizeof(*save)))
		goto out_free;

	ret = -EINVAL;
	if (!nested_vmcb_check_controls(ctl))
		goto out_free;
1225 1226 1227 1228 1229 1230 1231

	/*
	 * Processor state contains L2 state.  Check that it is
	 * valid for guest mode (see nested_vmcb_checks).
	 */
	cr0 = kvm_read_cr0(vcpu);
        if (((cr0 & X86_CR0_CD) == 0) && (cr0 & X86_CR0_NW))
1232
		goto out_free;
1233 1234 1235 1236 1237 1238

	/*
	 * Validate host state saved from before VMRUN (see
	 * nested_svm_check_permissions).
	 * TODO: validate reserved bits for all saved state.
	 */
1239 1240
	if (!(save->cr0 & X86_CR0_PG))
		goto out_free;
1241 1242

	/*
1243 1244 1245 1246
	 * All checks done, we can enter guest mode. Userspace provides
	 * vmcb12.control, which will be combined with L1 and stored into
	 * vmcb02, and the L1 save state which we store in vmcb01.
	 * L2 registers if needed are moved from the current VMCB to VMCB02.
1247
	 */
1248 1249 1250 1251

	svm->nested.nested_run_pending =
		!!(kvm_state->flags & KVM_STATE_NESTED_RUN_PENDING);

1252
	svm->nested.vmcb12_gpa = kvm_state->hdr.svm.vmcb_pa;
1253 1254
	if (svm->current_vmcb == &svm->vmcb01)
		svm->nested.vmcb02.ptr->save = svm->vmcb01.ptr->save;
1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271

	svm->vmcb01.ptr->save.es = save->es;
	svm->vmcb01.ptr->save.cs = save->cs;
	svm->vmcb01.ptr->save.ss = save->ss;
	svm->vmcb01.ptr->save.ds = save->ds;
	svm->vmcb01.ptr->save.gdtr = save->gdtr;
	svm->vmcb01.ptr->save.idtr = save->idtr;
	svm->vmcb01.ptr->save.rflags = save->rflags | X86_EFLAGS_FIXED;
	svm->vmcb01.ptr->save.efer = save->efer;
	svm->vmcb01.ptr->save.cr0 = save->cr0;
	svm->vmcb01.ptr->save.cr3 = save->cr3;
	svm->vmcb01.ptr->save.cr4 = save->cr4;
	svm->vmcb01.ptr->save.rax = save->rax;
	svm->vmcb01.ptr->save.rsp = save->rsp;
	svm->vmcb01.ptr->save.rip = save->rip;
	svm->vmcb01.ptr->save.cpl = 0;

1272
	nested_load_control_from_vmcb12(svm, ctl);
1273 1274 1275

	svm_switch_vmcb(svm, &svm->nested.vmcb02);

1276
	nested_vmcb02_prepare_control(svm);
1277

1278
	kvm_make_request(KVM_REQ_GET_NESTED_STATE_PAGES, vcpu);
1279 1280 1281 1282 1283 1284
	ret = 0;
out_free:
	kfree(save);
	kfree(ctl);

	return ret;
1285 1286
}

1287 1288
struct kvm_x86_nested_ops svm_nested_ops = {
	.check_events = svm_check_nested_events,
1289
	.get_nested_state_pages = svm_get_nested_state_pages,
1290 1291
	.get_state = svm_get_nested_state,
	.set_state = svm_set_nested_state,
1292
};