paging_tmpl.h 21.0 KB
Newer Older
A
Avi Kivity 已提交
1 2 3 4 5 6 7 8 9
/*
 * Kernel-based Virtual Machine driver for Linux
 *
 * This module enables machines with Intel VT-x extensions to run virtual
 * machines without emulation or binary translation.
 *
 * MMU support
 *
 * Copyright (C) 2006 Qumranet, Inc.
N
Nicolas Kaiser 已提交
10
 * Copyright 2010 Red Hat, Inc. and/or its affiliates.
A
Avi Kivity 已提交
11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30
 *
 * Authors:
 *   Yaniv Kamay  <yaniv@qumranet.com>
 *   Avi Kivity   <avi@qumranet.com>
 *
 * This work is licensed under the terms of the GNU GPL, version 2.  See
 * the COPYING file in the top-level directory.
 *
 */

/*
 * We need the mmu code to access both 32-bit and 64-bit guest ptes,
 * so the code in this file is compiled twice, once per pte size.
 */

#if PTTYPE == 64
	#define pt_element_t u64
	#define guest_walker guest_walker64
	#define FNAME(name) paging##64_##name
	#define PT_BASE_ADDR_MASK PT64_BASE_ADDR_MASK
31 32
	#define PT_LVL_ADDR_MASK(lvl) PT64_LVL_ADDR_MASK(lvl)
	#define PT_LVL_OFFSET_MASK(lvl) PT64_LVL_OFFSET_MASK(lvl)
A
Avi Kivity 已提交
33
	#define PT_INDEX(addr, level) PT64_INDEX(addr, level)
34
	#define PT_LEVEL_BITS PT64_LEVEL_BITS
35 36
	#ifdef CONFIG_X86_64
	#define PT_MAX_FULL_LEVELS 4
37
	#define CMPXCHG cmpxchg
38
	#else
39
	#define CMPXCHG cmpxchg64
40 41
	#define PT_MAX_FULL_LEVELS 2
	#endif
A
Avi Kivity 已提交
42 43 44 45 46
#elif PTTYPE == 32
	#define pt_element_t u32
	#define guest_walker guest_walker32
	#define FNAME(name) paging##32_##name
	#define PT_BASE_ADDR_MASK PT32_BASE_ADDR_MASK
47 48
	#define PT_LVL_ADDR_MASK(lvl) PT32_LVL_ADDR_MASK(lvl)
	#define PT_LVL_OFFSET_MASK(lvl) PT32_LVL_OFFSET_MASK(lvl)
A
Avi Kivity 已提交
49
	#define PT_INDEX(addr, level) PT32_INDEX(addr, level)
50
	#define PT_LEVEL_BITS PT32_LEVEL_BITS
51
	#define PT_MAX_FULL_LEVELS 2
52
	#define CMPXCHG cmpxchg
A
Avi Kivity 已提交
53 54 55 56
#else
	#error Invalid PTTYPE value
#endif

57 58
#define gpte_to_gfn_lvl FNAME(gpte_to_gfn_lvl)
#define gpte_to_gfn(pte) gpte_to_gfn_lvl((pte), PT_PAGE_TABLE_LEVEL)
59

A
Avi Kivity 已提交
60 61 62 63 64 65
/*
 * The guest_walker structure emulates the behavior of the hardware page
 * table walker.
 */
struct guest_walker {
	int level;
66
	gfn_t table_gfn[PT_MAX_FULL_LEVELS];
67
	pt_element_t ptes[PT_MAX_FULL_LEVELS];
68
	pt_element_t prefetch_ptes[PTE_PREFETCH_NUM];
69
	gpa_t pte_gpa[PT_MAX_FULL_LEVELS];
70 71
	unsigned pt_access;
	unsigned pte_access;
72
	gfn_t gfn;
73
	struct x86_exception fault;
A
Avi Kivity 已提交
74 75
};

76
static gfn_t gpte_to_gfn_lvl(pt_element_t gpte, int lvl)
77
{
78
	return (gpte & PT_LVL_ADDR_MASK(lvl)) >> PAGE_SHIFT;
79 80
}

81
static int FNAME(cmpxchg_gpte)(struct kvm_vcpu *vcpu, struct kvm_mmu *mmu,
82 83
			       pt_element_t __user *ptep_user, unsigned index,
			       pt_element_t orig_pte, pt_element_t new_pte)
