paging_tmpl.h 20.9 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.
A
Avi Kivity 已提交
10
 * Copyright 2010 Red Hat, Inc. and/or its affilates.
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 34
	#define PT_INDEX(addr, level) PT64_INDEX(addr, level)
	#define PT_LEVEL_MASK(level) PT64_LEVEL_MASK(level)
35
	#define PT_LEVEL_BITS PT64_LEVEL_BITS
36 37
	#ifdef CONFIG_X86_64
	#define PT_MAX_FULL_LEVELS 4
38
	#define CMPXCHG cmpxchg
39
	#else
40
	#define CMPXCHG cmpxchg64
41 42
	#define PT_MAX_FULL_LEVELS 2
	#endif
A
Avi Kivity 已提交
43 44 45 46 47
#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
48 49
	#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 已提交
50 51
	#define PT_INDEX(addr, level) PT32_INDEX(addr, level)
	#define PT_LEVEL_MASK(level) PT32_LEVEL_MASK(level)
52
	#define PT_LEVEL_BITS PT32_LEVEL_BITS
53
	#define PT_MAX_FULL_LEVELS 2
54
	#define CMPXCHG cmpxchg
A
Avi Kivity 已提交
55 56 57 58
#else
	#error Invalid PTTYPE value
#endif

59 60
#define gpte_to_gfn_lvl FNAME(gpte_to_gfn_lvl)
#define gpte_to_gfn(pte) gpte_to_gfn_lvl((pte), PT_PAGE_TABLE_LEVEL)
61

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

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

83 84 85 86 87 88 89 90 91
static bool FNAME(cmpxchg_gpte)(struct kvm *kvm,
			 gfn_t table_gfn, unsigned index,
			 pt_element_t orig_pte, pt_element_t new_pte)
{
	pt_element_t ret;
	pt_element_t *table;
	struct page *page;

	page = gfn_to_page(kvm, table_gfn);
92

93 94 95 96 97 98 99 100 101
	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);
}

102 103 104 105 106 107 108 109 110 111 112 113
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
	if (is_nx(vcpu))
		access &= ~(gpte >> PT64_NX_SHIFT);
#endif
	return access;
}

114 115 116
/*
 * Fetch a guest pte for a guest virtual address
 */
117 118 119 120
static int FNAME(walk_addr_generic)(struct guest_walker *walker,
				    struct kvm_vcpu *vcpu, struct kvm_mmu *mmu,
				    gva_t addr, int write_fault,
				    int user_fault, int fetch_fault)
