mmu.c 69.8 KB
Newer Older
A
Avi Kivity 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18
/*
 * 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.
 *
 * 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.
 *
 */
A
Avi Kivity 已提交
19 20

#include "vmx.h"
21
#include "mmu.h"
A
Avi Kivity 已提交
22

23
#include <linux/kvm_host.h>
A
Avi Kivity 已提交
24 25 26 27 28
#include <linux/types.h>
#include <linux/string.h>
#include <linux/mm.h>
#include <linux/highmem.h>
#include <linux/module.h>
29
#include <linux/swap.h>
M
Marcelo Tosatti 已提交
30
#include <linux/hugetlb.h>
31
#include <linux/compiler.h>
A
Avi Kivity 已提交
32

A
Avi Kivity 已提交
33 34
#include <asm/page.h>
#include <asm/cmpxchg.h>
35
#include <asm/io.h>
A
Avi Kivity 已提交
36

37 38 39 40 41 42 43
/*
 * When setting this variable to true it enables Two-Dimensional-Paging
 * where the hardware walks 2 page tables:
 * 1. the guest-virtual to guest-physical
 * 2. while doing 1. it walks guest-physical to host-physical
 * If the hardware supports that we don't need to do shadow paging.
 */
44
bool tdp_enabled = false;
45

46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68
#undef MMU_DEBUG

#undef AUDIT

#ifdef AUDIT
static void kvm_mmu_audit(struct kvm_vcpu *vcpu, const char *msg);
#else
static void kvm_mmu_audit(struct kvm_vcpu *vcpu, const char *msg) {}
#endif

#ifdef MMU_DEBUG

#define pgprintk(x...) do { if (dbg) printk(x); } while (0)
#define rmap_printk(x...) do { if (dbg) printk(x); } while (0)

#else

#define pgprintk(x...) do { } while (0)
#define rmap_printk(x...) do { } while (0)

#endif

#if defined(MMU_DEBUG) || defined(AUDIT)
69 70
static int dbg = 0;
module_param(dbg, bool, 0644);
71
#endif
A
Avi Kivity 已提交
72

73 74 75
static int oos_shadow = 1;
module_param(oos_shadow, bool, 0644);

76 77 78
#ifndef MMU_DEBUG
#define ASSERT(x) do { } while (0)
#else
A
Avi Kivity 已提交
79 80 81 82 83
#define ASSERT(x)							\
	if (!(x)) {							\
		printk(KERN_WARNING "assertion failed %s:%d: %s\n",	\
		       __FILE__, __LINE__, #x);				\
	}
84
#endif
A
Avi Kivity 已提交
85 86 87 88 89 90 91 92 93

#define PT_FIRST_AVAIL_BITS_SHIFT 9
#define PT64_SECOND_AVAIL_BITS_SHIFT 52

#define VALID_PAGE(x) ((x) != INVALID_PAGE)

#define PT64_LEVEL_BITS 9

#define PT64_LEVEL_SHIFT(level) \
M
Mike Day 已提交
94
		(PAGE_SHIFT + (level - 1) * PT64_LEVEL_BITS)
A
Avi Kivity 已提交
95 96 97 98 99 100 101 102 103 104 105

#define PT64_LEVEL_MASK(level) \
		(((1ULL << PT64_LEVEL_BITS) - 1) << PT64_LEVEL_SHIFT(level))

#define PT64_INDEX(address, level)\
	(((address) >> PT64_LEVEL_SHIFT(level)) & ((1 << PT64_LEVEL_BITS) - 1))


#define PT32_LEVEL_BITS 10

#define PT32_LEVEL_SHIFT(level) \
M
Mike Day 已提交
106
		(PAGE_SHIFT + (level - 1) * PT32_LEVEL_BITS)
A
Avi Kivity 已提交
107 108 109 110 111 112 113 114

#define PT32_LEVEL_MASK(level) \
		(((1ULL << PT32_LEVEL_BITS) - 1) << PT32_LEVEL_SHIFT(level))

#define PT32_INDEX(address, level)\
	(((address) >> PT32_LEVEL_SHIFT(level)) & ((1 << PT32_LEVEL_BITS) - 1))


115
#define PT64_BASE_ADDR_MASK (((1ULL << 52) - 1) & ~(u64)(PAGE_SIZE-1))
A
Avi Kivity 已提交
116 117 118 119 120 121 122
#define PT64_DIR_BASE_ADDR_MASK \
	(PT64_BASE_ADDR_MASK & ~((1ULL << (PAGE_SHIFT + PT64_LEVEL_BITS)) - 1))

#define PT32_BASE_ADDR_MASK PAGE_MASK
#define PT32_DIR_BASE_ADDR_MASK \
	(PAGE_MASK & ~((1ULL << (PAGE_SHIFT + PT32_LEVEL_BITS)) - 1))

123 124
#define PT64_PERM_MASK (PT_PRESENT_MASK | PT_WRITABLE_MASK | PT_USER_MASK \
			| PT64_NX_MASK)
A
Avi Kivity 已提交
125 126 127 128

#define PFERR_PRESENT_MASK (1U << 0)
#define PFERR_WRITE_MASK (1U << 1)
#define PFERR_USER_MASK (1U << 2)
129
#define PFERR_FETCH_MASK (1U << 4)
A
Avi Kivity 已提交
130 131 132 133

#define PT_DIRECTORY_LEVEL 2
#define PT_PAGE_TABLE_LEVEL 1

134 135
#define RMAP_EXT 4

136 137 138 139 140
#define ACC_EXEC_MASK    1
#define ACC_WRITE_MASK   PT_WRITABLE_MASK
#define ACC_USER_MASK    PT_USER_MASK
#define ACC_ALL          (ACC_EXEC_MASK | ACC_WRITE_MASK | ACC_USER_MASK)

141 142
#define SHADOW_PT_INDEX(addr, level) PT64_INDEX(addr, level)

143 144 145 146 147
struct kvm_rmap_desc {
	u64 *shadow_ptes[RMAP_EXT];
	struct kvm_rmap_desc *more;
};

A
Avi Kivity 已提交
148 149
struct kvm_shadow_walk {
	int (*entry)(struct kvm_shadow_walk *walk, struct kvm_vcpu *vcpu,
150
		     u64 addr, u64 *spte, int level);
A
Avi Kivity 已提交
151 152
};

153 154 155 156
struct kvm_unsync_walk {
	int (*entry) (struct kvm_mmu_page *sp, struct kvm_unsync_walk *walk);
};

M
Marcelo Tosatti 已提交
157 158
typedef int (*mmu_parent_walk_fn) (struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp);

159 160
static struct kmem_cache *pte_chain_cache;
static struct kmem_cache *rmap_desc_cache;
161
static struct kmem_cache *mmu_page_header_cache;
162

163 164
static u64 __read_mostly shadow_trap_nonpresent_pte;
static u64 __read_mostly shadow_notrap_nonpresent_pte;
S
Sheng Yang 已提交
165 166 167 168 169 170
static u64 __read_mostly shadow_base_present_pte;
static u64 __read_mostly shadow_nx_mask;
static u64 __read_mostly shadow_x_mask;	/* mutual exclusive with nx_mask */
static u64 __read_mostly shadow_user_mask;
static u64 __read_mostly shadow_accessed_mask;
static u64 __read_mostly shadow_dirty_mask;
171 172 173 174 175 176 177 178

void kvm_mmu_set_nonpresent_ptes(u64 trap_pte, u64 notrap_pte)
{
	shadow_trap_nonpresent_pte = trap_pte;
	shadow_notrap_nonpresent_pte = notrap_pte;
}
EXPORT_SYMBOL_GPL(kvm_mmu_set_nonpresent_ptes);

S
Sheng Yang 已提交
179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195
void kvm_mmu_set_base_ptes(u64 base_pte)
{
	shadow_base_present_pte = base_pte;
}
EXPORT_SYMBOL_GPL(kvm_mmu_set_base_ptes);

void kvm_mmu_set_mask_ptes(u64 user_mask, u64 accessed_mask,
		u64 dirty_mask, u64 nx_mask, u64 x_mask)
{
	shadow_user_mask = user_mask;
	shadow_accessed_mask = accessed_mask;
	shadow_dirty_mask = dirty_mask;
	shadow_nx_mask = nx_mask;
	shadow_x_mask = x_mask;
}
EXPORT_SYMBOL_GPL(kvm_mmu_set_mask_ptes);

A
Avi Kivity 已提交
196 197
static int is_write_protection(struct kvm_vcpu *vcpu)
{
198
	return vcpu->arch.cr0 & X86_CR0_WP;
A
Avi Kivity 已提交
199 200 201 202 203 204 205
}

static int is_cpuid_PSE36(void)
{
	return 1;
}

206 207
static int is_nx(struct kvm_vcpu *vcpu)
{
208
	return vcpu->arch.shadow_efer & EFER_NX;
209 210
}

A
Avi Kivity 已提交
211 212 213 214 215
static int is_present_pte(unsigned long pte)
{
	return pte & PT_PRESENT_MASK;
}

216 217 218 219 220 221
static int is_shadow_present_pte(u64 pte)
{
	return pte != shadow_trap_nonpresent_pte
		&& pte != shadow_notrap_nonpresent_pte;
}

M
Marcelo Tosatti 已提交
222 223 224 225 226
static int is_large_pte(u64 pte)
{
	return pte & PT_PAGE_SIZE_MASK;
}

A
Avi Kivity 已提交
227 228 229 230 231
static int is_writeble_pte(unsigned long pte)
{
	return pte & PT_WRITABLE_MASK;
}

232 233
static int is_dirty_pte(unsigned long pte)
{
S
Sheng Yang 已提交
234
	return pte & shadow_dirty_mask;
235 236
}

237 238
static int is_rmap_pte(u64 pte)
{
239
	return is_shadow_present_pte(pte);
240 241
}

242
static pfn_t spte_to_pfn(u64 pte)
243
{
244
	return (pte & PT64_BASE_ADDR_MASK) >> PAGE_SHIFT;
245 246
}

247 248 249 250 251 252 253
static gfn_t pse36_gfn_delta(u32 gpte)
{
	int shift = 32 - PT32_DIR_PSE36_SHIFT - PAGE_SHIFT;

	return (gpte & PT32_DIR_PSE36_MASK) << shift;
}

254 255 256 257 258 259 260 261 262
static void set_shadow_pte(u64 *sptep, u64 spte)
{
#ifdef CONFIG_X86_64
	set_64bit((unsigned long *)sptep, spte);
#else
	set_64bit((unsigned long long *)sptep, spte);
#endif
}

263
static int mmu_topup_memory_cache(struct kvm_mmu_memory_cache *cache,
264
				  struct kmem_cache *base_cache, int min)
265 266 267 268
{
	void *obj;

	if (cache->nobjs >= min)
269
		return 0;
270
	while (cache->nobjs < ARRAY_SIZE(cache->objects)) {
271
		obj = kmem_cache_zalloc(base_cache, GFP_KERNEL);
272
		if (!obj)
273
			return -ENOMEM;
274 275
		cache->objects[cache->nobjs++] = obj;
	}
276
	return 0;
277 278 279 280 281 282 283 284
}

static void mmu_free_memory_cache(struct kvm_mmu_memory_cache *mc)
{
	while (mc->nobjs)
		kfree(mc->objects[--mc->nobjs]);
}

A
Avi Kivity 已提交
285
static int mmu_topup_memory_cache_page(struct kvm_mmu_memory_cache *cache,
286
				       int min)
A
Avi Kivity 已提交
287 288 289 290 291 292
{
	struct page *page;

	if (cache->nobjs >= min)
		return 0;
	while (cache->nobjs < ARRAY_SIZE(cache->objects)) {
293
		page = alloc_page(GFP_KERNEL);
A
Avi Kivity 已提交
294 295 296 297 298 299 300 301 302 303 304
		if (!page)
			return -ENOMEM;
		set_page_private(page, 0);
		cache->objects[cache->nobjs++] = page_address(page);
	}
	return 0;
}

static void mmu_free_memory_cache_page(struct kvm_mmu_memory_cache *mc)
{
	while (mc->nobjs)
305
		free_page((unsigned long)mc->objects[--mc->nobjs]);
A
Avi Kivity 已提交
306 307
}

308
static int mmu_topup_memory_caches(struct kvm_vcpu *vcpu)
309
{
310 311
	int r;

312
	r = mmu_topup_memory_cache(&vcpu->arch.mmu_pte_chain_cache,
313
				   pte_chain_cache, 4);
314 315
	if (r)
		goto out;
316
	r = mmu_topup_memory_cache(&vcpu->arch.mmu_rmap_desc_cache,
317
				   rmap_desc_cache, 4);
318 319
	if (r)
		goto out;
320
	r = mmu_topup_memory_cache_page(&vcpu->arch.mmu_page_cache, 8);
321 322
	if (r)
		goto out;
323
	r = mmu_topup_memory_cache(&vcpu->arch.mmu_page_header_cache,
324
				   mmu_page_header_cache, 4);
325 326
out:
	return r;
327 328 329 330
}

static void mmu_free_memory_caches(struct kvm_vcpu *vcpu)
{
331 332 333 334
	mmu_free_memory_cache(&vcpu->arch.mmu_pte_chain_cache);
	mmu_free_memory_cache(&vcpu->arch.mmu_rmap_desc_cache);
	mmu_free_memory_cache_page(&vcpu->arch.mmu_page_cache);
	mmu_free_memory_cache(&vcpu->arch.mmu_page_header_cache);
335 336 337 338 339 340 341 342 343 344 345 346 347 348 349
}

static void *mmu_memory_cache_alloc(struct kvm_mmu_memory_cache *mc,
				    size_t size)
{
	void *p;

	BUG_ON(!mc->nobjs);
	p = mc->objects[--mc->nobjs];
	memset(p, 0, size);
	return p;
}

static struct kvm_pte_chain *mmu_alloc_pte_chain(struct kvm_vcpu *vcpu)
{
350
	return mmu_memory_cache_alloc(&vcpu->arch.mmu_pte_chain_cache,
351 352 353
				      sizeof(struct kvm_pte_chain));
}

354
static void mmu_free_pte_chain(struct kvm_pte_chain *pc)
355
{
356
	kfree(pc);
357 358 359 360
}

static struct kvm_rmap_desc *mmu_alloc_rmap_desc(struct kvm_vcpu *vcpu)
{
361
	return mmu_memory_cache_alloc(&vcpu->arch.mmu_rmap_desc_cache,
362 363 364
				      sizeof(struct kvm_rmap_desc));
}

365
static void mmu_free_rmap_desc(struct kvm_rmap_desc *rd)
366
{
367
	kfree(rd);
368 369
}

M
Marcelo Tosatti 已提交
370 371 372 373 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 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416
/*
 * Return the pointer to the largepage write count for a given
 * gfn, handling slots that are not large page aligned.
 */
static int *slot_largepage_idx(gfn_t gfn, struct kvm_memory_slot *slot)
{
	unsigned long idx;

	idx = (gfn / KVM_PAGES_PER_HPAGE) -
	      (slot->base_gfn / KVM_PAGES_PER_HPAGE);
	return &slot->lpage_info[idx].write_count;
}

static void account_shadowed(struct kvm *kvm, gfn_t gfn)
{
	int *write_count;

	write_count = slot_largepage_idx(gfn, gfn_to_memslot(kvm, gfn));
	*write_count += 1;
}

