mmu.c 85.8 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
 *
 * 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 已提交
20

21
#include "mmu.h"
22
#include "x86.h"
A
Avi Kivity 已提交
23
#include "kvm_cache_regs.h"
A
Avi Kivity 已提交
24

25
#include <linux/kvm_host.h>
A
Avi Kivity 已提交
26 27 28 29 30
#include <linux/types.h>
#include <linux/string.h>
#include <linux/mm.h>
#include <linux/highmem.h>
#include <linux/module.h>
31
#include <linux/swap.h>
M
Marcelo Tosatti 已提交
32
#include <linux/hugetlb.h>
33
#include <linux/compiler.h>
34
#include <linux/srcu.h>
35
#include <linux/slab.h>
36
#include <linux/uaccess.h>
A
Avi Kivity 已提交
37

A
Avi Kivity 已提交
38 39
#include <asm/page.h>
#include <asm/cmpxchg.h>
40
#include <asm/io.h>
41
#include <asm/vmx.h>
A
Avi Kivity 已提交
42

43 44 45 46 47 48 49
/*
 * 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.
 */
50
bool tdp_enabled = false;
51

52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74
#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)
75 76
static int dbg = 0;
module_param(dbg, bool, 0644);
77
#endif
A
Avi Kivity 已提交
78

79 80 81
static int oos_shadow = 1;
module_param(oos_shadow, bool, 0644);

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

#define PT_FIRST_AVAIL_BITS_SHIFT 9
#define PT64_SECOND_AVAIL_BITS_SHIFT 52

#define PT64_LEVEL_BITS 9

#define PT64_LEVEL_SHIFT(level) \
M
Mike Day 已提交
98
		(PAGE_SHIFT + (level - 1) * PT64_LEVEL_BITS)
A
Avi Kivity 已提交
99 100 101 102 103 104 105 106 107 108 109

#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 已提交
110
		(PAGE_SHIFT + (level - 1) * PT32_LEVEL_BITS)
A
Avi Kivity 已提交
111 112 113

#define PT32_LEVEL_MASK(level) \
		(((1ULL << PT32_LEVEL_BITS) - 1) << PT32_LEVEL_SHIFT(level))
114 115 116
#define PT32_LVL_OFFSET_MASK(level) \
	(PT32_BASE_ADDR_MASK & ((1ULL << (PAGE_SHIFT + (((level) - 1) \
						* PT32_LEVEL_BITS))) - 1))
A
Avi Kivity 已提交
117 118 119 120 121

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


122
#define PT64_BASE_ADDR_MASK (((1ULL << 52) - 1) & ~(u64)(PAGE_SIZE-1))
A
Avi Kivity 已提交
123 124
#define PT64_DIR_BASE_ADDR_MASK \
	(PT64_BASE_ADDR_MASK & ~((1ULL << (PAGE_SHIFT + PT64_LEVEL_BITS)) - 1))
125 126 127 128 129 130
#define PT64_LVL_ADDR_MASK(level) \
	(PT64_BASE_ADDR_MASK & ~((1ULL << (PAGE_SHIFT + (((level) - 1) \
						* PT64_LEVEL_BITS))) - 1))
#define PT64_LVL_OFFSET_MASK(level) \
	(PT64_BASE_ADDR_MASK & ((1ULL << (PAGE_SHIFT + (((level) - 1) \
						* PT64_LEVEL_BITS))) - 1))
A
Avi Kivity 已提交
131 132 133 134

#define PT32_BASE_ADDR_MASK PAGE_MASK
#define PT32_DIR_BASE_ADDR_MASK \
	(PAGE_MASK & ~((1ULL << (PAGE_SHIFT + PT32_LEVEL_BITS)) - 1))
135 136 137
#define PT32_LVL_ADDR_MASK(level) \
	(PAGE_MASK & ~((1ULL << (PAGE_SHIFT + (((level) - 1) \
					    * PT32_LEVEL_BITS))) - 1))
A
Avi Kivity 已提交
138

139 140
#define PT64_PERM_MASK (PT_PRESENT_MASK | PT_WRITABLE_MASK | PT_USER_MASK \
			| PT64_NX_MASK)
A
Avi Kivity 已提交
141

142 143
#define RMAP_EXT 4

144 145 146 147 148
#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)

149 150
#include <trace/events/kvm.h>

151 152 153
#define CREATE_TRACE_POINTS
#include "mmutrace.h"

154 155
#define SPTE_HOST_WRITEABLE (1ULL << PT_FIRST_AVAIL_BITS_SHIFT)

156 157
#define SHADOW_PT_INDEX(addr, level) PT64_INDEX(addr, level)

158
struct kvm_rmap_desc {
A
Avi Kivity 已提交
159
	u64 *sptes[RMAP_EXT];
160 161 162
	struct kvm_rmap_desc *more;
};

163 164 165 166 167 168 169 170 171 172 173 174 175
struct kvm_shadow_walk_iterator {
	u64 addr;
	hpa_t shadow_addr;
	int level;
	u64 *sptep;
	unsigned index;
};

#define for_each_shadow_entry(_vcpu, _addr, _walker)    \
	for (shadow_walk_init(&(_walker), _vcpu, _addr);	\
	     shadow_walk_okay(&(_walker));			\
	     shadow_walk_next(&(_walker)))

176
typedef void (*mmu_parent_walk_fn) (struct kvm_mmu_page *sp, u64 *spte);
M
Marcelo Tosatti 已提交
177

178 179
static struct kmem_cache *pte_chain_cache;
static struct kmem_cache *rmap_desc_cache;
180
static struct kmem_cache *mmu_page_header_cache;
181

182 183
static u64 __read_mostly shadow_trap_nonpresent_pte;
static u64 __read_mostly shadow_notrap_nonpresent_pte;
S
Sheng Yang 已提交
184 185 186 187 188 189
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;
190

191 192 193 194 195
static inline u64 rsvd_bits(int s, int e)
{
	return ((1ULL << (e - s + 1)) - 1) << s;
}

196 197 198 199 200 201 202
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 已提交
203 204 205 206 207 208 209
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,
210
		u64 dirty_mask, u64 nx_mask, u64 x_mask)
S
Sheng Yang 已提交
211 212 213 214 215 216 217 218 219
{
	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);

220
static bool is_write_protection(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
221
{
222
	return kvm_read_cr0_bits(vcpu, X86_CR0_WP);
A
Avi Kivity 已提交
223 224 225 226 227 228 229
}

static int is_cpuid_PSE36(void)
{
	return 1;
}

230 231
static int is_nx(struct kvm_vcpu *vcpu)
{
232
	return vcpu->arch.efer & EFER_NX;
233 234
}

235 236 237 238 239 240
static int is_shadow_present_pte(u64 pte)
{
	return pte != shadow_trap_nonpresent_pte
		&& pte != shadow_notrap_nonpresent_pte;
}

M
Marcelo Tosatti 已提交
241 242 243 244 245
static int is_large_pte(u64 pte)
{
	return pte & PT_PAGE_SIZE_MASK;
}

246
static int is_writable_pte(unsigned long pte)
A
Avi Kivity 已提交
247 248 249 250
{
	return pte & PT_WRITABLE_MASK;
}

251
static int is_dirty_gpte(unsigned long pte)
252
{
A
Avi Kivity 已提交
253
	return pte & PT_DIRTY_MASK;
254 255
}

256
static int is_rmap_spte(u64 pte)
257
{
258
	return is_shadow_present_pte(pte);
259 260
}

261 262 263 264
static int is_last_spte(u64 pte, int level)
{
	if (level == PT_PAGE_TABLE_LEVEL)
		return 1;
265
	if (is_large_pte(pte))
266 267 268 269
		return 1;
	return 0;
}

270
static pfn_t spte_to_pfn(u64 pte)
271
{
272
	return (pte & PT64_BASE_ADDR_MASK) >> PAGE_SHIFT;
273 274
}

275 276 277 278 279 280 281
static gfn_t pse36_gfn_delta(u32 gpte)
{
	int shift = 32 - PT32_DIR_PSE36_SHIFT - PAGE_SHIFT;

	return (gpte & PT32_DIR_PSE36_MASK) << shift;
}

A
Avi Kivity 已提交
282
static void __set_spte(u64 *sptep, u64 spte)
283
{
284
	set_64bit(sptep, spte);
285 286
}

287 288 289 290 291 292 293 294 295 296 297 298 299 300 301
static u64 __xchg_spte(u64 *sptep, u64 new_spte)
{
#ifdef CONFIG_X86_64
	return xchg(sptep, new_spte);
#else
	u64 old_spte;

	do {
		old_spte = *sptep;
	} while (cmpxchg64(sptep, old_spte, new_spte) != old_spte);

	return old_spte;
#endif
}

302 303 304 305 306 307 308 309 310 311 312 313 314 315
static bool spte_has_volatile_bits(u64 spte)
{
	if (!shadow_accessed_mask)
		return false;

	if (!is_shadow_present_pte(spte))
		return false;

	if (spte & shadow_accessed_mask)
		return false;

	return true;
}

316 317 318 319
static void update_spte(u64 *sptep, u64 new_spte)
{
	u64 old_spte;

320 321
	if (!shadow_accessed_mask || (new_spte & shadow_accessed_mask) ||
	      !is_rmap_spte(*sptep))
322
		__set_spte(sptep, new_spte);
323
	else {
324 325
		old_spte = __xchg_spte(sptep, new_spte);
		if (old_spte & shadow_accessed_mask)
326
			kvm_set_pfn_accessed(spte_to_pfn(old_spte));
327 328 329
	}
}

330
static int mmu_topup_memory_cache(struct kvm_mmu_memory_cache *cache,
331
				  struct kmem_cache *base_cache, int min)
332 333 334 335
{
	void *obj;

	if (cache->nobjs >= min)
336
		return 0;
337
	while (cache->nobjs < ARRAY_SIZE(cache->objects)) {
338
		obj = kmem_cache_zalloc(base_cache, GFP_KERNEL);
339
		if (!obj)
340
			return -ENOMEM;
341 342
		cache->objects[cache->nobjs++] = obj;
	}
343
	return 0;
344 345
}

346 347
static void mmu_free_memory_cache(struct kvm_mmu_memory_cache *mc,
				  struct kmem_cache *cache)
348 349
{
	while (mc->nobjs)
350
		kmem_cache_free(cache, mc->objects[--mc->nobjs]);
351 352
}

A
Avi Kivity 已提交
353
static int mmu_topup_memory_cache_page(struct kvm_mmu_memory_cache *cache,
354
				       int min)
A
Avi Kivity 已提交
355 356 357 358 359 360
{
	struct page *page;

	if (cache->nobjs >= min)
		return 0;
	while (cache->nobjs < ARRAY_SIZE(cache->objects)) {
361
		page = alloc_page(GFP_KERNEL);
A
Avi Kivity 已提交
362 363 364 365 366 367 368 369 370 371
		if (!page)
			return -ENOMEM;
		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)
372
		free_page((unsigned long)mc->objects[--mc->nobjs]);
A
Avi Kivity 已提交
373 374
}

375
static int mmu_topup_memory_caches(struct kvm_vcpu *vcpu)
376
{
377 378
	int r;

379
	r = mmu_topup_memory_cache(&vcpu->arch.mmu_pte_chain_cache,
380
				   pte_chain_cache, 4);
381 382
	if (r)
		goto out;
383
	r = mmu_topup_memory_cache(&vcpu->arch.mmu_rmap_desc_cache,
384
				   rmap_desc_cache, 4);
385 386
	if (r)
		goto out;
387
	r = mmu_topup_memory_cache_page(&vcpu->arch.mmu_page_cache, 8);
388 389
	if (r)
		goto out;
390
	r = mmu_topup_memory_cache(&vcpu->arch.mmu_page_header_cache,
391
				   mmu_page_header_cache, 4);
392 393
out:
	return r;
394 395 396 397
}

static void mmu_free_memory_caches(struct kvm_vcpu *vcpu)
{
398 399
	mmu_free_memory_cache(&vcpu->arch.mmu_pte_chain_cache, pte_chain_cache);
	mmu_free_memory_cache(&vcpu->arch.mmu_rmap_desc_cache, rmap_desc_cache);
400
	mmu_free_memory_cache_page(&vcpu->arch.mmu_page_cache);
401 402
	mmu_free_memory_cache(&vcpu->arch.mmu_page_header_cache,
				mmu_page_header_cache);
403 404 405 406 407 408 409 410 411 412 413 414 415 416
}

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];
	return p;
}

static struct kvm_pte_chain *mmu_alloc_pte_chain(struct kvm_vcpu *vcpu)
{
417
	return mmu_memory_cache_alloc(&vcpu->arch.mmu_pte_chain_cache,
418 419 420
				      sizeof(struct kvm_pte_chain));
}

421
static void mmu_free_pte_chain(struct kvm_pte_chain *pc)
422
{
423
	kmem_cache_free(pte_chain_cache, pc);
424 425 426 427
}

static struct kvm_rmap_desc *mmu_alloc_rmap_desc(struct kvm_vcpu *vcpu)
{
428
	return mmu_memory_cache_alloc(&vcpu->arch.mmu_rmap_desc_cache,
429 430 431
				      sizeof(struct kvm_rmap_desc));
}

432
static void mmu_free_rmap_desc(struct kvm_rmap_desc *rd)
433
{
434
	kmem_cache_free(rmap_desc_cache, rd);
435 436
}

437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452
static gfn_t kvm_mmu_page_get_gfn(struct kvm_mmu_page *sp, int index)
{
	if (!sp->role.direct)
		return sp->gfns[index];

	return sp->gfn + (index << ((sp->role.level - 1) * PT64_LEVEL_BITS));
}

static void kvm_mmu_page_set_gfn(struct kvm_mmu_page *sp, int index, gfn_t gfn)
{
	if (sp->role.direct)
		BUG_ON(gfn != kvm_mmu_page_get_gfn(sp, index));
	else
		sp->gfns[index] = gfn;
}

M
Marcelo Tosatti 已提交
453 454 455 456
/*
 * Return the pointer to the largepage write count for a given
 * gfn, handling slots that are not large page aligned.
 */
457 458 459
static int *slot_largepage_idx(gfn_t gfn,
			       struct kvm_memory_slot *slot,
			       int level)
M
Marcelo Tosatti 已提交
460 461 462
{
	unsigned long idx;

463 464
	idx = (gfn >> KVM_HPAGE_GFN_SHIFT(level)) -
	      (slot->base_gfn >> KVM_HPAGE_GFN_SHIFT(level));
465
	return &slot->lpage_info[level - 2][idx].write_count;
M
Marcelo Tosatti 已提交
466 467 468 469
}

static void account_shadowed(struct kvm *kvm, gfn_t gfn)
{
470
	struct kvm_memory_slot *slot;
M
Marcelo Tosatti 已提交
471
	int *write_count;
472
	int i;
M
Marcelo Tosatti 已提交
473

A
Avi Kivity 已提交
474
	slot = gfn_to_memslot(kvm, gfn);
475 476 477 478 479
	for (i = PT_DIRECTORY_LEVEL;
	     i < PT_PAGE_TABLE_LEVEL + KVM_NR_PAGE_SIZES; ++i) {
		write_count   = slot_largepage_idx(gfn, slot, i);
		*write_count += 1;
	}
M
Marcelo Tosatti 已提交
480 481 482 483
}

static void unaccount_shadowed(struct kvm *kvm, gfn_t gfn)
{
484
	struct kvm_memory_slot *slot;
M
Marcelo Tosatti 已提交
485
	int *write_count;
486
	int i;
M
Marcelo Tosatti 已提交
487

A
Avi Kivity 已提交
488
	slot = gfn_to_memslot(kvm, gfn);
489 490 491 492 493 494
	for (i = PT_DIRECTORY_LEVEL;
	     i < PT_PAGE_TABLE_LEVEL + KVM_NR_PAGE_SIZES; ++i) {
		write_count   = slot_largepage_idx(gfn, slot, i);
		*write_count -= 1;
		WARN_ON(*write_count < 0);
	}
M
Marcelo Tosatti 已提交
495 496
}

497 498 499
static int has_wrprotected_page(struct kvm *kvm,
				gfn_t gfn,
				int level)
M
Marcelo Tosatti 已提交
500
{
501
	struct kvm_memory_slot *slot;
M
Marcelo Tosatti 已提交
502 503
	int *largepage_idx;

A
Avi Kivity 已提交
504
	slot = gfn_to_memslot(kvm, gfn);
M
Marcelo Tosatti 已提交
505
	if (slot) {
506
		largepage_idx = slot_largepage_idx(gfn, slot, level);
M
Marcelo Tosatti 已提交
507 508 509 510 511 512
		return *largepage_idx;
	}

	return 1;
}