84
{
85
	int npages;
86 87 88 89
	pt_element_t ret;
	pt_element_t *table;
	struct page *page;

90 91 92
	npages = get_user_pages_fast((unsigned long)ptep_user, 1, 1, &page);
	/* Check if the user is doing something meaningless. */
	if (unlikely(npages != 1))
93 94
		return -EFAULT;

95
	table = kmap_atomic(page);
96
	ret = CMPXCHG(&table[index], orig_pte, new_pte);
97
	kunmap_atomic(table);
98 99 100 101 102 103

	kvm_release_page_dirty(page);

	return (ret != orig_pte);
}

104 105
static unsigned FNAME(gpte_access)(struct kvm_vcpu *vcpu, pt_element_t gpte,
				   bool last)
106 107 108 109
{
	unsigned access;

	access = (gpte & (PT_WRITABLE_MASK | PT_USER_MASK)) | ACC_EXEC_MASK;
110 111 112
	if (last && !is_dirty_gpte(gpte))
		access &= ~ACC_WRITE_MASK;

113
#if PTTYPE == 64
114
	if (vcpu->arch.mmu.nx)
115 116 117 118 119
		access &= ~(gpte >> PT64_NX_SHIFT);
#endif
	return access;
}

120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137
static bool FNAME(is_last_gpte)(struct guest_walker *walker,
				struct kvm_vcpu *vcpu, struct kvm_mmu *mmu,
				pt_element_t gpte)
{
	if (walker->level == PT_PAGE_TABLE_LEVEL)
		return true;

	if ((walker->level == PT_DIRECTORY_LEVEL) && is_large_pte(gpte) &&
	    (PTTYPE == 64 || is_pse(vcpu)))
		return true;

	if ((walker->level == PT_PDPE_LEVEL) && is_large_pte(gpte) &&
	    (mmu->root_level == PT64_ROOT_LEVEL))
		return true;

	return false;
}

138 139 140
/*
 * Fetch a guest pte for a guest virtual address
 */
141 142
static int FNAME(walk_addr_generic)(struct guest_walker *walker,
				    struct kvm_vcpu *vcpu, struct kvm_mmu *mmu,
143
				    gva_t addr, u32 access)