static void unaccount_shadowed(struct kvm *kvm, gfn_t gfn)
{
	int *write_count;

	write_count = slot_largepage_idx(gfn, gfn_to_memslot(kvm, gfn));
	*write_count -= 1;
	WARN_ON(*write_count < 0);
}

static int has_wrprotected_page(struct kvm *kvm, gfn_t gfn)
{
	struct kvm_memory_slot *slot = gfn_to_memslot(kvm, gfn);
	int *largepage_idx;

	if (slot) {
		largepage_idx = slot_largepage_idx(gfn, slot);
		return *largepage_idx;
	}

	return 1;
}

static int host_largepage_backed(struct kvm *kvm, gfn_t gfn)
{
	struct vm_area_struct *vma;
	unsigned long addr;
417
	int ret = 0;
M
Marcelo Tosatti 已提交
418 419 420

	addr = gfn_to_hva(kvm, gfn);
	if (kvm_is_error_hva(addr))
421
		return ret;
M
Marcelo Tosatti 已提交
422

423
	down_read(&current->mm->mmap_sem);
M
Marcelo Tosatti 已提交
424 425
	vma = find_vma(current->mm, addr);
	if (vma && is_vm_hugetlb_page(vma))
426 427
		ret = 1;
	up_read(&current->mm->mmap_sem);
M
Marcelo Tosatti 已提交
428

429
	return ret;
M
Marcelo Tosatti 已提交
430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448
}

static int is_largepage_backed(struct kvm_vcpu *vcpu, gfn_t large_gfn)
{
	struct kvm_memory_slot *slot;

	if (has_wrprotected_page(vcpu->kvm, large_gfn))
		return 0;

	if (!host_largepage_backed(vcpu->kvm, large_gfn))
		return 0;

	slot = gfn_to_memslot(vcpu->kvm, large_gfn);
	if (slot && slot->dirty_bitmap)
		return 0;

	return 1;
}

449 450 451 452 453
/*
 * Take gfn and return the reverse mapping to it.
 * Note: gfn must be unaliased before this function get called
 */

M
Marcelo Tosatti 已提交
454
static unsigned long *gfn_to_rmap(struct kvm *kvm, gfn_t gfn, int lpage)
455 456
{
	struct kvm_memory_slot *slot;
M
Marcelo Tosatti 已提交
457
	unsigned long idx;
458 459

	slot = gfn_to_memslot(kvm, gfn);
M
Marcelo Tosatti 已提交
460 461 462 463 464 465 466
	if (!lpage)
		return &slot->rmap[gfn - slot->base_gfn];

	idx = (gfn / KVM_PAGES_PER_HPAGE) -
	      (slot->base_gfn / KVM_PAGES_PER_HPAGE);

	return &slot->lpage_info[idx].rmap_pde;
467 468
}

469 470 471
/*
 * Reverse mapping data structures:
 *
472 473
 * If rmapp bit zero is zero, then rmapp point to the shadw page table entry
 * that points to page_address(page).
474
 *
475 476
 * If rmapp bit zero is one, (then rmap & ~1) points to a struct kvm_rmap_desc
 * containing more mappings.
477
 */
M
Marcelo Tosatti 已提交
478
static void rmap_add(struct kvm_vcpu *vcpu, u64 *spte, gfn_t gfn, int lpage)
479
{
480
	struct kvm_mmu_page *sp;
481
	struct kvm_rmap_desc *desc;
482
	unsigned long *rmapp;
483 484 485 486
	int i;

	if (!is_rmap_pte(*spte))
		return;
487
	gfn = unalias_gfn(vcpu->kvm, gfn);
488 489
	sp = page_header(__pa(spte));
	sp->gfns[spte - sp->spt] = gfn;
M
Marcelo Tosatti 已提交
490
	rmapp = gfn_to_rmap(vcpu->kvm, gfn, lpage);
491
	if (!*rmapp) {
492
		rmap_printk("rmap_add: %p %llx 0->1\n", spte, *spte);
493 494
		*rmapp = (unsigned long)spte;
	} else if (!(*rmapp & 1)) {
495
		rmap_printk("rmap_add: %p %llx 1->many\n", spte, *spte);
496
		desc = mmu_alloc_rmap_desc(vcpu);
497
		desc->shadow_ptes[0] = (u64 *)*rmapp;
498
		desc->shadow_ptes[1] = spte;
499
		*rmapp = (unsigned long)desc | 1;
500 501
	} else {
		rmap_printk("rmap_add: %p %llx many->many\n", spte, *spte);
502
		desc = (struct kvm_rmap_desc *)(*rmapp & ~1ul);
503 504 505
		while (desc->shadow_ptes[RMAP_EXT-1] && desc->more)
			desc = desc->more;
		if (desc->shadow_ptes[RMAP_EXT-1]) {
506
			desc->more = mmu_alloc_rmap_desc(vcpu);
507 508 509 510 511 512 513 514
			desc = desc->more;
		}
		for (i = 0; desc->shadow_ptes[i]; ++i)
			;
		desc->shadow_ptes[i] = spte;
	}
}

515
static void rmap_desc_remove_entry(unsigned long *rmapp,
516 517 518 519 520 521 522 523 524
				   struct kvm_rmap_desc *desc,
				   int i,
				   struct kvm_rmap_desc *prev_desc)
{
	int j;

	for (j = RMAP_EXT - 1; !desc->shadow_ptes[j] && j > i; --j)
		;
	desc->shadow_ptes[i] = desc->shadow_ptes[j];
A
Al Viro 已提交
525
	desc->shadow_ptes[j] = NULL;
526 527 528
	if (j != 0)
		return;
	if (!prev_desc && !desc->more)
529
		*rmapp = (unsigned long)desc->shadow_ptes[0];
530 531 532 533
	else
		if (prev_desc)
			prev_desc->more = desc->more;
		else
534
			*rmapp = (unsigned long)desc->more | 1;
535
	mmu_free_rmap_desc(desc);
536 537
}

538
static void rmap_remove(struct kvm *kvm, u64 *spte)
539 540 541
{
	struct kvm_rmap_desc *desc;
	struct kvm_rmap_desc *prev_desc;
542
	struct kvm_mmu_page *sp;
543
	pfn_t pfn;
544
	unsigned long *rmapp;
545 546 547 548
	int i;

	if (!is_rmap_pte(*spte))
		return;
549
	sp = page_header(__pa(spte));
550
	pfn = spte_to_pfn(*spte);
S
Sheng Yang 已提交
551
	if (*spte & shadow_accessed_mask)
552
		kvm_set_pfn_accessed(pfn);
553
	if (is_writeble_pte(*spte))
554
		kvm_release_pfn_dirty(pfn);
555
	else
556
		kvm_release_pfn_clean(pfn);
M
Marcelo Tosatti 已提交
557
	rmapp = gfn_to_rmap(kvm, sp->gfns[spte - sp->spt], is_large_pte(*spte));
558
	if (!*rmapp) {
559 560
		printk(KERN_ERR "rmap_remove: %p %llx 0->BUG\n", spte, *spte);
		BUG();
561
	} else if (!(*rmapp & 1)) {
562
		rmap_printk("rmap_remove:  %p %llx 1->0\n", spte, *spte);
563
		if ((u64 *)*rmapp != spte) {
564 565 566 567
			printk(KERN_ERR "rmap_remove:  %p %llx 1->BUG\n",
			       spte, *spte);
			BUG();
		}
568
		*rmapp = 0;
569 570
	} else {
		rmap_printk("rmap_remove:  %p %llx many->many\n", spte, *spte);
571
		desc = (struct kvm_rmap_desc *)(*rmapp & ~1ul);
572 573 574 575
		prev_desc = NULL;
		while (desc) {
			for (i = 0; i < RMAP_EXT && desc->shadow_ptes[i]; ++i)
				if (desc->shadow_ptes[i] == spte) {
576
					rmap_desc_remove_entry(rmapp,
577
							       desc, i,
578 579 580 581 582 583 584 585 586 587
							       prev_desc);
					return;
				}
			prev_desc = desc;
			desc = desc->more;
		}
		BUG();
	}
}

588
static u64 *rmap_next(struct kvm *kvm, unsigned long *rmapp, u64 *spte)
589 590
{
	struct kvm_rmap_desc *desc;
591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617
	struct kvm_rmap_desc *prev_desc;
	u64 *prev_spte;
	int i;

	if (!*rmapp)
		return NULL;
	else if (!(*rmapp & 1)) {
		if (!spte)
			return (u64 *)*rmapp;
		return NULL;
	}
	desc = (struct kvm_rmap_desc *)(*rmapp & ~1ul);
	prev_desc = NULL;
	prev_spte = NULL;
	while (desc) {
		for (i = 0; i < RMAP_EXT && desc->shadow_ptes[i]; ++i) {
			if (prev_spte == spte)
				return desc->shadow_ptes[i];
			prev_spte = desc->shadow_ptes[i];
		}
		desc = desc->more;
	}
	return NULL;
}

static void rmap_write_protect(struct kvm *kvm, u64 gfn)
{
618
	unsigned long *rmapp;
619
	u64 *spte;
620
	int write_protected = 0;
621

622
	gfn = unalias_gfn(kvm, gfn);
M
Marcelo Tosatti 已提交
623
	rmapp = gfn_to_rmap(kvm, gfn, 0);
624

625 626
	spte = rmap_next(kvm, rmapp, NULL);
	while (spte) {
627 628 629
		BUG_ON(!spte);
		BUG_ON(!(*spte & PT_PRESENT_MASK));
		rmap_printk("rmap_write_protect: spte %p %llx\n", spte, *spte);
630
		if (is_writeble_pte(*spte)) {
631
			set_shadow_pte(spte, *spte & ~PT_WRITABLE_MASK);
632 633
			write_protected = 1;
		}
634
		spte = rmap_next(kvm, rmapp, spte);
635
	}
636
	if (write_protected) {
637
		pfn_t pfn;
638 639

		spte = rmap_next(kvm, rmapp, NULL);
640 641
		pfn = spte_to_pfn(*spte);
		kvm_set_pfn_dirty(pfn);
642 643
	}

M
Marcelo Tosatti 已提交
644 645 646 647 648 649 650 651 652 653 654 655
	/* check for huge page mappings */
	rmapp = gfn_to_rmap(kvm, gfn, 1);
	spte = rmap_next(kvm, rmapp, NULL);
	while (spte) {
		BUG_ON(!spte);
		BUG_ON(!(*spte & PT_PRESENT_MASK));
		BUG_ON((*spte & (PT_PAGE_SIZE_MASK|PT_PRESENT_MASK)) != (PT_PAGE_SIZE_MASK|PT_PRESENT_MASK));
		pgprintk("rmap_write_protect(large): spte %p %llx %lld\n", spte, *spte, gfn);
		if (is_writeble_pte(*spte)) {
			rmap_remove(kvm, spte);
			--kvm->stat.lpages;
			set_shadow_pte(spte, shadow_trap_nonpresent_pte);
656
			spte = NULL;
M
Marcelo Tosatti 已提交
657 658 659 660 661
			write_protected = 1;
		}
		spte = rmap_next(kvm, rmapp, spte);
	}

662 663
	if (write_protected)
		kvm_flush_remote_tlbs(kvm);
664 665
}

666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723
static int kvm_unmap_rmapp(struct kvm *kvm, unsigned long *rmapp)
{
	u64 *spte;
	int need_tlb_flush = 0;

	while ((spte = rmap_next(kvm, rmapp, NULL))) {
		BUG_ON(!(*spte & PT_PRESENT_MASK));
		rmap_printk("kvm_rmap_unmap_hva: spte %p %llx\n", spte, *spte);
		rmap_remove(kvm, spte);
		set_shadow_pte(spte, shadow_trap_nonpresent_pte);
		need_tlb_flush = 1;
	}
	return need_tlb_flush;
}

static int kvm_handle_hva(struct kvm *kvm, unsigned long hva,
			  int (*handler)(struct kvm *kvm, unsigned long *rmapp))
{
	int i;
	int retval = 0;

	/*
	 * If mmap_sem isn't taken, we can look the memslots with only
	 * the mmu_lock by skipping over the slots with userspace_addr == 0.
	 */
	for (i = 0; i < kvm->nmemslots; i++) {
		struct kvm_memory_slot *memslot = &kvm->memslots[i];
		unsigned long start = memslot->userspace_addr;
		unsigned long end;

		/* mmu_lock protects userspace_addr */
		if (!start)
			continue;

		end = start + (memslot->npages << PAGE_SHIFT);
		if (hva >= start && hva < end) {
			gfn_t gfn_offset = (hva - start) >> PAGE_SHIFT;
			retval |= handler(kvm, &memslot->rmap[gfn_offset]);
			retval |= handler(kvm,
					  &memslot->lpage_info[
						  gfn_offset /
						  KVM_PAGES_PER_HPAGE].rmap_pde);
		}
	}

	return retval;
}

int kvm_unmap_hva(struct kvm *kvm, unsigned long hva)
{
	return kvm_handle_hva(kvm, hva, kvm_unmap_rmapp);
}

static int kvm_age_rmapp(struct kvm *kvm, unsigned long *rmapp)
{
	u64 *spte;
	int young = 0;

724 725 726 727
	/* always return old for EPT */
	if (!shadow_accessed_mask)
		return 0;

728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747
	spte = rmap_next(kvm, rmapp, NULL);
	while (spte) {
		int _young;
		u64 _spte = *spte;
		BUG_ON(!(_spte & PT_PRESENT_MASK));
		_young = _spte & PT_ACCESSED_MASK;
		if (_young) {
			young = 1;
			clear_bit(PT_ACCESSED_SHIFT, (unsigned long *)spte);
		}
		spte = rmap_next(kvm, rmapp, spte);
	}
	return young;
}

int kvm_age_hva(struct kvm *kvm, unsigned long hva)
{
	return kvm_handle_hva(kvm, hva, kvm_age_rmapp);
}

748
#ifdef MMU_DEBUG
749
static int is_empty_shadow_page(u64 *spt)
A
Avi Kivity 已提交
750
{
751 752 753
	u64 *pos;
	u64 *end;

754
	for (pos = spt, end = pos + PAGE_SIZE / sizeof(u64); pos != end; pos++)
755
		if (is_shadow_present_pte(*pos)) {
756
			printk(KERN_ERR "%s: %p %llx\n", __func__,
757
			       pos, *pos);
A
Avi Kivity 已提交
758
			return 0;
759
		}
A
Avi Kivity 已提交
760 761
	return 1;
}
762
#endif
A
Avi Kivity 已提交
763

764
static void kvm_mmu_free_page(struct kvm *kvm, struct kvm_mmu_page *sp)
765
{
766 767 768 769 770
	ASSERT(is_empty_shadow_page(sp->spt));
	list_del(&sp->link);
	__free_page(virt_to_page(sp->spt));
	__free_page(virt_to_page(sp->gfns));
	kfree(sp);
771
	++kvm->arch.n_free_mmu_pages;
772 773
}

774 775
static unsigned kvm_page_table_hashfn(gfn_t gfn)
{
776
	return gfn & ((1 << KVM_MMU_HASH_SHIFT) - 1);
777 778
}

779 780
static struct kvm_mmu_page *kvm_mmu_alloc_page(struct kvm_vcpu *vcpu,
					       u64 *parent_pte)