513
static int host_mapping_level(struct kvm *kvm, gfn_t gfn)
M
Marcelo Tosatti 已提交
514
{
J
Joerg Roedel 已提交
515
	unsigned long page_size;
516
	int i, ret = 0;
M
Marcelo Tosatti 已提交
517

J
Joerg Roedel 已提交
518
	page_size = kvm_host_page_size(kvm, gfn);
M
Marcelo Tosatti 已提交
519

520 521 522 523 524 525 526 527
	for (i = PT_PAGE_TABLE_LEVEL;
	     i < (PT_PAGE_TABLE_LEVEL + KVM_NR_PAGE_SIZES); ++i) {
		if (page_size >= KVM_HPAGE_SIZE(i))
			ret = i;
		else
			break;
	}

528
	return ret;
M
Marcelo Tosatti 已提交
529 530
}

531
static int mapping_level(struct kvm_vcpu *vcpu, gfn_t large_gfn)
M
Marcelo Tosatti 已提交
532 533
{
	struct kvm_memory_slot *slot;
534
	int host_level, level, max_level;
M
Marcelo Tosatti 已提交
535 536 537

	slot = gfn_to_memslot(vcpu->kvm, large_gfn);
	if (slot && slot->dirty_bitmap)
538
		return PT_PAGE_TABLE_LEVEL;
M
Marcelo Tosatti 已提交
539

540 541 542 543 544
	host_level = host_mapping_level(vcpu->kvm, large_gfn);

	if (host_level == PT_PAGE_TABLE_LEVEL)
		return host_level;

545 546 547 548
	max_level = kvm_x86_ops->get_lpage_level() < host_level ?
		kvm_x86_ops->get_lpage_level() : host_level;

	for (level = PT_DIRECTORY_LEVEL; level <= max_level; ++level)
549 550 551 552
		if (has_wrprotected_page(vcpu->kvm, large_gfn, level))
			break;

	return level - 1;
M
Marcelo Tosatti 已提交
553 554
}

555 556 557 558
/*
 * Take gfn and return the reverse mapping to it.
 */

559
static unsigned long *gfn_to_rmap(struct kvm *kvm, gfn_t gfn, int level)
560 561
{
	struct kvm_memory_slot *slot;
M
Marcelo Tosatti 已提交
562
	unsigned long idx;
563 564

	slot = gfn_to_memslot(kvm, gfn);
565
	if (likely(level == PT_PAGE_TABLE_LEVEL))
M
Marcelo Tosatti 已提交
566 567
		return &slot->rmap[gfn - slot->base_gfn];

568 569
	idx = (gfn >> KVM_HPAGE_GFN_SHIFT(level)) -
		(slot->base_gfn >> KVM_HPAGE_GFN_SHIFT(level));
M
Marcelo Tosatti 已提交
570

571
	return &slot->lpage_info[level - 2][idx].rmap_pde;
572 573
}

574 575 576
/*
 * Reverse mapping data structures:
 *
577 578
 * If rmapp bit zero is zero, then rmapp point to the shadw page table entry
 * that points to page_address(page).
579
 *
580 581
 * If rmapp bit zero is one, (then rmap & ~1) points to a struct kvm_rmap_desc
 * containing more mappings.
582 583 584 585
 *
 * Returns the number of rmap entries before the spte was added or zero if
 * the spte was not added.
 *
586
 */
587
static int rmap_add(struct kvm_vcpu *vcpu, u64 *spte, gfn_t gfn)
588
{
589
	struct kvm_mmu_page *sp;
590
	struct kvm_rmap_desc *desc;
591
	unsigned long *rmapp;
592
	int i, count = 0;
593

594
	if (!is_rmap_spte(*spte))
595
		return count;
596
	sp = page_header(__pa(spte));
597
	kvm_mmu_page_set_gfn(sp, spte - sp->spt, gfn);
598
	rmapp = gfn_to_rmap(vcpu->kvm, gfn, sp->role.level);
599
	if (!*rmapp) {
600
		rmap_printk("rmap_add: %p %llx 0->1\n", spte, *spte);
601 602
		*rmapp = (unsigned long)spte;
	} else if (!(*rmapp & 1)) {
603
		rmap_printk("rmap_add: %p %llx 1->many\n", spte, *spte);
604
		desc = mmu_alloc_rmap_desc(vcpu);
A
Avi Kivity 已提交
605 606
		desc->sptes[0] = (u64 *)*rmapp;
		desc->sptes[1] = spte;
607
		*rmapp = (unsigned long)desc | 1;
608 609
	} else {
		rmap_printk("rmap_add: %p %llx many->many\n", spte, *spte);
610
		desc = (struct kvm_rmap_desc *)(*rmapp & ~1ul);
A
Avi Kivity 已提交
611
		while (desc->sptes[RMAP_EXT-1] && desc->more) {
612
			desc = desc->more;
613 614
			count += RMAP_EXT;
		}
A
Avi Kivity 已提交
615
		if (desc->sptes[RMAP_EXT-1]) {
616
			desc->more = mmu_alloc_rmap_desc(vcpu);
617 618
			desc = desc->more;
		}
A
Avi Kivity 已提交
619
		for (i = 0; desc->sptes[i]; ++i)
620
			;
A
Avi Kivity 已提交
621
		desc->sptes[i] = spte;
622
	}
623
	return count;
624 625
}

626
static void rmap_desc_remove_entry(unsigned long *rmapp,
627 628 629 630 631 632
				   struct kvm_rmap_desc *desc,
				   int i,
				   struct kvm_rmap_desc *prev_desc)
{
	int j;

A
Avi Kivity 已提交
633
	for (j = RMAP_EXT - 1; !desc->sptes[j] && j > i; --j)
634
		;
A
Avi Kivity 已提交
635 636
	desc->sptes[i] = desc->sptes[j];
	desc->sptes[j] = NULL;
637 638 639
	if (j != 0)
		return;
	if (!prev_desc && !desc->more)
A
Avi Kivity 已提交
640
		*rmapp = (unsigned long)desc->sptes[0];
641 642 643 644
	else
		if (prev_desc)
			prev_desc->more = desc->more;
		else
645
			*rmapp = (unsigned long)desc->more | 1;
646
	mmu_free_rmap_desc(desc);
647 648
}

649
static void rmap_remove(struct kvm *kvm, u64 *spte)
650 651 652
{
	struct kvm_rmap_desc *desc;
	struct kvm_rmap_desc *prev_desc;
653
	struct kvm_mmu_page *sp;
654
	gfn_t gfn;
655
	unsigned long *rmapp;
656 657
	int i;

658
	sp = page_header(__pa(spte));
659 660
	gfn = kvm_mmu_page_get_gfn(sp, spte - sp->spt);
	rmapp = gfn_to_rmap(kvm, gfn, sp->role.level);
661
	if (!*rmapp) {
662
		printk(KERN_ERR "rmap_remove: %p 0->BUG\n", spte);
663
		BUG();
664
	} else if (!(*rmapp & 1)) {
665
		rmap_printk("rmap_remove:  %p 1->0\n", spte);
666
		if ((u64 *)*rmapp != spte) {
667
			printk(KERN_ERR "rmap_remove:  %p 1->BUG\n", spte);
668 669
			BUG();
		}
670
		*rmapp = 0;
671
	} else {
672
		rmap_printk("rmap_remove:  %p many->many\n", spte);
673
		desc = (struct kvm_rmap_desc *)(*rmapp & ~1ul);
674 675
		prev_desc = NULL;
		while (desc) {
A
Avi Kivity 已提交
676 677
			for (i = 0; i < RMAP_EXT && desc->sptes[i]; ++i)
				if (desc->sptes[i] == spte) {
678
					rmap_desc_remove_entry(rmapp,
679
							       desc, i,
680 681 682 683 684 685
							       prev_desc);
					return;
				}
			prev_desc = desc;
			desc = desc->more;
		}
686
		pr_err("rmap_remove: %p many->many\n", spte);
687 688 689 690
		BUG();
	}
}

691
static void set_spte_track_bits(u64 *sptep, u64 new_spte)
A
Avi Kivity 已提交
692
{
693
	pfn_t pfn;
694 695
	u64 old_spte = *sptep;

696
	if (!spte_has_volatile_bits(old_spte))
697
		__set_spte(sptep, new_spte);
698
	else
699
		old_spte = __xchg_spte(sptep, new_spte);
700

701
	if (!is_rmap_spte(old_spte))
702
		return;
703

704
	pfn = spte_to_pfn(old_spte);
705
	if (!shadow_accessed_mask || old_spte & shadow_accessed_mask)
706
		kvm_set_pfn_accessed(pfn);
707
	if (is_writable_pte(old_spte))
708
		kvm_set_pfn_dirty(pfn);
709 710 711 712 713
}

static void drop_spte(struct kvm *kvm, u64 *sptep, u64 new_spte)
{
	set_spte_track_bits(sptep, new_spte);
A
Avi Kivity 已提交
714 715 716
	rmap_remove(kvm, sptep);
}

717
static u64 *rmap_next(struct kvm *kvm, unsigned long *rmapp, u64 *spte)
718 719
{
	struct kvm_rmap_desc *desc;
720 721 722 723 724 725 726 727 728 729 730 731 732
	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_spte = NULL;
	while (desc) {
A
Avi Kivity 已提交
733
		for (i = 0; i < RMAP_EXT && desc->sptes[i]; ++i) {
734
			if (prev_spte == spte)
A
Avi Kivity 已提交
735 736
				return desc->sptes[i];
			prev_spte = desc->sptes[i];
737 738 739 740 741 742
		}
		desc = desc->more;
	}
	return NULL;
}

743
static int rmap_write_protect(struct kvm *kvm, u64 gfn)
744
{
745
	unsigned long *rmapp;
746
	u64 *spte;
747
	int i, write_protected = 0;
748

749
	rmapp = gfn_to_rmap(kvm, gfn, PT_PAGE_TABLE_LEVEL);
750

751 752
	spte = rmap_next(kvm, rmapp, NULL);
	while (spte) {
753 754 755
		BUG_ON(!spte);
		BUG_ON(!(*spte & PT_PRESENT_MASK));
		rmap_printk("rmap_write_protect: spte %p %llx\n", spte, *spte);
756
		if (is_writable_pte(*spte)) {
757
			update_spte(spte, *spte & ~PT_WRITABLE_MASK);
758 759
			write_protected = 1;
		}
760
		spte = rmap_next(kvm, rmapp, spte);
761
	}
762
	if (write_protected) {
763
		pfn_t pfn;
764 765

		spte = rmap_next(kvm, rmapp, NULL);
766 767
		pfn = spte_to_pfn(*spte);
		kvm_set_pfn_dirty(pfn);
768 769
	}

M
Marcelo Tosatti 已提交
770
	/* check for huge page mappings */
771 772 773 774 775 776 777 778 779
	for (i = PT_DIRECTORY_LEVEL;
	     i < PT_PAGE_TABLE_LEVEL + KVM_NR_PAGE_SIZES; ++i) {
		rmapp = gfn_to_rmap(kvm, gfn, i);
		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);
780
			if (is_writable_pte(*spte)) {
A
Avi Kivity 已提交
781 782
				drop_spte(kvm, spte,
					  shadow_trap_nonpresent_pte);
783 784 785 786 787
				--kvm->stat.lpages;
				spte = NULL;
				write_protected = 1;
			}
			spte = rmap_next(kvm, rmapp, spte);
M
Marcelo Tosatti 已提交
788 789 790
		}
	}

791
	return write_protected;
792 793
}

F
Frederik Deweerdt 已提交
794 795
static int kvm_unmap_rmapp(struct kvm *kvm, unsigned long *rmapp,
			   unsigned long data)
796 797 798 799 800 801 802
{
	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);
A
Avi Kivity 已提交
803
		drop_spte(kvm, spte, shadow_trap_nonpresent_pte);
804 805 806 807 808
		need_tlb_flush = 1;
	}
	return need_tlb_flush;
}

F
Frederik Deweerdt 已提交
809 810
static int kvm_set_pte_rmapp(struct kvm *kvm, unsigned long *rmapp,
			     unsigned long data)
811 812
{
	int need_flush = 0;
813
	u64 *spte, new_spte;
814 815 816 817 818 819 820 821 822 823 824
	pte_t *ptep = (pte_t *)data;
	pfn_t new_pfn;

	WARN_ON(pte_huge(*ptep));
	new_pfn = pte_pfn(*ptep);
	spte = rmap_next(kvm, rmapp, NULL);
	while (spte) {
		BUG_ON(!is_shadow_present_pte(*spte));
		rmap_printk("kvm_set_pte_rmapp: spte %p %llx\n", spte, *spte);
		need_flush = 1;
		if (pte_write(*ptep)) {
A
Avi Kivity 已提交
825
			drop_spte(kvm, spte, shadow_trap_nonpresent_pte);
826 827 828 829 830 831 832
			spte = rmap_next(kvm, rmapp, NULL);
		} else {
			new_spte = *spte &~ (PT64_BASE_ADDR_MASK);
			new_spte |= (u64)new_pfn << PAGE_SHIFT;

			new_spte &= ~PT_WRITABLE_MASK;
			new_spte &= ~SPTE_HOST_WRITEABLE;
833
			new_spte &= ~shadow_accessed_mask;
834
			set_spte_track_bits(spte, new_spte);
835 836 837 838 839 840 841 842 843
			spte = rmap_next(kvm, rmapp, spte);
		}
	}
	if (need_flush)
		kvm_flush_remote_tlbs(kvm);

	return 0;
}

F
Frederik Deweerdt 已提交
844 845
static int kvm_handle_hva(struct kvm *kvm, unsigned long hva,
			  unsigned long data,
846
			  int (*handler)(struct kvm *kvm, unsigned long *rmapp,
F
Frederik Deweerdt 已提交
847
					 unsigned long data))
848
{
849
	int i, j;
850
	int ret;
851
	int retval = 0;
852 853
	struct kvm_memslots *slots;

854
	slots = kvm_memslots(kvm);
855

856 857
	for (i = 0; i < slots->nmemslots; i++) {
		struct kvm_memory_slot *memslot = &slots->memslots[i];
858 859 860 861 862 863
		unsigned long start = memslot->userspace_addr;
		unsigned long end;

		end = start + (memslot->npages << PAGE_SHIFT);
		if (hva >= start && hva < end) {
			gfn_t gfn_offset = (hva - start) >> PAGE_SHIFT;
864

865
			ret = handler(kvm, &memslot->rmap[gfn_offset], data);
866 867

			for (j = 0; j < KVM_NR_PAGE_SIZES - 1; ++j) {
868 869 870 871 872 873
				unsigned long idx;
				int sh;

				sh = KVM_HPAGE_GFN_SHIFT(PT_DIRECTORY_LEVEL+j);
				idx = ((memslot->base_gfn+gfn_offset) >> sh) -
					(memslot->base_gfn >> sh);
874
				ret |= handler(kvm,
875 876
					&memslot->lpage_info[j][idx].rmap_pde,
					data);
877
			}
878 879
			trace_kvm_age_page(hva, memslot, ret);
			retval |= ret;
880 881 882 883 884 885 886 887
		}
	}

	return retval;
}

int kvm_unmap_hva(struct kvm *kvm, unsigned long hva)
{
888 889 890 891 892
	return kvm_handle_hva(kvm, hva, 0, kvm_unmap_rmapp);
}

void kvm_set_spte_hva(struct kvm *kvm, unsigned long hva, pte_t pte)
{
F
Frederik Deweerdt 已提交
893
	kvm_handle_hva(kvm, hva, (unsigned long)&pte, kvm_set_pte_rmapp);
894 895
}

F
Frederik Deweerdt 已提交
896 897
static int kvm_age_rmapp(struct kvm *kvm, unsigned long *rmapp,
			 unsigned long data)
898 899 900 901
{
	u64 *spte;
	int young = 0;

902 903 904 905 906 907 908
	/*
	 * Emulate the accessed bit for EPT, by checking if this page has
	 * an EPT mapping, and clearing it if it does. On the next access,
	 * a new EPT mapping will be established.
	 * This has some overhead, but not as much as the cost of swapping
	 * out actively used pages or breaking up actively used hugepages.
	 */
909
	if (!shadow_accessed_mask)
910
		return kvm_unmap_rmapp(kvm, rmapp, data);
911

912 913 914 915 916 917 918 919 920 921 922 923 924 925 926
	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;
}

927 928
#define RMAP_RECYCLE_THRESHOLD 1000

929
static void rmap_recycle(struct kvm_vcpu *vcpu, u64 *spte, gfn_t gfn)
930 931
{
	unsigned long *rmapp;
932 933 934
	struct kvm_mmu_page *sp;

	sp = page_header(__pa(spte));
935

936
	rmapp = gfn_to_rmap(vcpu->kvm, gfn, sp->role.level);
937

938
	kvm_unmap_rmapp(vcpu->kvm, rmapp, 0);
939 940 941
	kvm_flush_remote_tlbs(vcpu->kvm);
}