A
Avi Kivity 已提交
121
{
122
	pt_element_t pte;
123
	gfn_t table_gfn;
124
	unsigned index, pt_access, uninitialized_var(pte_access);
125
	gpa_t pte_gpa;
126
	bool eperm, present, rsvd_fault;
127 128
	int offset;
	u32 access = 0;
A
Avi Kivity 已提交
129

130 131
	trace_kvm_mmu_pagetable_walk(addr, write_fault, user_fault,
				     fetch_fault);
132
walk:
133 134
	present = true;
	eperm = rsvd_fault = false;
135 136 137
	walker->level = mmu->root_level;
	pte           = mmu->get_cr3(vcpu);

138
#if PTTYPE == 64
139
	if (walker->level == PT32E_ROOT_LEVEL) {
A
Avi Kivity 已提交
140
		pte = kvm_pdptr_read(vcpu, (addr >> 30) & 3);
141
		trace_kvm_mmu_paging_element(pte, walker->level);
142 143 144 145
		if (!is_present_gpte(pte)) {
			present = false;
			goto error;
		}
146 147 148
		--walker->level;
	}
#endif
A
Avi Kivity 已提交
149
	ASSERT((!is_long_mode(vcpu) && is_pae(vcpu)) ||
150
	       (mmu->get_cr3(vcpu) & CR3_NONPAE_RESERVED_BITS) == 0);
A
Avi Kivity 已提交
151

152
	pt_access = ACC_ALL;
153 154

	for (;;) {
155
		index = PT_INDEX(addr, walker->level);
156

157
		table_gfn = gpte_to_gfn(pte);
158 159
		offset    = index * sizeof(pt_element_t);
		pte_gpa   = gfn_to_gpa(table_gfn) + offset;
160
		walker->table_gfn[walker->level - 1] = table_gfn;
161
		walker->pte_gpa[walker->level - 1] = pte_gpa;
162

163 164 165
		if (kvm_read_guest_page_mmu(vcpu, mmu, table_gfn, &pte,
					    offset, sizeof(pte),
					    PFERR_USER_MASK|PFERR_WRITE_MASK)) {
166 167 168
			present = false;
			break;
		}
169

170
		trace_kvm_mmu_paging_element(pte, walker->level);
171

172 173 174 175
		if (!is_present_gpte(pte)) {
			present = false;
			break;
		}
176

177
		if (is_rsvd_bits_set(&vcpu->arch.mmu, pte, walker->level)) {
178 179 180
			rsvd_fault = true;
			break;
		}
181

182
		if (write_fault && !is_writable_pte(pte))
183
			if (user_fault || is_write_protection(vcpu))
184
				eperm = true;
185

186
		if (user_fault && !(pte & PT_USER_MASK))
187
			eperm = true;
188

189
#if PTTYPE == 64
190
		if (fetch_fault && (pte & PT64_NX_MASK))
191
			eperm = true;
192 193
#endif

194
		if (!eperm && !rsvd_fault && !(pte & PT_ACCESSED_MASK)) {
195 196
			trace_kvm_mmu_set_accessed_bit(table_gfn, index,
						       sizeof(pte));
197 198 199
			if (FNAME(cmpxchg_gpte)(vcpu->kvm, table_gfn,
			    index, pte, pte|PT_ACCESSED_MASK))
				goto walk;
200
			mark_page_dirty(vcpu->kvm, table_gfn);
201
			pte |= PT_ACCESSED_MASK;
202
		}
203

204
		pte_access = pt_access & FNAME(gpte_access)(vcpu, pte);
205

206 207
		walker->ptes[walker->level - 1] = pte;

208 209
		if ((walker->level == PT_PAGE_TABLE_LEVEL) ||
		    ((walker->level == PT_DIRECTORY_LEVEL) &&
210
				is_large_pte(pte) &&
211 212
				(PTTYPE == 64 || is_pse(vcpu))) ||
		    ((walker->level == PT_PDPE_LEVEL) &&
213
				is_large_pte(pte) &&
214
				mmu->root_level == PT64_ROOT_LEVEL)) {
215
			int lvl = walker->level;
216 217
			gpa_t real_gpa;
			gfn_t gfn;
218

219 220
			gfn = gpte_to_gfn_lvl(pte, lvl);
			gfn += (addr & PT_LVL_OFFSET_MASK(lvl)) >> PAGE_SHIFT;
221 222 223 224

			if (PTTYPE == 32 &&
			    walker->level == PT_DIRECTORY_LEVEL &&
			    is_cpuid_PSE36())
225 226 227 228 229 230 231 232 233 234 235 236
				gfn += pse36_gfn_delta(pte);

			access |= write_fault ? PFERR_WRITE_MASK : 0;
			access |= fetch_fault ? PFERR_FETCH_MASK : 0;
			access |= user_fault  ? PFERR_USER_MASK  : 0;

			real_gpa = mmu->translate_gpa(vcpu, gfn_to_gpa(gfn),
						      access);
			if (real_gpa == UNMAPPED_GVA)
				return 0;

			walker->gfn = real_gpa >> PAGE_SHIFT;
237

238
			break;
239
		}
240

241
		pt_access = pte_access;
242 243
		--walker->level;
	}
244

245 246 247
	if (!present || eperm || rsvd_fault)
		goto error;

248
	if (write_fault && !is_dirty_gpte(pte)) {
249 250
		bool ret;

251
		trace_kvm_mmu_set_dirty_bit(table_gfn, index, sizeof(pte));
252 253 254 255
		ret = FNAME(cmpxchg_gpte)(vcpu->kvm, table_gfn, index, pte,
			    pte|PT_DIRTY_MASK);
		if (ret)
			goto walk;
256
		mark_page_dirty(vcpu->kvm, table_gfn);
257
		pte |= PT_DIRTY_MASK;
258
		walker->ptes[walker->level - 1] = pte;
259 260
	}

261 262 263
	walker->pt_access = pt_access;
	walker->pte_access = pte_access;
	pgprintk("%s: pte %llx pte_access %x pt_access %x\n",
264
		 __func__, (u64)pte, pte_access, pt_access);
265 266
	return 1;

267
error:
268
	walker->error_code = 0;
269 270
	if (present)
		walker->error_code |= PFERR_PRESENT_MASK;
271 272 273 274
	if (write_fault)
		walker->error_code |= PFERR_WRITE_MASK;
	if (user_fault)
		walker->error_code |= PFERR_USER_MASK;
275
	if (fetch_fault && is_nx(vcpu))
276
		walker->error_code |= PFERR_FETCH_MASK;
277 278
	if (rsvd_fault)
		walker->error_code |= PFERR_RSVD_MASK;
279 280 281 282

	vcpu->arch.fault.address    = addr;
	vcpu->arch.fault.error_code = walker->error_code;

283
	trace_kvm_mmu_walker_error(walker->error_code);
284
	return 0;
A
Avi Kivity 已提交
285 286
}