A
Avi Kivity 已提交
781
{
782
	struct kvm_mmu_page *sp;
A
Avi Kivity 已提交
783

784 785 786
	sp = mmu_memory_cache_alloc(&vcpu->arch.mmu_page_header_cache, sizeof *sp);
	sp->spt = mmu_memory_cache_alloc(&vcpu->arch.mmu_page_cache, PAGE_SIZE);
	sp->gfns = mmu_memory_cache_alloc(&vcpu->arch.mmu_page_cache, PAGE_SIZE);
787
	set_page_private(virt_to_page(sp->spt), (unsigned long)sp);
788
	list_add(&sp->link, &vcpu->kvm->arch.active_mmu_pages);
789 790 791 792
	ASSERT(is_empty_shadow_page(sp->spt));
	sp->slot_bitmap = 0;
	sp->multimapped = 0;
	sp->parent_pte = parent_pte;
793
	--vcpu->kvm->arch.n_free_mmu_pages;
794
	return sp;
A
Avi Kivity 已提交
795 796
}

797
static void mmu_page_add_parent_pte(struct kvm_vcpu *vcpu,
798
				    struct kvm_mmu_page *sp, u64 *parent_pte)
799 800 801 802 803 804 805
{
	struct kvm_pte_chain *pte_chain;
	struct hlist_node *node;
	int i;

	if (!parent_pte)
		return;
806 807
	if (!sp->multimapped) {
		u64 *old = sp->parent_pte;
808 809

		if (!old) {
810
			sp->parent_pte = parent_pte;
811 812
			return;
		}
813
		sp->multimapped = 1;
814
		pte_chain = mmu_alloc_pte_chain(vcpu);
815 816
		INIT_HLIST_HEAD(&sp->parent_ptes);
		hlist_add_head(&pte_chain->link, &sp->parent_ptes);
817 818
		pte_chain->parent_ptes[0] = old;
	}
819
	hlist_for_each_entry(pte_chain, node, &sp->parent_ptes, link) {
820 821 822 823 824 825 826 827
		if (pte_chain->parent_ptes[NR_PTE_CHAIN_ENTRIES-1])
			continue;
		for (i = 0; i < NR_PTE_CHAIN_ENTRIES; ++i)
			if (!pte_chain->parent_ptes[i]) {
				pte_chain->parent_ptes[i] = parent_pte;
				return;
			}
	}
828
	pte_chain = mmu_alloc_pte_chain(vcpu);
829
	BUG_ON(!pte_chain);
830
	hlist_add_head(&pte_chain->link, &sp->parent_ptes);
831 832 833
	pte_chain->parent_ptes[0] = parent_pte;
}

834
static void mmu_page_remove_parent_pte(struct kvm_mmu_page *sp,
835 836 837 838 839 840
				       u64 *parent_pte)
{
	struct kvm_pte_chain *pte_chain;
	struct hlist_node *node;
	int i;

841 842 843
	if (!sp->multimapped) {
		BUG_ON(sp->parent_pte != parent_pte);
		sp->parent_pte = NULL;
844 845
		return;
	}
846
	hlist_for_each_entry(pte_chain, node, &sp->parent_ptes, link)
847 848 849 850 851
		for (i = 0; i < NR_PTE_CHAIN_ENTRIES; ++i) {
			if (!pte_chain->parent_ptes[i])
				break;
			if (pte_chain->parent_ptes[i] != parent_pte)
				continue;
852 853
			while (i + 1 < NR_PTE_CHAIN_ENTRIES
				&& pte_chain->parent_ptes[i + 1]) {
854 855 856 857 858
				pte_chain->parent_ptes[i]
					= pte_chain->parent_ptes[i + 1];
				++i;
			}
			pte_chain->parent_ptes[i] = NULL;
859 860
			if (i == 0) {
				hlist_del(&pte_chain->link);
861
				mmu_free_pte_chain(pte_chain);
862 863 864
				if (hlist_empty(&sp->parent_ptes)) {
					sp->multimapped = 0;
					sp->parent_pte = NULL;
865 866
				}
			}
867 868 869 870 871
			return;
		}
	BUG();
}

M
Marcelo Tosatti 已提交
872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896

static void mmu_parent_walk(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp,
			    mmu_parent_walk_fn fn)
{
	struct kvm_pte_chain *pte_chain;
	struct hlist_node *node;
	struct kvm_mmu_page *parent_sp;
	int i;

	if (!sp->multimapped && sp->parent_pte) {
		parent_sp = page_header(__pa(sp->parent_pte));
		fn(vcpu, parent_sp);
		mmu_parent_walk(vcpu, parent_sp, fn);
		return;
	}
	hlist_for_each_entry(pte_chain, node, &sp->parent_ptes, link)
		for (i = 0; i < NR_PTE_CHAIN_ENTRIES; ++i) {
			if (!pte_chain->parent_ptes[i])
				break;
			parent_sp = page_header(__pa(pte_chain->parent_ptes[i]));
			fn(vcpu, parent_sp);
			mmu_parent_walk(vcpu, parent_sp, fn);
		}
}

897 898 899 900 901 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 937 938 939 940 941 942
static void kvm_mmu_update_unsync_bitmap(u64 *spte)
{
	unsigned int index;
	struct kvm_mmu_page *sp = page_header(__pa(spte));

	index = spte - sp->spt;
	__set_bit(index, sp->unsync_child_bitmap);
	sp->unsync_children = 1;
}

static void kvm_mmu_update_parents_unsync(struct kvm_mmu_page *sp)
{
	struct kvm_pte_chain *pte_chain;
	struct hlist_node *node;
	int i;

	if (!sp->parent_pte)
		return;

	if (!sp->multimapped) {
		kvm_mmu_update_unsync_bitmap(sp->parent_pte);
		return;
	}

	hlist_for_each_entry(pte_chain, node, &sp->parent_ptes, link)
		for (i = 0; i < NR_PTE_CHAIN_ENTRIES; ++i) {
			if (!pte_chain->parent_ptes[i])
				break;
			kvm_mmu_update_unsync_bitmap(pte_chain->parent_ptes[i]);
		}
}

static int unsync_walk_fn(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp)
{
	sp->unsync_children = 1;
	kvm_mmu_update_parents_unsync(sp);
	return 1;
}

static void kvm_mmu_mark_parents_unsync(struct kvm_vcpu *vcpu,
					struct kvm_mmu_page *sp)
{
	mmu_parent_walk(vcpu, sp, unsync_walk_fn);
	kvm_mmu_update_parents_unsync(sp);
}

943 944 945 946 947 948 949 950 951
static void nonpaging_prefetch_page(struct kvm_vcpu *vcpu,
				    struct kvm_mmu_page *sp)
{
	int i;

	for (i = 0; i < PT64_ENT_PER_PAGE; ++i)
		sp->spt[i] = shadow_trap_nonpresent_pte;
}

952 953 954 955 956 957
static int nonpaging_sync_page(struct kvm_vcpu *vcpu,
			       struct kvm_mmu_page *sp)
{
	return 1;
}

M
Marcelo Tosatti 已提交
958 959 960 961
static void nonpaging_invlpg(struct kvm_vcpu *vcpu, gva_t gva)
{
}

962 963 964 965 966
#define for_each_unsync_children(bitmap, idx)		\
	for (idx = find_first_bit(bitmap, 512);		\
	     idx < 512;					\
	     idx = find_next_bit(bitmap, 512, idx+1))

967 968 969 970 971 972 973 974
static int mmu_unsync_walk(struct kvm_mmu_page *sp,
			   struct kvm_unsync_walk *walker)
{
	int i, ret;

	if (!sp->unsync_children)
		return 0;

975
	for_each_unsync_children(sp->unsync_child_bitmap, i) {
976 977 978 979 980 981 982 983 984 985
		u64 ent = sp->spt[i];

		if (is_shadow_present_pte(ent)) {
			struct kvm_mmu_page *child;
			child = page_header(ent & PT64_BASE_ADDR_MASK);

			if (child->unsync_children) {
				ret = mmu_unsync_walk(child, walker);
				if (ret)
					return ret;
986
				__clear_bit(i, sp->unsync_child_bitmap);
987 988 989 990
			}

			if (child->unsync) {
				ret = walker->entry(child, walker);
991
				__clear_bit(i, sp->unsync_child_bitmap);
992 993 994 995 996 997
				if (ret)
					return ret;
			}
		}
	}

998
	if (find_first_bit(sp->unsync_child_bitmap, 512) == 512)
999 1000 1001 1002 1003
		sp->unsync_children = 0;

	return 0;
}

1004
static struct kvm_mmu_page *kvm_mmu_lookup_page(struct kvm *kvm, gfn_t gfn)
1005 1006 1007
{
	unsigned index;
	struct hlist_head *bucket;
1008
	struct kvm_mmu_page *sp;
1009 1010
	struct hlist_node *node;

1011
	pgprintk("%s: looking for gfn %lx\n", __func__, gfn);
1012
	index = kvm_page_table_hashfn(gfn);
1013
	bucket = &kvm->arch.mmu_page_hash[index];
1014
	hlist_for_each_entry(sp, node, bucket, hash_link)
1015 1016
		if (sp->gfn == gfn && !sp->role.metaphysical
		    && !sp->role.invalid) {
1017
			pgprintk("%s: found role %x\n",
1018
				 __func__, sp->role.word);
1019
			return sp;
1020 1021 1022 1023
		}
	return NULL;
}

1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040
static void kvm_unlink_unsync_page(struct kvm *kvm, struct kvm_mmu_page *sp)
{
	WARN_ON(!sp->unsync);
	sp->unsync = 0;
	--kvm->stat.mmu_unsync;
}

static int kvm_mmu_zap_page(struct kvm *kvm, struct kvm_mmu_page *sp);

static int kvm_sync_page(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp)
{
	if (sp->role.glevels != vcpu->arch.mmu.root_level) {
		kvm_mmu_zap_page(vcpu->kvm, sp);
		return 1;
	}

	rmap_write_protect(vcpu->kvm, sp->gfn);
1041
	kvm_unlink_unsync_page(vcpu->kvm, sp);
1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076
	if (vcpu->arch.mmu.sync_page(vcpu, sp)) {
		kvm_mmu_zap_page(vcpu->kvm, sp);
		return 1;
	}

	kvm_mmu_flush_tlb(vcpu);
	return 0;
}

struct sync_walker {
	struct kvm_vcpu *vcpu;
	struct kvm_unsync_walk walker;
};

static int mmu_sync_fn(struct kvm_mmu_page *sp, struct kvm_unsync_walk *walk)
{
	struct sync_walker *sync_walk = container_of(walk, struct sync_walker,
						     walker);
	struct kvm_vcpu *vcpu = sync_walk->vcpu;

	kvm_sync_page(vcpu, sp);
	return (need_resched() || spin_needbreak(&vcpu->kvm->mmu_lock));
}

static void mmu_sync_children(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp)
{
	struct sync_walker walker = {
		.walker = { .entry = mmu_sync_fn, },
		.vcpu = vcpu,
	};

	while (mmu_unsync_walk(sp, &walker.walker))
		cond_resched_lock(&vcpu->kvm->mmu_lock);
}

1077 1078 1079 1080 1081
static struct kvm_mmu_page *kvm_mmu_get_page(struct kvm_vcpu *vcpu,
					     gfn_t gfn,
					     gva_t gaddr,
					     unsigned level,
					     int metaphysical,
1082
					     unsigned access,
1083
					     u64 *parent_pte)
1084 1085 1086 1087 1088
{
	union kvm_mmu_page_role role;
	unsigned index;
	unsigned quadrant;
	struct hlist_head *bucket;
1089
	struct kvm_mmu_page *sp;
1090
	struct hlist_node *node, *tmp;
1091 1092

	role.word = 0;
1093
	role.glevels = vcpu->arch.mmu.root_level;
1094 1095
	role.level = level;
	role.metaphysical = metaphysical;
1096
	role.access = access;
1097
	if (vcpu->arch.mmu.root_level <= PT32_ROOT_LEVEL) {
1098 1099 1100 1101
		quadrant = gaddr >> (PAGE_SHIFT + (PT64_PT_BITS * level));
		quadrant &= (1 << ((PT32_PT_BITS - PT64_PT_BITS) * level)) - 1;
		role.quadrant = quadrant;
	}
1102
	pgprintk("%s: looking gfn %lx role %x\n", __func__,
1103
		 gfn, role.word);
1104
	index = kvm_page_table_hashfn(gfn);
1105
	bucket = &vcpu->kvm->arch.mmu_page_hash[index];
1106 1107 1108 1109 1110 1111 1112 1113 1114
	hlist_for_each_entry_safe(sp, node, tmp, bucket, hash_link)
		if (sp->gfn == gfn) {
			if (sp->unsync)
				if (kvm_sync_page(vcpu, sp))
					continue;

			if (sp->role.word != role.word)
				continue;

1115
			mmu_page_add_parent_pte(vcpu, sp, parent_pte);
1116 1117 1118 1119
			if (sp->unsync_children) {
				set_bit(KVM_REQ_MMU_SYNC, &vcpu->requests);
				kvm_mmu_mark_parents_unsync(vcpu, sp);
			}
1120
			pgprintk("%s: found\n", __func__);
1121
			return sp;
1122
		}
A
Avi Kivity 已提交
1123
	++vcpu->kvm->stat.mmu_cache_miss;
1124 1125 1126
	sp = kvm_mmu_alloc_page(vcpu, parent_pte);
	if (!sp)
		return sp;
1127
	pgprintk("%s: adding gfn %lx role %x\n", __func__, gfn, role.word);
1128 1129 1130
	sp->gfn = gfn;
	sp->role = role;
	hlist_add_head(&sp->hash_link, bucket);
1131
	if (!metaphysical) {
1132
		rmap_write_protect(vcpu->kvm, gfn);
1133 1134
		account_shadowed(vcpu->kvm, gfn);
	}
1135 1136 1137 1138
	if (shadow_trap_nonpresent_pte != shadow_notrap_nonpresent_pte)
		vcpu->arch.mmu.prefetch_page(vcpu, sp);
	else
		nonpaging_prefetch_page(vcpu, sp);
1139
	return sp;
1140 1141
}

A
Avi Kivity 已提交
1142
static int walk_shadow(struct kvm_shadow_walk *walker,
1143
		       struct kvm_vcpu *vcpu, u64 addr)
A
Avi Kivity 已提交
1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170
{
	hpa_t shadow_addr;
	int level;
	int r;
	u64 *sptep;
	unsigned index;

	shadow_addr = vcpu->arch.mmu.root_hpa;
	level = vcpu->arch.mmu.shadow_root_level;
	if (level == PT32E_ROOT_LEVEL) {
		shadow_addr = vcpu->arch.mmu.pae_root[(addr >> 30) & 3];
		shadow_addr &= PT64_BASE_ADDR_MASK;
		--level;
	}

	while (level >= PT_PAGE_TABLE_LEVEL) {
		index = SHADOW_PT_INDEX(addr, level);
		sptep = ((u64 *)__va(shadow_addr)) + index;
		r = walker->entry(walker, vcpu, addr, sptep, level);
		if (r)
			return r;
		shadow_addr = *sptep & PT64_BASE_ADDR_MASK;
		--level;
	}
	return 0;
}

1171
static void kvm_mmu_page_unlink_children(struct kvm *kvm,
1172
					 struct kvm_mmu_page *sp)