942 943
int kvm_age_hva(struct kvm *kvm, unsigned long hva)
{
944
	return kvm_handle_hva(kvm, hva, 0, kvm_age_rmapp);
945 946
}

947
#ifdef MMU_DEBUG
948
static int is_empty_shadow_page(u64 *spt)
A
Avi Kivity 已提交
949
{
950 951 952
	u64 *pos;
	u64 *end;

953
	for (pos = spt, end = pos + PAGE_SIZE / sizeof(u64); pos != end; pos++)
954
		if (is_shadow_present_pte(*pos)) {
955
			printk(KERN_ERR "%s: %p %llx\n", __func__,
956
			       pos, *pos);
A
Avi Kivity 已提交
957
			return 0;
958
		}
A
Avi Kivity 已提交
959 960
	return 1;
}
961
#endif
A
Avi Kivity 已提交
962

963
static void kvm_mmu_free_page(struct kvm *kvm, struct kvm_mmu_page *sp)
964
{
965
	ASSERT(is_empty_shadow_page(sp->spt));
966
	hlist_del(&sp->hash_link);
967 968
	list_del(&sp->link);
	__free_page(virt_to_page(sp->spt));
969 970
	if (!sp->role.direct)
		__free_page(virt_to_page(sp->gfns));
971
	kmem_cache_free(mmu_page_header_cache, sp);
972
	++kvm->arch.n_free_mmu_pages;
973 974
}

975 976
static unsigned kvm_page_table_hashfn(gfn_t gfn)
{
977
	return gfn & ((1 << KVM_MMU_HASH_SHIFT) - 1);
978 979
}

980
static struct kvm_mmu_page *kvm_mmu_alloc_page(struct kvm_vcpu *vcpu,
981
					       u64 *parent_pte, int direct)
A
Avi Kivity 已提交
982
{
983
	struct kvm_mmu_page *sp;
A
Avi Kivity 已提交
984

985 986
	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);
987 988 989
	if (!direct)
		sp->gfns = mmu_memory_cache_alloc(&vcpu->arch.mmu_page_cache,
						  PAGE_SIZE);
990
	set_page_private(virt_to_page(sp->spt), (unsigned long)sp);
991
	list_add(&sp->link, &vcpu->kvm->arch.active_mmu_pages);
992
	bitmap_zero(sp->slot_bitmap, KVM_MEMORY_SLOTS + KVM_PRIVATE_MEM_SLOTS);
993 994
	sp->multimapped = 0;
	sp->parent_pte = parent_pte;
995
	--vcpu->kvm->arch.n_free_mmu_pages;
996
	return sp;
A
Avi Kivity 已提交
997 998
}

999
static void mmu_page_add_parent_pte(struct kvm_vcpu *vcpu,
1000
				    struct kvm_mmu_page *sp, u64 *parent_pte)
1001 1002 1003 1004 1005 1006 1007
{
	struct kvm_pte_chain *pte_chain;
	struct hlist_node *node;
	int i;

	if (!parent_pte)
		return;
1008 1009
	if (!sp->multimapped) {
		u64 *old = sp->parent_pte;
1010 1011

		if (!old) {
1012
			sp->parent_pte = parent_pte;
1013 1014
			return;
		}
1015
		sp->multimapped = 1;
1016
		pte_chain = mmu_alloc_pte_chain(vcpu);
1017 1018
		INIT_HLIST_HEAD(&sp->parent_ptes);
		hlist_add_head(&pte_chain->link, &sp->parent_ptes);
1019 1020
		pte_chain->parent_ptes[0] = old;
	}
1021
	hlist_for_each_entry(pte_chain, node, &sp->parent_ptes, link) {
1022 1023 1024 1025 1026 1027 1028 1029
		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;
			}
	}
1030
	pte_chain = mmu_alloc_pte_chain(vcpu);
1031
	BUG_ON(!pte_chain);
1032
	hlist_add_head(&pte_chain->link, &sp->parent_ptes);
1033 1034 1035
	pte_chain->parent_ptes[0] = parent_pte;
}

1036
static void mmu_page_remove_parent_pte(struct kvm_mmu_page *sp,
1037 1038 1039 1040 1041 1042
				       u64 *parent_pte)
{
	struct kvm_pte_chain *pte_chain;
	struct hlist_node *node;
	int i;

1043 1044 1045
	if (!sp->multimapped) {
		BUG_ON(sp->parent_pte != parent_pte);
		sp->parent_pte = NULL;
1046 1047
		return;
	}
1048
	hlist_for_each_entry(pte_chain, node, &sp->parent_ptes, link)
1049 1050 1051 1052 1053
		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;
1054 1055
			while (i + 1 < NR_PTE_CHAIN_ENTRIES
				&& pte_chain->parent_ptes[i + 1]) {
1056 1057 1058 1059 1060
				pte_chain->parent_ptes[i]
					= pte_chain->parent_ptes[i + 1];
				++i;
			}
			pte_chain->parent_ptes[i] = NULL;
1061 1062
			if (i == 0) {
				hlist_del(&pte_chain->link);
1063
				mmu_free_pte_chain(pte_chain);
1064 1065 1066
				if (hlist_empty(&sp->parent_ptes)) {
					sp->multimapped = 0;
					sp->parent_pte = NULL;
1067 1068
				}
			}
1069 1070 1071 1072 1073
			return;
		}
	BUG();
}

1074
static void mmu_parent_walk(struct kvm_mmu_page *sp, mmu_parent_walk_fn fn)
M
Marcelo Tosatti 已提交
1075 1076 1077 1078 1079 1080 1081 1082
{
	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));
1083
		fn(parent_sp, sp->parent_pte);
M
Marcelo Tosatti 已提交
1084 1085
		return;
	}
1086

M
Marcelo Tosatti 已提交
1087 1088
	hlist_for_each_entry(pte_chain, node, &sp->parent_ptes, link)
		for (i = 0; i < NR_PTE_CHAIN_ENTRIES; ++i) {
1089 1090 1091
			u64 *spte = pte_chain->parent_ptes[i];

			if (!spte)
M
Marcelo Tosatti 已提交
1092
				break;
1093 1094
			parent_sp = page_header(__pa(spte));
			fn(parent_sp, spte);
M
Marcelo Tosatti 已提交
1095 1096 1097
		}
}

1098 1099
static void mark_unsync(struct kvm_mmu_page *sp, u64 *spte);
static void kvm_mmu_mark_parents_unsync(struct kvm_mmu_page *sp)
1100
{
1101
	mmu_parent_walk(sp, mark_unsync);
1102 1103
}

1104
static void mark_unsync(struct kvm_mmu_page *sp, u64 *spte)
1105
{
1106
	unsigned int index;
1107

1108 1109
	index = spte - sp->spt;
	if (__test_and_set_bit(index, sp->unsync_child_bitmap))
1110
		return;
1111
	if (sp->unsync_children++)
1112
		return;
1113
	kvm_mmu_mark_parents_unsync(sp);
1114 1115
}

1116 1117 1118 1119 1120 1121 1122 1123 1124
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;
}

1125
static int nonpaging_sync_page(struct kvm_vcpu *vcpu,
1126
			       struct kvm_mmu_page *sp, bool clear_unsync)
1127 1128 1129 1130
{
	return 1;
}

M
Marcelo Tosatti 已提交
1131 1132 1133 1134
static void nonpaging_invlpg(struct kvm_vcpu *vcpu, gva_t gva)
{
}

1135 1136 1137 1138 1139 1140 1141 1142 1143 1144
#define KVM_PAGE_ARRAY_NR 16

struct kvm_mmu_pages {
	struct mmu_page_and_offset {
		struct kvm_mmu_page *sp;
		unsigned int idx;
	} page[KVM_PAGE_ARRAY_NR];
	unsigned int nr;
};

1145 1146 1147 1148 1149
#define for_each_unsync_children(bitmap, idx)		\
	for (idx = find_first_bit(bitmap, 512);		\
	     idx < 512;					\
	     idx = find_next_bit(bitmap, 512, idx+1))

1150 1151
static int mmu_pages_add(struct kvm_mmu_pages *pvec, struct kvm_mmu_page *sp,
			 int idx)
1152
{
1153
	int i;
1154

1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169
	if (sp->unsync)
		for (i=0; i < pvec->nr; i++)
			if (pvec->page[i].sp == sp)
				return 0;

	pvec->page[pvec->nr].sp = sp;
	pvec->page[pvec->nr].idx = idx;
	pvec->nr++;
	return (pvec->nr == KVM_PAGE_ARRAY_NR);
}

static int __mmu_unsync_walk(struct kvm_mmu_page *sp,
			   struct kvm_mmu_pages *pvec)
{
	int i, ret, nr_unsync_leaf = 0;
1170

1171
	for_each_unsync_children(sp->unsync_child_bitmap, i) {
1172
		struct kvm_mmu_page *child;
1173 1174
		u64 ent = sp->spt[i];

1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203
		if (!is_shadow_present_pte(ent) || is_large_pte(ent))
			goto clear_child_bitmap;

		child = page_header(ent & PT64_BASE_ADDR_MASK);

		if (child->unsync_children) {
			if (mmu_pages_add(pvec, child, i))
				return -ENOSPC;

			ret = __mmu_unsync_walk(child, pvec);
			if (!ret)
				goto clear_child_bitmap;
			else if (ret > 0)
				nr_unsync_leaf += ret;
			else
				return ret;
		} else if (child->unsync) {
			nr_unsync_leaf++;
			if (mmu_pages_add(pvec, child, i))
				return -ENOSPC;
		} else
			 goto clear_child_bitmap;

		continue;

clear_child_bitmap:
		__clear_bit(i, sp->unsync_child_bitmap);
		sp->unsync_children--;
		WARN_ON((int)sp->unsync_children < 0);
1204 1205 1206
	}


1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217
	return nr_unsync_leaf;
}

static int mmu_unsync_walk(struct kvm_mmu_page *sp,
			   struct kvm_mmu_pages *pvec)
{
	if (!sp->unsync_children)
		return 0;

	mmu_pages_add(pvec, sp, 0);
	return __mmu_unsync_walk(sp, pvec);
1218 1219 1220 1221 1222
}

static void kvm_unlink_unsync_page(struct kvm *kvm, struct kvm_mmu_page *sp)
{
	WARN_ON(!sp->unsync);
1223
	trace_kvm_mmu_sync_page(sp);
1224 1225 1226 1227
	sp->unsync = 0;
	--kvm->stat.mmu_unsync;
}

1228 1229 1230 1231
static int kvm_mmu_prepare_zap_page(struct kvm *kvm, struct kvm_mmu_page *sp,
				    struct list_head *invalid_list);
static void kvm_mmu_commit_zap_page(struct kvm *kvm,
				    struct list_head *invalid_list);
1232

1233 1234
#define for_each_gfn_sp(kvm, sp, gfn, pos)				\
  hlist_for_each_entry(sp, pos,						\
1235 1236 1237
   &(kvm)->arch.mmu_page_hash[kvm_page_table_hashfn(gfn)], hash_link)	\
	if ((sp)->gfn != (gfn)) {} else

1238 1239
#define for_each_gfn_indirect_valid_sp(kvm, sp, gfn, pos)		\
  hlist_for_each_entry(sp, pos,						\
1240 1241 1242 1243
   &(kvm)->arch.mmu_page_hash[kvm_page_table_hashfn(gfn)], hash_link)	\
		if ((sp)->gfn != (gfn) || (sp)->role.direct ||		\
			(sp)->role.invalid) {} else

1244
/* @sp->gfn should be write-protected at the call site */
1245
static int __kvm_sync_page(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp,
1246
			   struct list_head *invalid_list, bool clear_unsync)
1247
{
1248
	if (sp->role.cr4_pae != !!is_pae(vcpu)) {
1249
		kvm_mmu_prepare_zap_page(vcpu->kvm, sp, invalid_list);
1250 1251 1252
		return 1;
	}

1253
	if (clear_unsync)
1254 1255
		kvm_unlink_unsync_page(vcpu->kvm, sp);

1256
	if (vcpu->arch.mmu.sync_page(vcpu, sp, clear_unsync)) {
1257
		kvm_mmu_prepare_zap_page(vcpu->kvm, sp, invalid_list);
1258 1259 1260 1261 1262 1263 1264
		return 1;
	}

	kvm_mmu_flush_tlb(vcpu);
	return 0;
}

1265 1266 1267
static int kvm_sync_page_transient(struct kvm_vcpu *vcpu,
				   struct kvm_mmu_page *sp)
{
1268
	LIST_HEAD(invalid_list);
1269 1270
	int ret;

1271
	ret = __kvm_sync_page(vcpu, sp, &invalid_list, false);
1272
	if (ret)
1273 1274
		kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);

1275 1276 1277
	return ret;
}

1278 1279
static int kvm_sync_page(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp,
			 struct list_head *invalid_list)
1280
{
1281
	return __kvm_sync_page(vcpu, sp, invalid_list, true);
1282 1283
}

1284 1285 1286 1287
/* @gfn should be write-protected at the call site */
static void kvm_sync_pages(struct kvm_vcpu *vcpu,  gfn_t gfn)
{
	struct kvm_mmu_page *s;
1288
	struct hlist_node *node;
1289
	LIST_HEAD(invalid_list);
1290 1291
	bool flush = false;

1292
	for_each_gfn_indirect_valid_sp(vcpu->kvm, s, gfn, node) {
1293
		if (!s->unsync)
1294 1295 1296 1297
			continue;

		WARN_ON(s->role.level != PT_PAGE_TABLE_LEVEL);
		if ((s->role.cr4_pae != !!is_pae(vcpu)) ||
1298
			(vcpu->arch.mmu.sync_page(vcpu, s, true))) {
1299
			kvm_mmu_prepare_zap_page(vcpu->kvm, s, &invalid_list);
1300 1301 1302 1303 1304 1305
			continue;
		}
		kvm_unlink_unsync_page(vcpu->kvm, s);
		flush = true;
	}

1306
	kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
1307 1308 1309 1310
	if (flush)
		kvm_mmu_flush_tlb(vcpu);
}

1311 1312 1313
struct mmu_page_path {
	struct kvm_mmu_page *parent[PT64_ROOT_LEVEL-1];
	unsigned int idx[PT64_ROOT_LEVEL-1];
1314 1315
};

1316 1317 1318 1319 1320 1321
#define for_each_sp(pvec, sp, parents, i)			\
		for (i = mmu_pages_next(&pvec, &parents, -1),	\
			sp = pvec.page[i].sp;			\
			i < pvec.nr && ({ sp = pvec.page[i].sp; 1;});	\
			i = mmu_pages_next(&pvec, &parents, i))

1322 1323 1324
static int mmu_pages_next(struct kvm_mmu_pages *pvec,
			  struct mmu_page_path *parents,
			  int i)
1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342
{
	int n;

	for (n = i+1; n < pvec->nr; n++) {
		struct kvm_mmu_page *sp = pvec->page[n].sp;

		if (sp->role.level == PT_PAGE_TABLE_LEVEL) {
			parents->idx[0] = pvec->page[n].idx;
			return n;
		}

		parents->parent[sp->role.level-2] = sp;
		parents->idx[sp->role.level-1] = pvec->page[n].idx;
	}

	return n;
}

1343
static void mmu_pages_clear_parents(struct mmu_page_path *parents)
1344
{
1345 1346 1347 1348 1349
	struct kvm_mmu_page *sp;
	unsigned int level = 0;

	do {
		unsigned int idx = parents->idx[level];
1350

1351 1352 1353 1354 1355 1356 1357 1358 1359
		sp = parents->parent[level];
		if (!sp)
			return;

		--sp->unsync_children;
		WARN_ON((int)sp->unsync_children < 0);
		__clear_bit(idx, sp->unsync_child_bitmap);
		level++;
	} while (level < PT64_ROOT_LEVEL-1 && !sp->unsync_children);
1360 1361
}

1362 1363 1364
static void kvm_mmu_pages_init(struct kvm_mmu_page *parent,
			       struct mmu_page_path *parents,
			       struct kvm_mmu_pages *pvec)
1365
{
1366 1367 1368
	parents->parent[parent->role.level-1] = NULL;
	pvec->nr = 0;
}
1369

1370 1371 1372 1373 1374 1375 1376
static void mmu_sync_children(struct kvm_vcpu *vcpu,
			      struct kvm_mmu_page *parent)
{
	int i;
	struct kvm_mmu_page *sp;
	struct mmu_page_path parents;
	struct kvm_mmu_pages pages;
1377
	LIST_HEAD(invalid_list);
1378 1379 1380

