paging_tmpl.h 22.2 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 96 97 98 99 100 101 102 103
	table = kmap_atomic(page, KM_USER0);
	ret = CMPXCHG(&table[index], orig_pte, new_pte);
	kunmap_atomic(table, KM_USER0);

	kvm_release_page_dirty(page);

	return (ret != orig_pte);
}

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

	access = (gpte & (PT_WRITABLE_MASK | PT_USER_MASK)) | ACC_EXEC_MASK;
#if PTTYPE == 64
110
	if (vcpu->arch.mmu.nx)
111 112 113 114 115
		access &= ~(gpte >> PT64_NX_SHIFT);
#endif
	return access;
}

116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133
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;
}

134 135 136
/*
 * Fetch a guest pte for a guest virtual address
 */
137 138
static int FNAME(walk_addr_generic)(struct guest_walker *walker,
				    struct kvm_vcpu *vcpu, struct kvm_mmu *mmu,
139
				    gva_t addr, u32 access)
A
Avi Kivity 已提交
140
{
141
	pt_element_t pte;
142
	pt_element_t __user *uninitialized_var(ptep_user);
143
	gfn_t table_gfn;
144
	unsigned index, pt_access, uninitialized_var(pte_access);
145
	gpa_t pte_gpa;
146 147 148 149 150 151
	bool eperm;
	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 已提交
152

153 154
	trace_kvm_mmu_pagetable_walk(addr, write_fault, user_fault,
				     fetch_fault);
155
retry_walk:
156
	eperm = false;
157 158 159
	walker->level = mmu->root_level;
	pte           = mmu->get_cr3(vcpu);

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

172
	pt_access = ACC_ALL;
173 174

	for (;;) {
175 176 177
		gfn_t real_gfn;
		unsigned long host_addr;

178
		index = PT_INDEX(addr, walker->level);
179

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

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

		host_addr = gfn_to_hva(vcpu->kvm, real_gfn);
193 194
		if (unlikely(kvm_is_error_hva(host_addr)))
			goto error;
195 196

		ptep_user = (pt_element_t __user *)((void *)host_addr + offset);
197 198
		if (unlikely(__copy_from_user(&pte, ptep_user, sizeof(pte))))
			goto error;
199

200
		trace_kvm_mmu_paging_element(pte, walker->level);
201

202 203
		if (unlikely(!is_present_gpte(pte)))
			goto error;
204

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

211 212
		if (!check_write_user_access(vcpu, write_fault, user_fault,
					  pte))
213
			eperm = true;
214

215
#if PTTYPE == 64
216
		if (unlikely(fetch_fault && (pte & PT64_NX_MASK)))
217
			eperm = true;
218 219
#endif

220
		if (!eperm && unlikely(!(pte & PT_ACCESSED_MASK))) {
221
			int ret;
222 223
			trace_kvm_mmu_set_accessed_bit(table_gfn, index,
						       sizeof(pte));
224 225
			ret = FNAME(cmpxchg_gpte)(vcpu, mmu, ptep_user, index,
						  pte, pte|PT_ACCESSED_MASK);
226 227 228
			if (unlikely(ret < 0))
				goto error;
			else if (ret)
229
				goto retry_walk;
230

231
			mark_page_dirty(vcpu->kvm, table_gfn);
232
			pte |= PT_ACCESSED_MASK;
233
		}
234

235
		pte_access = pt_access & FNAME(gpte_access)(vcpu, pte);
236

237 238
		walker->ptes[walker->level - 1] = pte;

239
		if (FNAME(is_last_gpte)(walker, vcpu, mmu, pte)) {
240
			int lvl = walker->level;
241 242
			gpa_t real_gpa;
			gfn_t gfn;
243
			u32 ac;
244

245 246 247 248 249 250
			/* 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;

251 252
			gfn = gpte_to_gfn_lvl(pte, lvl);
			gfn += (addr & PT_LVL_OFFSET_MASK(lvl)) >> PAGE_SHIFT;
253 254 255 256

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

259
			ac = write_fault | fetch_fault | user_fault;
260 261

			real_gpa = mmu->translate_gpa(vcpu, gfn_to_gpa(gfn),
262
						      ac);
263 264 265 266
			if (real_gpa == UNMAPPED_GVA)
				return 0;

			walker->gfn = real_gpa >> PAGE_SHIFT;
267

268
			break;
269
		}
270

271
		pt_access = pte_access;
272 273
		--walker->level;
	}
274

275 276
	if (unlikely(eperm)) {
		errcode |= PFERR_PRESENT_MASK;
277
		goto error;
278
	}
279

280
	if (write_fault && unlikely(!is_dirty_gpte(pte))) {
281
		int ret;
282

283
		trace_kvm_mmu_set_dirty_bit(table_gfn, index, sizeof(pte));
284 285
		ret = FNAME(cmpxchg_gpte)(vcpu, mmu, ptep_user, index,
					  pte, pte|PT_DIRTY_MASK);
286
		if (unlikely(ret < 0))
287
			goto error;
288
		else if (ret)
289
			goto retry_walk;
290

291
		mark_page_dirty(vcpu->kvm, table_gfn);
292
		pte |= PT_DIRTY_MASK;
293
		walker->ptes[walker->level - 1] = pte;
294 295
	}

296 297 298
	walker->pt_access = pt_access;
	walker->pte_access = pte_access;
	pgprintk("%s: pte %llx pte_access %x pt_access %x\n",
299
		 __func__, (u64)pte, pte_access, pt_access);
300 301
	return 1;

302
error:
303
	errcode |= write_fault | user_fault;
304 305
	if (fetch_fault && (mmu->nx ||
			    kvm_read_cr4_bits(vcpu, X86_CR4_SMEP)))
306
		errcode |= PFERR_FETCH_MASK;
307

308 309 310
	walker->fault.vector = PF_VECTOR;
	walker->fault.error_code_valid = true;
	walker->fault.error_code = errcode;
311 312
	walker->fault.address = addr;
	walker->fault.nested_page_fault = mmu != vcpu->arch.walk_mmu;
313

314
	trace_kvm_mmu_walker_error(walker->fault.error_code);
315
	return 0;
A
Avi Kivity 已提交
316 317
}

318
static int FNAME(walk_addr)(struct guest_walker *walker,
319
			    struct kvm_vcpu *vcpu, gva_t addr, u32 access)
320 321
{
	return FNAME(walk_addr_generic)(walker, vcpu, &vcpu->arch.mmu, addr,
322
					access);
323 324
}

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

333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357
static bool FNAME(prefetch_invalid_gpte)(struct kvm_vcpu *vcpu,
				    struct kvm_mmu_page *sp, u64 *spte,
				    pt_element_t gpte)
{
	u64 nonpresent = shadow_trap_nonpresent_pte;

	if (is_rsvd_bits_set(&vcpu->arch.mmu, gpte, PT_PAGE_TABLE_LEVEL))
		goto no_present;

	if (!is_present_gpte(gpte)) {
		if (!sp->unsync)
			nonpresent = shadow_notrap_nonpresent_pte;
		goto no_present;
	}

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

	return false;

no_present:
	drop_spte(vcpu->kvm, spte, nonpresent);
	return true;
}

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

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

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

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

A
Avi Kivity 已提交
386 387 388 389
static bool FNAME(gpte_changed)(struct kvm_vcpu *vcpu,
				struct guest_walker *gw, int level)
{
	pt_element_t curr_pte;
390 391 392 393 394 395 396 397 398 399 400 401 402 403
	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 已提交
404
				  &curr_pte, sizeof(curr_pte));
405

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

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

	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;
		bool dirty;

		if (spte == sptep)
			continue;

		if (*spte != shadow_trap_nonpresent_pte)
			continue;

		gpte = gptep[i];

443
		if (FNAME(prefetch_invalid_gpte)(vcpu, sp, spte, gpte))
444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461
			continue;

		pte_access = sp->role.access & FNAME(gpte_access)(vcpu, gpte);
		gfn = gpte_to_gfn(gpte);
		dirty = is_dirty_gpte(gpte);
		pfn = pte_prefetch_gfn_to_pfn(vcpu, gfn,
				      (pte_access & ACC_WRITE_MASK) && dirty);
		if (is_error_pfn(pfn)) {
			kvm_release_pfn_clean(pfn);
			break;
		}

		mmu_set_spte(vcpu, spte, sp->role.access, pte_access, 0, 0,
			     dirty, NULL, PT_PAGE_TABLE_LEVEL, gfn,
			     pfn, true, true);
	}
}

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

478
	if (!is_present_gpte(gw->ptes[gw->level - 1]))
479
		return NULL;
A
Avi Kivity 已提交
480

481 482 483 484
	direct_access = gw->pt_access & gw->pte_access;
	if (!dirty)
		direct_access &= ~ACC_WRITE_MASK;

485 486 487 488 489 490 491 492 493 494 495 496
	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;

497 498 499
	for (shadow_walk_init(&it, vcpu, addr);
	     shadow_walk_okay(&it) && it.level > gw->level;
	     shadow_walk_next(&it)) {
500 501
		gfn_t table_gfn;

502
		drop_large_spte(vcpu, it.sptep);
503

504
		sp = NULL;
505 506 507 508
		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);
509
		}
510 511 512 513 514

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

518
		if (sp)
519
			link_shadow_page(it.sptep, sp);
520
	}
A
Avi Kivity 已提交
521

522
	for (;
523 524
	     shadow_walk_okay(&it) && it.level > hlevel;
	     shadow_walk_next(&it)) {
525 526
		gfn_t direct_gfn;

527
		validate_direct_spte(vcpu, it.sptep, direct_access);
528

529
		drop_large_spte(vcpu, it.sptep);
530

531
		if (is_shadow_present_pte(*it.sptep))
532 533
			continue;

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

536 537 538
		sp = kvm_mmu_get_page(vcpu, direct_gfn, addr, it.level-1,
				      true, direct_access, it.sptep);
		link_shadow_page(it.sptep, sp);
539 540
	}

541 542
	mmu_set_spte(vcpu, it.sptep, access, gw->pte_access & access,
		     user_fault, write_fault, dirty, ptwrite, it.level,
X
Xiao Guangrong 已提交
543
		     gw->gfn, pfn, prefault, map_writable);
544
	FNAME(pte_prefetch)(vcpu, gw, it.sptep);
545

546
	return it.sptep;
547 548

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

/*
 * 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
 *
566 567
 *  Returns: 1 if we need to emulate the instruction, 0 otherwise, or
 *           a negative value on error.
A
Avi Kivity 已提交
568
 */
G
Gleb Natapov 已提交
569
static int FNAME(page_fault)(struct kvm_vcpu *vcpu, gva_t addr, u32 error_code,
570
			     bool prefault)
A
Avi Kivity 已提交
571 572 573 574
{
	int write_fault = error_code & PFERR_WRITE_MASK;
	int user_fault = error_code & PFERR_USER_MASK;
	struct guest_walker walker;
A
Avi Kivity 已提交
575
	u64 *sptep;
576
	int write_pt = 0;
577
	int r;
578
	pfn_t pfn;
579
	int level = PT_PAGE_TABLE_LEVEL;
580
	int force_pt_level;
581
	unsigned long mmu_seq;
582
	bool map_writable;
A
Avi Kivity 已提交
583

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

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__);
X
Xiao Guangrong 已提交
600 601 602 603 604
		if (!prefault) {
			inject_page_fault(vcpu, &walker.fault);
			/* reset fork detector */
			vcpu->arch.last_pt_write_count = 0;
		}
A
Avi Kivity 已提交
605 606 607
		return 0;
	}

608 609 610 611 612
	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) {
613 614
		level = min(walker.level, mapping_level(vcpu, walker.gfn));
		walker.gfn = walker.gfn & ~(KVM_PAGES_PER_HPAGE(level) - 1);
M
Marcelo Tosatti 已提交
615
	}
616

617
	mmu_seq = vcpu->kvm->mmu_notifier_seq;
618
	smp_rmb();
619

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

624
	/* mmio */
625 626 627 628 629 630 631 632 633 634
	if (is_error_pfn(pfn)) {
		unsigned access = walker.pte_access;
		bool dirty = is_dirty_gpte(walker.ptes[walker.level - 1]);

		if (!dirty)
			access &= ~ACC_WRITE_MASK;

		return kvm_handle_bad_page(vcpu, mmu_is_nested(vcpu) ? 0 :
					   addr, access, walker.gfn, pfn);
	}
635

636
	spin_lock(&vcpu->kvm->mmu_lock);
637 638
	if (mmu_notifier_retry(vcpu, mmu_seq))
		goto out_unlock;
639

640
	trace_kvm_mmu_audit(vcpu, AUDIT_PRE_PAGE_FAULT);
641
	kvm_mmu_free_some_pages(vcpu);
642 643
	if (!force_pt_level)
		transparent_hugepage_adjust(vcpu, &walker.gfn, &pfn, &level);
A
Avi Kivity 已提交
644
	sptep = FNAME(fetch)(vcpu, addr, &walker, user_fault, write_fault,
X
Xiao Guangrong 已提交
645
			     level, &write_pt, pfn, map_writable, prefault);
A
Andi Kleen 已提交
646
	(void)sptep;
647
	pgprintk("%s: shadow pte %p %llx ptwrite %d\n", __func__,
A
Avi Kivity 已提交
648
		 sptep, *sptep, write_pt);
649

650
	if (!write_pt)
651
		vcpu->arch.last_pt_write_count = 0; /* reset fork detector */
652

A
Avi Kivity 已提交
653
	++vcpu->stat.pf_fixed;
654
	trace_kvm_mmu_audit(vcpu, AUDIT_POST_PAGE_FAULT);
655
	spin_unlock(&vcpu->kvm->mmu_lock);
A
Avi Kivity 已提交
656

657
	return write_pt;
658 659 660 661 662

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

665
static void FNAME(invlpg)(struct kvm_vcpu *vcpu, gva_t gva)
M
Marcelo Tosatti 已提交
666
{
667
	struct kvm_shadow_walk_iterator iterator;
668
	struct kvm_mmu_page *sp;
669
	gpa_t pte_gpa = -1;
670 671
	int level;
	u64 *sptep;
672
	int need_flush = 0;
673

674 675
	vcpu_clear_mmio_info(vcpu, gva);

676
	spin_lock(&vcpu->kvm->mmu_lock);
M
Marcelo Tosatti 已提交
677

678 679 680
	for_each_shadow_entry(vcpu, gva, iterator) {
		level = iterator.level;
		sptep = iterator.sptep;
681

682
		sp = page_header(__pa(sptep));
X
Xiao Guangrong 已提交
683
		if (is_last_spte(*sptep, level)) {
684
			int offset, shift;
685

686 687 688
			if (!sp->unsync)
				break;

689 690 691 692 693
			shift = PAGE_SHIFT -
				  (PT_LEVEL_BITS - PT64_LEVEL_BITS) * level;
			offset = sp->role.quadrant << shift;

			pte_gpa = (sp->gfn << PAGE_SHIFT) + offset;
694
			pte_gpa += (sptep - sp->spt) * sizeof(pt_element_t);
695 696 697 698

			if (is_shadow_present_pte(*sptep)) {
				if (is_large_pte(*sptep))
					--vcpu->kvm->stat.lpages;
A
Avi Kivity 已提交
699 700
				drop_spte(vcpu->kvm, sptep,
					  shadow_trap_nonpresent_pte);
701
				need_flush = 1;
A
Avi Kivity 已提交
702 703
			} else
				__set_spte(sptep, shadow_trap_nonpresent_pte);
704
			break;
705
		}
M
Marcelo Tosatti 已提交
706

707
		if (!is_shadow_present_pte(*sptep) || !sp->unsync_children)
708 709
			break;
	}
M
Marcelo Tosatti 已提交
710

711 712
	if (need_flush)
		kvm_flush_remote_tlbs(vcpu->kvm);
713 714 715

	atomic_inc(&vcpu->kvm->arch.invlpg_counter);

716
	spin_unlock(&vcpu->kvm->mmu_lock);
717 718 719 720 721 722 723

	if (pte_gpa == -1)
		return;

	if (mmu_topup_memory_caches(vcpu))
		return;
	kvm_mmu_pte_write(vcpu, pte_gpa, NULL, sizeof(pt_element_t), 0);
M
Marcelo Tosatti 已提交
724 725
}

726
static gpa_t FNAME(gva_to_gpa)(struct kvm_vcpu *vcpu, gva_t vaddr, u32 access,
727
			       struct x86_exception *exception)
A
Avi Kivity 已提交
728 729
{
	struct guest_walker walker;
A
Avi Kivity 已提交
730 731
	gpa_t gpa = UNMAPPED_GVA;
	int r;
A
Avi Kivity 已提交
732

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

A
Avi Kivity 已提交
735
	if (r) {
A
Avi Kivity 已提交
736
		gpa = gfn_to_gpa(walker.gfn);
A
Avi Kivity 已提交
737
		gpa |= vaddr & ~PAGE_MASK;
738 739
	} else if (exception)
		*exception = walker.fault;
A
Avi Kivity 已提交
740 741 742 743

	return gpa;
}

744
static gpa_t FNAME(gva_to_gpa_nested)(struct kvm_vcpu *vcpu, gva_t vaddr,
745 746
				      u32 access,
				      struct x86_exception *exception)
747 748 749 750 751
{
	struct guest_walker walker;
	gpa_t gpa = UNMAPPED_GVA;
	int r;

752
	r = FNAME(walk_addr_nested)(&walker, vcpu, vaddr, access);
753 754 755 756

	if (r) {
		gpa = gfn_to_gpa(walker.gfn);
		gpa |= vaddr & ~PAGE_MASK;
757 758
	} else if (exception)
		*exception = walker.fault;
759 760 761 762

	return gpa;
}

763 764 765
static void FNAME(prefetch_page)(struct kvm_vcpu *vcpu,
				 struct kvm_mmu_page *sp)
{
A
Avi Kivity 已提交
766 767 768
	int i, j, offset, r;
	pt_element_t pt[256 / sizeof(pt_element_t)];
	gpa_t pte_gpa;
769

770
	if (sp->role.direct
771
	    || (PTTYPE == 32 && sp->role.level > PT_PAGE_TABLE_LEVEL)) {
772 773 774 775
		nonpaging_prefetch_page(vcpu, sp);
		return;
	}

A
Avi Kivity 已提交
776 777
	pte_gpa = gfn_to_gpa(sp->gfn);
	if (PTTYPE == 32) {
778
		offset = sp->role.quadrant << PT64_LEVEL_BITS;
A
Avi Kivity 已提交
779 780
		pte_gpa += offset * sizeof(pt_element_t);
	}
781

A
Avi Kivity 已提交
782 783 784 785
	for (i = 0; i < PT64_ENT_PER_PAGE; i += ARRAY_SIZE(pt)) {
		r = kvm_read_guest_atomic(vcpu->kvm, pte_gpa, pt, sizeof pt);
		pte_gpa += ARRAY_SIZE(pt) * sizeof(pt_element_t);
		for (j = 0; j < ARRAY_SIZE(pt); ++j)
786
			if (r || is_present_gpte(pt[j]))
A
Avi Kivity 已提交
787 788 789
				sp->spt[i+j] = shadow_trap_nonpresent_pte;
			else
				sp->spt[i+j] = shadow_notrap_nonpresent_pte;
790
	}
791 792
}

793 794 795 796
/*
 * 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.
797 798 799 800 801 802 803 804
 *
 * 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.
805
 */
806
static int FNAME(sync_page)(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp)
807 808
{
	int i, offset, nr_present;
809
	bool host_writable;
810
	gpa_t first_pte_gpa;
811 812 813

	offset = nr_present = 0;

814 815 816
	/* direct kvm_mmu_page can not be unsync. */
	BUG_ON(sp->role.direct);

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

820 821
	first_pte_gpa = gfn_to_gpa(sp->gfn) + offset * sizeof(pt_element_t);

822 823 824 825
	for (i = 0; i < PT64_ENT_PER_PAGE; i++) {
		unsigned pte_access;
		pt_element_t gpte;
		gpa_t pte_gpa;
826
		gfn_t gfn;
827 828 829 830

		if (!is_shadow_present_pte(sp->spt[i]))
			continue;

831
		pte_gpa = first_pte_gpa + i * sizeof(pt_element_t);
832 833 834 835 836

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

837
		gfn = gpte_to_gfn(gpte);
838 839

		if (FNAME(prefetch_invalid_gpte)(vcpu, sp, &sp->spt[i], gpte)) {
840
			vcpu->kvm->tlbs_dirty++;
841 842 843 844 845 846
			continue;
		}

		if (gfn != sp->gfns[i]) {
			drop_spte(vcpu->kvm, &sp->spt[i],
				      shadow_trap_nonpresent_pte);
847
			vcpu->kvm->tlbs_dirty++;
848 849 850 851 852
			continue;
		}

		nr_present++;
		pte_access = sp->role.access & FNAME(gpte_access)(vcpu, gpte);
853 854
		host_writable = sp->spt[i] & SPTE_HOST_WRITEABLE;

855
		set_spte(vcpu, &sp->spt[i], pte_access, 0, 0,
856
			 is_dirty_gpte(gpte), PT_PAGE_TABLE_LEVEL, gfn,
857
			 spte_to_pfn(sp->spt[i]), true, false,
858
			 host_writable);
859 860 861 862 863
	}

	return !nr_present;
}

A
Avi Kivity 已提交
864 865 866 867 868
#undef pt_element_t
#undef guest_walker
#undef FNAME
#undef PT_BASE_ADDR_MASK
#undef PT_INDEX
869 870
#undef PT_LVL_ADDR_MASK
#undef PT_LVL_OFFSET_MASK
871
#undef PT_LEVEL_BITS
872
#undef PT_MAX_FULL_LEVELS
873
#undef gpte_to_gfn
874
#undef gpte_to_gfn_lvl
875
#undef CMPXCHG