A
Avi Kivity 已提交
144
{
145
	pt_element_t pte;
146
	pt_element_t __user *uninitialized_var(ptep_user);
147
	gfn_t table_gfn;
148
	unsigned index, pt_access, uninitialized_var(pte_access);
149
	gpa_t pte_gpa;
150
	bool eperm, last_gpte;
151 152 153 154 155
	int offset;
	const int write_fault = access & PFERR_WRITE_MASK;
	const int user_fault  = access & PFERR_USER_MASK;
	const int fetch_fault = access & PFERR_FETCH_MASK;
	u16 errcode = 0;
A
Avi Kivity 已提交
156

157
	trace_kvm_mmu_pagetable_walk(addr, access);
158
retry_walk:
159
	eperm = false;
160 161 162
	walker->level = mmu->root_level;
	pte           = mmu->get_cr3(vcpu);

163
#if PTTYPE == 64
164
	if (walker->level == PT32E_ROOT_LEVEL) {
165
		pte = mmu->get_pdptr(vcpu, (addr >> 30) & 3);
166
		trace_kvm_mmu_paging_element(pte, walker->level);
167
		if (!is_present_gpte(pte))
168
			goto error;
169 170 171
		--walker->level;
	}
#endif
A
Avi Kivity 已提交
172
	ASSERT((!is_long_mode(vcpu) && is_pae(vcpu)) ||
173
	       (mmu->get_cr3(vcpu) & CR3_NONPAE_RESERVED_BITS) == 0);
A
Avi Kivity 已提交
174

175
	pt_access = ACC_ALL;
176 177

	for (;;) {
178 179 180
		gfn_t real_gfn;
		unsigned long host_addr;

181
		index = PT_INDEX(addr, walker->level);
182

183
		table_gfn = gpte_to_gfn(pte);
184 185
		offset    = index * sizeof(pt_element_t);
		pte_gpa   = gfn_to_gpa(table_gfn) + offset;
186
		walker->table_gfn[walker->level - 1] = table_gfn;
187
		walker->pte_gpa[walker->level - 1] = pte_gpa;
188

189 190
		real_gfn = mmu->translate_gpa(vcpu, gfn_to_gpa(table_gfn),
					      PFERR_USER_MASK|PFERR_WRITE_MASK);
191 192
		if (unlikely(real_gfn == UNMAPPED_GVA))
			goto error;
193 194 195
		real_gfn = gpa_to_gfn(real_gfn);

		host_addr = gfn_to_hva(vcpu->kvm, real_gfn);
196 197
		if (unlikely(kvm_is_error_hva(host_addr)))
			goto error;
198 199

		ptep_user = (pt_element_t __user *)((void *)host_addr + offset);
200 201
		if (unlikely(__copy_from_user(&pte, ptep_user, sizeof(pte))))
			goto error;
202

203
		trace_kvm_mmu_paging_element(pte, walker->level);
204

205 206
		if (unlikely(!is_present_gpte(pte)))
			goto error;
207

208 209
		if (unlikely(is_rsvd_bits_set(&vcpu->arch.mmu, pte,
					      walker->level))) {
210 211
			errcode |= PFERR_RSVD_MASK | PFERR_PRESENT_MASK;
			goto error;
212
		}
213

214 215
		if (!check_write_user_access(vcpu, write_fault, user_fault,
					  pte))
216
			eperm = true;
217

218
#if PTTYPE == 64
219
		if (unlikely(fetch_fault && (pte & PT64_NX_MASK)))
220
			eperm = true;
221 222
#endif

223 224 225 226 227 228 229 230 231 232 233
		last_gpte = FNAME(is_last_gpte)(walker, vcpu, mmu, pte);
		if (last_gpte) {
			pte_access = pt_access &
				     FNAME(gpte_access)(vcpu, pte, true);
			/* check if the kernel is fetching from user page */
			if (unlikely(pte_access & PT_USER_MASK) &&
			    kvm_read_cr4_bits(vcpu, X86_CR4_SMEP))
				if (fetch_fault && !user_fault)
					eperm = true;
		}

234
		if (!eperm && unlikely(!(pte & PT_ACCESSED_MASK))) {
235
			int ret;
236 237
			trace_kvm_mmu_set_accessed_bit(table_gfn, index,
						       sizeof(pte));
238 239
			ret = FNAME(cmpxchg_gpte)(vcpu, mmu, ptep_user, index,
						  pte, pte|PT_ACCESSED_MASK);
240 241 242
			if (unlikely(ret < 0))
				goto error;
			else if (ret)
243
				goto retry_walk;
244

245
			mark_page_dirty(vcpu->kvm, table_gfn);
246
			pte |= PT_ACCESSED_MASK;
247
		}
248

249 250
		walker->ptes[walker->level - 1] = pte;

251
		if (last_gpte) {
252
			int lvl = walker->level;
253 254
			gpa_t real_gpa;
			gfn_t gfn;
255
			u32 ac;
256

257 258
			gfn = gpte_to_gfn_lvl(pte, lvl);
			gfn += (addr & PT_LVL_OFFSET_MASK(lvl)) >> PAGE_SHIFT;
259 260 261 262

			if (PTTYPE == 32 &&
			    walker->level == PT_DIRECTORY_LEVEL &&
			    is_cpuid_PSE36())
263 264
				gfn += pse36_gfn_delta(pte);

265
			ac = write_fault | fetch_fault | user_fault;
266 267

			real_gpa = mmu->translate_gpa(vcpu, gfn_to_gpa(gfn),
268
						      ac);
269 270 271 272
			if (real_gpa == UNMAPPED_GVA)
				return 0;

			walker->gfn = real_gpa >> PAGE_SHIFT;
273

274
			break;
275
		}
276

277
		pt_access &= FNAME(gpte_access)(vcpu, pte, false);
278 279
		--walker->level;
	}
280

281 282
	if (unlikely(eperm)) {
		errcode |= PFERR_PRESENT_MASK;
283
		goto error;
284
	}
285

286
	if (write_fault && unlikely(!is_dirty_gpte(pte))) {
287
		int ret;
288

289
		trace_kvm_mmu_set_dirty_bit(table_gfn, index, sizeof(pte));
290 291
		ret = FNAME(cmpxchg_gpte)(vcpu, mmu, ptep_user, index,
					  pte, pte|PT_DIRTY_MASK);
292
		if (unlikely(ret < 0))
293
			goto error;
294
		else if (ret)
295
			goto retry_walk;
296

297
		mark_page_dirty(vcpu->kvm, table_gfn);
298
		pte |= PT_DIRTY_MASK;
299
		walker->ptes[walker->level - 1] = pte;
300 301
	}

302 303 304
	walker->pt_access = pt_access;
	walker->pte_access = pte_access;
	pgprintk("%s: pte %llx pte_access %x pt_access %x\n",
305
		 __func__, (u64)pte, pte_access, pt_access);
306 307
	return 1;

308
error:
309
	errcode |= write_fault | user_fault;
310 311
	if (fetch_fault && (mmu->nx ||
			    kvm_read_cr4_bits(vcpu, X86_CR4_SMEP)))
312
		errcode |= PFERR_FETCH_MASK;
313

314 315 316
	walker->fault.vector = PF_VECTOR;
	walker->fault.error_code_valid = true;
	walker->fault.error_code = errcode;
317 318
	walker->fault.address = addr;
	walker->fault.nested_page_fault = mmu != vcpu->arch.walk_mmu;
319

320
	trace_kvm_mmu_walker_error(walker->fault.error_code);
321
	return 0;
A
Avi Kivity 已提交
322 323
}