	kvm_mmu_pages_init(parent, &parents, &pages);
	while (mmu_unsync_walk(parent, &pages)) {
1381 1382 1383 1384 1385 1386 1387 1388
		int protected = 0;

		for_each_sp(pages, sp, parents, i)
			protected |= rmap_write_protect(vcpu->kvm, sp->gfn);

		if (protected)
			kvm_flush_remote_tlbs(vcpu->kvm);

1389
		for_each_sp(pages, sp, parents, i) {
1390
			kvm_sync_page(vcpu, sp, &invalid_list);
1391 1392
			mmu_pages_clear_parents(&parents);
		}
1393
		kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
1394
		cond_resched_lock(&vcpu->kvm->mmu_lock);
1395 1396
		kvm_mmu_pages_init(parent, &parents, &pages);
	}
1397 1398
}

1399 1400 1401 1402
static struct kvm_mmu_page *kvm_mmu_get_page(struct kvm_vcpu *vcpu,
					     gfn_t gfn,
					     gva_t gaddr,
					     unsigned level,
1403
					     int direct,
1404
					     unsigned access,
1405
					     u64 *parent_pte)
1406 1407 1408
{
	union kvm_mmu_page_role role;
	unsigned quadrant;
1409
	struct kvm_mmu_page *sp;
1410
	struct hlist_node *node;
1411
	bool need_sync = false;
1412

1413
	role = vcpu->arch.mmu.base_role;
1414
	role.level = level;
1415
	role.direct = direct;
1416
	if (role.direct)
1417
		role.cr4_pae = 0;
1418
	role.access = access;
1419
	if (!tdp_enabled && vcpu->arch.mmu.root_level <= PT32_ROOT_LEVEL) {
1420 1421 1422 1423
		quadrant = gaddr >> (PAGE_SHIFT + (PT64_PT_BITS * level));
		quadrant &= (1 << ((PT32_PT_BITS - PT64_PT_BITS) * level)) - 1;
		role.quadrant = quadrant;
	}
1424
	for_each_gfn_sp(vcpu->kvm, sp, gfn, node) {
1425 1426
		if (!need_sync && sp->unsync)
			need_sync = true;
1427

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

1431 1432
		if (sp->unsync && kvm_sync_page_transient(vcpu, sp))
			break;
1433

1434 1435
		mmu_page_add_parent_pte(vcpu, sp, parent_pte);
		if (sp->unsync_children) {
1436
			kvm_make_request(KVM_REQ_MMU_SYNC, vcpu);
1437 1438 1439
			kvm_mmu_mark_parents_unsync(sp);
		} else if (sp->unsync)
			kvm_mmu_mark_parents_unsync(sp);
1440

1441 1442 1443
		trace_kvm_mmu_get_page(sp, false);
		return sp;
	}
A
Avi Kivity 已提交
1444
	++vcpu->kvm->stat.mmu_cache_miss;
1445
	sp = kvm_mmu_alloc_page(vcpu, parent_pte, direct);
1446 1447 1448 1449
	if (!sp)
		return sp;
	sp->gfn = gfn;
	sp->role = role;
1450 1451
	hlist_add_head(&sp->hash_link,
		&vcpu->kvm->arch.mmu_page_hash[kvm_page_table_hashfn(gfn)]);
1452
	if (!direct) {
1453 1454
		if (rmap_write_protect(vcpu->kvm, gfn))
			kvm_flush_remote_tlbs(vcpu->kvm);
1455 1456 1457
		if (level > PT_PAGE_TABLE_LEVEL && need_sync)
			kvm_sync_pages(vcpu, gfn);

1458 1459
		account_shadowed(vcpu->kvm, gfn);
	}
1460 1461 1462 1463
	if (shadow_trap_nonpresent_pte != shadow_notrap_nonpresent_pte)
		vcpu->arch.mmu.prefetch_page(vcpu, sp);
	else
		nonpaging_prefetch_page(vcpu, sp);
A
Avi Kivity 已提交
1464
	trace_kvm_mmu_get_page(sp, true);
1465
	return sp;
1466 1467
}

1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487
static void shadow_walk_init(struct kvm_shadow_walk_iterator *iterator,
			     struct kvm_vcpu *vcpu, u64 addr)
{
	iterator->addr = addr;
	iterator->shadow_addr = vcpu->arch.mmu.root_hpa;
	iterator->level = vcpu->arch.mmu.shadow_root_level;
	if (iterator->level == PT32E_ROOT_LEVEL) {
		iterator->shadow_addr
			= vcpu->arch.mmu.pae_root[(addr >> 30) & 3];
		iterator->shadow_addr &= PT64_BASE_ADDR_MASK;
		--iterator->level;
		if (!iterator->shadow_addr)
			iterator->level = 0;
	}
}

static bool shadow_walk_okay(struct kvm_shadow_walk_iterator *iterator)
{
	if (iterator->level < PT_PAGE_TABLE_LEVEL)
		return false;
1488 1489 1490 1491 1492

	if (iterator->level == PT_PAGE_TABLE_LEVEL)
		if (is_large_pte(*iterator->sptep))
			return false;

1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503
	iterator->index = SHADOW_PT_INDEX(iterator->addr, iterator->level);
	iterator->sptep	= ((u64 *)__va(iterator->shadow_addr)) + iterator->index;
	return true;
}

static void shadow_walk_next(struct kvm_shadow_walk_iterator *iterator)
{
	iterator->shadow_addr = *iterator->sptep & PT64_BASE_ADDR_MASK;
	--iterator->level;
}

1504 1505 1506 1507 1508 1509 1510
static void link_shadow_page(u64 *sptep, struct kvm_mmu_page *sp)
{
	u64 spte;

	spte = __pa(sp->spt)
		| PT_PRESENT_MASK | PT_ACCESSED_MASK
		| PT_WRITABLE_MASK | PT_USER_MASK;
1511
	__set_spte(sptep, spte);
1512 1513
}

1514 1515 1516 1517 1518 1519 1520 1521
static void drop_large_spte(struct kvm_vcpu *vcpu, u64 *sptep)
{
	if (is_large_pte(*sptep)) {
		drop_spte(vcpu->kvm, sptep, shadow_trap_nonpresent_pte);
		kvm_flush_remote_tlbs(vcpu->kvm);
	}
}

1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544
static void validate_direct_spte(struct kvm_vcpu *vcpu, u64 *sptep,
				   unsigned direct_access)
{
	if (is_shadow_present_pte(*sptep) && !is_large_pte(*sptep)) {
		struct kvm_mmu_page *child;

		/*
		 * For the direct sp, if the guest pte's dirty bit
		 * changed form clean to dirty, it will corrupt the
		 * sp's access: allow writable in the read-only sp,
		 * so we should update the spte at this point to get
		 * a new sp with the correct access.
		 */
		child = page_header(*sptep & PT64_BASE_ADDR_MASK);
		if (child->role.access == direct_access)
			return;

		mmu_page_remove_parent_pte(child, sptep);
		__set_spte(sptep, shadow_trap_nonpresent_pte);
		kvm_flush_remote_tlbs(vcpu->kvm);
	}
}

1545
static void kvm_mmu_page_unlink_children(struct kvm *kvm,
1546
					 struct kvm_mmu_page *sp)
1547
{
1548 1549 1550 1551
	unsigned i;
	u64 *pt;
	u64 ent;

1552
	pt = sp->spt;
1553 1554 1555 1556

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

M
Marcelo Tosatti 已提交
1557
		if (is_shadow_present_pte(ent)) {
1558
			if (!is_last_spte(ent, sp->role.level)) {
M
Marcelo Tosatti 已提交
1559 1560 1561 1562
				ent &= PT64_BASE_ADDR_MASK;
				mmu_page_remove_parent_pte(page_header(ent),
							   &pt[i]);
			} else {
1563 1564
				if (is_large_pte(ent))
					--kvm->stat.lpages;
A
Avi Kivity 已提交
1565 1566
				drop_spte(kvm, &pt[i],
					  shadow_trap_nonpresent_pte);
M
Marcelo Tosatti 已提交
1567 1568
			}
		}
1569
		pt[i] = shadow_trap_nonpresent_pte;
1570
	}
1571 1572
}

1573
static void kvm_mmu_put_page(struct kvm_mmu_page *sp, u64 *parent_pte)
1574
{
1575
	mmu_page_remove_parent_pte(sp, parent_pte);
1576 1577
}

1578 1579 1580
static void kvm_mmu_reset_last_pte_updated(struct kvm *kvm)
{
	int i;
1581
	struct kvm_vcpu *vcpu;
1582

1583 1584
	kvm_for_each_vcpu(i, vcpu, kvm)
		vcpu->arch.last_pte_updated = NULL;
1585 1586
}

1587
static void kvm_mmu_unlink_parents(struct kvm *kvm, struct kvm_mmu_page *sp)
1588 1589 1590
{
	u64 *parent_pte;

1591 1592 1593
	while (sp->multimapped || sp->parent_pte) {
		if (!sp->multimapped)
			parent_pte = sp->parent_pte;
1594 1595 1596
		else {
			struct kvm_pte_chain *chain;

1597
			chain = container_of(sp->parent_ptes.first,
1598 1599 1600
					     struct kvm_pte_chain, link);
			parent_pte = chain->parent_ptes[0];
		}
1601
		BUG_ON(!parent_pte);
1602
		kvm_mmu_put_page(sp, parent_pte);
A
Avi Kivity 已提交
1603
		__set_spte(parent_pte, shadow_trap_nonpresent_pte);
1604
	}
1605 1606
}

1607
static int mmu_zap_unsync_children(struct kvm *kvm,
1608 1609
				   struct kvm_mmu_page *parent,
				   struct list_head *invalid_list)
1610
{
1611 1612 1613
	int i, zapped = 0;
	struct mmu_page_path parents;
	struct kvm_mmu_pages pages;
1614

1615
	if (parent->role.level == PT_PAGE_TABLE_LEVEL)
1616
		return 0;
1617 1618 1619 1620 1621 1622

	kvm_mmu_pages_init(parent, &parents, &pages);
	while (mmu_unsync_walk(parent, &pages)) {
		struct kvm_mmu_page *sp;

		for_each_sp(pages, sp, parents, i) {
1623
			kvm_mmu_prepare_zap_page(kvm, sp, invalid_list);
1624
			mmu_pages_clear_parents(&parents);
1625
			zapped++;
1626 1627 1628 1629 1630
		}
		kvm_mmu_pages_init(parent, &parents, &pages);
	}

	return zapped;
1631 1632
}

1633 1634
static int kvm_mmu_prepare_zap_page(struct kvm *kvm, struct kvm_mmu_page *sp,
				    struct list_head *invalid_list)
1635
{
1636
	int ret;
A
Avi Kivity 已提交
1637

1638
	trace_kvm_mmu_prepare_zap_page(sp);
1639
	++kvm->stat.mmu_shadow_zapped;
1640
	ret = mmu_zap_unsync_children(kvm, sp, invalid_list);
1641
	kvm_mmu_page_unlink_children(kvm, sp);
1642
	kvm_mmu_unlink_parents(kvm, sp);
1643
	if (!sp->role.invalid && !sp->role.direct)
A
Avi Kivity 已提交
1644
		unaccount_shadowed(kvm, sp->gfn);
1645 1646
	if (sp->unsync)
		kvm_unlink_unsync_page(kvm, sp);
1647
	if (!sp->root_count) {
1648 1649
		/* Count self */
		ret++;
1650
		list_move(&sp->link, invalid_list);
1651
	} else {
A
Avi Kivity 已提交
1652
		list_move(&sp->link, &kvm->arch.active_mmu_pages);
1653 1654
		kvm_reload_remote_mmus(kvm);
	}
1655 1656

	sp->role.invalid = 1;
1657
	kvm_mmu_reset_last_pte_updated(kvm);
1658
	return ret;
1659 1660
}

1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678
static void kvm_mmu_commit_zap_page(struct kvm *kvm,
				    struct list_head *invalid_list)
{
	struct kvm_mmu_page *sp;

	if (list_empty(invalid_list))
		return;

	kvm_flush_remote_tlbs(kvm);

	do {
		sp = list_first_entry(invalid_list, struct kvm_mmu_page, link);
		WARN_ON(!sp->role.invalid || sp->root_count);
		kvm_mmu_free_page(kvm, sp);
	} while (!list_empty(invalid_list));

}

1679 1680 1681 1682 1683 1684
/*
 * 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)
{
1685
	int used_pages;
1686
	LIST_HEAD(invalid_list);
1687 1688 1689 1690

	used_pages = kvm->arch.n_alloc_mmu_pages - kvm->arch.n_free_mmu_pages;
	used_pages = max(0, used_pages);

1691 1692 1693 1694 1695 1696
	/*
	 * 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
	 */

1697
	if (used_pages > kvm_nr_mmu_pages) {
1698 1699
		while (used_pages > kvm_nr_mmu_pages &&
			!list_empty(&kvm->arch.active_mmu_pages)) {
1700 1701
			struct kvm_mmu_page *page;

1702
			page = container_of(kvm->arch.active_mmu_pages.prev,
1703
					    struct kvm_mmu_page, link);
1704 1705
			used_pages -= kvm_mmu_prepare_zap_page(kvm, page,
							       &invalid_list);
1706
		}
1707
		kvm_mmu_commit_zap_page(kvm, &invalid_list);
1708
		kvm_nr_mmu_pages = used_pages;
1709
		kvm->arch.n_free_mmu_pages = 0;
1710 1711
	}
	else
1712 1713
		kvm->arch.n_free_mmu_pages += kvm_nr_mmu_pages
					 - kvm->arch.n_alloc_mmu_pages;
1714

1715
	kvm->arch.n_alloc_mmu_pages = kvm_nr_mmu_pages;
1716 1717
}

1718
static int kvm_mmu_unprotect_page(struct kvm *kvm, gfn_t gfn)
1719
{
1720
	struct kvm_mmu_page *sp;
1721
	struct hlist_node *node;
1722
	LIST_HEAD(invalid_list);
1723 1724
	int r;

1725
	pgprintk("%s: looking for gfn %lx\n", __func__, gfn);
1726
	r = 0;
1727 1728

	for_each_gfn_indirect_valid_sp(kvm, sp, gfn, node) {
1729 1730 1731
		pgprintk("%s: gfn %lx role %x\n", __func__, gfn,
			 sp->role.word);
		r = 1;
1732
		kvm_mmu_prepare_zap_page(kvm, sp, &invalid_list);
1733
	}
1734
	kvm_mmu_commit_zap_page(kvm, &invalid_list);
1735
	return r;
1736 1737
}

1738
static void mmu_unshadow(struct kvm *kvm, gfn_t gfn)
1739
{
1740
	struct kvm_mmu_page *sp;
1741
	struct hlist_node *node;
1742
	LIST_HEAD(invalid_list);
1743

1744
	for_each_gfn_indirect_valid_sp(kvm, sp, gfn, node) {
1745 1746
		pgprintk("%s: zap %lx %x\n",
			 __func__, gfn, sp->role.word);
1747
		kvm_mmu_prepare_zap_page(kvm, sp, &invalid_list);
1748
	}
1749
	kvm_mmu_commit_zap_page(kvm, &invalid_list);
1750 1751
}

1752
static void page_header_update_slot(struct kvm *kvm, void *pte, gfn_t gfn)
A
Avi Kivity 已提交
1753
{
1754
	int slot = memslot_id(kvm, gfn);
1755
	struct kvm_mmu_page *sp = page_header(__pa(pte));
A
Avi Kivity 已提交
1756

1757
	__set_bit(slot, sp->slot_bitmap);
A
Avi Kivity 已提交
1758 1759
}

1760 1761 1762 1763 1764 1765 1766 1767 1768 1769
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)
A
Avi Kivity 已提交
1770
			__set_spte(&pt[i], shadow_trap_nonpresent_pte);
1771 1772 1773
	}
}