287 288 289 290 291 292 293 294
static int FNAME(walk_addr)(struct guest_walker *walker,
			    struct kvm_vcpu *vcpu, gva_t addr,
			    int write_fault, int user_fault, int fetch_fault)
{
	return FNAME(walk_addr_generic)(walker, vcpu, &vcpu->arch.mmu, addr,
					write_fault, user_fault, fetch_fault);
}

295 296 297 298 299 300 301 302 303 304
static int FNAME(walk_addr_nested)(struct guest_walker *walker,
				   struct kvm_vcpu *vcpu, gva_t addr,
				   int write_fault, int user_fault,
				   int fetch_fault)
{
	return FNAME(walk_addr_generic)(walker, vcpu, &vcpu->arch.nested_mmu,
					addr, write_fault, user_fault,
					fetch_fault);
}

305
static void FNAME(update_pte)(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp,
306
			      u64 *spte, const void *pte)
307 308
{
	pt_element_t gpte;
309
	unsigned pte_access;
310
	pfn_t pfn;
311
	u64 new_spte;
312 313

	gpte = *(const pt_element_t *)pte;
314
	if (~gpte & (PT_PRESENT_MASK | PT_ACCESSED_MASK)) {
315
		if (!is_present_gpte(gpte)) {
316
			if (sp->unsync)
317 318 319 320 321
				new_spte = shadow_trap_nonpresent_pte;
			else
				new_spte = shadow_notrap_nonpresent_pte;
			__set_spte(spte, new_spte);
		}
322 323
		return;
	}
324
	pgprintk("%s: gpte %llx spte %p\n", __func__, (u64)gpte, spte);
325
	pte_access = sp->role.access & FNAME(gpte_access)(vcpu, gpte);
326 327
	if (gpte_to_gfn(gpte) != vcpu->arch.update_pte.gfn)
		return;
328 329
	pfn = vcpu->arch.update_pte.pfn;
	if (is_error_pfn(pfn))
330
		return;
331 332
	if (mmu_notifier_retry(vcpu, vcpu->arch.update_pte.mmu_seq))
		return;
333
	kvm_get_pfn(pfn);
334 335 336 337
	/*
	 * we call mmu_set_spte() with reset_host_protection = true beacuse that
	 * vcpu->arch.update_pte.pfn was fetched from get_user_pages(write = 1).
	 */
338
	mmu_set_spte(vcpu, spte, sp->role.access, pte_access, 0, 0,
339
		     is_dirty_gpte(gpte), NULL, PT_PAGE_TABLE_LEVEL,
340
		     gpte_to_gfn(gpte), pfn, true, true);
341 342
}