324
static int FNAME(walk_addr)(struct guest_walker *walker,
325
			    struct kvm_vcpu *vcpu, gva_t addr, u32 access)
326 327
{
	return FNAME(walk_addr_generic)(walker, vcpu, &vcpu->arch.mmu, addr,
328
					access);
329 330
}

331 332
static int FNAME(walk_addr_nested)(struct guest_walker *walker,
				   struct kvm_vcpu *vcpu, gva_t addr,
333
				   u32 access)
334 335
{
	return FNAME(walk_addr_generic)(walker, vcpu, &vcpu->arch.nested_mmu,
336
					addr, access);
337 338
}

339 340 341 342 343 344 345
static bool FNAME(prefetch_invalid_gpte)(struct kvm_vcpu *vcpu,
				    struct kvm_mmu_page *sp, u64 *spte,
				    pt_element_t gpte)
{
	if (is_rsvd_bits_set(&vcpu->arch.mmu, gpte, PT_PAGE_TABLE_LEVEL))
		goto no_present;

346
	if (!is_present_gpte(gpte))
347 348 349 350 351 352 353 354
		goto no_present;

	if (!(gpte & PT_ACCESSED_MASK))
		goto no_present;

	return false;

no_present:
355
	drop_spte(vcpu->kvm, spte);
356 357 358
	return true;
}

359
static void FNAME(update_pte)(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp,
360
			      u64 *spte, const void *pte)
361 362
{
	pt_element_t gpte;
363
	unsigned pte_access;
364
	pfn_t pfn;
365 366

	gpte = *(const pt_element_t *)pte;
367
	if (FNAME(prefetch_invalid_gpte)(vcpu, sp, spte, gpte))
368
		return;
369

370
	pgprintk("%s: gpte %llx spte %p\n", __func__, (u64)gpte, spte);
371
	pte_access = sp->role.access & FNAME(gpte_access)(vcpu, gpte, true);
372
	pfn = gfn_to_pfn_atomic(vcpu->kvm, gpte_to_gfn(gpte));
373
	if (mmu_invalid_pfn(pfn))
374
		return;
375

376
	/*
L
Lucas De Marchi 已提交
377
	 * we call mmu_set_spte() with host_writable = true because that
378 379
	 * vcpu->arch.update_pte.pfn was fetched from get_user_pages(write = 1).
	 */
380
	mmu_set_spte(vcpu, spte, sp->role.access, pte_access, 0, 0,
381
		     NULL, PT_PAGE_TABLE_LEVEL,
382
		     gpte_to_gfn(gpte), pfn, true, true);
383 384
}

A
Avi Kivity 已提交
385 386 387 388
static bool FNAME(gpte_changed)(struct kvm_vcpu *vcpu,
				struct guest_walker *gw, int level)
{
	pt_element_t curr_pte;
389 390 391 392 393 394 395 396 397 398 399 400 401 402
	gpa_t base_gpa, pte_gpa = gw->pte_gpa[level - 1];
	u64 mask;
	int r, index;

	if (level == PT_PAGE_TABLE_LEVEL) {
		mask = PTE_PREFETCH_NUM * sizeof(pt_element_t) - 1;
		base_gpa = pte_gpa & ~mask;
		index = (pte_gpa - base_gpa) / sizeof(pt_element_t);

		r = kvm_read_guest_atomic(vcpu->kvm, base_gpa,
				gw->prefetch_ptes, sizeof(gw->prefetch_ptes));
		curr_pte = gw->prefetch_ptes[index];
	} else
		r = kvm_read_guest_atomic(vcpu->kvm, pte_gpa,
A
Avi Kivity 已提交
403
				  &curr_pte, sizeof(curr_pte));
404

A
Avi Kivity 已提交
405 406 407
	return r || curr_pte != gw->ptes[level - 1];
}

408 409
static void FNAME(pte_prefetch)(struct kvm_vcpu *vcpu, struct guest_walker *gw,
				u64 *sptep)