1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866
/*
 * 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;
}

1867
u8 kvm_get_guest_memory_type(struct kvm_vcpu *vcpu, gfn_t gfn)
1868 1869 1870 1871 1872 1873 1874 1875 1876
{
	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;
}
1877
EXPORT_SYMBOL_GPL(kvm_get_guest_memory_type);
1878

1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889
static void __kvm_unsync_page(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp)
{
	trace_kvm_mmu_unsync_page(sp);
	++vcpu->kvm->stat.mmu_unsync;
	sp->unsync = 1;

	kvm_mmu_mark_parents_unsync(sp);
	mmu_convert_notrap(sp);
}

static void kvm_unsync_pages(struct kvm_vcpu *vcpu,  gfn_t gfn)
1890 1891
{
	struct kvm_mmu_page *s;
1892
	struct hlist_node *node;
1893

1894
	for_each_gfn_indirect_valid_sp(vcpu->kvm, s, gfn, node) {
1895
		if (s->unsync)
1896
			continue;
1897 1898
		WARN_ON(s->role.level != PT_PAGE_TABLE_LEVEL);
		__kvm_unsync_page(vcpu, s);
1899 1900 1901 1902 1903 1904
	}
}

static int mmu_need_write_protect(struct kvm_vcpu *vcpu, gfn_t gfn,
				  bool can_unsync)
{
1905
	struct kvm_mmu_page *s;
1906
	struct hlist_node *node;
1907 1908
	bool need_unsync = false;

1909
	for_each_gfn_indirect_valid_sp(vcpu->kvm, s, gfn, node) {
1910 1911 1912
		if (!can_unsync)
			return 1;

1913
		if (s->role.level != PT_PAGE_TABLE_LEVEL)
1914
			return 1;
1915 1916

		if (!need_unsync && !s->unsync) {
1917
			if (!oos_shadow)
1918 1919 1920
				return 1;
			need_unsync = true;
		}
1921
	}
1922 1923
	if (need_unsync)
		kvm_unsync_pages(vcpu, gfn);
1924 1925 1926
	return 0;
}

A
Avi Kivity 已提交
1927
static int set_spte(struct kvm_vcpu *vcpu, u64 *sptep,
M
Marcelo Tosatti 已提交
1928
		    unsigned pte_access, int user_fault,
1929
		    int write_fault, int dirty, int level,
1930
		    gfn_t gfn, pfn_t pfn, bool speculative,
1931
		    bool can_unsync, bool reset_host_protection)
1932 1933
{
	u64 spte;
M
Marcelo Tosatti 已提交
1934
	int ret = 0;
S
Sheng Yang 已提交
1935

1936 1937 1938 1939 1940
	/*
	 * 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 已提交
1941
	spte = shadow_base_present_pte | shadow_dirty_mask;
1942
	if (!speculative)
1943
		spte |= shadow_accessed_mask;
1944 1945
	if (!dirty)
		pte_access &= ~ACC_WRITE_MASK;
S
Sheng Yang 已提交
1946 1947 1948 1949
	if (pte_access & ACC_EXEC_MASK)
		spte |= shadow_x_mask;
	else
		spte |= shadow_nx_mask;
1950
	if (pte_access & ACC_USER_MASK)
S
Sheng Yang 已提交
1951
		spte |= shadow_user_mask;
1952
	if (level > PT_PAGE_TABLE_LEVEL)
M
Marcelo Tosatti 已提交
1953
		spte |= PT_PAGE_SIZE_MASK;
1954 1955 1956
	if (tdp_enabled)
		spte |= kvm_x86_ops->get_mt_mask(vcpu, gfn,
			kvm_is_mmio_pfn(pfn));
1957

1958 1959 1960
	if (reset_host_protection)
		spte |= SPTE_HOST_WRITEABLE;

1961
	spte |= (u64)pfn << PAGE_SHIFT;
1962 1963

	if ((pte_access & ACC_WRITE_MASK)
1964 1965
	    || (!tdp_enabled && write_fault && !is_write_protection(vcpu)
		&& !user_fault)) {
1966

1967 1968
		if (level > PT_PAGE_TABLE_LEVEL &&
		    has_wrprotected_page(vcpu->kvm, gfn, level)) {
1969
			ret = 1;
A
Avi Kivity 已提交
1970 1971
			drop_spte(vcpu->kvm, sptep, shadow_trap_nonpresent_pte);
			goto done;
1972 1973
		}

1974 1975
		spte |= PT_WRITABLE_MASK;

1976 1977 1978
		if (!tdp_enabled && !(pte_access & ACC_WRITE_MASK))
			spte &= ~PT_USER_MASK;

1979 1980 1981 1982 1983 1984
		/*
		 * Optimization: for pte sync, if spte was writable the hash
		 * lookup is unnecessary (and expensive). Write protection
		 * is responsibility of mmu_get_page / kvm_sync_page.
		 * Same reasoning can be applied to dirty page accounting.
		 */
1985
		if (!can_unsync && is_writable_pte(*sptep))
1986 1987
			goto set_pte;

1988
		if (mmu_need_write_protect(vcpu, gfn, can_unsync)) {
1989
			pgprintk("%s: found shadow page for %lx, marking ro\n",
1990
				 __func__, gfn);
M
Marcelo Tosatti 已提交
1991
			ret = 1;
1992
			pte_access &= ~ACC_WRITE_MASK;
1993
			if (is_writable_pte(spte))
1994 1995 1996 1997 1998 1999 2000
				spte &= ~PT_WRITABLE_MASK;
		}
	}

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

2001
set_pte:
2002 2003
	if (is_writable_pte(*sptep) && !is_writable_pte(spte))
		kvm_set_pfn_dirty(pfn);
2004
	update_spte(sptep, spte);
A
Avi Kivity 已提交
2005
done:
M
Marcelo Tosatti 已提交
2006 2007 2008
	return ret;
}

A
Avi Kivity 已提交
2009
static void mmu_set_spte(struct kvm_vcpu *vcpu, u64 *sptep,
M
Marcelo Tosatti 已提交
2010 2011
			 unsigned pt_access, unsigned pte_access,
			 int user_fault, int write_fault, int dirty,
2012
			 int *ptwrite, int level, gfn_t gfn,
2013 2014
			 pfn_t pfn, bool speculative,
			 bool reset_host_protection)
M
Marcelo Tosatti 已提交
2015 2016
{
	int was_rmapped = 0;
2017
	int rmap_count;
M
Marcelo Tosatti 已提交
2018 2019 2020

	pgprintk("%s: spte %llx access %x write_fault %d"
		 " user_fault %d gfn %lx\n",
A
Avi Kivity 已提交
2021
		 __func__, *sptep, pt_access,
M
Marcelo Tosatti 已提交
2022 2023
		 write_fault, user_fault, gfn);

A
Avi Kivity 已提交
2024
	if (is_rmap_spte(*sptep)) {
M
Marcelo Tosatti 已提交
2025 2026 2027 2028
		/*
		 * If we overwrite a PTE page pointer with a 2MB PMD, unlink
		 * the parent of the now unreachable PTE.
		 */
2029 2030
		if (level > PT_PAGE_TABLE_LEVEL &&
		    !is_large_pte(*sptep)) {
M
Marcelo Tosatti 已提交
2031
			struct kvm_mmu_page *child;
A
Avi Kivity 已提交
2032
			u64 pte = *sptep;
M
Marcelo Tosatti 已提交
2033 2034

			child = page_header(pte & PT64_BASE_ADDR_MASK);
A
Avi Kivity 已提交
2035
			mmu_page_remove_parent_pte(child, sptep);
2036 2037
			__set_spte(sptep, shadow_trap_nonpresent_pte);
			kvm_flush_remote_tlbs(vcpu->kvm);
A
Avi Kivity 已提交
2038
		} else if (pfn != spte_to_pfn(*sptep)) {
M
Marcelo Tosatti 已提交
2039
			pgprintk("hfn old %lx new %lx\n",
A
Avi Kivity 已提交
2040
				 spte_to_pfn(*sptep), pfn);
A
Avi Kivity 已提交
2041
			drop_spte(vcpu->kvm, sptep, shadow_trap_nonpresent_pte);
2042
			kvm_flush_remote_tlbs(vcpu->kvm);
2043 2044
		} else
			was_rmapped = 1;
M
Marcelo Tosatti 已提交
2045
	}
2046

A
Avi Kivity 已提交
2047
	if (set_spte(vcpu, sptep, pte_access, user_fault, write_fault,
2048 2049
		      dirty, level, gfn, pfn, speculative, true,
		      reset_host_protection)) {
M
Marcelo Tosatti 已提交
2050 2051
		if (write_fault)
			*ptwrite = 1;
2052
		kvm_mmu_flush_tlb(vcpu);
2053
	}
M
Marcelo Tosatti 已提交
2054

A
Avi Kivity 已提交
2055
	pgprintk("%s: setting spte %llx\n", __func__, *sptep);
M
Marcelo Tosatti 已提交
2056
	pgprintk("instantiating %s PTE (%s) at %ld (%llx) addr %p\n",
A
Avi Kivity 已提交
2057
		 is_large_pte(*sptep)? "2MB" : "4kB",
2058 2059
		 *sptep & PT_PRESENT_MASK ?"RW":"R", gfn,
		 *sptep, sptep);
A
Avi Kivity 已提交
2060
	if (!was_rmapped && is_large_pte(*sptep))
M
Marcelo Tosatti 已提交
2061 2062
		++vcpu->kvm->stat.lpages;

A
Avi Kivity 已提交
2063
	page_header_update_slot(vcpu->kvm, sptep, gfn);
2064
	if (!was_rmapped) {
2065
		rmap_count = rmap_add(vcpu, sptep, gfn);
2066
		if (rmap_count > RMAP_RECYCLE_THRESHOLD)
2067
			rmap_recycle(vcpu, sptep, gfn);
2068
	}
2069
	kvm_release_pfn_clean(pfn);
2070
	if (speculative) {
A
Avi Kivity 已提交
2071
		vcpu->arch.last_pte_updated = sptep;
2072 2073
		vcpu->arch.last_pte_gfn = gfn;
	}
2074 2075
}

A
Avi Kivity 已提交
2076 2077 2078 2079
static void nonpaging_new_cr3(struct kvm_vcpu *vcpu)
{
}

2080
static int __direct_map(struct kvm_vcpu *vcpu, gpa_t v, int write,
2081
			int level, gfn_t gfn, pfn_t pfn)
2082
{
2083
	struct kvm_shadow_walk_iterator iterator;
2084
	struct kvm_mmu_page *sp;
2085
	int pt_write = 0;
2086
	gfn_t pseudo_gfn;
A
Avi Kivity 已提交
2087

2088
	for_each_shadow_entry(vcpu, (u64)gfn << PAGE_SHIFT, iterator) {
2089
		if (iterator.level == level) {
2090 2091
			mmu_set_spte(vcpu, iterator.sptep, ACC_ALL, ACC_ALL,
				     0, write, 1, &pt_write,
2092
				     level, gfn, pfn, false, true);
2093 2094
			++vcpu->stat.pf_fixed;
			break;
A
Avi Kivity 已提交
2095 2096
		}

2097
		if (*iterator.sptep == shadow_trap_nonpresent_pte) {
2098 2099 2100 2101
			u64 base_addr = iterator.addr;

			base_addr &= PT64_LVL_ADDR_MASK(iterator.level);
			pseudo_gfn = base_addr >> PAGE_SHIFT;
2102 2103 2104 2105 2106 2107 2108 2109
			sp = kvm_mmu_get_page(vcpu, pseudo_gfn, iterator.addr,
					      iterator.level - 1,
					      1, ACC_ALL, iterator.sptep);
			if (!sp) {
				pgprintk("nonpaging_map: ENOMEM\n");
				kvm_release_pfn_clean(pfn);
				return -ENOMEM;
			}
2110

A
Avi Kivity 已提交
2111 2112 2113 2114
			__set_spte(iterator.sptep,
				   __pa(sp->spt)
				   | PT_PRESENT_MASK | PT_WRITABLE_MASK
				   | shadow_user_mask | shadow_x_mask);
2115 2116 2117
		}
	}
	return pt_write;
A
Avi Kivity 已提交
2118 2119
}

2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136
static void kvm_send_hwpoison_signal(struct kvm *kvm, gfn_t gfn)
{
	char buf[1];
	void __user *hva;
	int r;

	/* Touch the page, so send SIGBUS */
	hva = (void __user *)gfn_to_hva(kvm, gfn);
	r = copy_from_user(buf, hva, 1);
}

static int kvm_handle_bad_page(struct kvm *kvm, gfn_t gfn, pfn_t pfn)
{
	kvm_release_pfn_clean(pfn);
	if (is_hwpoison_pfn(pfn)) {
		kvm_send_hwpoison_signal(kvm, gfn);
		return 0;
2137 2138 2139
	} else if (is_fault_pfn(pfn))
		return -EFAULT;

2140 2141 2142
	return 1;
}

2143 2144 2145
static int nonpaging_map(struct kvm_vcpu *vcpu, gva_t v, int write, gfn_t gfn)
{
	int r;
2146
	int level;
2147
	pfn_t pfn;
2148
	unsigned long mmu_seq;
2149

2150 2151 2152 2153 2154 2155 2156 2157 2158 2159
	level = mapping_level(vcpu, gfn);

	/*
	 * This path builds a PAE pagetable - so we can map 2mb pages at
	 * maximum. Therefore check if the level is larger than that.
	 */
	if (level > PT_DIRECTORY_LEVEL)
		level = PT_DIRECTORY_LEVEL;

	gfn &= ~(KVM_PAGES_PER_HPAGE(level) - 1);
M
Marcelo Tosatti 已提交
2160

2161
	mmu_seq = vcpu->kvm->mmu_notifier_seq;
2162
	smp_rmb();
2163
	pfn = gfn_to_pfn(vcpu->kvm, gfn);
2164

2165
	/* mmio */
2166 2167
	if (is_error_pfn(pfn))
		return kvm_handle_bad_page(vcpu->kvm, gfn, pfn);
2168

2169
	spin_lock(&vcpu->kvm->mmu_lock);
2170 2171
	if (mmu_notifier_retry(vcpu, mmu_seq))
		goto out_unlock;
2172
	kvm_mmu_free_some_pages(vcpu);
2173
	r = __direct_map(vcpu, v, write, level, gfn, pfn);
2174 2175 2176
	spin_unlock(&vcpu->kvm->mmu_lock);


2177
	return r;
2178 2179 2180 2181 2182

out_unlock:
	spin_unlock(&vcpu->kvm->mmu_lock);
	kvm_release_pfn_clean(pfn);
	return 0;
2183 2184 2185
}


2186 2187 2188
static void mmu_free_roots(struct kvm_vcpu *vcpu)
{
	int i;
2189
	struct kvm_mmu_page *sp;
2190
	LIST_HEAD(invalid_list);
2191

2192
	if (!VALID_PAGE(vcpu->arch.mmu.root_hpa))
A
Avi Kivity 已提交
2193
		return;
2194
	spin_lock(&vcpu->kvm->mmu_lock);
2195 2196
	if (vcpu->arch.mmu.shadow_root_level == PT64_ROOT_LEVEL) {
		hpa_t root = vcpu->arch.mmu.root_hpa;
2197

2198 2199
		sp = page_header(root);
		--sp->root_count;
2200 2201 2202 2203
		if (!sp->root_count && sp->role.invalid) {
			kvm_mmu_prepare_zap_page(vcpu->kvm, sp, &invalid_list);
			kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
		}
2204
		vcpu->arch.mmu.root_hpa = INVALID_PAGE;
2205
		spin_unlock(&vcpu->kvm->mmu_lock);
2206 2207 2208
		return;
	}
	for (i = 0; i < 4; ++i) {
2209
		hpa_t root = vcpu->arch.mmu.pae_root[i];
2210

A
Avi Kivity 已提交
2211 2212
		if (root) {
			root &= PT64_BASE_ADDR_MASK;
2213 2214
			sp = page_header(root);
			--sp->root_count;
2215
			if (!sp->root_count && sp->role.invalid)
2216 2217
				kvm_mmu_prepare_zap_page(vcpu->kvm, sp,
							 &invalid_list);
A
Avi Kivity 已提交
2218
		}
2219
		vcpu->arch.mmu.pae_root[i] = INVALID_PAGE;
2220
	}
2221
	kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
2222
	spin_unlock(&vcpu->kvm->mmu_lock);
2223
	vcpu->arch.mmu.root_hpa = INVALID_PAGE;
2224 2225
}

2226 2227 2228 2229 2230
static int mmu_check_root(struct kvm_vcpu *vcpu, gfn_t root_gfn)
{
	int ret = 0;

	if (!kvm_is_visible_gfn(vcpu->kvm, root_gfn)) {
2231
		kvm_make_request(KVM_REQ_TRIPLE_FAULT, vcpu);
2232 2233 2234 2235 2236 2237 2238
		ret = 1;
	}

	return ret;
}