A
Avi Kivity 已提交
343 344 345 346
static bool FNAME(gpte_changed)(struct kvm_vcpu *vcpu,
				struct guest_walker *gw, int level)
{
	pt_element_t curr_pte;
347 348 349 350 351 352 353 354 355 356 357 358 359 360
	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 已提交
361
				  &curr_pte, sizeof(curr_pte));
362

A
Avi Kivity 已提交
363 364 365
	return r || curr_pte != gw->ptes[level - 1];
}

366 367
static void FNAME(pte_prefetch)(struct kvm_vcpu *vcpu, struct guest_walker *gw,
				u64 *sptep)
368 369
{
	struct kvm_mmu_page *sp;
370
	struct kvm_mmu *mmu = &vcpu->arch.mmu;
371
	pt_element_t *gptep = gw->prefetch_ptes;
372
	u64 *spte;
373
	int i;
374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401

	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];

		if (!is_present_gpte(gpte) ||
402
		      is_rsvd_bits_set(mmu, gpte, PT_PAGE_TABLE_LEVEL)) {
403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426
			if (!sp->unsync)
				__set_spte(spte, shadow_notrap_nonpresent_pte);
			continue;
		}

		if (!(gpte & PT_ACCESSED_MASK))
			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 已提交
427 428 429
/*
 * Fetch a shadow pte for a specific level in the paging hierarchy.
 */
430 431
static u64 *FNAME(fetch)(struct kvm_vcpu *vcpu, gva_t addr,
			 struct guest_walker *gw,
432
			 int user_fault, int write_fault, int hlevel,
433
			 int *ptwrite, pfn_t pfn)
A
Avi Kivity 已提交
434
{
435
	unsigned access = gw->pt_access;
436
	struct kvm_mmu_page *sp = NULL;
437
	bool dirty = is_dirty_gpte(gw->ptes[gw->level - 1]);
438
	int top_level;
439
	unsigned direct_access;
440
	struct kvm_shadow_walk_iterator it;
441

442
	if (!is_present_gpte(gw->ptes[gw->level - 1]))
443
		return NULL;
A
Avi Kivity 已提交
444

445 446 447 448
	direct_access = gw->pt_access & gw->pte_access;
	if (!dirty)
		direct_access &= ~ACC_WRITE_MASK;

449 450 451 452 453 454 455 456 457 458 459 460
	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;

461 462 463
	for (shadow_walk_init(&it, vcpu, addr);
	     shadow_walk_okay(&it) && it.level > gw->level;
	     shadow_walk_next(&it)) {
464 465
		gfn_t table_gfn;

466
		drop_large_spte(vcpu, it.sptep);
467

468
		sp = NULL;
469 470 471 472
		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);
473
		}
474 475 476 477 478

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

482
		if (sp)
483
			link_shadow_page(it.sptep, sp);
484
	}
A
Avi Kivity 已提交
485

486
	for (;
487 488
	     shadow_walk_okay(&it) && it.level > hlevel;
	     shadow_walk_next(&it)) {
489 490
		gfn_t direct_gfn;

491
		validate_direct_spte(vcpu, it.sptep, direct_access);
492

493
		drop_large_spte(vcpu, it.sptep);
494

495
		if (is_shadow_present_pte(*it.sptep))
496 497
			continue;

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

500 501 502
		sp = kvm_mmu_get_page(vcpu, direct_gfn, addr, it.level-1,
				      true, direct_access, it.sptep);
		link_shadow_page(it.sptep, sp);
503 504
	}

505 506
	mmu_set_spte(vcpu, it.sptep, access, gw->pte_access & access,
		     user_fault, write_fault, dirty, ptwrite, it.level,
507
		     gw->gfn, pfn, false, true);
508
	FNAME(pte_prefetch)(vcpu, gw, it.sptep);
509

510
	return it.sptep;
511 512

out_gpte_changed:
513
	if (sp)
514
		kvm_mmu_put_page(sp, it.sptep);