410 411
{
	struct kvm_mmu_page *sp;
412
	pt_element_t *gptep = gw->prefetch_ptes;
413
	u64 *spte;
414
	int i;
415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435

	sp = page_header(__pa(sptep));

	if (sp->role.level > PT_PAGE_TABLE_LEVEL)
		return;

	if (sp->role.direct)
		return __direct_pte_prefetch(vcpu, sp, sptep);

	i = (sptep - sp->spt) & ~(PTE_PREFETCH_NUM - 1);
	spte = sp->spt + i;

	for (i = 0; i < PTE_PREFETCH_NUM; i++, spte++) {
		pt_element_t gpte;
		unsigned pte_access;
		gfn_t gfn;
		pfn_t pfn;

		if (spte == sptep)
			continue;

436
		if (is_shadow_present_pte(*spte))
437 438 439 440
			continue;

		gpte = gptep[i];

441
		if (FNAME(prefetch_invalid_gpte)(vcpu, sp, spte, gpte))
442 443
			continue;

444 445
		pte_access = sp->role.access & FNAME(gpte_access)(vcpu, gpte,
								  true);
446 447
		gfn = gpte_to_gfn(gpte);
		pfn = pte_prefetch_gfn_to_pfn(vcpu, gfn,
448
				      pte_access & ACC_WRITE_MASK);
449
		if (mmu_invalid_pfn(pfn))
450 451 452
			break;

		mmu_set_spte(vcpu, spte, sp->role.access, pte_access, 0, 0,
453
			     NULL, PT_PAGE_TABLE_LEVEL, gfn,
454 455 456 457
			     pfn, true, true);
	}
}

A
Avi Kivity 已提交
458 459 460
/*
 * Fetch a shadow pte for a specific level in the paging hierarchy.
 */
461 462
static u64 *FNAME(fetch)(struct kvm_vcpu *vcpu, gva_t addr,
			 struct guest_walker *gw,
463
			 int user_fault, int write_fault, int hlevel,
464
			 int *emulate, pfn_t pfn, bool map_writable,
X
Xiao Guangrong 已提交
465
			 bool prefault)
A
Avi Kivity 已提交
466
{
467
	unsigned access = gw->pt_access;
468 469
	struct kvm_mmu_page *sp = NULL;
	int top_level;
470
	unsigned direct_access;
471
	struct kvm_shadow_walk_iterator it;
472

473
	if (!is_present_gpte(gw->ptes[gw->level - 1]))
474
		return NULL;
A
Avi Kivity 已提交
475

476
	direct_access = gw->pte_access;
477

478 479 480 481 482 483 484 485 486 487 488 489
	top_level = vcpu->arch.mmu.root_level;
	if (top_level == PT32E_ROOT_LEVEL)
		top_level = PT32_ROOT_LEVEL;
	/*
	 * Verify that the top-level gpte is still there.  Since the page
	 * is a root page, it is either write protected (and cannot be
	 * changed from now on) or it is invalid (in which case, we don't
	 * really care if it changes underneath us after this point).
	 */
	if (FNAME(gpte_changed)(vcpu, gw, top_level))
		goto out_gpte_changed;

490 491 492
	for (shadow_walk_init(&it, vcpu, addr);
	     shadow_walk_okay(&it) && it.level > gw->level;
	     shadow_walk_next(&it)) {
493 494
		gfn_t table_gfn;

495
		clear_sp_write_flooding_count(it.sptep);
496
		drop_large_spte(vcpu, it.sptep);
497

498
		sp = NULL;
499 500 501 502
		if (!is_shadow_present_pte(*it.sptep)) {
			table_gfn = gw->table_gfn[it.level - 2];
			sp = kvm_mmu_get_page(vcpu, table_gfn, addr, it.level-1,
					      false, access, it.sptep);
503
		}
504 505 506 507 508

		/*
		 * Verify that the gpte in the page we've just write
		 * protected is still there.
		 */
509
		if (FNAME(gpte_changed)(vcpu, gw, it.level - 1))
510
			goto out_gpte_changed;
511

512
		if (sp)
513
			link_shadow_page(it.sptep, sp);
514
	}
A
Avi Kivity 已提交
515

516
	for (;
517 518
	     shadow_walk_okay(&it) && it.level > hlevel;
	     shadow_walk_next(&it)) {
519 520
		gfn_t direct_gfn;

521
		clear_sp_write_flooding_count(it.sptep);
522
		validate_direct_spte(vcpu, it.sptep, direct_access);
523

524
		drop_large_spte(vcpu, it.sptep);
525

526
		if (is_shadow_present_pte(*it.sptep))
527 528
			continue;

529
		direct_gfn = gw->gfn & ~(KVM_PAGES_PER_HPAGE(it.level) - 1);
530

531 532 533
		sp = kvm_mmu_get_page(vcpu, direct_gfn, addr, it.level-1,
				      true, direct_access, it.sptep);
		link_shadow_page(it.sptep, sp);
534 535
	}

536
	clear_sp_write_flooding_count(it.sptep);
537
	mmu_set_spte(vcpu, it.sptep, access, gw->pte_access,
538
		     user_fault, write_fault, emulate, it.level,
X
Xiao Guangrong 已提交
539
		     gw->gfn, pfn, prefault, map_writable);
540
	FNAME(pte_prefetch)(vcpu, gw, it.sptep);
541

542
	return it.sptep;
543 544

out_gpte_changed:
545
	if (sp)
546
		kvm_mmu_put_page(sp, it.sptep);
547 548
	kvm_release_pfn_clean(pfn);
	return NULL;
A
Avi Kivity 已提交
549 550 551 552 553 554 555 556 557 558 559 560 561
}