1173
{
1174 1175 1176 1177
	unsigned i;
	u64 *pt;
	u64 ent;

1178
	pt = sp->spt;
1179

1180
	if (sp->role.level == PT_PAGE_TABLE_LEVEL) {
1181
		for (i = 0; i < PT64_ENT_PER_PAGE; ++i) {
1182
			if (is_shadow_present_pte(pt[i]))
1183
				rmap_remove(kvm, &pt[i]);
1184
			pt[i] = shadow_trap_nonpresent_pte;
1185 1186 1187 1188 1189 1190 1191
		}
		return;
	}

	for (i = 0; i < PT64_ENT_PER_PAGE; ++i) {
		ent = pt[i];

M
Marcelo Tosatti 已提交
1192 1193 1194 1195 1196 1197 1198 1199 1200 1201
		if (is_shadow_present_pte(ent)) {
			if (!is_large_pte(ent)) {
				ent &= PT64_BASE_ADDR_MASK;
				mmu_page_remove_parent_pte(page_header(ent),
							   &pt[i]);
			} else {
				--kvm->stat.lpages;
				rmap_remove(kvm, &pt[i]);
			}
		}
1202
		pt[i] = shadow_trap_nonpresent_pte;
1203
	}
1204 1205
}

1206
static void kvm_mmu_put_page(struct kvm_mmu_page *sp, u64 *parent_pte)
1207
{
1208
	mmu_page_remove_parent_pte(sp, parent_pte);
1209 1210
}

1211 1212 1213 1214 1215 1216
static void kvm_mmu_reset_last_pte_updated(struct kvm *kvm)
{
	int i;

	for (i = 0; i < KVM_MAX_VCPUS; ++i)
		if (kvm->vcpus[i])
1217
			kvm->vcpus[i]->arch.last_pte_updated = NULL;
1218 1219
}

1220
static void kvm_mmu_unlink_parents(struct kvm *kvm, struct kvm_mmu_page *sp)
1221 1222 1223
{
	u64 *parent_pte;

1224 1225 1226
	while (sp->multimapped || sp->parent_pte) {
		if (!sp->multimapped)
			parent_pte = sp->parent_pte;
1227 1228 1229
		else {
			struct kvm_pte_chain *chain;

1230
			chain = container_of(sp->parent_ptes.first,
1231 1232 1233
					     struct kvm_pte_chain, link);
			parent_pte = chain->parent_ptes[0];
		}
1234
		BUG_ON(!parent_pte);
1235
		kvm_mmu_put_page(sp, parent_pte);
1236
		set_shadow_pte(parent_pte, shadow_trap_nonpresent_pte);
1237
	}
1238 1239
}

1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268
struct zap_walker {
	struct kvm_unsync_walk walker;
	struct kvm *kvm;
	int zapped;
};

static int mmu_zap_fn(struct kvm_mmu_page *sp, struct kvm_unsync_walk *walk)
{
	struct zap_walker *zap_walk = container_of(walk, struct zap_walker,
						     walker);
	kvm_mmu_zap_page(zap_walk->kvm, sp);
	zap_walk->zapped = 1;
	return 0;
}

static int mmu_zap_unsync_children(struct kvm *kvm, struct kvm_mmu_page *sp)
{
	struct zap_walker walker = {
		.walker = { .entry = mmu_zap_fn, },
		.kvm = kvm,
		.zapped = 0,
	};

	if (sp->role.level == PT_PAGE_TABLE_LEVEL)
		return 0;
	mmu_unsync_walk(sp, &walker.walker);
	return walker.zapped;
}

1269
static int kvm_mmu_zap_page(struct kvm *kvm, struct kvm_mmu_page *sp)
1270
{
1271
	int ret;
1272
	++kvm->stat.mmu_shadow_zapped;
1273
	ret = mmu_zap_unsync_children(kvm, sp);
1274
	kvm_mmu_page_unlink_children(kvm, sp);
1275
	kvm_mmu_unlink_parents(kvm, sp);
A
Avi Kivity 已提交
1276 1277 1278
	kvm_flush_remote_tlbs(kvm);
	if (!sp->role.invalid && !sp->role.metaphysical)
		unaccount_shadowed(kvm, sp->gfn);
1279 1280
	if (sp->unsync)
		kvm_unlink_unsync_page(kvm, sp);
1281 1282 1283
	if (!sp->root_count) {
		hlist_del(&sp->hash_link);
		kvm_mmu_free_page(kvm, sp);
1284 1285
	} else {
		sp->role.invalid = 1;
A
Avi Kivity 已提交
1286
		list_move(&sp->link, &kvm->arch.active_mmu_pages);
1287 1288
		kvm_reload_remote_mmus(kvm);
	}
1289
	kvm_mmu_reset_last_pte_updated(kvm);
1290
	return ret;
1291 1292
}

1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304
/*
 * Changing the number of mmu pages allocated to the vm
 * Note: if kvm_nr_mmu_pages is too small, you will get dead lock
 */
void kvm_mmu_change_mmu_pages(struct kvm *kvm, unsigned int kvm_nr_mmu_pages)
{
	/*
	 * If we set the number of mmu pages to be smaller be than the
	 * number of actived pages , we must to free some mmu pages before we
	 * change the value
	 */

1305
	if ((kvm->arch.n_alloc_mmu_pages - kvm->arch.n_free_mmu_pages) >
1306
	    kvm_nr_mmu_pages) {
1307 1308
		int n_used_mmu_pages = kvm->arch.n_alloc_mmu_pages
				       - kvm->arch.n_free_mmu_pages;
1309 1310 1311 1312

		while (n_used_mmu_pages > kvm_nr_mmu_pages) {
			struct kvm_mmu_page *page;

1313
			page = container_of(kvm->arch.active_mmu_pages.prev,
1314 1315 1316 1317
					    struct kvm_mmu_page, link);
			kvm_mmu_zap_page(kvm, page);
			n_used_mmu_pages--;
		}
1318
		kvm->arch.n_free_mmu_pages = 0;
1319 1320
	}
	else
1321 1322
		kvm->arch.n_free_mmu_pages += kvm_nr_mmu_pages
					 - kvm->arch.n_alloc_mmu_pages;
1323

1324
	kvm->arch.n_alloc_mmu_pages = kvm_nr_mmu_pages;
1325 1326
}

1327
static int kvm_mmu_unprotect_page(struct kvm *kvm, gfn_t gfn)
1328 1329 1330
{
	unsigned index;
	struct hlist_head *bucket;
1331
	struct kvm_mmu_page *sp;
1332 1333 1334
	struct hlist_node *node, *n;
	int r;

1335
	pgprintk("%s: looking for gfn %lx\n", __func__, gfn);
1336
	r = 0;
1337
	index = kvm_page_table_hashfn(gfn);
1338
	bucket = &kvm->arch.mmu_page_hash[index];
1339 1340
	hlist_for_each_entry_safe(sp, node, n, bucket, hash_link)
		if (sp->gfn == gfn && !sp->role.metaphysical) {
1341
			pgprintk("%s: gfn %lx role %x\n", __func__, gfn,
1342
				 sp->role.word);
1343
			r = 1;
1344 1345
			if (kvm_mmu_zap_page(kvm, sp))
				n = bucket->first;
1346 1347
		}
	return r;
1348 1349
}

1350
static void mmu_unshadow(struct kvm *kvm, gfn_t gfn)
1351
{
1352
	struct kvm_mmu_page *sp;
1353

1354
	while ((sp = kvm_mmu_lookup_page(kvm, gfn)) != NULL) {
1355
		pgprintk("%s: zap %lx %x\n", __func__, gfn, sp->role.word);
1356
		kvm_mmu_zap_page(kvm, sp);
1357 1358 1359
	}
}

1360
static void page_header_update_slot(struct kvm *kvm, void *pte, gfn_t gfn)
A
Avi Kivity 已提交
1361
{
1362
	int slot = memslot_id(kvm, gfn_to_memslot(kvm, gfn));
1363
	struct kvm_mmu_page *sp = page_header(__pa(pte));
A
Avi Kivity 已提交
1364

1365
	__set_bit(slot, &sp->slot_bitmap);
A
Avi Kivity 已提交
1366 1367
}

1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381
static void mmu_convert_notrap(struct kvm_mmu_page *sp)
{
	int i;
	u64 *pt = sp->spt;

	if (shadow_trap_nonpresent_pte == shadow_notrap_nonpresent_pte)
		return;

	for (i = 0; i < PT64_ENT_PER_PAGE; ++i) {
		if (pt[i] == shadow_notrap_nonpresent_pte)
			set_shadow_pte(&pt[i], shadow_trap_nonpresent_pte);
	}
}

1382 1383
struct page *gva_to_page(struct kvm_vcpu *vcpu, gva_t gva)
{
1384 1385
	struct page *page;

1386
	gpa_t gpa = vcpu->arch.mmu.gva_to_gpa(vcpu, gva);
1387 1388 1389

	if (gpa == UNMAPPED_GVA)
		return NULL;
1390 1391 1392 1393

	page = gfn_to_page(vcpu->kvm, gpa >> PAGE_SHIFT);

	return page;
1394 1395
}

1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499
/*
 * The function is based on mtrr_type_lookup() in
 * arch/x86/kernel/cpu/mtrr/generic.c
 */
static int get_mtrr_type(struct mtrr_state_type *mtrr_state,
			 u64 start, u64 end)
{
	int i;
	u64 base, mask;
	u8 prev_match, curr_match;
	int num_var_ranges = KVM_NR_VAR_MTRR;

	if (!mtrr_state->enabled)
		return 0xFF;

	/* Make end inclusive end, instead of exclusive */
	end--;

	/* Look in fixed ranges. Just return the type as per start */
	if (mtrr_state->have_fixed && (start < 0x100000)) {
		int idx;

		if (start < 0x80000) {
			idx = 0;
			idx += (start >> 16);
			return mtrr_state->fixed_ranges[idx];
		} else if (start < 0xC0000) {
			idx = 1 * 8;
			idx += ((start - 0x80000) >> 14);
			return mtrr_state->fixed_ranges[idx];
		} else if (start < 0x1000000) {
			idx = 3 * 8;
			idx += ((start - 0xC0000) >> 12);
			return mtrr_state->fixed_ranges[idx];
		}
	}

	/*
	 * Look in variable ranges
	 * Look of multiple ranges matching this address and pick type
	 * as per MTRR precedence
	 */
	if (!(mtrr_state->enabled & 2))
		return mtrr_state->def_type;

	prev_match = 0xFF;
	for (i = 0; i < num_var_ranges; ++i) {
		unsigned short start_state, end_state;

		if (!(mtrr_state->var_ranges[i].mask_lo & (1 << 11)))
			continue;

		base = (((u64)mtrr_state->var_ranges[i].base_hi) << 32) +
		       (mtrr_state->var_ranges[i].base_lo & PAGE_MASK);
		mask = (((u64)mtrr_state->var_ranges[i].mask_hi) << 32) +
		       (mtrr_state->var_ranges[i].mask_lo & PAGE_MASK);

		start_state = ((start & mask) == (base & mask));
		end_state = ((end & mask) == (base & mask));
		if (start_state != end_state)
			return 0xFE;

		if ((start & mask) != (base & mask))
			continue;

		curr_match = mtrr_state->var_ranges[i].base_lo & 0xff;
		if (prev_match == 0xFF) {
			prev_match = curr_match;
			continue;
		}

		if (prev_match == MTRR_TYPE_UNCACHABLE ||
		    curr_match == MTRR_TYPE_UNCACHABLE)
			return MTRR_TYPE_UNCACHABLE;

		if ((prev_match == MTRR_TYPE_WRBACK &&
		     curr_match == MTRR_TYPE_WRTHROUGH) ||
		    (prev_match == MTRR_TYPE_WRTHROUGH &&
		     curr_match == MTRR_TYPE_WRBACK)) {
			prev_match = MTRR_TYPE_WRTHROUGH;
			curr_match = MTRR_TYPE_WRTHROUGH;
		}

		if (prev_match != curr_match)
			return MTRR_TYPE_UNCACHABLE;
	}

	if (prev_match != 0xFF)
		return prev_match;

	return mtrr_state->def_type;
}

static u8 get_memory_type(struct kvm_vcpu *vcpu, gfn_t gfn)
{
	u8 mtrr;

	mtrr = get_mtrr_type(&vcpu->arch.mtrr_state, gfn << PAGE_SHIFT,
			     (gfn << PAGE_SHIFT) + PAGE_SIZE);
	if (mtrr == 0xfe || mtrr == 0xff)
		mtrr = MTRR_TYPE_WRBACK;
	return mtrr;
}

1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515
static int kvm_unsync_page(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp)
{
	unsigned index;
	struct hlist_head *bucket;
	struct kvm_mmu_page *s;
	struct hlist_node *node, *n;

	index = kvm_page_table_hashfn(sp->gfn);
	bucket = &vcpu->kvm->arch.mmu_page_hash[index];
	/* don't unsync if pagetable is shadowed with multiple roles */
	hlist_for_each_entry_safe(s, node, n, bucket, hash_link) {
		if (s->gfn != sp->gfn || s->role.metaphysical)
			continue;
		if (s->role.word != sp->role.word)
			return 1;
	}
1516
	kvm_mmu_mark_parents_unsync(vcpu, sp);
1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533
	++vcpu->kvm->stat.mmu_unsync;
	sp->unsync = 1;
	mmu_convert_notrap(sp);
	return 0;
}

static int mmu_need_write_protect(struct kvm_vcpu *vcpu, gfn_t gfn,
				  bool can_unsync)
{
	struct kvm_mmu_page *shadow;

	shadow = kvm_mmu_lookup_page(vcpu->kvm, gfn);
	if (shadow) {
		if (shadow->role.level != PT_PAGE_TABLE_LEVEL)
			return 1;
		if (shadow->unsync)
			return 0;
1534
		if (can_unsync && oos_shadow)
1535 1536 1537 1538 1539 1540
			return kvm_unsync_page(vcpu, shadow);
		return 1;
	}
	return 0;
}

M
Marcelo Tosatti 已提交
1541 1542 1543
static int set_spte(struct kvm_vcpu *vcpu, u64 *shadow_pte,
		    unsigned pte_access, int user_fault,
		    int write_fault, int dirty, int largepage,
1544 1545
		    gfn_t gfn, pfn_t pfn, bool speculative,
		    bool can_unsync)