515 516
	kvm_release_pfn_clean(pfn);
	return NULL;
A
Avi Kivity 已提交
517 518 519 520 521 522 523 524 525 526 527 528 529
}

/*
 * 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
 *
530 531
 *  Returns: 1 if we need to emulate the instruction, 0 otherwise, or
 *           a negative value on error.
A
Avi Kivity 已提交
532 533 534 535 536 537
 */
static int FNAME(page_fault)(struct kvm_vcpu *vcpu, gva_t addr,
			       u32 error_code)
{
	int write_fault = error_code & PFERR_WRITE_MASK;
	int user_fault = error_code & PFERR_USER_MASK;
538
	int fetch_fault = error_code & PFERR_FETCH_MASK;
A
Avi Kivity 已提交
539
	struct guest_walker walker;
A
Avi Kivity 已提交
540
	u64 *sptep;
541
	int write_pt = 0;
542
	int r;
543
	pfn_t pfn;
544
	int level = PT_PAGE_TABLE_LEVEL;
545
	unsigned long mmu_seq;
A
Avi Kivity 已提交
546

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

549 550 551
	r = mmu_topup_memory_caches(vcpu);
	if (r)
		return r;
552

A
Avi Kivity 已提交
553
	/*
554
	 * Look up the guest pte for the faulting address.
A
Avi Kivity 已提交
555
	 */
556 557
	r = FNAME(walk_addr)(&walker, vcpu, addr, write_fault, user_fault,
			     fetch_fault);
A
Avi Kivity 已提交
558 559 560 561

	/*
	 * The page is not mapped by the guest.  Let the guest handle it.
	 */
562
	if (!r) {
563
		pgprintk("%s: guest page fault\n", __func__);
564
		inject_page_fault(vcpu);
565
		vcpu->arch.last_pt_write_count = 0; /* reset fork detector */
A
Avi Kivity 已提交
566 567 568
		return 0;
	}

569 570 571
	if (walker.level >= PT_DIRECTORY_LEVEL) {
		level = min(walker.level, mapping_level(vcpu, walker.gfn));
		walker.gfn = walker.gfn & ~(KVM_PAGES_PER_HPAGE(level) - 1);
M
Marcelo Tosatti 已提交
572
	}
573

574
	mmu_seq = vcpu->kvm->mmu_notifier_seq;
575
	smp_rmb();
576
	pfn = gfn_to_pfn(vcpu->kvm, walker.gfn);
577

578
	/* mmio */
579 580
	if (is_error_pfn(pfn))
		return kvm_handle_bad_page(vcpu->kvm, walker.gfn, pfn);
581

582
	spin_lock(&vcpu->kvm->mmu_lock);
583 584
	if (mmu_notifier_retry(vcpu, mmu_seq))
		goto out_unlock;
585

586
	trace_kvm_mmu_audit(vcpu, AUDIT_PRE_PAGE_FAULT);
587
	kvm_mmu_free_some_pages(vcpu);
A
Avi Kivity 已提交
588
	sptep = FNAME(fetch)(vcpu, addr, &walker, user_fault, write_fault,
589
			     level, &write_pt, pfn);
A
Andi Kleen 已提交
590
	(void)sptep;
591
	pgprintk("%s: shadow pte %p %llx ptwrite %d\n", __func__,
A
Avi Kivity 已提交
592
		 sptep, *sptep, write_pt);
593

594
	if (!write_pt)
595
		vcpu->arch.last_pt_write_count = 0; /* reset fork detector */
596

A
Avi Kivity 已提交
597
	++vcpu->stat.pf_fixed;
598
	trace_kvm_mmu_audit(vcpu, AUDIT_POST_PAGE_FAULT);
599
	spin_unlock(&vcpu->kvm->mmu_lock);
A
Avi Kivity 已提交
600

601
	return write_pt;
602 603 604 605 606

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

609
static void FNAME(invlpg)(struct kvm_vcpu *vcpu, gva_t gva)
M
Marcelo Tosatti 已提交
610
{
611
	struct kvm_shadow_walk_iterator iterator;
612
	struct kvm_mmu_page *sp;
613
	gpa_t pte_gpa = -1;
614 615
	int level;
	u64 *sptep;
616
	int need_flush = 0;
617 618

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

620 621 622
	for_each_shadow_entry(vcpu, gva, iterator) {
		level = iterator.level;
		sptep = iterator.sptep;
623

624
		sp = page_header(__pa(sptep));
X
Xiao Guangrong 已提交
625
		if (is_last_spte(*sptep, level)) {
626
			int offset, shift;
627

628 629 630
			if (!sp->unsync)
				break;

631 632 633 634 635
			shift = PAGE_SHIFT -
				  (PT_LEVEL_BITS - PT64_LEVEL_BITS) * level;
			offset = sp->role.quadrant << shift;

			pte_gpa = (sp->gfn << PAGE_SHIFT) + offset;
636
			pte_gpa += (sptep - sp->spt) * sizeof(pt_element_t);
637 638 639 640

			if (is_shadow_present_pte(*sptep)) {
				if (is_large_pte(*sptep))
					--vcpu->kvm->stat.lpages;
A
Avi Kivity 已提交
641 642
				drop_spte(vcpu->kvm, sptep,
					  shadow_trap_nonpresent_pte);
643
				need_flush = 1;
A
Avi Kivity 已提交
644 645
			} else
				__set_spte(sptep, shadow_trap_nonpresent_pte);
646
			break;
647
		}
M
Marcelo Tosatti 已提交
648

649
		if (!is_shadow_present_pte(*sptep) || !sp->unsync_children)
650 651
			break;
	}
M
Marcelo Tosatti 已提交
652

653 654
	if (need_flush)
		kvm_flush_remote_tlbs(vcpu->kvm);
655 656 657

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

658
	spin_unlock(&vcpu->kvm->mmu_lock);
659 660 661 662 663 664 665

	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 已提交
666 667
}

668 669
static gpa_t FNAME(gva_to_gpa)(struct kvm_vcpu *vcpu, gva_t vaddr, u32 access,
			       u32 *error)
A
Avi Kivity 已提交
670 671
{
	struct guest_walker walker;
A
Avi Kivity 已提交
672 673
	gpa_t gpa = UNMAPPED_GVA;
	int r;
A
Avi Kivity 已提交
674

675 676 677 678
	r = FNAME(walk_addr)(&walker, vcpu, vaddr,
			     !!(access & PFERR_WRITE_MASK),
			     !!(access & PFERR_USER_MASK),
			     !!(access & PFERR_FETCH_MASK));
A
Avi Kivity 已提交
679

A
Avi Kivity 已提交
680
	if (r) {
A
Avi Kivity 已提交
681
		gpa = gfn_to_gpa(walker.gfn);
A
Avi Kivity 已提交
682
		gpa |= vaddr & ~PAGE_MASK;
683 684
	} else if (error)
		*error = walker.error_code;
A
Avi Kivity 已提交
685 686 687 688

	return gpa;
}

689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709
static gpa_t FNAME(gva_to_gpa_nested)(struct kvm_vcpu *vcpu, gva_t vaddr,
				      u32 access, u32 *error)
{
	struct guest_walker walker;
	gpa_t gpa = UNMAPPED_GVA;
	int r;

	r = FNAME(walk_addr_nested)(&walker, vcpu, vaddr,
				    access & PFERR_WRITE_MASK,
				    access & PFERR_USER_MASK,
				    access & PFERR_FETCH_MASK);

	if (r) {
		gpa = gfn_to_gpa(walker.gfn);
		gpa |= vaddr & ~PAGE_MASK;
	} else if (error)
		*error = walker.error_code;

	return gpa;
}

710 711 712
static void FNAME(prefetch_page)(struct kvm_vcpu *vcpu,
				 struct kvm_mmu_page *sp)
{
A
Avi Kivity 已提交
713 714 715
	int i, j, offset, r;
	pt_element_t pt[256 / sizeof(pt_element_t)];
	gpa_t pte_gpa;
716

717
	if (sp->role.direct
718
	    || (PTTYPE == 32 && sp->role.level > PT_PAGE_TABLE_LEVEL)) {
719 720 721 722
		nonpaging_prefetch_page(vcpu, sp);
		return;
	}

A
Avi Kivity 已提交
723 724
	pte_gpa = gfn_to_gpa(sp->gfn);
	if (PTTYPE == 32) {
725
		offset = sp->role.quadrant << PT64_LEVEL_BITS;
A
Avi Kivity 已提交
726 727
		pte_gpa += offset * sizeof(pt_element_t);
	}
728

A
Avi Kivity 已提交
729 730 731 732
	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)
733
			if (r || is_present_gpte(pt[j]))
A
Avi Kivity 已提交
734 735 736
				sp->spt[i+j] = shadow_trap_nonpresent_pte;
			else
				sp->spt[i+j] = shadow_notrap_nonpresent_pte;
737
	}