/*
 * Page fault handler.  There are several causes for a page fault:
 *   - there is no shadow pte for the guest pte
 *   - write access through a shadow pte marked read only so that we can set
 *     the dirty bit
 *   - write access to a shadow pte marked read only so we can update the page
 *     dirty bitmap, when userspace requests it
 *   - mmio access; in this case we will never install a present shadow pte
 *   - normal guest page fault due to the guest pte marked not present, not
 *     writable, or not executable
 *
562 563
 *  Returns: 1 if we need to emulate the instruction, 0 otherwise, or
 *           a negative value on error.
A
Avi Kivity 已提交
564
 */
G
Gleb Natapov 已提交
565
static int FNAME(page_fault)(struct kvm_vcpu *vcpu, gva_t addr, u32 error_code,
566
			     bool prefault)
A
Avi Kivity 已提交
567 568 569 570
{
	int write_fault = error_code & PFERR_WRITE_MASK;
	int user_fault = error_code & PFERR_USER_MASK;
	struct guest_walker walker;
A
Avi Kivity 已提交
571
	u64 *sptep;
572
	int emulate = 0;
573
	int r;
574
	pfn_t pfn;
575
	int level = PT_PAGE_TABLE_LEVEL;
576
	int force_pt_level;
577
	unsigned long mmu_seq;
578
	bool map_writable;
A
Avi Kivity 已提交
579

580
	pgprintk("%s: addr %lx err %x\n", __func__, addr, error_code);
581

582 583 584 585
	if (unlikely(error_code & PFERR_RSVD_MASK))
		return handle_mmio_page_fault(vcpu, addr, error_code,
					      mmu_is_nested(vcpu));

586 587 588
	r = mmu_topup_memory_caches(vcpu);
	if (r)
		return r;
589

A
Avi Kivity 已提交
590
	/*
591
	 * Look up the guest pte for the faulting address.
A
Avi Kivity 已提交
592
	 */
593
	r = FNAME(walk_addr)(&walker, vcpu, addr, error_code);
A
Avi Kivity 已提交
594 595 596 597

	/*
	 * The page is not mapped by the guest.  Let the guest handle it.
	 */
598
	if (!r) {
599
		pgprintk("%s: guest page fault\n", __func__);
600
		if (!prefault)
X
Xiao Guangrong 已提交
601
			inject_page_fault(vcpu, &walker.fault);
602

A
Avi Kivity 已提交
603 604 605
		return 0;
	}

606 607 608 609 610
	if (walker.level >= PT_DIRECTORY_LEVEL)
		force_pt_level = mapping_level_dirty_bitmap(vcpu, walker.gfn);
	else
		force_pt_level = 1;
	if (!force_pt_level) {
611 612
		level = min(walker.level, mapping_level(vcpu, walker.gfn));
		walker.gfn = walker.gfn & ~(KVM_PAGES_PER_HPAGE(level) - 1);
M
Marcelo Tosatti 已提交
613
	}
614

615
	mmu_seq = vcpu->kvm->mmu_notifier_seq;
616
	smp_rmb();
617

618
	if (try_async_pf(vcpu, prefault, walker.gfn, addr, &pfn, write_fault,
619
			 &map_writable))
620
		return 0;
621

622 623 624 625
	if (handle_abnormal_pfn(vcpu, mmu_is_nested(vcpu) ? 0 : addr,
				walker.gfn, pfn, walker.pte_access, &r))
		return r;

626
	spin_lock(&vcpu->kvm->mmu_lock);
627 628
	if (mmu_notifier_retry(vcpu, mmu_seq))
		goto out_unlock;
629

630
	kvm_mmu_audit(vcpu, AUDIT_PRE_PAGE_FAULT);
631
	kvm_mmu_free_some_pages(vcpu);
632 633
	if (!force_pt_level)
		transparent_hugepage_adjust(vcpu, &walker.gfn, &pfn, &level);
A
Avi Kivity 已提交
634
	sptep = FNAME(fetch)(vcpu, addr, &walker, user_fault, write_fault,
635
			     level, &emulate, pfn, map_writable, prefault);
A
Andi Kleen 已提交
636
	(void)sptep;
637 638
	pgprintk("%s: shadow pte %p %llx emulate %d\n", __func__,
		 sptep, *sptep, emulate);
639

A
Avi Kivity 已提交
640
	++vcpu->stat.pf_fixed;
641
	kvm_mmu_audit(vcpu, AUDIT_POST_PAGE_FAULT);
642
	spin_unlock(&vcpu->kvm->mmu_lock);
A
Avi Kivity 已提交
643

644
	return emulate;
645 646 647 648 649

out_unlock:
	spin_unlock(&vcpu->kvm->mmu_lock);
	kvm_release_pfn_clean(pfn);
	return 0;
A
Avi Kivity 已提交
650 651
}