1546 1547
{
	u64 spte;
M
Marcelo Tosatti 已提交
1548
	int ret = 0;
1549 1550 1551 1552 1553
	/*
	 * We don't set the accessed bit, since we sometimes want to see
	 * whether the guest actually used the pte (in order to detect
	 * demand paging).
	 */
S
Sheng Yang 已提交
1554
	spte = shadow_base_present_pte | shadow_dirty_mask;
1555
	if (!speculative)
1556
		spte |= shadow_accessed_mask;
1557 1558
	if (!dirty)
		pte_access &= ~ACC_WRITE_MASK;
S
Sheng Yang 已提交
1559 1560 1561 1562
	if (pte_access & ACC_EXEC_MASK)
		spte |= shadow_x_mask;
	else
		spte |= shadow_nx_mask;
1563
	if (pte_access & ACC_USER_MASK)
S
Sheng Yang 已提交
1564
		spte |= shadow_user_mask;
M
Marcelo Tosatti 已提交
1565 1566
	if (largepage)
		spte |= PT_PAGE_SIZE_MASK;
1567

1568
	spte |= (u64)pfn << PAGE_SHIFT;
1569 1570 1571 1572

	if ((pte_access & ACC_WRITE_MASK)
	    || (write_fault && !is_write_protection(vcpu) && !user_fault)) {

1573 1574 1575 1576 1577 1578
		if (largepage && has_wrprotected_page(vcpu->kvm, gfn)) {
			ret = 1;
			spte = shadow_trap_nonpresent_pte;
			goto set_pte;
		}

1579 1580
		spte |= PT_WRITABLE_MASK;

1581
		if (mmu_need_write_protect(vcpu, gfn, can_unsync)) {
1582
			pgprintk("%s: found shadow page for %lx, marking ro\n",
1583
				 __func__, gfn);
M
Marcelo Tosatti 已提交
1584
			ret = 1;
1585
			pte_access &= ~ACC_WRITE_MASK;
1586
			if (is_writeble_pte(spte))
1587 1588 1589 1590 1591 1592 1593
				spte &= ~PT_WRITABLE_MASK;
		}
	}

	if (pte_access & ACC_WRITE_MASK)
		mark_page_dirty(vcpu->kvm, gfn);

1594
set_pte:
1595
	set_shadow_pte(shadow_pte, spte);
M
Marcelo Tosatti 已提交
1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635
	return ret;
}

static void mmu_set_spte(struct kvm_vcpu *vcpu, u64 *shadow_pte,
			 unsigned pt_access, unsigned pte_access,
			 int user_fault, int write_fault, int dirty,
			 int *ptwrite, int largepage, gfn_t gfn,
			 pfn_t pfn, bool speculative)
{
	int was_rmapped = 0;
	int was_writeble = is_writeble_pte(*shadow_pte);

	pgprintk("%s: spte %llx access %x write_fault %d"
		 " user_fault %d gfn %lx\n",
		 __func__, *shadow_pte, pt_access,
		 write_fault, user_fault, gfn);

	if (is_rmap_pte(*shadow_pte)) {
		/*
		 * If we overwrite a PTE page pointer with a 2MB PMD, unlink
		 * the parent of the now unreachable PTE.
		 */
		if (largepage && !is_large_pte(*shadow_pte)) {
			struct kvm_mmu_page *child;
			u64 pte = *shadow_pte;

			child = page_header(pte & PT64_BASE_ADDR_MASK);
			mmu_page_remove_parent_pte(child, shadow_pte);
		} else if (pfn != spte_to_pfn(*shadow_pte)) {
			pgprintk("hfn old %lx new %lx\n",
				 spte_to_pfn(*shadow_pte), pfn);
			rmap_remove(vcpu->kvm, shadow_pte);
		} else {
			if (largepage)
				was_rmapped = is_large_pte(*shadow_pte);
			else
				was_rmapped = 1;
		}
	}
	if (set_spte(vcpu, shadow_pte, pte_access, user_fault, write_fault,
1636
		      dirty, largepage, gfn, pfn, speculative, true)) {
M
Marcelo Tosatti 已提交
1637 1638
		if (write_fault)
			*ptwrite = 1;
1639 1640
		kvm_x86_ops->tlb_flush(vcpu);
	}
M
Marcelo Tosatti 已提交
1641 1642 1643 1644 1645 1646 1647

	pgprintk("%s: setting spte %llx\n", __func__, *shadow_pte);
	pgprintk("instantiating %s PTE (%s) at %ld (%llx) addr %p\n",
		 is_large_pte(*shadow_pte)? "2MB" : "4kB",
		 is_present_pte(*shadow_pte)?"RW":"R", gfn,
		 *shadow_pte, shadow_pte);
	if (!was_rmapped && is_large_pte(*shadow_pte))
M
Marcelo Tosatti 已提交
1648 1649
		++vcpu->kvm->stat.lpages;

1650 1651
	page_header_update_slot(vcpu->kvm, shadow_pte, gfn);
	if (!was_rmapped) {
M
Marcelo Tosatti 已提交
1652
		rmap_add(vcpu, shadow_pte, gfn, largepage);
1653
		if (!is_rmap_pte(*shadow_pte))
1654
			kvm_release_pfn_clean(pfn);
1655 1656
	} else {
		if (was_writeble)
1657
			kvm_release_pfn_dirty(pfn);
1658
		else
1659
			kvm_release_pfn_clean(pfn);
1660
	}
1661
	if (speculative) {
1662
		vcpu->arch.last_pte_updated = shadow_pte;
1663 1664
		vcpu->arch.last_pte_gfn = gfn;
	}
1665 1666
}

A
Avi Kivity 已提交
1667 1668 1669 1670
static void nonpaging_new_cr3(struct kvm_vcpu *vcpu)
{
}

1671 1672 1673 1674 1675 1676 1677
struct direct_shadow_walk {
	struct kvm_shadow_walk walker;
	pfn_t pfn;
	int write;
	int largepage;
	int pt_write;
};
A
Avi Kivity 已提交
1678

1679 1680
static int direct_map_entry(struct kvm_shadow_walk *_walk,
			    struct kvm_vcpu *vcpu,
1681
			    u64 addr, u64 *sptep, int level)
1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693
{
	struct direct_shadow_walk *walk =
		container_of(_walk, struct direct_shadow_walk, walker);
	struct kvm_mmu_page *sp;
	gfn_t pseudo_gfn;
	gfn_t gfn = addr >> PAGE_SHIFT;

	if (level == PT_PAGE_TABLE_LEVEL
	    || (walk->largepage && level == PT_DIRECTORY_LEVEL)) {
		mmu_set_spte(vcpu, sptep, ACC_ALL, ACC_ALL,
			     0, walk->write, 1, &walk->pt_write,
			     walk->largepage, gfn, walk->pfn, false);
1694
		++vcpu->stat.pf_fixed;
1695 1696
		return 1;
	}
A
Avi Kivity 已提交
1697

1698 1699
	if (*sptep == shadow_trap_nonpresent_pte) {
		pseudo_gfn = (addr & PT64_DIR_BASE_ADDR_MASK) >> PAGE_SHIFT;
1700
		sp = kvm_mmu_get_page(vcpu, pseudo_gfn, (gva_t)addr, level - 1,
1701 1702 1703 1704 1705
				      1, ACC_ALL, sptep);
		if (!sp) {
			pgprintk("nonpaging_map: ENOMEM\n");
			kvm_release_pfn_clean(walk->pfn);
			return -ENOMEM;
A
Avi Kivity 已提交
1706 1707
		}

1708 1709 1710 1711
		set_shadow_pte(sptep,
			       __pa(sp->spt)
			       | PT_PRESENT_MASK | PT_WRITABLE_MASK
			       | shadow_user_mask | shadow_x_mask);
A
Avi Kivity 已提交
1712
	}
1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727
	return 0;
}

static int __direct_map(struct kvm_vcpu *vcpu, gpa_t v, int write,
			int largepage, gfn_t gfn, pfn_t pfn)
{
	int r;
	struct direct_shadow_walk walker = {
		.walker = { .entry = direct_map_entry, },
		.pfn = pfn,
		.largepage = largepage,
		.write = write,
		.pt_write = 0,
	};

1728
	r = walk_shadow(&walker.walker, vcpu, gfn << PAGE_SHIFT);
1729 1730 1731
	if (r < 0)
		return r;
	return walker.pt_write;
A
Avi Kivity 已提交
1732 1733
}

1734 1735 1736
static int nonpaging_map(struct kvm_vcpu *vcpu, gva_t v, int write, gfn_t gfn)
{
	int r;
M
Marcelo Tosatti 已提交
1737
	int largepage = 0;
1738
	pfn_t pfn;
1739
	unsigned long mmu_seq;
1740

M
Marcelo Tosatti 已提交
1741 1742 1743 1744 1745
	if (is_largepage_backed(vcpu, gfn & ~(KVM_PAGES_PER_HPAGE-1))) {
		gfn &= ~(KVM_PAGES_PER_HPAGE-1);
		largepage = 1;
	}

1746
	mmu_seq = vcpu->kvm->mmu_notifier_seq;
1747
	smp_rmb();
1748
	pfn = gfn_to_pfn(vcpu->kvm, gfn);
1749

1750
	/* mmio */
1751 1752
	if (is_error_pfn(pfn)) {
		kvm_release_pfn_clean(pfn);
1753 1754 1755
		return 1;
	}

1756
	spin_lock(&vcpu->kvm->mmu_lock);
1757 1758
	if (mmu_notifier_retry(vcpu, mmu_seq))
		goto out_unlock;
1759
	kvm_mmu_free_some_pages(vcpu);
1760
	r = __direct_map(vcpu, v, write, largepage, gfn, pfn);
1761 1762 1763
	spin_unlock(&vcpu->kvm->mmu_lock);


1764
	return r;
1765 1766 1767 1768 1769

out_unlock:
	spin_unlock(&vcpu->kvm->mmu_lock);
	kvm_release_pfn_clean(pfn);
	return 0;
1770 1771 1772
}


1773 1774 1775
static void mmu_free_roots(struct kvm_vcpu *vcpu)
{
	int i;
1776
	struct kvm_mmu_page *sp;
1777

1778
	if (!VALID_PAGE(vcpu->arch.mmu.root_hpa))
A
Avi Kivity 已提交
1779
		return;
1780
	spin_lock(&vcpu->kvm->mmu_lock);
1781 1782
	if (vcpu->arch.mmu.shadow_root_level == PT64_ROOT_LEVEL) {
		hpa_t root = vcpu->arch.mmu.root_hpa;
1783

1784 1785
		sp = page_header(root);
		--sp->root_count;
1786 1787
		if (!sp->root_count && sp->role.invalid)
			kvm_mmu_zap_page(vcpu->kvm, sp);
1788
		vcpu->arch.mmu.root_hpa = INVALID_PAGE;
1789
		spin_unlock(&vcpu->kvm->mmu_lock);
1790 1791 1792
		return;
	}
	for (i = 0; i < 4; ++i) {
1793
		hpa_t root = vcpu->arch.mmu.pae_root[i];
1794

A
Avi Kivity 已提交
1795 1796
		if (root) {
			root &= PT64_BASE_ADDR_MASK;
1797 1798
			sp = page_header(root);
			--sp->root_count;
1799 1800
			if (!sp->root_count && sp->role.invalid)
				kvm_mmu_zap_page(vcpu->kvm, sp);
A
Avi Kivity 已提交
1801
		}
1802
		vcpu->arch.mmu.pae_root[i] = INVALID_PAGE;
1803
	}
1804
	spin_unlock(&vcpu->kvm->mmu_lock);
1805
	vcpu->arch.mmu.root_hpa = INVALID_PAGE;
1806 1807 1808 1809 1810
}

static void mmu_alloc_roots(struct kvm_vcpu *vcpu)
{
	int i;
1811
	gfn_t root_gfn;
1812
	struct kvm_mmu_page *sp;
1813
	int metaphysical = 0;
1814

1815
	root_gfn = vcpu->arch.cr3 >> PAGE_SHIFT;
1816

1817 1818
	if (vcpu->arch.mmu.shadow_root_level == PT64_ROOT_LEVEL) {
		hpa_t root = vcpu->arch.mmu.root_hpa;
1819 1820

		ASSERT(!VALID_PAGE(root));
1821 1822
		if (tdp_enabled)
			metaphysical = 1;
1823
		sp = kvm_mmu_get_page(vcpu, root_gfn, 0,
1824 1825
				      PT64_ROOT_LEVEL, metaphysical,
				      ACC_ALL, NULL);
1826 1827
		root = __pa(sp->spt);
		++sp->root_count;
1828
		vcpu->arch.mmu.root_hpa = root;
1829 1830
		return;
	}
1831 1832 1833
	metaphysical = !is_paging(vcpu);
	if (tdp_enabled)
		metaphysical = 1;
1834
	for (i = 0; i < 4; ++i) {
1835
		hpa_t root = vcpu->arch.mmu.pae_root[i];
1836 1837

		ASSERT(!VALID_PAGE(root));
1838 1839 1840
		if (vcpu->arch.mmu.root_level == PT32E_ROOT_LEVEL) {
			if (!is_present_pte(vcpu->arch.pdptrs[i])) {
				vcpu->arch.mmu.pae_root[i] = 0;
A
Avi Kivity 已提交
1841 1842
				continue;
			}
1843 1844
			root_gfn = vcpu->arch.pdptrs[i] >> PAGE_SHIFT;
		} else if (vcpu->arch.mmu.root_level == 0)
1845
			root_gfn = 0;
1846
		sp = kvm_mmu_get_page(vcpu, root_gfn, i << 30,
1847
				      PT32_ROOT_LEVEL, metaphysical,
1848
				      ACC_ALL, NULL);
1849 1850
		root = __pa(sp->spt);
		++sp->root_count;
1851
		vcpu->arch.mmu.pae_root[i] = root | PT_PRESENT_MASK;
1852
	}
1853
	vcpu->arch.mmu.root_hpa = __pa(vcpu->arch.mmu.pae_root);
1854 1855
}

1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886
static void mmu_sync_roots(struct kvm_vcpu *vcpu)
{
	int i;
	struct kvm_mmu_page *sp;

	if (!VALID_PAGE(vcpu->arch.mmu.root_hpa))
		return;
	if (vcpu->arch.mmu.shadow_root_level == PT64_ROOT_LEVEL) {
		hpa_t root = vcpu->arch.mmu.root_hpa;
		sp = page_header(root);
		mmu_sync_children(vcpu, sp);
		return;
	}
	for (i = 0; i < 4; ++i) {
		hpa_t root = vcpu->arch.mmu.pae_root[i];

		if (root) {
			root &= PT64_BASE_ADDR_MASK;
			sp = page_header(root);
			mmu_sync_children(vcpu, sp);
		}
	}
}

void kvm_mmu_sync_roots(struct kvm_vcpu *vcpu)
{
	spin_lock(&vcpu->kvm->mmu_lock);
	mmu_sync_roots(vcpu);
	spin_unlock(&vcpu->kvm->mmu_lock);
}

A
Avi Kivity 已提交
1887 1888 1889 1890 1891 1892
static gpa_t nonpaging_gva_to_gpa(struct kvm_vcpu *vcpu, gva_t vaddr)
{
	return vaddr;
}

static int nonpaging_page_fault(struct kvm_vcpu *vcpu, gva_t gva,
A
Avi Kivity 已提交
1893
				u32 error_code)
A
Avi Kivity 已提交
1894
{
1895
	gfn_t gfn;
1896
	int r;
A
Avi Kivity 已提交
1897

1898
	pgprintk("%s: gva %lx error %x\n", __func__, gva, error_code);
1899 1900 1901
	r = mmu_topup_memory_caches(vcpu);
	if (r)
		return r;
1902

A
Avi Kivity 已提交
1903
	ASSERT(vcpu);
1904
	ASSERT(VALID_PAGE(vcpu->arch.mmu.root_hpa));
A
Avi Kivity 已提交
1905

1906
	gfn = gva >> PAGE_SHIFT;
A
Avi Kivity 已提交
1907

1908 1909
	return nonpaging_map(vcpu, gva & PAGE_MASK,
			     error_code & PFERR_WRITE_MASK, gfn);
A
Avi Kivity 已提交
1910 1911
}