738 739
}

740 741 742 743 744
/*
 * 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.
 */
745 746
static int FNAME(sync_page)(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp,
			    bool clear_unsync)
747 748
{
	int i, offset, nr_present;
749
	bool reset_host_protection;
750
	gpa_t first_pte_gpa;
751 752 753

	offset = nr_present = 0;

754 755 756
	/* direct kvm_mmu_page can not be unsync. */
	BUG_ON(sp->role.direct);

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

760 761
	first_pte_gpa = gfn_to_gpa(sp->gfn) + offset * sizeof(pt_element_t);

762 763 764 765
	for (i = 0; i < PT64_ENT_PER_PAGE; i++) {
		unsigned pte_access;
		pt_element_t gpte;
		gpa_t pte_gpa;
766
		gfn_t gfn;
767 768 769 770

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

771
		pte_gpa = first_pte_gpa + i * sizeof(pt_element_t);
772 773 774 775 776

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

777
		gfn = gpte_to_gfn(gpte);
778
		if (is_rsvd_bits_set(&vcpu->arch.mmu, gpte, PT_PAGE_TABLE_LEVEL)
779 780
		      || gfn != sp->gfns[i] || !is_present_gpte(gpte)
		      || !(gpte & PT_ACCESSED_MASK)) {
781 782
			u64 nonpresent;

783
			if (is_present_gpte(gpte) || !clear_unsync)
784 785 786
				nonpresent = shadow_trap_nonpresent_pte;
			else
				nonpresent = shadow_notrap_nonpresent_pte;
A
Avi Kivity 已提交
787
			drop_spte(vcpu->kvm, &sp->spt[i], nonpresent);
788 789 790 791 792
			continue;
		}

		nr_present++;
		pte_access = sp->role.access & FNAME(gpte_access)(vcpu, gpte);
793 794 795 796 797 798
		if (!(sp->spt[i] & SPTE_HOST_WRITEABLE)) {
			pte_access &= ~ACC_WRITE_MASK;
			reset_host_protection = 0;
		} else {
			reset_host_protection = 1;
		}
799
		set_spte(vcpu, &sp->spt[i], pte_access, 0, 0,
800
			 is_dirty_gpte(gpte), PT_PAGE_TABLE_LEVEL, gfn,
801 802
			 spte_to_pfn(sp->spt[i]), true, false,
			 reset_host_protection);
803 804 805 806 807
	}

	return !nr_present;
}

A
Avi Kivity 已提交
808 809 810 811 812 813
#undef pt_element_t
#undef guest_walker
#undef FNAME
#undef PT_BASE_ADDR_MASK
#undef PT_INDEX
#undef PT_LEVEL_MASK
814 815
#undef PT_LVL_ADDR_MASK
#undef PT_LVL_OFFSET_MASK
816
#undef PT_LEVEL_BITS
817
#undef PT_MAX_FULL_LEVELS
818
#undef gpte_to_gfn
819
#undef gpte_to_gfn_lvl
820
#undef CMPXCHG