static int mmu_alloc_roots(struct kvm_vcpu *vcpu)
2239 2240
{
	int i;
2241
	gfn_t root_gfn;
2242
	struct kvm_mmu_page *sp;
2243
	int direct = 0;
A
Avi Kivity 已提交
2244
	u64 pdptr;
2245

2246
	root_gfn = vcpu->arch.cr3 >> PAGE_SHIFT;
2247

2248 2249
	if (vcpu->arch.mmu.shadow_root_level == PT64_ROOT_LEVEL) {
		hpa_t root = vcpu->arch.mmu.root_hpa;
2250 2251

		ASSERT(!VALID_PAGE(root));
2252 2253
		if (mmu_check_root(vcpu, root_gfn))
			return 1;
2254 2255 2256 2257
		if (tdp_enabled) {
			direct = 1;
			root_gfn = 0;
		}
2258
		spin_lock(&vcpu->kvm->mmu_lock);
2259
		kvm_mmu_free_some_pages(vcpu);
2260
		sp = kvm_mmu_get_page(vcpu, root_gfn, 0,
2261
				      PT64_ROOT_LEVEL, direct,
2262
				      ACC_ALL, NULL);
2263 2264
		root = __pa(sp->spt);
		++sp->root_count;
2265
		spin_unlock(&vcpu->kvm->mmu_lock);
2266
		vcpu->arch.mmu.root_hpa = root;
2267
		return 0;
2268
	}
2269
	direct = !is_paging(vcpu);
2270
	for (i = 0; i < 4; ++i) {
2271
		hpa_t root = vcpu->arch.mmu.pae_root[i];
2272 2273

		ASSERT(!VALID_PAGE(root));
2274
		if (vcpu->arch.mmu.root_level == PT32E_ROOT_LEVEL) {
A
Avi Kivity 已提交
2275
			pdptr = kvm_pdptr_read(vcpu, i);
2276
			if (!is_present_gpte(pdptr)) {
2277
				vcpu->arch.mmu.pae_root[i] = 0;
A
Avi Kivity 已提交
2278 2279
				continue;
			}
A
Avi Kivity 已提交
2280
			root_gfn = pdptr >> PAGE_SHIFT;
2281
		} else if (vcpu->arch.mmu.root_level == 0)
2282
			root_gfn = 0;
2283 2284
		if (mmu_check_root(vcpu, root_gfn))
			return 1;
2285 2286 2287 2288
		if (tdp_enabled) {
			direct = 1;
			root_gfn = i << 30;
		}
2289
		spin_lock(&vcpu->kvm->mmu_lock);
2290
		kvm_mmu_free_some_pages(vcpu);
2291
		sp = kvm_mmu_get_page(vcpu, root_gfn, i << 30,
2292
				      PT32_ROOT_LEVEL, direct,
2293
				      ACC_ALL, NULL);
2294 2295
		root = __pa(sp->spt);
		++sp->root_count;
2296 2297
		spin_unlock(&vcpu->kvm->mmu_lock);

2298
		vcpu->arch.mmu.pae_root[i] = root | PT_PRESENT_MASK;
2299
	}
2300
	vcpu->arch.mmu.root_hpa = __pa(vcpu->arch.mmu.pae_root);
2301
	return 0;
2302 2303
}

2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319
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];

2320
		if (root && VALID_PAGE(root)) {
2321 2322 2323 2324 2325 2326 2327 2328 2329 2330 2331
			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);
2332
	spin_unlock(&vcpu->kvm->mmu_lock);
2333 2334
}

2335 2336
static gpa_t nonpaging_gva_to_gpa(struct kvm_vcpu *vcpu, gva_t vaddr,
				  u32 access, u32 *error)
A
Avi Kivity 已提交
2337
{
2338 2339
	if (error)
		*error = 0;
A
Avi Kivity 已提交
2340 2341 2342 2343
	return vaddr;
}

static int nonpaging_page_fault(struct kvm_vcpu *vcpu, gva_t gva,
A
Avi Kivity 已提交
2344
				u32 error_code)
A
Avi Kivity 已提交
2345
{
2346
	gfn_t gfn;
2347
	int r;
A
Avi Kivity 已提交
2348

2349
	pgprintk("%s: gva %lx error %x\n", __func__, gva, error_code);
2350 2351 2352
	r = mmu_topup_memory_caches(vcpu);
	if (r)
		return r;
2353

A
Avi Kivity 已提交
2354
	ASSERT(vcpu);
2355
	ASSERT(VALID_PAGE(vcpu->arch.mmu.root_hpa));
A
Avi Kivity 已提交
2356

2357
	gfn = gva >> PAGE_SHIFT;
A
Avi Kivity 已提交
2358

2359 2360
	return nonpaging_map(vcpu, gva & PAGE_MASK,
			     error_code & PFERR_WRITE_MASK, gfn);
A
Avi Kivity 已提交
2361 2362
}

2363 2364 2365
static int tdp_page_fault(struct kvm_vcpu *vcpu, gva_t gpa,
				u32 error_code)
{
2366
	pfn_t pfn;
2367
	int r;
2368
	int level;
M
Marcelo Tosatti 已提交
2369
	gfn_t gfn = gpa >> PAGE_SHIFT;
2370
	unsigned long mmu_seq;
2371 2372 2373 2374 2375 2376 2377 2378

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

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

2379 2380 2381 2382
	level = mapping_level(vcpu, gfn);

	gfn &= ~(KVM_PAGES_PER_HPAGE(level) - 1);

2383
	mmu_seq = vcpu->kvm->mmu_notifier_seq;
2384
	smp_rmb();
2385
	pfn = gfn_to_pfn(vcpu->kvm, gfn);
2386 2387
	if (is_error_pfn(pfn))
		return kvm_handle_bad_page(vcpu->kvm, gfn, pfn);
2388
	spin_lock(&vcpu->kvm->mmu_lock);
2389 2390
	if (mmu_notifier_retry(vcpu, mmu_seq))
		goto out_unlock;
2391 2392
	kvm_mmu_free_some_pages(vcpu);
	r = __direct_map(vcpu, gpa, error_code & PFERR_WRITE_MASK,
2393
			 level, gfn, pfn);
2394 2395 2396
	spin_unlock(&vcpu->kvm->mmu_lock);

	return r;
2397 2398 2399 2400 2401

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

A
Avi Kivity 已提交
2404 2405
static void nonpaging_free(struct kvm_vcpu *vcpu)
{
2406
	mmu_free_roots(vcpu);
A
Avi Kivity 已提交
2407 2408 2409 2410
}

static int nonpaging_init_context(struct kvm_vcpu *vcpu)
{
2411
	struct kvm_mmu *context = &vcpu->arch.mmu;
A
Avi Kivity 已提交
2412 2413 2414 2415 2416

	context->new_cr3 = nonpaging_new_cr3;
	context->page_fault = nonpaging_page_fault;
	context->gva_to_gpa = nonpaging_gva_to_gpa;
	context->free = nonpaging_free;
2417
	context->prefetch_page = nonpaging_prefetch_page;
2418
	context->sync_page = nonpaging_sync_page;
M
Marcelo Tosatti 已提交
2419
	context->invlpg = nonpaging_invlpg;
2420
	context->root_level = 0;
A
Avi Kivity 已提交
2421
	context->shadow_root_level = PT32E_ROOT_LEVEL;
A
Avi Kivity 已提交
2422
	context->root_hpa = INVALID_PAGE;
A
Avi Kivity 已提交
2423 2424 2425
	return 0;
}

2426
void kvm_mmu_flush_tlb(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2427
{
A
Avi Kivity 已提交
2428
	++vcpu->stat.tlb_flush;
2429
	kvm_make_request(KVM_REQ_TLB_FLUSH, vcpu);
A
Avi Kivity 已提交
2430 2431 2432 2433
}

static void paging_new_cr3(struct kvm_vcpu *vcpu)
{
2434
	pgprintk("%s: cr3 %lx\n", __func__, vcpu->arch.cr3);
2435
	mmu_free_roots(vcpu);
A
Avi Kivity 已提交
2436 2437 2438 2439 2440 2441
}

static void inject_page_fault(struct kvm_vcpu *vcpu,
			      u64 addr,
			      u32 err_code)
{
2442
	kvm_inject_page_fault(vcpu, addr, err_code);
A
Avi Kivity 已提交
2443 2444 2445 2446 2447 2448 2449
}

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

2450 2451 2452 2453 2454 2455 2456 2457
static bool is_rsvd_bits_set(struct kvm_vcpu *vcpu, u64 gpte, int level)
{
	int bit7;

	bit7 = (gpte >> 7) & 1;
	return (gpte & vcpu->arch.mmu.rsvd_bits_mask[bit7][level-1]) != 0;
}

A
Avi Kivity 已提交
2458 2459 2460 2461 2462 2463 2464 2465
#define PTTYPE 64
#include "paging_tmpl.h"
#undef PTTYPE

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

2466 2467 2468 2469 2470 2471 2472 2473 2474 2475 2476 2477 2478
static void reset_rsvds_bits_mask(struct kvm_vcpu *vcpu, int level)
{
	struct kvm_mmu *context = &vcpu->arch.mmu;
	int maxphyaddr = cpuid_maxphyaddr(vcpu);
	u64 exb_bit_rsvd = 0;

	if (!is_nx(vcpu))
		exb_bit_rsvd = rsvd_bits(63, 63);
	switch (level) {
	case PT32_ROOT_LEVEL:
		/* no rsvd bits for 2 level 4K page table entries */
		context->rsvd_bits_mask[0][1] = 0;
		context->rsvd_bits_mask[0][0] = 0;
2479 2480 2481 2482 2483 2484 2485
		context->rsvd_bits_mask[1][0] = context->rsvd_bits_mask[0][0];

		if (!is_pse(vcpu)) {
			context->rsvd_bits_mask[1][1] = 0;
			break;
		}

2486 2487 2488 2489 2490 2491 2492 2493
		if (is_cpuid_PSE36())
			/* 36bits PSE 4MB page */
			context->rsvd_bits_mask[1][1] = rsvd_bits(17, 21);
		else
			/* 32 bits PSE 4MB page */
			context->rsvd_bits_mask[1][1] = rsvd_bits(13, 21);
		break;
	case PT32E_ROOT_LEVEL:
2494 2495 2496
		context->rsvd_bits_mask[0][2] =
			rsvd_bits(maxphyaddr, 63) |
			rsvd_bits(7, 8) | rsvd_bits(1, 2);	/* PDPTE */
2497
		context->rsvd_bits_mask[0][1] = exb_bit_rsvd |
2498
			rsvd_bits(maxphyaddr, 62);	/* PDE */
2499 2500 2501 2502 2503
		context->rsvd_bits_mask[0][0] = exb_bit_rsvd |
			rsvd_bits(maxphyaddr, 62); 	/* PTE */
		context->rsvd_bits_mask[1][1] = exb_bit_rsvd |
			rsvd_bits(maxphyaddr, 62) |
			rsvd_bits(13, 20);		/* large page */
2504
		context->rsvd_bits_mask[1][0] = context->rsvd_bits_mask[0][0];
2505 2506 2507 2508 2509 2510 2511
		break;
	case PT64_ROOT_LEVEL:
		context->rsvd_bits_mask[0][3] = exb_bit_rsvd |
			rsvd_bits(maxphyaddr, 51) | rsvd_bits(7, 8);
		context->rsvd_bits_mask[0][2] = exb_bit_rsvd |
			rsvd_bits(maxphyaddr, 51) | rsvd_bits(7, 8);
		context->rsvd_bits_mask[0][1] = exb_bit_rsvd |
2512
			rsvd_bits(maxphyaddr, 51);
2513 2514 2515
		context->rsvd_bits_mask[0][0] = exb_bit_rsvd |
			rsvd_bits(maxphyaddr, 51);
		context->rsvd_bits_mask[1][3] = context->rsvd_bits_mask[0][3];
2516 2517 2518
		context->rsvd_bits_mask[1][2] = exb_bit_rsvd |
			rsvd_bits(maxphyaddr, 51) |
			rsvd_bits(13, 29);
2519
		context->rsvd_bits_mask[1][1] = exb_bit_rsvd |
2520 2521
			rsvd_bits(maxphyaddr, 51) |
			rsvd_bits(13, 20);		/* large page */
2522
		context->rsvd_bits_mask[1][0] = context->rsvd_bits_mask[0][0];
2523 2524 2525 2526
		break;
	}
}

2527
static int paging64_init_context_common(struct kvm_vcpu *vcpu, int level)
A
Avi Kivity 已提交
2528
{
2529
	struct kvm_mmu *context = &vcpu->arch.mmu;
A
Avi Kivity 已提交
2530 2531 2532 2533 2534

	ASSERT(is_pae(vcpu));
	context->new_cr3 = paging_new_cr3;
	context->page_fault = paging64_page_fault;
	context->gva_to_gpa = paging64_gva_to_gpa;
2535
	context->prefetch_page = paging64_prefetch_page;
2536
	context->sync_page = paging64_sync_page;
M
Marcelo Tosatti 已提交
2537
	context->invlpg = paging64_invlpg;
A
Avi Kivity 已提交
2538
	context->free = paging_free;
2539 2540
	context->root_level = level;
	context->shadow_root_level = level;
A
Avi Kivity 已提交
2541
	context->root_hpa = INVALID_PAGE;
A
Avi Kivity 已提交
2542 2543 2544
	return 0;
}

2545 2546
static int paging64_init_context(struct kvm_vcpu *vcpu)
{
2547
	reset_rsvds_bits_mask(vcpu, PT64_ROOT_LEVEL);
2548 2549 2550
	return paging64_init_context_common(vcpu, PT64_ROOT_LEVEL);
}

A
Avi Kivity 已提交
2551 2552
static int paging32_init_context(struct kvm_vcpu *vcpu)
{
2553
	struct kvm_mmu *context = &vcpu->arch.mmu;
A
Avi Kivity 已提交
2554

2555
	reset_rsvds_bits_mask(vcpu, PT32_ROOT_LEVEL);
A
Avi Kivity 已提交
2556 2557 2558 2559
	context->new_cr3 = paging_new_cr3;
	context->page_fault = paging32_page_fault;
	context->gva_to_gpa = paging32_gva_to_gpa;
	context->free = paging_free;
2560
	context->prefetch_page = paging32_prefetch_page;
2561
	context->sync_page = paging32_sync_page;
M
Marcelo Tosatti 已提交
2562
	context->invlpg = paging32_invlpg;
A
Avi Kivity 已提交
2563 2564
	context->root_level = PT32_ROOT_LEVEL;
	context->shadow_root_level = PT32E_ROOT_LEVEL;
A
Avi Kivity 已提交
2565
	context->root_hpa = INVALID_PAGE;
A
Avi Kivity 已提交
2566 2567 2568 2569 2570
	return 0;
}

static int paging32E_init_context(struct kvm_vcpu *vcpu)
{
2571
	reset_rsvds_bits_mask(vcpu, PT32E_ROOT_LEVEL);
2572
	return paging64_init_context_common(vcpu, PT32E_ROOT_LEVEL);
A
Avi Kivity 已提交
2573 2574
}

2575 2576 2577 2578 2579 2580 2581 2582
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;
2583
	context->sync_page = nonpaging_sync_page;
M
Marcelo Tosatti 已提交
2584
	context->invlpg = nonpaging_invlpg;
2585
	context->shadow_root_level = kvm_x86_ops->get_tdp_level();
2586 2587 2588 2589 2590 2591
	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)) {
2592
		reset_rsvds_bits_mask(vcpu, PT64_ROOT_LEVEL);
2593 2594 2595
		context->gva_to_gpa = paging64_gva_to_gpa;
		context->root_level = PT64_ROOT_LEVEL;
	} else if (is_pae(vcpu)) {
2596
		reset_rsvds_bits_mask(vcpu, PT32E_ROOT_LEVEL);
2597 2598 2599
		context->gva_to_gpa = paging64_gva_to_gpa;
		context->root_level = PT32E_ROOT_LEVEL;
	} else {
2600
		reset_rsvds_bits_mask(vcpu, PT32_ROOT_LEVEL);
2601 2602 2603 2604 2605 2606 2607 2608
		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 已提交
2609
{
2610 2611
	int r;

A
Avi Kivity 已提交
2612
	ASSERT(vcpu);
2613
	ASSERT(!VALID_PAGE(vcpu->arch.mmu.root_hpa));
A
Avi Kivity 已提交
2614 2615

	if (!is_paging(vcpu))
2616
		r = nonpaging_init_context(vcpu);
A
Avi Kivity 已提交
2617
	else if (is_long_mode(vcpu))
2618
		r = paging64_init_context(vcpu);
A
Avi Kivity 已提交
2619
	else if (is_pae(vcpu))
2620
		r = paging32E_init_context(vcpu);
A
Avi Kivity 已提交
2621
	else
2622 2623
		r = paging32_init_context(vcpu);

2624
	vcpu->arch.mmu.base_role.cr4_pae = !!is_pae(vcpu);
2625
	vcpu->arch.mmu.base_role.cr0_wp = is_write_protection(vcpu);
2626 2627

	return r;
A
Avi Kivity 已提交
2628 2629
}

2630 2631
static int init_kvm_mmu(struct kvm_vcpu *vcpu)
{
2632 2633
	vcpu->arch.update_pte.pfn = bad_pfn;

2634 2635 2636 2637 2638 2639
	if (tdp_enabled)
		return init_kvm_tdp_mmu(vcpu);
	else
		return init_kvm_softmmu(vcpu);
}

A
Avi Kivity 已提交
2640 2641 2642
static void destroy_kvm_mmu(struct kvm_vcpu *vcpu)
{
	ASSERT(vcpu);
2643 2644
	if (VALID_PAGE(vcpu->arch.mmu.root_hpa))
		/* mmu.free() should set root_hpa = INVALID_PAGE */
2645
		vcpu->arch.mmu.free(vcpu);
A
Avi Kivity 已提交
2646 2647 2648
}

int kvm_mmu_reset_context(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2649 2650 2651 2652
{
	destroy_kvm_mmu(vcpu);
	return init_kvm_mmu(vcpu);
}
2653
EXPORT_SYMBOL_GPL(kvm_mmu_reset_context);
A
Avi Kivity 已提交
2654 2655

int kvm_mmu_load(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2656
{
2657 2658
	int r;

2659
	r = mmu_topup_memory_caches(vcpu);
A
Avi Kivity 已提交
2660 2661
	if (r)
		goto out;
2662
	r = mmu_alloc_roots(vcpu);
2663
	spin_lock(&vcpu->kvm->mmu_lock);
2664
	mmu_sync_roots(vcpu);
2665
	spin_unlock(&vcpu->kvm->mmu_lock);
2666 2667
	if (r)
		goto out;
2668
	/* set_cr3() should ensure TLB has been flushed */
2669
	kvm_x86_ops->set_cr3(vcpu, vcpu->arch.mmu.root_hpa);
2670 2671
out:
	return r;
A
Avi Kivity 已提交
2672
}
A
Avi Kivity 已提交
2673 2674 2675 2676 2677 2678
EXPORT_SYMBOL_GPL(kvm_mmu_load);

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

2680
static void mmu_pte_write_zap_pte(struct kvm_vcpu *vcpu,
2681
				  struct kvm_mmu_page *sp,
2682 2683 2684 2685 2686 2687
				  u64 *spte)
{
	u64 pte;
	struct kvm_mmu_page *child;

	pte = *spte;
2688
	if (is_shadow_present_pte(pte)) {
2689
		if (is_last_spte(pte, sp->role.level))
A
Avi Kivity 已提交
2690
			drop_spte(vcpu->kvm, spte, shadow_trap_nonpresent_pte);
2691 2692
		else {
			child = page_header(pte & PT64_BASE_ADDR_MASK);
2693
			mmu_page_remove_parent_pte(child, spte);
2694 2695
		}
	}
A
Avi Kivity 已提交
2696
	__set_spte(spte, shadow_trap_nonpresent_pte);
M
Marcelo Tosatti 已提交
2697 2698
	if (is_large_pte(pte))
		--vcpu->kvm->stat.lpages;
2699 2700
}

2701
static void mmu_pte_write_new_pte(struct kvm_vcpu *vcpu,
2702
				  struct kvm_mmu_page *sp,
2703
				  u64 *spte,
2704
				  const void *new)
2705
{
2706
	if (sp->role.level != PT_PAGE_TABLE_LEVEL) {
2707 2708
		++vcpu->kvm->stat.mmu_pde_zapped;
		return;
2709
        }
2710

2711 2712 2713
	if (is_rsvd_bits_set(vcpu, *(u64 *)new, PT_PAGE_TABLE_LEVEL))
		return;

A
Avi Kivity 已提交
2714
	++vcpu->kvm->stat.mmu_pte_updated;
2715
	if (!sp->role.cr4_pae)
2716
		paging32_update_pte(vcpu, sp, spte, new);
2717
	else
2718
		paging64_update_pte(vcpu, sp, spte, new);
2719 2720
}

2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731 2732 2733
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;
}

2734 2735
static void mmu_pte_write_flush_tlb(struct kvm_vcpu *vcpu, bool zap_page,
				    bool remote_flush, bool local_flush)
2736
{
2737 2738 2739 2740
	if (zap_page)
		return;

	if (remote_flush)
2741
		kvm_flush_remote_tlbs(vcpu->kvm);
2742
	else if (local_flush)
2743 2744 2745
		kvm_mmu_flush_tlb(vcpu);
}

2746 2747
static bool last_updated_pte_accessed(struct kvm_vcpu *vcpu)
{
2748
	u64 *spte = vcpu->arch.last_pte_updated;
2749

S
Sheng Yang 已提交
2750
	return !!(spte && (*spte & shadow_accessed_mask));
2751 2752
}

2753
static void mmu_guess_page_from_pte_write(struct kvm_vcpu *vcpu, gpa_t gpa,
2754
					  u64 gpte)
2755 2756
{
	gfn_t gfn;
2757
	pfn_t pfn;
2758

2759
	if (!is_present_gpte(gpte))
2760 2761
		return;
	gfn = (gpte & PT64_BASE_ADDR_MASK) >> PAGE_SHIFT;
2762

2763
	vcpu->arch.update_pte.mmu_seq = vcpu->kvm->mmu_notifier_seq;
2764
	smp_rmb();
2765
	pfn = gfn_to_pfn(vcpu->kvm, gfn);
2766

2767 2768
	if (is_error_pfn(pfn)) {
		kvm_release_pfn_clean(pfn);
2769 2770
		return;
	}
2771
	vcpu->arch.update_pte.gfn = gfn;
2772
	vcpu->arch.update_pte.pfn = pfn;
2773 2774
}

2775 2776 2777 2778 2779 2780 2781 2782 2783 2784 2785 2786
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);
}