X
Xiao Guangrong 已提交
652 653 654 655
static gpa_t FNAME(get_level1_sp_gpa)(struct kvm_mmu_page *sp)
{
	int offset = 0;

656
	WARN_ON(sp->role.level != PT_PAGE_TABLE_LEVEL);
X
Xiao Guangrong 已提交
657 658 659 660 661 662 663

	if (PTTYPE == 32)
		offset = sp->role.quadrant << PT64_LEVEL_BITS;

	return gfn_to_gpa(sp->gfn) + offset * sizeof(pt_element_t);
}

664
static void FNAME(invlpg)(struct kvm_vcpu *vcpu, gva_t gva)
M
Marcelo Tosatti 已提交
665
{
666
	struct kvm_shadow_walk_iterator iterator;
667
	struct kvm_mmu_page *sp;
668 669 670
	int level;
	u64 *sptep;

671 672
	vcpu_clear_mmio_info(vcpu, gva);

673 674 675 676 677
	/*
	 * No need to check return value here, rmap_can_add() can
	 * help us to skip pte prefetch later.
	 */
	mmu_topup_memory_caches(vcpu);
M
Marcelo Tosatti 已提交
678

679
	spin_lock(&vcpu->kvm->mmu_lock);
680 681 682
	for_each_shadow_entry(vcpu, gva, iterator) {
		level = iterator.level;
		sptep = iterator.sptep;
683

684
		sp = page_header(__pa(sptep));
X
Xiao Guangrong 已提交
685
		if (is_last_spte(*sptep, level)) {
686 687 688
			pt_element_t gpte;
			gpa_t pte_gpa;

689 690 691
			if (!sp->unsync)
				break;

X
Xiao Guangrong 已提交
692
			pte_gpa = FNAME(get_level1_sp_gpa)(sp);
693
			pte_gpa += (sptep - sp->spt) * sizeof(pt_element_t);
694

X
Xiao Guangrong 已提交
695 696
			if (mmu_page_zap_pte(vcpu->kvm, sp, sptep))
				kvm_flush_remote_tlbs(vcpu->kvm);
697 698 699 700 701 702 703 704 705

			if (!rmap_can_add(vcpu))
				break;

			if (kvm_read_guest_atomic(vcpu->kvm, pte_gpa, &gpte,
						  sizeof(pt_element_t)))
				break;

			FNAME(update_pte)(vcpu, sp, sptep, &gpte);
706
		}
M
Marcelo Tosatti 已提交
707

708
		if (!is_shadow_present_pte(*sptep) || !sp->unsync_children)
709 710
			break;
	}
711
	spin_unlock(&vcpu->kvm->mmu_lock);
M
Marcelo Tosatti 已提交
712 713
}

714
static gpa_t FNAME(gva_to_gpa)(struct kvm_vcpu *vcpu, gva_t vaddr, u32 access,
715
			       struct x86_exception *exception)