1912 1913 1914
static int tdp_page_fault(struct kvm_vcpu *vcpu, gva_t gpa,
				u32 error_code)
{
1915
	pfn_t pfn;
1916
	int r;
M
Marcelo Tosatti 已提交
1917 1918
	int largepage = 0;
	gfn_t gfn = gpa >> PAGE_SHIFT;
1919
	unsigned long mmu_seq;
1920 1921 1922 1923 1924 1925 1926 1927

	ASSERT(vcpu);
	ASSERT(VALID_PAGE(vcpu->arch.mmu.root_hpa));

	r = mmu_topup_memory_caches(vcpu);
	if (r)
		return r;

M
Marcelo Tosatti 已提交
1928 1929 1930 1931
	if (is_largepage_backed(vcpu, gfn & ~(KVM_PAGES_PER_HPAGE-1))) {
		gfn &= ~(KVM_PAGES_PER_HPAGE-1);
		largepage = 1;
	}
1932
	mmu_seq = vcpu->kvm->mmu_notifier_seq;
1933
	smp_rmb();
1934 1935 1936
	pfn = gfn_to_pfn(vcpu->kvm, gfn);
	if (is_error_pfn(pfn)) {
		kvm_release_pfn_clean(pfn);
1937 1938 1939
		return 1;
	}
	spin_lock(&vcpu->kvm->mmu_lock);
1940 1941
	if (mmu_notifier_retry(vcpu, mmu_seq))
		goto out_unlock;
1942 1943
	kvm_mmu_free_some_pages(vcpu);
	r = __direct_map(vcpu, gpa, error_code & PFERR_WRITE_MASK,
1944
			 largepage, gfn, pfn);
1945 1946 1947
	spin_unlock(&vcpu->kvm->mmu_lock);

	return r;
1948 1949 1950 1951 1952

out_unlock:
	spin_unlock(&vcpu->kvm->mmu_lock);
	kvm_release_pfn_clean(pfn);
	return 0;
1953 1954
}

A
Avi Kivity 已提交
1955 1956
static void nonpaging_free(struct kvm_vcpu *vcpu)
{
1957
	mmu_free_roots(vcpu);
A
Avi Kivity 已提交
1958 1959 1960 1961
}

static int nonpaging_init_context(struct kvm_vcpu *vcpu)
{
1962
	struct kvm_mmu *context = &vcpu->arch.mmu;
A
Avi Kivity 已提交
1963 1964 1965 1966 1967

	context->new_cr3 = nonpaging_new_cr3;
	context->page_fault = nonpaging_page_fault;
	context->gva_to_gpa = nonpaging_gva_to_gpa;
	context->free = nonpaging_free;
1968
	context->prefetch_page = nonpaging_prefetch_page;
1969
	context->sync_page = nonpaging_sync_page;
M
Marcelo Tosatti 已提交
1970
	context->invlpg = nonpaging_invlpg;
1971
	context->root_level = 0;
A
Avi Kivity 已提交
1972
	context->shadow_root_level = PT32E_ROOT_LEVEL;
A
Avi Kivity 已提交
1973
	context->root_hpa = INVALID_PAGE;
A
Avi Kivity 已提交
1974 1975 1976
	return 0;
}