2787
void kvm_mmu_pte_write(struct kvm_vcpu *vcpu, gpa_t gpa,
2788 2789
		       const u8 *new, int bytes,
		       bool guest_initiated)
2790
{
2791
	gfn_t gfn = gpa >> PAGE_SHIFT;
2792
	union kvm_mmu_page_role mask = { .word = 0 };
2793
	struct kvm_mmu_page *sp;
2794
	struct hlist_node *node;
2795
	LIST_HEAD(invalid_list);
2796
	u64 entry, gentry;
2797 2798
	u64 *spte;
	unsigned offset = offset_in_page(gpa);
2799
	unsigned pte_size;
2800
	unsigned page_offset;
2801
	unsigned misaligned;
2802
	unsigned quadrant;
2803
	int level;
2804
	int flooded = 0;
2805
	int npte;
2806
	int r;
2807
	int invlpg_counter;
2808 2809 2810
	bool remote_flush, local_flush, zap_page;

	zap_page = remote_flush = local_flush = false;
2811

2812
	pgprintk("%s: gpa %llx bytes %d\n", __func__, gpa, bytes);
2813

2814
	invlpg_counter = atomic_read(&vcpu->kvm->arch.invlpg_counter);
2815 2816 2817 2818 2819 2820 2821

	/*
	 * 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().
	 */
2822
	if ((is_pae(vcpu) && bytes == 4) || !new) {
2823
		/* Handle a 32-bit guest writing two halves of a 64-bit gpte */
2824 2825 2826 2827 2828
		if (is_pae(vcpu)) {
			gpa &= ~(gpa_t)7;
			bytes = 8;
		}
		r = kvm_read_guest(vcpu->kvm, gpa, &gentry, min(bytes, 8));
2829 2830
		if (r)
			gentry = 0;
2831 2832 2833 2834 2835 2836 2837 2838 2839 2840 2841 2842 2843
		new = (const u8 *)&gentry;
	}

	switch (bytes) {
	case 4:
		gentry = *(const u32 *)new;
		break;
	case 8:
		gentry = *(const u64 *)new;
		break;
	default:
		gentry = 0;
		break;
2844 2845 2846
	}

	mmu_guess_page_from_pte_write(vcpu, gpa, gentry);
2847
	spin_lock(&vcpu->kvm->mmu_lock);
2848 2849
	if (atomic_read(&vcpu->kvm->arch.invlpg_counter) != invlpg_counter)
		gentry = 0;
2850
	kvm_mmu_access_page(vcpu, gfn);
2851
	kvm_mmu_free_some_pages(vcpu);
A
Avi Kivity 已提交
2852
	++vcpu->kvm->stat.mmu_pte_write;
2853
	kvm_mmu_audit(vcpu, "pre pte write");
2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864
	if (guest_initiated) {
		if (gfn == vcpu->arch.last_pt_write_gfn
		    && !last_updated_pte_accessed(vcpu)) {
			++vcpu->arch.last_pt_write_count;
			if (vcpu->arch.last_pt_write_count >= 3)
				flooded = 1;
		} else {
			vcpu->arch.last_pt_write_gfn = gfn;
			vcpu->arch.last_pt_write_count = 1;
			vcpu->arch.last_pte_updated = NULL;
		}
2865
	}
2866

2867
	mask.cr0_wp = mask.cr4_pae = mask.nxe = 1;
2868
	for_each_gfn_indirect_valid_sp(vcpu->kvm, sp, gfn, node) {
2869
		pte_size = sp->role.cr4_pae ? 8 : 4;
2870
		misaligned = (offset ^ (offset + bytes - 1)) & ~(pte_size - 1);
2871
		misaligned |= bytes < 4;
2872
		if (misaligned || flooded) {
2873 2874 2875 2876
			/*
			 * Misaligned accesses are too much trouble to fix
			 * up; also, they usually indicate a page is not used
			 * as a page table.
2877 2878 2879 2880 2881
			 *
			 * 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.
2882 2883
			 */
			pgprintk("misaligned: gpa %llx bytes %d role %x\n",
2884
				 gpa, bytes, sp->role.word);
2885
			zap_page |= !!kvm_mmu_prepare_zap_page(vcpu->kvm, sp,
2886
						     &invalid_list);
A
Avi Kivity 已提交
2887
			++vcpu->kvm->stat.mmu_flooded;
2888 2889
			continue;
		}
2890
		page_offset = offset;
2891
		level = sp->role.level;
2892
		npte = 1;
2893
		if (!sp->role.cr4_pae) {
2894 2895 2896 2897 2898 2899 2900
			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) {
2901
				page_offset &= ~7; /* kill rounding error */
2902 2903 2904
				page_offset <<= 1;
				npte = 2;
			}
2905
			quadrant = page_offset >> PAGE_SHIFT;
2906
			page_offset &= ~PAGE_MASK;
2907
			if (quadrant != sp->role.quadrant)
2908
				continue;
2909
		}
2910
		local_flush = true;
2911
		spte = &sp->spt[page_offset / sizeof(*spte)];
2912
		while (npte--) {
2913
			entry = *spte;
2914
			mmu_pte_write_zap_pte(vcpu, sp, spte);
2915 2916 2917
			if (gentry &&
			      !((sp->role.word ^ vcpu->arch.mmu.base_role.word)
			      & mask.word))
2918
				mmu_pte_write_new_pte(vcpu, sp, spte, &gentry);
2919 2920
			if (!remote_flush && need_remote_flush(entry, *spte))
				remote_flush = true;
2921
			++spte;
2922 2923
		}
	}
2924
	mmu_pte_write_flush_tlb(vcpu, zap_page, remote_flush, local_flush);
2925
	kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
2926
	kvm_mmu_audit(vcpu, "post pte write");
2927
	spin_unlock(&vcpu->kvm->mmu_lock);
2928 2929 2930
	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;
2931
	}
2932 2933
}

2934 2935
int kvm_mmu_unprotect_page_virt(struct kvm_vcpu *vcpu, gva_t gva)
{
2936 2937
	gpa_t gpa;
	int r;
2938

2939 2940 2941
	if (tdp_enabled)
		return 0;

2942
	gpa = kvm_mmu_gva_to_gpa_read(vcpu, gva, NULL);
2943

2944
	spin_lock(&vcpu->kvm->mmu_lock);
2945
	r = kvm_mmu_unprotect_page(vcpu->kvm, gpa >> PAGE_SHIFT);
2946
	spin_unlock(&vcpu->kvm->mmu_lock);
2947
	return r;
2948
}
2949
EXPORT_SYMBOL_GPL(kvm_mmu_unprotect_page_virt);
2950

2951
void __kvm_mmu_free_some_pages(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2952
{
2953
	int free_pages;
2954
	LIST_HEAD(invalid_list);
2955 2956 2957

	free_pages = vcpu->kvm->arch.n_free_mmu_pages;
	while (free_pages < KVM_REFILL_PAGES &&
2958
	       !list_empty(&vcpu->kvm->arch.active_mmu_pages)) {
2959
		struct kvm_mmu_page *sp;
A
Avi Kivity 已提交
2960

2961
		sp = container_of(vcpu->kvm->arch.active_mmu_pages.prev,
2962
				  struct kvm_mmu_page, link);
2963 2964
		free_pages += kvm_mmu_prepare_zap_page(vcpu->kvm, sp,
						       &invalid_list);
A
Avi Kivity 已提交
2965
		++vcpu->kvm->stat.mmu_recycled;
A
Avi Kivity 已提交
2966
	}
2967
	kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
A
Avi Kivity 已提交
2968 2969
}

2970 2971 2972 2973 2974
int kvm_mmu_page_fault(struct kvm_vcpu *vcpu, gva_t cr2, u32 error_code)
{
	int r;
	enum emulation_result er;

2975
	r = vcpu->arch.mmu.page_fault(vcpu, cr2, error_code);
2976 2977 2978 2979 2980 2981 2982 2983
	if (r < 0)
		goto out;

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

2984 2985 2986 2987
	r = mmu_topup_memory_caches(vcpu);
	if (r)
		goto out;

A
Avi Kivity 已提交
2988
	er = emulate_instruction(vcpu, cr2, error_code, 0);
2989 2990 2991 2992 2993 2994

	switch (er) {
	case EMULATE_DONE:
		return 1;
	case EMULATE_DO_MMIO:
		++vcpu->stat.mmio_exits;
2995
		/* fall through */
2996
	case EMULATE_FAIL:
2997
		return 0;
2998 2999 3000 3001 3002 3003 3004 3005
	default:
		BUG();
	}
out:
	return r;
}
EXPORT_SYMBOL_GPL(kvm_mmu_page_fault);

M
Marcelo Tosatti 已提交
3006 3007 3008 3009 3010 3011 3012 3013
void kvm_mmu_invlpg(struct kvm_vcpu *vcpu, gva_t gva)
{
	vcpu->arch.mmu.invlpg(vcpu, gva);
	kvm_mmu_flush_tlb(vcpu);
	++vcpu->stat.invlpg;
}
EXPORT_SYMBOL_GPL(kvm_mmu_invlpg);

3014 3015 3016 3017 3018 3019
void kvm_enable_tdp(void)
{
	tdp_enabled = true;
}
EXPORT_SYMBOL_GPL(kvm_enable_tdp);

3020 3021 3022 3023 3024 3025
void kvm_disable_tdp(void)
{
	tdp_enabled = false;
}
EXPORT_SYMBOL_GPL(kvm_disable_tdp);

A
Avi Kivity 已提交
3026 3027
static void free_mmu_pages(struct kvm_vcpu *vcpu)
{
3028
	free_page((unsigned long)vcpu->arch.mmu.pae_root);
A
Avi Kivity 已提交
3029 3030 3031 3032
}

static int alloc_mmu_pages(struct kvm_vcpu *vcpu)
{
3033
	struct page *page;
A
Avi Kivity 已提交
3034 3035 3036 3037
	int i;

	ASSERT(vcpu);

3038 3039 3040 3041 3042 3043 3044
	/*
	 * 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)
3045 3046
		return -ENOMEM;

3047
	vcpu->arch.mmu.pae_root = page_address(page);
3048
	for (i = 0; i < 4; ++i)
3049
		vcpu->arch.mmu.pae_root[i] = INVALID_PAGE;
3050

A
Avi Kivity 已提交
3051 3052 3053
	return 0;
}

3054
int kvm_mmu_create(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
3055 3056
{
	ASSERT(vcpu);
3057
	ASSERT(!VALID_PAGE(vcpu->arch.mmu.root_hpa));
A
Avi Kivity 已提交
3058

3059 3060
	return alloc_mmu_pages(vcpu);
}
A
Avi Kivity 已提交
3061

3062 3063 3064
int kvm_mmu_setup(struct kvm_vcpu *vcpu)
{
	ASSERT(vcpu);
3065
	ASSERT(!VALID_PAGE(vcpu->arch.mmu.root_hpa));
3066

3067
	return init_kvm_mmu(vcpu);
A
Avi Kivity 已提交
3068 3069 3070 3071 3072 3073 3074 3075
}

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

	destroy_kvm_mmu(vcpu);
	free_mmu_pages(vcpu);
3076
	mmu_free_memory_caches(vcpu);
A
Avi Kivity 已提交
3077 3078
}

3079
void kvm_mmu_slot_remove_write_access(struct kvm *kvm, int slot)
A
Avi Kivity 已提交
3080
{
3081
	struct kvm_mmu_page *sp;
A
Avi Kivity 已提交
3082

3083
	list_for_each_entry(sp, &kvm->arch.active_mmu_pages, link) {
A
Avi Kivity 已提交
3084 3085 3086
		int i;
		u64 *pt;

3087
		if (!test_bit(slot, sp->slot_bitmap))
A
Avi Kivity 已提交
3088 3089
			continue;

3090
		pt = sp->spt;
A
Avi Kivity 已提交
3091 3092
		for (i = 0; i < PT64_ENT_PER_PAGE; ++i)
			/* avoid RMW */
3093
			if (is_writable_pte(pt[i]))
A
Avi Kivity 已提交
3094 3095
				pt[i] &= ~PT_WRITABLE_MASK;
	}
3096
	kvm_flush_remote_tlbs(kvm);
A
Avi Kivity 已提交
3097
}
3098