A
Avi Kivity 已提交
716 717
{
	struct guest_walker walker;
A
Avi Kivity 已提交
718 719
	gpa_t gpa = UNMAPPED_GVA;
	int r;
A
Avi Kivity 已提交
720

721
	r = FNAME(walk_addr)(&walker, vcpu, vaddr, access);
A
Avi Kivity 已提交
722

A
Avi Kivity 已提交
723
	if (r) {
A
Avi Kivity 已提交
724
		gpa = gfn_to_gpa(walker.gfn);
A
Avi Kivity 已提交
725
		gpa |= vaddr & ~PAGE_MASK;
726 727
	} else if (exception)
		*exception = walker.fault;
A
Avi Kivity 已提交
728 729 730 731

	return gpa;
}

732
static gpa_t FNAME(gva_to_gpa_nested)(struct kvm_vcpu *vcpu, gva_t vaddr,
733 734
				      u32 access,
				      struct x86_exception *exception)
735 736 737 738 739
{
	struct guest_walker walker;
	gpa_t gpa = UNMAPPED_GVA;
	int r;

740
	r = FNAME(walk_addr_nested)(&walker, vcpu, vaddr, access);
741 742 743 744

	if (r) {
		gpa = gfn_to_gpa(walker.gfn);
		gpa |= vaddr & ~PAGE_MASK;
745 746
	} else if (exception)
		*exception = walker.fault;
747 748 749 750

	return gpa;
}

751 752 753 754
/*
 * Using the cached information from sp->gfns is safe because:
 * - The spte has a reference to the struct page, so the pfn for a given gfn
 *   can't change unless all sptes pointing to it are nuked first.
755 756 757 758 759 760 761 762
 *
 * Note:
 *   We should flush all tlbs if spte is dropped even though guest is
 *   responsible for it. Since if we don't, kvm_mmu_notifier_invalidate_page
 *   and kvm_mmu_notifier_invalidate_range_start detect the mapping page isn't
 *   used by guest then tlbs are not flushed, so guest is allowed to access the
 *   freed pages.
 *   And we increase kvm->tlbs_dirty to delay tlbs flush in this case.
763
 */
764
static int FNAME(sync_page)(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp)
765
{
X
Xiao Guangrong 已提交
766
	int i, nr_present = 0;
767
	bool host_writable;
768
	gpa_t first_pte_gpa;
769

770 771 772
	/* direct kvm_mmu_page can not be unsync. */
	BUG_ON(sp->role.direct);

X
Xiao Guangrong 已提交
773
	first_pte_gpa = FNAME(get_level1_sp_gpa)(sp);
774

775 776 777 778
	for (i = 0; i < PT64_ENT_PER_PAGE; i++) {
		unsigned pte_access;
		pt_element_t gpte;
		gpa_t pte_gpa;
779
		gfn_t gfn;
780

781
		if (!sp->spt[i])
782 783
			continue;

784
		pte_gpa = first_pte_gpa + i * sizeof(pt_element_t);
785 786 787 788 789

		if (kvm_read_guest_atomic(vcpu->kvm, pte_gpa, &gpte,
					  sizeof(pt_element_t)))
			return -EINVAL;

790
		if (FNAME(prefetch_invalid_gpte)(vcpu, sp, &sp->spt[i], gpte)) {
791
			vcpu->kvm->tlbs_dirty++;
792 793 794
			continue;
		}

795 796 797 798 799 800 801
		gfn = gpte_to_gfn(gpte);
		pte_access = sp->role.access;
		pte_access &= FNAME(gpte_access)(vcpu, gpte, true);

		if (sync_mmio_spte(&sp->spt[i], gfn, pte_access, &nr_present))
			continue;

802
		if (gfn != sp->gfns[i]) {
803
			drop_spte(vcpu->kvm, &sp->spt[i]);
804
			vcpu->kvm->tlbs_dirty++;
805 806 807 808
			continue;
		}

		nr_present++;
809

810 811
		host_writable = sp->spt[i] & SPTE_HOST_WRITEABLE;

812
		set_spte(vcpu, &sp->spt[i], pte_access, 0, 0,
813
			 PT_PAGE_TABLE_LEVEL, gfn,
814
			 spte_to_pfn(sp->spt[i]), true, false,
815
			 host_writable);
816 817 818 819 820
	}

	return !nr_present;
}

A
Avi Kivity 已提交
821 822 823 824 825
#undef pt_element_t
#undef guest_walker
#undef FNAME
#undef PT_BASE_ADDR_MASK
#undef PT_INDEX
826 827
#undef PT_LVL_ADDR_MASK
#undef PT_LVL_OFFSET_MASK
828
#undef PT_LEVEL_BITS
829
#undef PT_MAX_FULL_LEVELS
830
#undef gpte_to_gfn
831
#undef gpte_to_gfn_lvl
832
#undef CMPXCHG