1977
void kvm_mmu_flush_tlb(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
1978
{
A
Avi Kivity 已提交
1979
	++vcpu->stat.tlb_flush;
1980
	kvm_x86_ops->tlb_flush(vcpu);
A
Avi Kivity 已提交
1981 1982 1983 1984
}

static void paging_new_cr3(struct kvm_vcpu *vcpu)
{
1985
	pgprintk("%s: cr3 %lx\n", __func__, vcpu->arch.cr3);
1986
	mmu_free_roots(vcpu);
A
Avi Kivity 已提交
1987 1988 1989 1990 1991 1992
}

static void inject_page_fault(struct kvm_vcpu *vcpu,
			      u64 addr,
			      u32 err_code)
{
1993
	kvm_inject_page_fault(vcpu, addr, err_code);
A
Avi Kivity 已提交
1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008
}

static void paging_free(struct kvm_vcpu *vcpu)
{
	nonpaging_free(vcpu);
}

#define PTTYPE 64
#include "paging_tmpl.h"
#undef PTTYPE

#define PTTYPE 32
#include "paging_tmpl.h"
#undef PTTYPE

2009
static int paging64_init_context_common(struct kvm_vcpu *vcpu, int level)
A
Avi Kivity 已提交
2010
{
2011
	struct kvm_mmu *context = &vcpu->arch.mmu;
A
Avi Kivity 已提交
2012 2013 2014 2015 2016

	ASSERT(is_pae(vcpu));
	context->new_cr3 = paging_new_cr3;
	context->page_fault = paging64_page_fault;
	context->gva_to_gpa = paging64_gva_to_gpa;
2017
	context->prefetch_page = paging64_prefetch_page;
2018
	context->sync_page = paging64_sync_page;
M
Marcelo Tosatti 已提交
2019
	context->invlpg = paging64_invlpg;
A
Avi Kivity 已提交
2020
	context->free = paging_free;
2021 2022
	context->root_level = level;
	context->shadow_root_level = level;
A
Avi Kivity 已提交
2023
	context->root_hpa = INVALID_PAGE;
A
Avi Kivity 已提交
2024 2025 2026
	return 0;
}

2027 2028 2029 2030 2031
static int paging64_init_context(struct kvm_vcpu *vcpu)
{
	return paging64_init_context_common(vcpu, PT64_ROOT_LEVEL);
}

A
Avi Kivity 已提交
2032 2033
static int paging32_init_context(struct kvm_vcpu *vcpu)
{
2034
	struct kvm_mmu *context = &vcpu->arch.mmu;
A
Avi Kivity 已提交
2035 2036 2037 2038 2039

	context->new_cr3 = paging_new_cr3;
	context->page_fault = paging32_page_fault;
	context->gva_to_gpa = paging32_gva_to_gpa;
	context->free = paging_free;
2040
	context->prefetch_page = paging32_prefetch_page;
2041
	context->sync_page = paging32_sync_page;
M
Marcelo Tosatti 已提交
2042
	context->invlpg = paging32_invlpg;
A
Avi Kivity 已提交
2043 2044
	context->root_level = PT32_ROOT_LEVEL;
	context->shadow_root_level = PT32E_ROOT_LEVEL;
A
Avi Kivity 已提交
2045
	context->root_hpa = INVALID_PAGE;
A
Avi Kivity 已提交
2046 2047 2048 2049 2050
	return 0;
}

static int paging32E_init_context(struct kvm_vcpu *vcpu)
{
2051
	return paging64_init_context_common(vcpu, PT32E_ROOT_LEVEL);
A
Avi Kivity 已提交
2052 2053
}

2054 2055 2056 2057 2058 2059 2060 2061
static int init_kvm_tdp_mmu(struct kvm_vcpu *vcpu)
{
	struct kvm_mmu *context = &vcpu->arch.mmu;

	context->new_cr3 = nonpaging_new_cr3;
	context->page_fault = tdp_page_fault;
	context->free = nonpaging_free;
	context->prefetch_page = nonpaging_prefetch_page;
2062
	context->sync_page = nonpaging_sync_page;
M
Marcelo Tosatti 已提交
2063
	context->invlpg = nonpaging_invlpg;
2064
	context->shadow_root_level = kvm_x86_ops->get_tdp_level();
2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084
	context->root_hpa = INVALID_PAGE;

	if (!is_paging(vcpu)) {
		context->gva_to_gpa = nonpaging_gva_to_gpa;
		context->root_level = 0;
	} else if (is_long_mode(vcpu)) {
		context->gva_to_gpa = paging64_gva_to_gpa;
		context->root_level = PT64_ROOT_LEVEL;
	} else if (is_pae(vcpu)) {
		context->gva_to_gpa = paging64_gva_to_gpa;
		context->root_level = PT32E_ROOT_LEVEL;
	} else {
		context->gva_to_gpa = paging32_gva_to_gpa;
		context->root_level = PT32_ROOT_LEVEL;
	}

	return 0;
}

static int init_kvm_softmmu(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2085 2086
{
	ASSERT(vcpu);
2087
	ASSERT(!VALID_PAGE(vcpu->arch.mmu.root_hpa));
A
Avi Kivity 已提交
2088 2089 2090

	if (!is_paging(vcpu))
		return nonpaging_init_context(vcpu);
A
Avi Kivity 已提交
2091
	else if (is_long_mode(vcpu))
A
Avi Kivity 已提交
2092 2093 2094 2095 2096 2097 2098
		return paging64_init_context(vcpu);
	else if (is_pae(vcpu))
		return paging32E_init_context(vcpu);
	else
		return paging32_init_context(vcpu);
}

2099 2100
static int init_kvm_mmu(struct kvm_vcpu *vcpu)
{
2101 2102
	vcpu->arch.update_pte.pfn = bad_pfn;

2103 2104 2105 2106 2107 2108
	if (tdp_enabled)
		return init_kvm_tdp_mmu(vcpu);
	else
		return init_kvm_softmmu(vcpu);
}

A
Avi Kivity 已提交
2109 2110 2111
static void destroy_kvm_mmu(struct kvm_vcpu *vcpu)
{
	ASSERT(vcpu);
2112 2113 2114
	if (VALID_PAGE(vcpu->arch.mmu.root_hpa)) {
		vcpu->arch.mmu.free(vcpu);
		vcpu->arch.mmu.root_hpa = INVALID_PAGE;
A
Avi Kivity 已提交
2115 2116 2117 2118
	}
}

int kvm_mmu_reset_context(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2119 2120 2121 2122
{
	destroy_kvm_mmu(vcpu);
	return init_kvm_mmu(vcpu);
}
2123
EXPORT_SYMBOL_GPL(kvm_mmu_reset_context);
A
Avi Kivity 已提交
2124 2125

int kvm_mmu_load(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2126
{
2127 2128
	int r;

2129
	r = mmu_topup_memory_caches(vcpu);
A
Avi Kivity 已提交
2130 2131
	if (r)
		goto out;
2132
	spin_lock(&vcpu->kvm->mmu_lock);
2133
	kvm_mmu_free_some_pages(vcpu);
A
Avi Kivity 已提交
2134
	mmu_alloc_roots(vcpu);
2135
	mmu_sync_roots(vcpu);
2136
	spin_unlock(&vcpu->kvm->mmu_lock);
2137
	kvm_x86_ops->set_cr3(vcpu, vcpu->arch.mmu.root_hpa);
A
Avi Kivity 已提交
2138
	kvm_mmu_flush_tlb(vcpu);
2139 2140
out:
	return r;
A
Avi Kivity 已提交
2141
}
A
Avi Kivity 已提交
2142 2143 2144 2145 2146 2147
EXPORT_SYMBOL_GPL(kvm_mmu_load);

void kvm_mmu_unload(struct kvm_vcpu *vcpu)
{
	mmu_free_roots(vcpu);
}
A
Avi Kivity 已提交
2148

2149
static void mmu_pte_write_zap_pte(struct kvm_vcpu *vcpu,
2150
				  struct kvm_mmu_page *sp,
2151 2152 2153 2154 2155 2156
				  u64 *spte)
{
	u64 pte;
	struct kvm_mmu_page *child;

	pte = *spte;
2157
	if (is_shadow_present_pte(pte)) {
M
Marcelo Tosatti 已提交
2158 2159
		if (sp->role.level == PT_PAGE_TABLE_LEVEL ||
		    is_large_pte(pte))
2160
			rmap_remove(vcpu->kvm, spte);
2161 2162
		else {
			child = page_header(pte & PT64_BASE_ADDR_MASK);
2163
			mmu_page_remove_parent_pte(child, spte);
2164 2165
		}
	}
2166
	set_shadow_pte(spte, shadow_trap_nonpresent_pte);
M
Marcelo Tosatti 已提交
2167 2168
	if (is_large_pte(pte))
		--vcpu->kvm->stat.lpages;
2169 2170
}

2171
static void mmu_pte_write_new_pte(struct kvm_vcpu *vcpu,
2172
				  struct kvm_mmu_page *sp,
2173
				  u64 *spte,
2174
				  const void *new)
2175
{
2176 2177 2178 2179 2180 2181 2182
	if (sp->role.level != PT_PAGE_TABLE_LEVEL) {
		if (!vcpu->arch.update_pte.largepage ||
		    sp->role.glevels == PT32_ROOT_LEVEL) {
			++vcpu->kvm->stat.mmu_pde_zapped;
			return;
		}
        }
2183

A
Avi Kivity 已提交
2184
	++vcpu->kvm->stat.mmu_pte_updated;
2185
	if (sp->role.glevels == PT32_ROOT_LEVEL)
2186
		paging32_update_pte(vcpu, sp, spte, new);
2187
	else
2188
		paging64_update_pte(vcpu, sp, spte, new);
2189 2190
}

2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206 2207 2208 2209 2210 2211
static bool need_remote_flush(u64 old, u64 new)
{
	if (!is_shadow_present_pte(old))
		return false;
	if (!is_shadow_present_pte(new))
		return true;
	if ((old ^ new) & PT64_BASE_ADDR_MASK)
		return true;
	old ^= PT64_NX_MASK;
	new ^= PT64_NX_MASK;
	return (old & ~new & PT64_PERM_MASK) != 0;
}

static void mmu_pte_write_flush_tlb(struct kvm_vcpu *vcpu, u64 old, u64 new)
{
	if (need_remote_flush(old, new))
		kvm_flush_remote_tlbs(vcpu->kvm);
	else
		kvm_mmu_flush_tlb(vcpu);
}

2212 2213
static bool last_updated_pte_accessed(struct kvm_vcpu *vcpu)
{
2214
	u64 *spte = vcpu->arch.last_pte_updated;
2215

S
Sheng Yang 已提交
2216
	return !!(spte && (*spte & shadow_accessed_mask));
2217 2218
}

2219 2220 2221 2222 2223 2224
static void mmu_guess_page_from_pte_write(struct kvm_vcpu *vcpu, gpa_t gpa,
					  const u8 *new, int bytes)
{
	gfn_t gfn;
	int r;
	u64 gpte = 0;
2225
	pfn_t pfn;
2226

M
Marcelo Tosatti 已提交
2227 2228
	vcpu->arch.update_pte.largepage = 0;

2229 2230 2231 2232 2233 2234 2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254
	if (bytes != 4 && bytes != 8)
		return;

	/*
	 * Assume that the pte write on a page table of the same type
	 * as the current vcpu paging mode.  This is nearly always true
	 * (might be false while changing modes).  Note it is verified later
	 * by update_pte().
	 */
	if (is_pae(vcpu)) {
		/* Handle a 32-bit guest writing two halves of a 64-bit gpte */
		if ((bytes == 4) && (gpa % 4 == 0)) {
			r = kvm_read_guest(vcpu->kvm, gpa & ~(u64)7, &gpte, 8);
			if (r)
				return;
			memcpy((void *)&gpte + (gpa % 8), new, 4);
		} else if ((bytes == 8) && (gpa % 8 == 0)) {
			memcpy((void *)&gpte, new, 8);
		}
	} else {
		if ((bytes == 4) && (gpa % 4 == 0))
			memcpy((void *)&gpte, new, 4);
	}
	if (!is_present_pte(gpte))
		return;
	gfn = (gpte & PT64_BASE_ADDR_MASK) >> PAGE_SHIFT;
2255

M
Marcelo Tosatti 已提交
2256 2257 2258 2259
	if (is_large_pte(gpte) && is_largepage_backed(vcpu, gfn)) {
		gfn &= ~(KVM_PAGES_PER_HPAGE-1);
		vcpu->arch.update_pte.largepage = 1;
	}
2260
	vcpu->arch.update_pte.mmu_seq = vcpu->kvm->mmu_notifier_seq;
2261
	smp_rmb();
2262
	pfn = gfn_to_pfn(vcpu->kvm, gfn);
2263

2264 2265
	if (is_error_pfn(pfn)) {
		kvm_release_pfn_clean(pfn);
2266 2267
		return;
	}
2268
	vcpu->arch.update_pte.gfn = gfn;
2269
	vcpu->arch.update_pte.pfn = pfn;
2270 2271
}

2272 2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283
static void kvm_mmu_access_page(struct kvm_vcpu *vcpu, gfn_t gfn)
{
	u64 *spte = vcpu->arch.last_pte_updated;

	if (spte
	    && vcpu->arch.last_pte_gfn == gfn
	    && shadow_accessed_mask
	    && !(*spte & shadow_accessed_mask)
	    && is_shadow_present_pte(*spte))
		set_bit(PT_ACCESSED_SHIFT, (unsigned long *)spte);
}

2284
void kvm_mmu_pte_write(struct kvm_vcpu *vcpu, gpa_t gpa,
2285
		       const u8 *new, int bytes)
2286
{
2287
	gfn_t gfn = gpa >> PAGE_SHIFT;
2288
	struct kvm_mmu_page *sp;
2289
	struct hlist_node *node, *n;
2290 2291
	struct hlist_head *bucket;
	unsigned index;
2292
	u64 entry, gentry;
2293 2294
	u64 *spte;
	unsigned offset = offset_in_page(gpa);
2295
	unsigned pte_size;
2296
	unsigned page_offset;
2297
	unsigned misaligned;
2298
	unsigned quadrant;
2299
	int level;
2300
	int flooded = 0;
2301
	int npte;
2302
	int r;
2303

2304
	pgprintk("%s: gpa %llx bytes %d\n", __func__, gpa, bytes);
2305
	mmu_guess_page_from_pte_write(vcpu, gpa, new, bytes);
2306
	spin_lock(&vcpu->kvm->mmu_lock);
2307
	kvm_mmu_access_page(vcpu, gfn);
2308
	kvm_mmu_free_some_pages(vcpu);
A
Avi Kivity 已提交
2309
	++vcpu->kvm->stat.mmu_pte_write;
2310
	kvm_mmu_audit(vcpu, "pre pte write");
2311
	if (gfn == vcpu->arch.last_pt_write_gfn
2312
	    && !last_updated_pte_accessed(vcpu)) {
2313 2314
		++vcpu->arch.last_pt_write_count;
		if (vcpu->arch.last_pt_write_count >= 3)
2315 2316
			flooded = 1;
	} else {
2317 2318 2319
		vcpu->arch.last_pt_write_gfn = gfn;
		vcpu->arch.last_pt_write_count = 1;
		vcpu->arch.last_pte_updated = NULL;
2320
	}
2321
	index = kvm_page_table_hashfn(gfn);
2322
	bucket = &vcpu->kvm->arch.mmu_page_hash[index];
2323
	hlist_for_each_entry_safe(sp, node, n, bucket, hash_link) {
A
Avi Kivity 已提交
2324
		if (sp->gfn != gfn || sp->role.metaphysical || sp->role.invalid)
2325
			continue;
2326
		pte_size = sp->role.glevels == PT32_ROOT_LEVEL ? 4 : 8;
2327
		misaligned = (offset ^ (offset + bytes - 1)) & ~(pte_size - 1);
2328
		misaligned |= bytes < 4;
2329
		if (misaligned || flooded) {
2330 2331 2332 2333
			/*
			 * Misaligned accesses are too much trouble to fix
			 * up; also, they usually indicate a page is not used
			 * as a page table.
2334 2335 2336 2337 2338
			 *
			 * If we're seeing too many writes to a page,
			 * it may no longer be a page table, or we may be
			 * forking, in which case it is better to unmap the
			 * page.
2339 2340
			 */
			pgprintk("misaligned: gpa %llx bytes %d role %x\n",
2341
				 gpa, bytes, sp->role.word);
2342 2343
			if (kvm_mmu_zap_page(vcpu->kvm, sp))
				n = bucket->first;
A
Avi Kivity 已提交
2344
			++vcpu->kvm->stat.mmu_flooded;
2345 2346
			continue;
		}
2347
		page_offset = offset;
2348
		level = sp->role.level;
2349
		npte = 1;
2350
		if (sp->role.glevels == PT32_ROOT_LEVEL) {
2351 2352 2353 2354 2355 2356 2357
			page_offset <<= 1;	/* 32->64 */
			/*
			 * A 32-bit pde maps 4MB while the shadow pdes map
			 * only 2MB.  So we need to double the offset again
			 * and zap two pdes instead of one.
			 */
			if (level == PT32_ROOT_LEVEL) {
2358
				page_offset &= ~7; /* kill rounding error */
2359 2360 2361
				page_offset <<= 1;
				npte = 2;
			}
2362
			quadrant = page_offset >> PAGE_SHIFT;
2363
			page_offset &= ~PAGE_MASK;
2364
			if (quadrant != sp->role.quadrant)
2365
				continue;
2366
		}
2367
		spte = &sp->spt[page_offset / sizeof(*spte)];
2368 2369 2370 2371 2372 2373 2374 2375 2376
		if ((gpa & (pte_size - 1)) || (bytes < pte_size)) {
			gentry = 0;
			r = kvm_read_guest_atomic(vcpu->kvm,
						  gpa & ~(u64)(pte_size - 1),
						  &gentry, pte_size);
			new = (const void *)&gentry;
			if (r < 0)
				new = NULL;
		}
2377
		while (npte--) {
2378
			entry = *spte;
2379
			mmu_pte_write_zap_pte(vcpu, sp, spte);
2380 2381
			if (new)
				mmu_pte_write_new_pte(vcpu, sp, spte, new);
2382
			mmu_pte_write_flush_tlb(vcpu, entry, *spte);
2383
			++spte;
2384 2385
		}
	}
2386
	kvm_mmu_audit(vcpu, "post pte write");
2387
	spin_unlock(&vcpu->kvm->mmu_lock);
2388 2389 2390
	if (!is_error_pfn(vcpu->arch.update_pte.pfn)) {
		kvm_release_pfn_clean(vcpu->arch.update_pte.pfn);
		vcpu->arch.update_pte.pfn = bad_pfn;
2391
	}
2392 2393
}

2394 2395
int kvm_mmu_unprotect_page_virt(struct kvm_vcpu *vcpu, gva_t gva)
{
2396 2397
	gpa_t gpa;
	int r;
2398

2399 2400
	gpa = vcpu->arch.mmu.gva_to_gpa(vcpu, gva);

2401
	spin_lock(&vcpu->kvm->mmu_lock);
2402
	r = kvm_mmu_unprotect_page(vcpu->kvm, gpa >> PAGE_SHIFT);
2403
	spin_unlock(&vcpu->kvm->mmu_lock);
2404
	return r;
2405
}
2406
EXPORT_SYMBOL_GPL(kvm_mmu_unprotect_page_virt);
2407

2408
void __kvm_mmu_free_some_pages(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2409
{
2410
	while (vcpu->kvm->arch.n_free_mmu_pages < KVM_REFILL_PAGES) {
2411
		struct kvm_mmu_page *sp;
A
Avi Kivity 已提交
2412

2413
		sp = container_of(vcpu->kvm->arch.active_mmu_pages.prev,
2414 2415
				  struct kvm_mmu_page, link);
		kvm_mmu_zap_page(vcpu->kvm, sp);
A
Avi Kivity 已提交
2416
		++vcpu->kvm->stat.mmu_recycled;
A
Avi Kivity 已提交
2417 2418 2419
	}
}

2420 2421 2422 2423 2424
int kvm_mmu_page_fault(struct kvm_vcpu *vcpu, gva_t cr2, u32 error_code)
{
	int r;
	enum emulation_result er;

2425
	r = vcpu->arch.mmu.page_fault(vcpu, cr2, error_code);
2426 2427 2428 2429 2430 2431 2432 2433
	if (r < 0)
		goto out;

	if (!r) {
		r = 1;
		goto out;
	}

2434 2435 2436 2437
	r = mmu_topup_memory_caches(vcpu);
	if (r)
		goto out;

2438 2439 2440 2441 2442 2443 2444 2445 2446 2447 2448 2449 2450 2451 2452 2453 2454 2455 2456
	er = emulate_instruction(vcpu, vcpu->run, cr2, error_code, 0);

	switch (er) {
	case EMULATE_DONE:
		return 1;
	case EMULATE_DO_MMIO:
		++vcpu->stat.mmio_exits;
		return 0;
	case EMULATE_FAIL:
		kvm_report_emulation_failure(vcpu, "pagetable");
		return 1;
	default:
		BUG();
	}
out:
	return r;
}
EXPORT_SYMBOL_GPL(kvm_mmu_page_fault);

M
Marcelo Tosatti 已提交
2457 2458 2459 2460 2461 2462 2463 2464 2465 2466
void kvm_mmu_invlpg(struct kvm_vcpu *vcpu, gva_t gva)
{
	spin_lock(&vcpu->kvm->mmu_lock);
	vcpu->arch.mmu.invlpg(vcpu, gva);
	spin_unlock(&vcpu->kvm->mmu_lock);
	kvm_mmu_flush_tlb(vcpu);
	++vcpu->stat.invlpg;
}
EXPORT_SYMBOL_GPL(kvm_mmu_invlpg);

2467 2468 2469 2470 2471 2472
void kvm_enable_tdp(void)
{
	tdp_enabled = true;
}
EXPORT_SYMBOL_GPL(kvm_enable_tdp);

2473 2474 2475 2476 2477 2478
void kvm_disable_tdp(void)
{
	tdp_enabled = false;
}
EXPORT_SYMBOL_GPL(kvm_disable_tdp);

A
Avi Kivity 已提交
2479 2480
static void free_mmu_pages(struct kvm_vcpu *vcpu)
{
2481
	struct kvm_mmu_page *sp;
A
Avi Kivity 已提交
2482

2483 2484
	while (!list_empty(&vcpu->kvm->arch.active_mmu_pages)) {
		sp = container_of(vcpu->kvm->arch.active_mmu_pages.next,
2485 2486
				  struct kvm_mmu_page, link);
		kvm_mmu_zap_page(vcpu->kvm, sp);
2487
		cond_resched();
2488
	}
2489
	free_page((unsigned long)vcpu->arch.mmu.pae_root);
A
Avi Kivity 已提交
2490 2491 2492 2493
}

static int alloc_mmu_pages(struct kvm_vcpu *vcpu)
{
2494
	struct page *page;
A
Avi Kivity 已提交
2495 2496 2497 2498
	int i;

	ASSERT(vcpu);

2499 2500 2501
	if (vcpu->kvm->arch.n_requested_mmu_pages)
		vcpu->kvm->arch.n_free_mmu_pages =
					vcpu->kvm->arch.n_requested_mmu_pages;
2502
	else
2503 2504
		vcpu->kvm->arch.n_free_mmu_pages =
					vcpu->kvm->arch.n_alloc_mmu_pages;
2505 2506 2507 2508 2509 2510 2511 2512
	/*
	 * When emulating 32-bit mode, cr3 is only 32 bits even on x86_64.
	 * Therefore we need to allocate shadow page tables in the first
	 * 4GB of memory, which happens to fit the DMA32 zone.
	 */
	page = alloc_page(GFP_KERNEL | __GFP_DMA32);
	if (!page)
		goto error_1;
2513
	vcpu->arch.mmu.pae_root = page_address(page);
2514
	for (i = 0; i < 4; ++i)
2515
		vcpu->arch.mmu.pae_root[i] = INVALID_PAGE;
2516

A
Avi Kivity 已提交
2517 2518 2519 2520 2521 2522 2523
	return 0;

error_1:
	free_mmu_pages(vcpu);
	return -ENOMEM;
}

2524
int kvm_mmu_create(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2525 2526
{
	ASSERT(vcpu);
2527
	ASSERT(!VALID_PAGE(vcpu->arch.mmu.root_hpa));
A
Avi Kivity 已提交
2528

2529 2530
	return alloc_mmu_pages(vcpu);
}
A
Avi Kivity 已提交
2531

2532 2533 2534
int kvm_mmu_setup(struct kvm_vcpu *vcpu)
{
	ASSERT(vcpu);
2535
	ASSERT(!VALID_PAGE(vcpu->arch.mmu.root_hpa));
2536

2537
	return init_kvm_mmu(vcpu);
A
Avi Kivity 已提交
2538 2539 2540 2541 2542 2543 2544 2545
}

void kvm_mmu_destroy(struct kvm_vcpu *vcpu)
{
	ASSERT(vcpu);

	destroy_kvm_mmu(vcpu);
	free_mmu_pages(vcpu);
2546
	mmu_free_memory_caches(vcpu);
A
Avi Kivity 已提交
2547 2548
}

2549
void kvm_mmu_slot_remove_write_access(struct kvm *kvm, int slot)
A
Avi Kivity 已提交
2550
{
2551
	struct kvm_mmu_page *sp;
A
Avi Kivity 已提交
2552

2553
	spin_lock(&kvm->mmu_lock);
2554
	list_for_each_entry(sp, &kvm->arch.active_mmu_pages, link) {
A
Avi Kivity 已提交
2555 2556 2557
		int i;
		u64 *pt;

2558
		if (!test_bit(slot, &sp->slot_bitmap))
A
Avi Kivity 已提交
2559 2560
			continue;

2561
		pt = sp->spt;
A
Avi Kivity 已提交
2562 2563
		for (i = 0; i < PT64_ENT_PER_PAGE; ++i)
			/* avoid RMW */
2564
			if (pt[i] & PT_WRITABLE_MASK)
A
Avi Kivity 已提交
2565 2566
				pt[i] &= ~PT_WRITABLE_MASK;
	}
2567
	kvm_flush_remote_tlbs(kvm);
2568
	spin_unlock(&kvm->mmu_lock);
A
Avi Kivity 已提交
2569
}
2570

2571
void kvm_mmu_zap_all(struct kvm *kvm)
D
Dor Laor 已提交
2572
{
2573
	struct kvm_mmu_page *sp, *node;
D
Dor Laor 已提交
2574

2575
	spin_lock(&kvm->mmu_lock);
2576
	list_for_each_entry_safe(sp, node, &kvm->arch.active_mmu_pages, link)
2577 2578 2579
		if (kvm_mmu_zap_page(kvm, sp))
			node = container_of(kvm->arch.active_mmu_pages.next,
					    struct kvm_mmu_page, link);
2580
	spin_unlock(&kvm->mmu_lock);
D
Dor Laor 已提交
2581

2582
	kvm_flush_remote_tlbs(kvm);
D
Dor Laor 已提交
2583 2584
}

2585
static void kvm_mmu_remove_one_alloc_mmu_page(struct kvm *kvm)
2586 2587 2588 2589 2590 2591 2592 2593 2594 2595 2596 2597 2598 2599 2600 2601 2602 2603 2604
{
	struct kvm_mmu_page *page;

	page = container_of(kvm->arch.active_mmu_pages.prev,
			    struct kvm_mmu_page, link);
	kvm_mmu_zap_page(kvm, page);
}

static int mmu_shrink(int nr_to_scan, gfp_t gfp_mask)
{
	struct kvm *kvm;
	struct kvm *kvm_freed = NULL;
	int cache_count = 0;

	spin_lock(&kvm_lock);

	list_for_each_entry(kvm, &vm_list, vm_list) {
		int npages;

2605 2606
		if (!down_read_trylock(&kvm->slots_lock))
			continue;
2607 2608 2609 2610 2611 2612 2613 2614 2615 2616 2617 2618
		spin_lock(&kvm->mmu_lock);
		npages = kvm->arch.n_alloc_mmu_pages -
			 kvm->arch.n_free_mmu_pages;
		cache_count += npages;
		if (!kvm_freed && nr_to_scan > 0 && npages > 0) {
			kvm_mmu_remove_one_alloc_mmu_page(kvm);
			cache_count--;
			kvm_freed = kvm;
		}
		nr_to_scan--;

		spin_unlock(&kvm->mmu_lock);
2619
		up_read(&kvm->slots_lock);
2620 2621 2622 2623 2624 2625 2626 2627 2628 2629 2630 2631 2632 2633
	}
	if (kvm_freed)
		list_move_tail(&kvm_freed->vm_list, &vm_list);

	spin_unlock(&kvm_lock);

	return cache_count;
}

static struct shrinker mmu_shrinker = {
	.shrink = mmu_shrink,
	.seeks = DEFAULT_SEEKS * 10,
};

I
Ingo Molnar 已提交
2634
static void mmu_destroy_caches(void)
2635 2636 2637 2638 2639
{
	if (pte_chain_cache)
		kmem_cache_destroy(pte_chain_cache);
	if (rmap_desc_cache)
		kmem_cache_destroy(rmap_desc_cache);
2640 2641
	if (mmu_page_header_cache)
		kmem_cache_destroy(mmu_page_header_cache);
2642 2643
}

2644 2645 2646 2647 2648 2649
void kvm_mmu_module_exit(void)
{
	mmu_destroy_caches();
	unregister_shrinker(&mmu_shrinker);
}

2650 2651 2652 2653
int kvm_mmu_module_init(void)
{
	pte_chain_cache = kmem_cache_create("kvm_pte_chain",
					    sizeof(struct kvm_pte_chain),
2654
					    0, 0, NULL);
2655 2656 2657 2658
	if (!pte_chain_cache)
		goto nomem;
	rmap_desc_cache = kmem_cache_create("kvm_rmap_desc",
					    sizeof(struct kvm_rmap_desc),
2659
					    0, 0, NULL);
2660 2661 2662
	if (!rmap_desc_cache)
		goto nomem;

2663 2664
	mmu_page_header_cache = kmem_cache_create("kvm_mmu_page_header",
						  sizeof(struct kvm_mmu_page),
2665
						  0, 0, NULL);
2666 2667 2668
	if (!mmu_page_header_cache)
		goto nomem;

2669 2670
	register_shrinker(&mmu_shrinker);

2671 2672 2673
	return 0;

nomem:
2674
	mmu_destroy_caches();
2675 2676 2677
	return -ENOMEM;
}

2678 2679 2680 2681 2682 2683 2684 2685 2686 2687 2688 2689 2690 2691 2692 2693 2694 2695 2696
/*
 * Caculate mmu pages needed for kvm.
 */
unsigned int kvm_mmu_calculate_mmu_pages(struct kvm *kvm)
{
	int i;
	unsigned int nr_mmu_pages;
	unsigned int  nr_pages = 0;

	for (i = 0; i < kvm->nmemslots; i++)
		nr_pages += kvm->memslots[i].npages;

	nr_mmu_pages = nr_pages * KVM_PERMILLE_MMU_PAGES / 1000;
	nr_mmu_pages = max(nr_mmu_pages,
			(unsigned int) KVM_MIN_ALLOC_MMU_PAGES);

	return nr_mmu_pages;
}

2697 2698 2699 2700 2701 2702 2703 2704 2705 2706 2707 2708 2709 2710 2711 2712 2713 2714 2715 2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731
static void *pv_mmu_peek_buffer(struct kvm_pv_mmu_op_buffer *buffer,
				unsigned len)
{
	if (len > buffer->len)
		return NULL;
	return buffer->ptr;
}

static void *pv_mmu_read_buffer(struct kvm_pv_mmu_op_buffer *buffer,
				unsigned len)
{
	void *ret;

	ret = pv_mmu_peek_buffer(buffer, len);
	if (!ret)
		return ret;
	buffer->ptr += len;
	buffer->len -= len;
	buffer->processed += len;
	return ret;
}

static int kvm_pv_mmu_write(struct kvm_vcpu *vcpu,
			     gpa_t addr, gpa_t value)
{
	int bytes = 8;
	int r;

	if (!is_long_mode(vcpu) && !is_pae(vcpu))
		bytes = 4;

	r = mmu_topup_memory_caches(vcpu);
	if (r)
		return r;

2732
	if (!emulator_write_phys(vcpu, addr, &value, bytes))
2733 2734 2735 2736 2737 2738 2739 2740
		return -EFAULT;

	return 1;
}

static int kvm_pv_mmu_flush_tlb(struct kvm_vcpu *vcpu)
{
	kvm_x86_ops->tlb_flush(vcpu);
2741
	set_bit(KVM_REQ_MMU_SYNC, &vcpu->requests);
2742 2743 2744 2745 2746 2747 2748 2749 2750 2751 2752 2753 2754 2755 2756 2757 2758 2759 2760 2761 2762 2763 2764 2765 2766 2767 2768 2769 2770 2771 2772 2773 2774 2775 2776 2777 2778 2779 2780 2781 2782 2783 2784 2785 2786 2787 2788 2789 2790 2791 2792 2793 2794
	return 1;
}

static int kvm_pv_mmu_release_pt(struct kvm_vcpu *vcpu, gpa_t addr)
{
	spin_lock(&vcpu->kvm->mmu_lock);
	mmu_unshadow(vcpu->kvm, addr >> PAGE_SHIFT);
	spin_unlock(&vcpu->kvm->mmu_lock);
	return 1;
}

static int kvm_pv_mmu_op_one(struct kvm_vcpu *vcpu,
			     struct kvm_pv_mmu_op_buffer *buffer)
{
	struct kvm_mmu_op_header *header;

	header = pv_mmu_peek_buffer(buffer, sizeof *header);
	if (!header)
		return 0;
	switch (header->op) {
	case KVM_MMU_OP_WRITE_PTE: {
		struct kvm_mmu_op_write_pte *wpte;

		wpte = pv_mmu_read_buffer(buffer, sizeof *wpte);
		if (!wpte)
			return 0;
		return kvm_pv_mmu_write(vcpu, wpte->pte_phys,
					wpte->pte_val);
	}
	case KVM_MMU_OP_FLUSH_TLB: {
		struct kvm_mmu_op_flush_tlb *ftlb;

		ftlb = pv_mmu_read_buffer(buffer, sizeof *ftlb);
		if (!ftlb)
			return 0;
		return kvm_pv_mmu_flush_tlb(vcpu);
	}
	case KVM_MMU_OP_RELEASE_PT: {
		struct kvm_mmu_op_release_pt *rpt;

		rpt = pv_mmu_read_buffer(buffer, sizeof *rpt);
		if (!rpt)
			return 0;
		return kvm_pv_mmu_release_pt(vcpu, rpt->pt_phys);
	}
	default: return 0;
	}
}

int kvm_pv_mmu_op(struct kvm_vcpu *vcpu, unsigned long bytes,
		  gpa_t addr, unsigned long *ret)
{
	int r;
2795
	struct kvm_pv_mmu_op_buffer *buffer = &vcpu->arch.mmu_op_buffer;
2796

2797 2798 2799
	buffer->ptr = buffer->buf;
	buffer->len = min_t(unsigned long, bytes, sizeof buffer->buf);
	buffer->processed = 0;
2800

2801
	r = kvm_read_guest(vcpu->kvm, addr, buffer->buf, buffer->len);
2802 2803 2804
	if (r)
		goto out;

2805 2806
	while (buffer->len) {
		r = kvm_pv_mmu_op_one(vcpu, buffer);
2807 2808 2809 2810 2811 2812 2813 2814
		if (r < 0)
			goto out;
		if (r == 0)
			break;
	}

	r = 1;
out:
2815
	*ret = buffer->processed;
2816 2817 2818
	return r;
}

2819 2820 2821 2822 2823 2824 2825 2826 2827 2828 2829 2830 2831 2832 2833 2834 2835 2836 2837 2838 2839 2840
#ifdef AUDIT

static const char *audit_msg;

static gva_t canonicalize(gva_t gva)
{
#ifdef CONFIG_X86_64
	gva = (long long)(gva << 16) >> 16;
#endif
	return gva;
}

static void audit_mappings_page(struct kvm_vcpu *vcpu, u64 page_pte,
				gva_t va, int level)
{
	u64 *pt = __va(page_pte & PT64_BASE_ADDR_MASK);
	int i;
	gva_t va_delta = 1ul << (PAGE_SHIFT + 9 * (level - 1));

	for (i = 0; i < PT64_ENT_PER_PAGE; ++i, va += va_delta) {
		u64 ent = pt[i];

2841
		if (ent == shadow_trap_nonpresent_pte)
2842 2843 2844
			continue;

		va = canonicalize(va);
2845 2846 2847 2848 2849
		if (level > 1) {
			if (ent == shadow_notrap_nonpresent_pte)
				printk(KERN_ERR "audit: (%s) nontrapping pte"
				       " in nonleaf level: levels %d gva %lx"
				       " level %d pte %llx\n", audit_msg,
2850
				       vcpu->arch.mmu.root_level, va, level, ent);
2851

2852
			audit_mappings_page(vcpu, ent, va, level - 1);
2853
		} else {
2854
			gpa_t gpa = vcpu->arch.mmu.gva_to_gpa(vcpu, va);
2855
			hpa_t hpa = (hpa_t)gpa_to_pfn(vcpu, gpa) << PAGE_SHIFT;
2856

2857
			if (is_shadow_present_pte(ent)
2858
			    && (ent & PT64_BASE_ADDR_MASK) != hpa)
2859 2860
				printk(KERN_ERR "xx audit error: (%s) levels %d"
				       " gva %lx gpa %llx hpa %llx ent %llx %d\n",
2861
				       audit_msg, vcpu->arch.mmu.root_level,
M
Mike Day 已提交
2862 2863
				       va, gpa, hpa, ent,
				       is_shadow_present_pte(ent));
2864 2865 2866 2867
			else if (ent == shadow_notrap_nonpresent_pte
				 && !is_error_hpa(hpa))
				printk(KERN_ERR "audit: (%s) notrap shadow,"
				       " valid guest gva %lx\n", audit_msg, va);
2868
			kvm_release_pfn_clean(pfn);
2869

2870 2871 2872 2873 2874 2875
		}
	}
}

static void audit_mappings(struct kvm_vcpu *vcpu)
{
2876
	unsigned i;
2877

2878 2879
	if (vcpu->arch.mmu.root_level == 4)
		audit_mappings_page(vcpu, vcpu->arch.mmu.root_hpa, 0, 4);
2880 2881
	else
		for (i = 0; i < 4; ++i)
2882
			if (vcpu->arch.mmu.pae_root[i] & PT_PRESENT_MASK)
2883
				audit_mappings_page(vcpu,
2884
						    vcpu->arch.mmu.pae_root[i],
2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898
						    i << 30,
						    2);
}

static int count_rmaps(struct kvm_vcpu *vcpu)
{
	int nmaps = 0;
	int i, j, k;

	for (i = 0; i < KVM_MEMORY_SLOTS; ++i) {
		struct kvm_memory_slot *m = &vcpu->kvm->memslots[i];
		struct kvm_rmap_desc *d;

		for (j = 0; j < m->npages; ++j) {
2899
			unsigned long *rmapp = &m->rmap[j];
2900

2901
			if (!*rmapp)
2902
				continue;
2903
			if (!(*rmapp & 1)) {
2904 2905 2906
				++nmaps;
				continue;
			}
2907
			d = (struct kvm_rmap_desc *)(*rmapp & ~1ul);
2908 2909 2910 2911 2912 2913 2914 2915 2916 2917 2918 2919 2920 2921 2922 2923
			while (d) {
				for (k = 0; k < RMAP_EXT; ++k)
					if (d->shadow_ptes[k])
						++nmaps;
					else
						break;
				d = d->more;
			}
		}
	}
	return nmaps;
}

static int count_writable_mappings(struct kvm_vcpu *vcpu)
{
	int nmaps = 0;
2924
	struct kvm_mmu_page *sp;
2925 2926
	int i;

2927
	list_for_each_entry(sp, &vcpu->kvm->arch.active_mmu_pages, link) {
2928
		u64 *pt = sp->spt;
2929

2930
		if (sp->role.level != PT_PAGE_TABLE_LEVEL)
2931 2932 2933 2934 2935 2936 2937 2938 2939 2940 2941 2942 2943 2944 2945 2946 2947 2948 2949 2950 2951 2952
			continue;

		for (i = 0; i < PT64_ENT_PER_PAGE; ++i) {
			u64 ent = pt[i];

			if (!(ent & PT_PRESENT_MASK))
				continue;
			if (!(ent & PT_WRITABLE_MASK))
				continue;
			++nmaps;
		}
	}
	return nmaps;
}

static void audit_rmap(struct kvm_vcpu *vcpu)
{
	int n_rmap = count_rmaps(vcpu);
	int n_actual = count_writable_mappings(vcpu);

	if (n_rmap != n_actual)
		printk(KERN_ERR "%s: (%s) rmap %d actual %d\n",
2953
		       __func__, audit_msg, n_rmap, n_actual);
2954 2955 2956 2957
}

static void audit_write_protection(struct kvm_vcpu *vcpu)
{
2958
	struct kvm_mmu_page *sp;
2959 2960 2961
	struct kvm_memory_slot *slot;
	unsigned long *rmapp;
	gfn_t gfn;
2962

2963
	list_for_each_entry(sp, &vcpu->kvm->arch.active_mmu_pages, link) {
2964
		if (sp->role.metaphysical)
2965 2966
			continue;

2967 2968
		slot = gfn_to_memslot(vcpu->kvm, sp->gfn);
		gfn = unalias_gfn(vcpu->kvm, sp->gfn);
2969 2970
		rmapp = &slot->rmap[gfn - slot->base_gfn];
		if (*rmapp)
2971 2972
			printk(KERN_ERR "%s: (%s) shadow page has writable"
			       " mappings: gfn %lx role %x\n",
2973
			       __func__, audit_msg, sp->gfn,
2974
			       sp->role.word);
2975 2976 2977 2978 2979 2980 2981 2982 2983 2984 2985 2986 2987 2988 2989 2990
	}
}

static void kvm_mmu_audit(struct kvm_vcpu *vcpu, const char *msg)
{
	int olddbg = dbg;

	dbg = 0;
	audit_msg = msg;
	audit_rmap(vcpu);
	audit_write_protection(vcpu);
	audit_mappings(vcpu);
	dbg = olddbg;
}

#endif