3099
void kvm_mmu_zap_all(struct kvm *kvm)
D
Dor Laor 已提交
3100
{
3101
	struct kvm_mmu_page *sp, *node;
3102
	LIST_HEAD(invalid_list);
D
Dor Laor 已提交
3103

3104
	spin_lock(&kvm->mmu_lock);
3105
restart:
3106
	list_for_each_entry_safe(sp, node, &kvm->arch.active_mmu_pages, link)
3107
		if (kvm_mmu_prepare_zap_page(kvm, sp, &invalid_list))
3108 3109
			goto restart;

3110
	kvm_mmu_commit_zap_page(kvm, &invalid_list);
3111
	spin_unlock(&kvm->mmu_lock);
D
Dor Laor 已提交
3112 3113
}

3114 3115
static int kvm_mmu_remove_some_alloc_mmu_pages(struct kvm *kvm,
					       struct list_head *invalid_list)
3116 3117 3118 3119 3120
{
	struct kvm_mmu_page *page;

	page = container_of(kvm->arch.active_mmu_pages.prev,
			    struct kvm_mmu_page, link);
3121
	return kvm_mmu_prepare_zap_page(kvm, page, invalid_list);
3122 3123
}

3124
static int mmu_shrink(struct shrinker *shrink, int nr_to_scan, gfp_t gfp_mask)
3125 3126 3127 3128 3129 3130 3131 3132
{
	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) {
G
Gui Jianfeng 已提交
3133
		int npages, idx, freed_pages;
3134
		LIST_HEAD(invalid_list);
3135

3136
		idx = srcu_read_lock(&kvm->srcu);
3137 3138 3139 3140 3141
		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) {
3142 3143
			freed_pages = kvm_mmu_remove_some_alloc_mmu_pages(kvm,
							  &invalid_list);
G
Gui Jianfeng 已提交
3144
			cache_count -= freed_pages;
3145 3146 3147 3148
			kvm_freed = kvm;
		}
		nr_to_scan--;

3149
		kvm_mmu_commit_zap_page(kvm, &invalid_list);
3150
		spin_unlock(&kvm->mmu_lock);
3151
		srcu_read_unlock(&kvm->srcu, idx);
3152 3153 3154 3155 3156 3157 3158 3159 3160 3161 3162 3163 3164 3165
	}
	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 已提交
3166
static void mmu_destroy_caches(void)
3167 3168 3169 3170 3171
{
	if (pte_chain_cache)
		kmem_cache_destroy(pte_chain_cache);
	if (rmap_desc_cache)
		kmem_cache_destroy(rmap_desc_cache);
3172 3173
	if (mmu_page_header_cache)
		kmem_cache_destroy(mmu_page_header_cache);
3174 3175
}

3176 3177 3178 3179 3180 3181
void kvm_mmu_module_exit(void)
{
	mmu_destroy_caches();
	unregister_shrinker(&mmu_shrinker);
}

3182 3183 3184 3185
int kvm_mmu_module_init(void)
{
	pte_chain_cache = kmem_cache_create("kvm_pte_chain",
					    sizeof(struct kvm_pte_chain),
3186
					    0, 0, NULL);
3187 3188 3189 3190
	if (!pte_chain_cache)
		goto nomem;
	rmap_desc_cache = kmem_cache_create("kvm_rmap_desc",
					    sizeof(struct kvm_rmap_desc),
3191
					    0, 0, NULL);
3192 3193 3194
	if (!rmap_desc_cache)
		goto nomem;

3195 3196
	mmu_page_header_cache = kmem_cache_create("kvm_mmu_page_header",
						  sizeof(struct kvm_mmu_page),
3197
						  0, 0, NULL);
3198 3199 3200
	if (!mmu_page_header_cache)
		goto nomem;

3201 3202
	register_shrinker(&mmu_shrinker);

3203 3204 3205
	return 0;

nomem:
3206
	mmu_destroy_caches();
3207 3208 3209
	return -ENOMEM;
}

3210 3211 3212 3213 3214 3215 3216 3217
/*
 * 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;
3218
	struct kvm_memslots *slots;
3219

3220 3221
	slots = kvm_memslots(kvm);

3222 3223
	for (i = 0; i < slots->nmemslots; i++)
		nr_pages += slots->memslots[i].npages;
3224 3225 3226 3227 3228 3229 3230 3231

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

3232 3233 3234 3235 3236 3237 3238 3239 3240 3241 3242 3243 3244 3245 3246 3247 3248 3249 3250 3251 3252 3253 3254 3255 3256 3257 3258 3259 3260 3261 3262 3263 3264 3265 3266
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;

3267
	if (!emulator_write_phys(vcpu, addr, &value, bytes))
3268 3269 3270 3271 3272 3273 3274
		return -EFAULT;

	return 1;
}

static int kvm_pv_mmu_flush_tlb(struct kvm_vcpu *vcpu)
{
3275
	(void)kvm_set_cr3(vcpu, vcpu->arch.cr3);
3276 3277 3278 3279 3280 3281 3282 3283 3284 3285 3286 3287 3288 3289 3290 3291 3292 3293 3294 3295 3296 3297 3298 3299 3300 3301 3302 3303 3304 3305 3306 3307 3308 3309 3310 3311 3312 3313 3314 3315 3316 3317 3318 3319 3320 3321 3322 3323 3324 3325 3326 3327 3328
	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;
3329
	struct kvm_pv_mmu_op_buffer *buffer = &vcpu->arch.mmu_op_buffer;
3330

3331 3332 3333
	buffer->ptr = buffer->buf;
	buffer->len = min_t(unsigned long, bytes, sizeof buffer->buf);
	buffer->processed = 0;
3334

3335
	r = kvm_read_guest(vcpu->kvm, addr, buffer->buf, buffer->len);
3336 3337 3338
	if (r)
		goto out;

3339 3340
	while (buffer->len) {
		r = kvm_pv_mmu_op_one(vcpu, buffer);
3341 3342 3343 3344 3345 3346 3347 3348
		if (r < 0)
			goto out;
		if (r == 0)
			break;
	}

	r = 1;
out:
3349
	*ret = buffer->processed;
3350 3351 3352
	return r;
}

3353 3354 3355 3356 3357 3358 3359 3360 3361 3362 3363 3364 3365 3366 3367 3368 3369 3370
int kvm_mmu_get_spte_hierarchy(struct kvm_vcpu *vcpu, u64 addr, u64 sptes[4])
{
	struct kvm_shadow_walk_iterator iterator;
	int nr_sptes = 0;

	spin_lock(&vcpu->kvm->mmu_lock);
	for_each_shadow_entry(vcpu, addr, iterator) {
		sptes[iterator.level-1] = *iterator.sptep;
		nr_sptes++;
		if (!is_shadow_present_pte(*iterator.sptep))
			break;
	}
	spin_unlock(&vcpu->kvm->mmu_lock);

	return nr_sptes;
}
EXPORT_SYMBOL_GPL(kvm_mmu_get_spte_hierarchy);

3371 3372 3373 3374 3375 3376 3377 3378 3379 3380 3381 3382
#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;
}

3383

3384
typedef void (*inspect_spte_fn) (struct kvm *kvm, u64 *sptep);
3385 3386 3387 3388 3389 3390 3391 3392 3393 3394

static void __mmu_spte_walk(struct kvm *kvm, struct kvm_mmu_page *sp,
			    inspect_spte_fn fn)
{
	int i;

	for (i = 0; i < PT64_ENT_PER_PAGE; ++i) {
		u64 ent = sp->spt[i];

		if (is_shadow_present_pte(ent)) {
3395
			if (!is_last_spte(ent, sp->role.level)) {
3396 3397 3398
				struct kvm_mmu_page *child;
				child = page_header(ent & PT64_BASE_ADDR_MASK);
				__mmu_spte_walk(kvm, child, fn);
3399
			} else
3400
				fn(kvm, &sp->spt[i]);
3401 3402 3403 3404 3405 3406 3407 3408 3409 3410 3411 3412 3413 3414 3415 3416 3417 3418 3419 3420 3421 3422 3423 3424 3425 3426 3427 3428 3429
		}
	}
}

static void mmu_spte_walk(struct kvm_vcpu *vcpu, inspect_spte_fn fn)
{
	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_spte_walk(vcpu->kvm, sp, fn);
		return;
	}
	for (i = 0; i < 4; ++i) {
		hpa_t root = vcpu->arch.mmu.pae_root[i];

		if (root && VALID_PAGE(root)) {
			root &= PT64_BASE_ADDR_MASK;
			sp = page_header(root);
			__mmu_spte_walk(vcpu->kvm, sp, fn);
		}
	}
	return;
}

3430 3431 3432 3433 3434 3435 3436 3437 3438 3439
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];

3440
		if (ent == shadow_trap_nonpresent_pte)
3441 3442 3443
			continue;

		va = canonicalize(va);
3444 3445 3446
		if (is_shadow_present_pte(ent) && !is_last_spte(ent, level))
			audit_mappings_page(vcpu, ent, va, level - 1);
		else {
3447
			gpa_t gpa = kvm_mmu_gva_to_gpa_read(vcpu, va, NULL);
J
Jan Kiszka 已提交
3448 3449 3450
			gfn_t gfn = gpa >> PAGE_SHIFT;
			pfn_t pfn = gfn_to_pfn(vcpu->kvm, gfn);
			hpa_t hpa = (hpa_t)pfn << PAGE_SHIFT;
3451

3452 3453 3454 3455 3456
			if (is_error_pfn(pfn)) {
				kvm_release_pfn_clean(pfn);
				continue;
			}

3457
			if (is_shadow_present_pte(ent)
3458
			    && (ent & PT64_BASE_ADDR_MASK) != hpa)
3459 3460
				printk(KERN_ERR "xx audit error: (%s) levels %d"
				       " gva %lx gpa %llx hpa %llx ent %llx %d\n",
3461
				       audit_msg, vcpu->arch.mmu.root_level,
M
Mike Day 已提交
3462 3463
				       va, gpa, hpa, ent,
				       is_shadow_present_pte(ent));
3464 3465 3466 3467
			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);
3468
			kvm_release_pfn_clean(pfn);
3469

3470 3471 3472 3473 3474 3475
		}
	}
}

static void audit_mappings(struct kvm_vcpu *vcpu)
{
3476
	unsigned i;
3477

3478 3479
	if (vcpu->arch.mmu.root_level == 4)
		audit_mappings_page(vcpu, vcpu->arch.mmu.root_hpa, 0, 4);
3480 3481
	else
		for (i = 0; i < 4; ++i)
3482
			if (vcpu->arch.mmu.pae_root[i] & PT_PRESENT_MASK)
3483
				audit_mappings_page(vcpu,
3484
						    vcpu->arch.mmu.pae_root[i],
3485 3486 3487 3488 3489 3490
						    i << 30,
						    2);
}

static int count_rmaps(struct kvm_vcpu *vcpu)
{
3491 3492
	struct kvm *kvm = vcpu->kvm;
	struct kvm_memslots *slots;
3493
	int nmaps = 0;
3494
	int i, j, k, idx;
3495

3496
	idx = srcu_read_lock(&kvm->srcu);
3497
	slots = kvm_memslots(kvm);
3498
	for (i = 0; i < KVM_MEMORY_SLOTS; ++i) {
3499
		struct kvm_memory_slot *m = &slots->memslots[i];
3500 3501 3502
		struct kvm_rmap_desc *d;

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

3505
			if (!*rmapp)
3506
				continue;
3507
			if (!(*rmapp & 1)) {
3508 3509 3510
				++nmaps;
				continue;
			}
3511
			d = (struct kvm_rmap_desc *)(*rmapp & ~1ul);
3512 3513
			while (d) {
				for (k = 0; k < RMAP_EXT; ++k)
A
Avi Kivity 已提交
3514
					if (d->sptes[k])
3515 3516 3517 3518 3519 3520 3521
						++nmaps;
					else
						break;
				d = d->more;
			}
		}
	}
3522
	srcu_read_unlock(&kvm->srcu, idx);
3523 3524 3525
	return nmaps;
}

3526
void inspect_spte_has_rmap(struct kvm *kvm, u64 *sptep)
3527 3528 3529 3530 3531
{
	unsigned long *rmapp;
	struct kvm_mmu_page *rev_sp;
	gfn_t gfn;

3532
	if (is_writable_pte(*sptep)) {
3533
		rev_sp = page_header(__pa(sptep));
3534
		gfn = kvm_mmu_page_get_gfn(rev_sp, sptep - rev_sp->spt);
3535 3536 3537 3538 3539 3540 3541

		if (!gfn_to_memslot(kvm, gfn)) {
			if (!printk_ratelimit())
				return;
			printk(KERN_ERR "%s: no memslot for gfn %ld\n",
					 audit_msg, gfn);
			printk(KERN_ERR "%s: index %ld of sp (gfn=%lx)\n",
3542
			       audit_msg, (long int)(sptep - rev_sp->spt),
3543 3544 3545 3546 3547
					rev_sp->gfn);
			dump_stack();
			return;
		}

3548
		rmapp = gfn_to_rmap(kvm, gfn, rev_sp->role.level);
3549 3550 3551 3552 3553 3554 3555 3556 3557 3558 3559 3560 3561 3562 3563 3564 3565
		if (!*rmapp) {
			if (!printk_ratelimit())
				return;
			printk(KERN_ERR "%s: no rmap for writable spte %llx\n",
					 audit_msg, *sptep);
			dump_stack();
		}
	}

}

void audit_writable_sptes_have_rmaps(struct kvm_vcpu *vcpu)
{
	mmu_spte_walk(vcpu, inspect_spte_has_rmap);
}

static void check_writable_mappings_rmap(struct kvm_vcpu *vcpu)
3566
{
3567
	struct kvm_mmu_page *sp;
3568 3569
	int i;

3570
	list_for_each_entry(sp, &vcpu->kvm->arch.active_mmu_pages, link) {
3571
		u64 *pt = sp->spt;
3572

3573
		if (sp->role.level != PT_PAGE_TABLE_LEVEL)
3574 3575 3576 3577 3578 3579 3580
			continue;

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

			if (!(ent & PT_PRESENT_MASK))
				continue;
3581
			if (!is_writable_pte(ent))
3582
				continue;
3583
			inspect_spte_has_rmap(vcpu->kvm, &pt[i]);
3584 3585
		}
	}
3586
	return;
3587 3588 3589 3590
}

static void audit_rmap(struct kvm_vcpu *vcpu)
{
3591 3592
	check_writable_mappings_rmap(vcpu);
	count_rmaps(vcpu);
3593 3594 3595 3596
}

static void audit_write_protection(struct kvm_vcpu *vcpu)
{
3597
	struct kvm_mmu_page *sp;
3598 3599
	struct kvm_memory_slot *slot;
	unsigned long *rmapp;
3600
	u64 *spte;
3601
	gfn_t gfn;
3602

3603
	list_for_each_entry(sp, &vcpu->kvm->arch.active_mmu_pages, link) {
3604
		if (sp->role.direct)
3605
			continue;
3606 3607
		if (sp->unsync)
			continue;
3608

A
Avi Kivity 已提交
3609
		slot = gfn_to_memslot(vcpu->kvm, sp->gfn);
3610
		rmapp = &slot->rmap[gfn - slot->base_gfn];
3611 3612 3613

		spte = rmap_next(vcpu->kvm, rmapp, NULL);
		while (spte) {
3614
			if (is_writable_pte(*spte))
3615 3616
				printk(KERN_ERR "%s: (%s) shadow page has "
				"writable mappings: gfn %lx role %x\n",
3617
			       __func__, audit_msg, sp->gfn,
3618
			       sp->role.word);
3619 3620
			spte = rmap_next(vcpu->kvm, rmapp, spte);
		}
3621 3622 3623 3624 3625 3626 3627 3628 3629 3630 3631
	}
}

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);
3632 3633
	if (strcmp("pre pte write", audit_msg) != 0)
		audit_mappings(vcpu);
3634
	audit_writable_sptes_have_rmaps(vcpu);
3635 3636 3637 3638
	dbg = olddbg;
}

#endif