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 285 286 287 288 289 290
{
#ifdef CONFIG_X86_64
	set_64bit((unsigned long *)sptep, spte);
#else
	set_64bit((unsigned long long *)sptep, spte);
#endif
}

291 292 293 294 295 296 297 298 299 300 301 302 303 304 305
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
}

306 307 308 309
static void update_spte(u64 *sptep, u64 new_spte)
{
	u64 old_spte;

310 311
	if (!shadow_accessed_mask || (new_spte & shadow_accessed_mask) ||
	      !is_rmap_spte(*sptep))
312
		__set_spte(sptep, new_spte);
313
	else {
314 315 316 317 318 319
		old_spte = __xchg_spte(sptep, new_spte);
		if (old_spte & shadow_accessed_mask)
			mark_page_accessed(pfn_to_page(spte_to_pfn(old_spte)));
	}
}

320
static int mmu_topup_memory_cache(struct kvm_mmu_memory_cache *cache,
321
				  struct kmem_cache *base_cache, int min)
322 323 324 325
{
	void *obj;

	if (cache->nobjs >= min)
326
		return 0;
327
	while (cache->nobjs < ARRAY_SIZE(cache->objects)) {
328
		obj = kmem_cache_zalloc(base_cache, GFP_KERNEL);
329
		if (!obj)
330
			return -ENOMEM;
331 332
		cache->objects[cache->nobjs++] = obj;
	}
333
	return 0;
334 335
}

336 337
static void mmu_free_memory_cache(struct kvm_mmu_memory_cache *mc,
				  struct kmem_cache *cache)
338 339
{
	while (mc->nobjs)
340
		kmem_cache_free(cache, mc->objects[--mc->nobjs]);
341 342
}

A
Avi Kivity 已提交
343
static int mmu_topup_memory_cache_page(struct kvm_mmu_memory_cache *cache,
344
				       int min)
A
Avi Kivity 已提交
345 346 347 348 349 350
{
	struct page *page;

	if (cache->nobjs >= min)
		return 0;
	while (cache->nobjs < ARRAY_SIZE(cache->objects)) {
351
		page = alloc_page(GFP_KERNEL);
A
Avi Kivity 已提交
352 353 354 355 356 357 358 359 360 361
		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)
362
		free_page((unsigned long)mc->objects[--mc->nobjs]);
A
Avi Kivity 已提交
363 364
}

365
static int mmu_topup_memory_caches(struct kvm_vcpu *vcpu)
366
{
367 368
	int r;

369
	r = mmu_topup_memory_cache(&vcpu->arch.mmu_pte_chain_cache,
370
				   pte_chain_cache, 4);
371 372
	if (r)
		goto out;
373
	r = mmu_topup_memory_cache(&vcpu->arch.mmu_rmap_desc_cache,
374
				   rmap_desc_cache, 4);
375 376
	if (r)
		goto out;
377
	r = mmu_topup_memory_cache_page(&vcpu->arch.mmu_page_cache, 8);
378 379
	if (r)
		goto out;
380
	r = mmu_topup_memory_cache(&vcpu->arch.mmu_page_header_cache,
381
				   mmu_page_header_cache, 4);
382 383
out:
	return r;
384 385 386 387
}

static void mmu_free_memory_caches(struct kvm_vcpu *vcpu)
{
388 389
	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);
390
	mmu_free_memory_cache_page(&vcpu->arch.mmu_page_cache);
391 392
	mmu_free_memory_cache(&vcpu->arch.mmu_page_header_cache,
				mmu_page_header_cache);
393 394 395 396 397 398 399 400 401 402 403 404 405 406
}

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)
{
407
	return mmu_memory_cache_alloc(&vcpu->arch.mmu_pte_chain_cache,
408 409 410
				      sizeof(struct kvm_pte_chain));
}

411
static void mmu_free_pte_chain(struct kvm_pte_chain *pc)
412
{
413
	kmem_cache_free(pte_chain_cache, pc);
414 415 416 417
}

static struct kvm_rmap_desc *mmu_alloc_rmap_desc(struct kvm_vcpu *vcpu)
{
418
	return mmu_memory_cache_alloc(&vcpu->arch.mmu_rmap_desc_cache,
419 420 421
				      sizeof(struct kvm_rmap_desc));
}

422
static void mmu_free_rmap_desc(struct kvm_rmap_desc *rd)
423
{
424
	kmem_cache_free(rmap_desc_cache, rd);
425 426
}

427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442
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 已提交
443 444 445 446
/*
 * Return the pointer to the largepage write count for a given
 * gfn, handling slots that are not large page aligned.
 */
447 448 449
static int *slot_largepage_idx(gfn_t gfn,
			       struct kvm_memory_slot *slot,
			       int level)
M
Marcelo Tosatti 已提交
450 451 452
{
	unsigned long idx;

453 454
	idx = (gfn >> KVM_HPAGE_GFN_SHIFT(level)) -
	      (slot->base_gfn >> KVM_HPAGE_GFN_SHIFT(level));
455
	return &slot->lpage_info[level - 2][idx].write_count;
M
Marcelo Tosatti 已提交
456 457 458 459
}

static void account_shadowed(struct kvm *kvm, gfn_t gfn)
{
460
	struct kvm_memory_slot *slot;
M
Marcelo Tosatti 已提交
461
	int *write_count;
462
	int i;
M
Marcelo Tosatti 已提交
463

A
Avi Kivity 已提交
464
	slot = gfn_to_memslot(kvm, gfn);
465 466 467 468 469
	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 已提交
470 471 472 473
}

static void unaccount_shadowed(struct kvm *kvm, gfn_t gfn)
{
474
	struct kvm_memory_slot *slot;
M
Marcelo Tosatti 已提交
475
	int *write_count;
476
	int i;
M
Marcelo Tosatti 已提交
477

A
Avi Kivity 已提交
478
	slot = gfn_to_memslot(kvm, gfn);
479 480 481 482 483 484
	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 已提交
485 486
}

487 488 489
static int has_wrprotected_page(struct kvm *kvm,
				gfn_t gfn,
				int level)
M
Marcelo Tosatti 已提交
490
{
491
	struct kvm_memory_slot *slot;
M
Marcelo Tosatti 已提交
492 493
	int *largepage_idx;

A
Avi Kivity 已提交
494
	slot = gfn_to_memslot(kvm, gfn);
M
Marcelo Tosatti 已提交
495
	if (slot) {
496
		largepage_idx = slot_largepage_idx(gfn, slot, level);
M
Marcelo Tosatti 已提交
497 498 499 500 501 502
		return *largepage_idx;
	}

	return 1;
}

503
static int host_mapping_level(struct kvm *kvm, gfn_t gfn)
M
Marcelo Tosatti 已提交
504
{
J
Joerg Roedel 已提交
505
	unsigned long page_size;
506
	int i, ret = 0;
M
Marcelo Tosatti 已提交
507

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

510 511 512 513 514 515 516 517
	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;
	}

518
	return ret;
M
Marcelo Tosatti 已提交
519 520
}

521
static int mapping_level(struct kvm_vcpu *vcpu, gfn_t large_gfn)
M
Marcelo Tosatti 已提交
522 523
{
	struct kvm_memory_slot *slot;
524
	int host_level, level, max_level;
M
Marcelo Tosatti 已提交
525 526 527

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

530 531 532 533 534
	host_level = host_mapping_level(vcpu->kvm, large_gfn);

	if (host_level == PT_PAGE_TABLE_LEVEL)
		return host_level;

535 536 537 538
	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)
539 540 541 542
		if (has_wrprotected_page(vcpu->kvm, large_gfn, level))
			break;

	return level - 1;
M
Marcelo Tosatti 已提交
543 544
}

545 546 547 548
/*
 * Take gfn and return the reverse mapping to it.
 */

549
static unsigned long *gfn_to_rmap(struct kvm *kvm, gfn_t gfn, int level)
550 551
{
	struct kvm_memory_slot *slot;
M
Marcelo Tosatti 已提交
552
	unsigned long idx;
553 554

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

558 559
	idx = (gfn >> KVM_HPAGE_GFN_SHIFT(level)) -
		(slot->base_gfn >> KVM_HPAGE_GFN_SHIFT(level));
M
Marcelo Tosatti 已提交
560

561
	return &slot->lpage_info[level - 2][idx].rmap_pde;
562 563
}

564 565 566
/*
 * Reverse mapping data structures:
 *
567 568
 * If rmapp bit zero is zero, then rmapp point to the shadw page table entry
 * that points to page_address(page).
569
 *
570 571
 * If rmapp bit zero is one, (then rmap & ~1) points to a struct kvm_rmap_desc
 * containing more mappings.
572 573 574 575
 *
 * Returns the number of rmap entries before the spte was added or zero if
 * the spte was not added.
 *
576
 */
577
static int rmap_add(struct kvm_vcpu *vcpu, u64 *spte, gfn_t gfn)
578
{
579
	struct kvm_mmu_page *sp;
580
	struct kvm_rmap_desc *desc;
581
	unsigned long *rmapp;
582
	int i, count = 0;
583

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

616
static void rmap_desc_remove_entry(unsigned long *rmapp,
617 618 619 620 621 622
				   struct kvm_rmap_desc *desc,
				   int i,
				   struct kvm_rmap_desc *prev_desc)
{
	int j;

A
Avi Kivity 已提交
623
	for (j = RMAP_EXT - 1; !desc->sptes[j] && j > i; --j)
624
		;
A
Avi Kivity 已提交
625 626
	desc->sptes[i] = desc->sptes[j];
	desc->sptes[j] = NULL;
627 628 629
	if (j != 0)
		return;
	if (!prev_desc && !desc->more)
A
Avi Kivity 已提交
630
		*rmapp = (unsigned long)desc->sptes[0];
631 632 633 634
	else
		if (prev_desc)
			prev_desc->more = desc->more;
		else
635
			*rmapp = (unsigned long)desc->more | 1;
636
	mmu_free_rmap_desc(desc);
637 638
}

639
static void rmap_remove(struct kvm *kvm, u64 *spte)
640 641 642
{
	struct kvm_rmap_desc *desc;
	struct kvm_rmap_desc *prev_desc;
643
	struct kvm_mmu_page *sp;
644
	gfn_t gfn;
645
	unsigned long *rmapp;
646 647
	int i;

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

682
static void set_spte_track_bits(u64 *sptep, u64 new_spte)
A
Avi Kivity 已提交
683
{
684
	pfn_t pfn;
685 686 687 688 689 690 691
	u64 old_spte = *sptep;

	if (!shadow_accessed_mask || !is_shadow_present_pte(old_spte) ||
	      old_spte & shadow_accessed_mask) {
		__set_spte(sptep, new_spte);
	} else
		old_spte = __xchg_spte(sptep, new_spte);
692

693
	if (!is_rmap_spte(old_spte))
694
		return;
695
	pfn = spte_to_pfn(old_spte);
696
	if (!shadow_accessed_mask || old_spte & shadow_accessed_mask)
697
		kvm_set_pfn_accessed(pfn);
698
	if (is_writable_pte(old_spte))
699
		kvm_set_pfn_dirty(pfn);
700 701 702 703 704
}

static void drop_spte(struct kvm *kvm, u64 *sptep, u64 new_spte)
{
	set_spte_track_bits(sptep, new_spte);
A
Avi Kivity 已提交
705 706 707
	rmap_remove(kvm, sptep);
}

708
static u64 *rmap_next(struct kvm *kvm, unsigned long *rmapp, u64 *spte)
709 710
{
	struct kvm_rmap_desc *desc;
711 712 713 714 715 716 717 718 719 720 721 722 723
	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 已提交
724
		for (i = 0; i < RMAP_EXT && desc->sptes[i]; ++i) {
725
			if (prev_spte == spte)
A
Avi Kivity 已提交
726 727
				return desc->sptes[i];
			prev_spte = desc->sptes[i];
728 729 730 731 732 733
		}
		desc = desc->more;
	}
	return NULL;
}

734
static int rmap_write_protect(struct kvm *kvm, u64 gfn)
735
{
736
	unsigned long *rmapp;
737
	u64 *spte;
738
	int i, write_protected = 0;
739

740
	rmapp = gfn_to_rmap(kvm, gfn, PT_PAGE_TABLE_LEVEL);
741

742 743
	spte = rmap_next(kvm, rmapp, NULL);
	while (spte) {
744 745 746
		BUG_ON(!spte);
		BUG_ON(!(*spte & PT_PRESENT_MASK));
		rmap_printk("rmap_write_protect: spte %p %llx\n", spte, *spte);
747
		if (is_writable_pte(*spte)) {
748
			update_spte(spte, *spte & ~PT_WRITABLE_MASK);
749 750
			write_protected = 1;
		}
751
		spte = rmap_next(kvm, rmapp, spte);
752
	}
753
	if (write_protected) {
754
		pfn_t pfn;
755 756

		spte = rmap_next(kvm, rmapp, NULL);
757 758
		pfn = spte_to_pfn(*spte);
		kvm_set_pfn_dirty(pfn);
759 760
	}

M
Marcelo Tosatti 已提交
761
	/* check for huge page mappings */
762 763 764 765 766 767 768 769 770
	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);
771
			if (is_writable_pte(*spte)) {
A
Avi Kivity 已提交
772 773
				drop_spte(kvm, spte,
					  shadow_trap_nonpresent_pte);
774 775 776 777 778
				--kvm->stat.lpages;
				spte = NULL;
				write_protected = 1;
			}
			spte = rmap_next(kvm, rmapp, spte);
M
Marcelo Tosatti 已提交
779 780 781
		}
	}

782
	return write_protected;
783 784
}

F
Frederik Deweerdt 已提交
785 786
static int kvm_unmap_rmapp(struct kvm *kvm, unsigned long *rmapp,
			   unsigned long data)
787 788 789 790 791 792 793
{
	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 已提交
794
		drop_spte(kvm, spte, shadow_trap_nonpresent_pte);
795 796 797 798 799
		need_tlb_flush = 1;
	}
	return need_tlb_flush;
}

F
Frederik Deweerdt 已提交
800 801
static int kvm_set_pte_rmapp(struct kvm *kvm, unsigned long *rmapp,
			     unsigned long data)
802 803
{
	int need_flush = 0;
804
	u64 *spte, new_spte;
805 806 807 808 809 810 811 812 813 814 815
	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 已提交
816
			drop_spte(kvm, spte, shadow_trap_nonpresent_pte);
817 818 819 820 821 822 823
			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;
824
			new_spte &= ~shadow_accessed_mask;
825
			set_spte_track_bits(spte, new_spte);
826 827 828 829 830 831 832 833 834
			spte = rmap_next(kvm, rmapp, spte);
		}
	}
	if (need_flush)
		kvm_flush_remote_tlbs(kvm);

	return 0;
}

F
Frederik Deweerdt 已提交
835 836
static int kvm_handle_hva(struct kvm *kvm, unsigned long hva,
			  unsigned long data,
837
			  int (*handler)(struct kvm *kvm, unsigned long *rmapp,
F
Frederik Deweerdt 已提交
838
					 unsigned long data))
839
{
840
	int i, j;
841
	int ret;
842
	int retval = 0;
843 844
	struct kvm_memslots *slots;

845
	slots = kvm_memslots(kvm);
846

847 848
	for (i = 0; i < slots->nmemslots; i++) {
		struct kvm_memory_slot *memslot = &slots->memslots[i];
849 850 851 852 853 854
		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;
855

856
			ret = handler(kvm, &memslot->rmap[gfn_offset], data);
857 858

			for (j = 0; j < KVM_NR_PAGE_SIZES - 1; ++j) {
859 860 861 862 863 864
				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);
865
				ret |= handler(kvm,
866 867
					&memslot->lpage_info[j][idx].rmap_pde,
					data);
868
			}
869 870
			trace_kvm_age_page(hva, memslot, ret);
			retval |= ret;
871 872 873 874 875 876 877 878
		}
	}

	return retval;
}

int kvm_unmap_hva(struct kvm *kvm, unsigned long hva)
{
879 880 881 882 883
	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 已提交
884
	kvm_handle_hva(kvm, hva, (unsigned long)&pte, kvm_set_pte_rmapp);
885 886
}

F
Frederik Deweerdt 已提交
887 888
static int kvm_age_rmapp(struct kvm *kvm, unsigned long *rmapp,
			 unsigned long data)
889 890 891 892
{
	u64 *spte;
	int young = 0;

893 894 895 896 897 898 899
	/*
	 * 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.
	 */
900
	if (!shadow_accessed_mask)
901
		return kvm_unmap_rmapp(kvm, rmapp, data);
902

903 904 905 906 907 908 909 910 911 912 913 914 915 916 917
	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;
}

918 919
#define RMAP_RECYCLE_THRESHOLD 1000

920
static void rmap_recycle(struct kvm_vcpu *vcpu, u64 *spte, gfn_t gfn)
921 922
{
	unsigned long *rmapp;
923 924 925
	struct kvm_mmu_page *sp;

	sp = page_header(__pa(spte));
926

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

929
	kvm_unmap_rmapp(vcpu->kvm, rmapp, 0);
930 931 932
	kvm_flush_remote_tlbs(vcpu->kvm);
}

933 934
int kvm_age_hva(struct kvm *kvm, unsigned long hva)
{
935
	return kvm_handle_hva(kvm, hva, 0, kvm_age_rmapp);
936 937
}

938
#ifdef MMU_DEBUG
939
static int is_empty_shadow_page(u64 *spt)
A
Avi Kivity 已提交
940
{
941 942 943
	u64 *pos;
	u64 *end;

944
	for (pos = spt, end = pos + PAGE_SIZE / sizeof(u64); pos != end; pos++)
945
		if (is_shadow_present_pte(*pos)) {
946
			printk(KERN_ERR "%s: %p %llx\n", __func__,
947
			       pos, *pos);
A
Avi Kivity 已提交
948
			return 0;
949
		}
A
Avi Kivity 已提交
950 951
	return 1;
}
952
#endif
A
Avi Kivity 已提交
953

954
static void kvm_mmu_free_page(struct kvm *kvm, struct kvm_mmu_page *sp)
955
{
956
	ASSERT(is_empty_shadow_page(sp->spt));
957
	hlist_del(&sp->hash_link);
958 959
	list_del(&sp->link);
	__free_page(virt_to_page(sp->spt));
960 961
	if (!sp->role.direct)
		__free_page(virt_to_page(sp->gfns));
962
	kmem_cache_free(mmu_page_header_cache, sp);
963
	++kvm->arch.n_free_mmu_pages;
964 965
}

966 967
static unsigned kvm_page_table_hashfn(gfn_t gfn)
{
968
	return gfn & ((1 << KVM_MMU_HASH_SHIFT) - 1);
969 970
}

971
static struct kvm_mmu_page *kvm_mmu_alloc_page(struct kvm_vcpu *vcpu,
972
					       u64 *parent_pte, int direct)
A
Avi Kivity 已提交
973
{
974
	struct kvm_mmu_page *sp;
A
Avi Kivity 已提交
975

976 977
	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);
978 979 980
	if (!direct)
		sp->gfns = mmu_memory_cache_alloc(&vcpu->arch.mmu_page_cache,
						  PAGE_SIZE);
981
	set_page_private(virt_to_page(sp->spt), (unsigned long)sp);
982
	list_add(&sp->link, &vcpu->kvm->arch.active_mmu_pages);
983
	bitmap_zero(sp->slot_bitmap, KVM_MEMORY_SLOTS + KVM_PRIVATE_MEM_SLOTS);
984 985
	sp->multimapped = 0;
	sp->parent_pte = parent_pte;
986
	--vcpu->kvm->arch.n_free_mmu_pages;
987
	return sp;
A
Avi Kivity 已提交
988 989
}

990
static void mmu_page_add_parent_pte(struct kvm_vcpu *vcpu,
991
				    struct kvm_mmu_page *sp, u64 *parent_pte)
992 993 994 995 996 997 998
{
	struct kvm_pte_chain *pte_chain;
	struct hlist_node *node;
	int i;

	if (!parent_pte)
		return;
999 1000
	if (!sp->multimapped) {
		u64 *old = sp->parent_pte;
1001 1002

		if (!old) {
1003
			sp->parent_pte = parent_pte;
1004 1005
			return;
		}
1006
		sp->multimapped = 1;
1007
		pte_chain = mmu_alloc_pte_chain(vcpu);
1008 1009
		INIT_HLIST_HEAD(&sp->parent_ptes);
		hlist_add_head(&pte_chain->link, &sp->parent_ptes);
1010 1011
		pte_chain->parent_ptes[0] = old;
	}
1012
	hlist_for_each_entry(pte_chain, node, &sp->parent_ptes, link) {
1013 1014 1015 1016 1017 1018 1019 1020
		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;
			}
	}
1021
	pte_chain = mmu_alloc_pte_chain(vcpu);
1022
	BUG_ON(!pte_chain);
1023
	hlist_add_head(&pte_chain->link, &sp->parent_ptes);
1024 1025 1026
	pte_chain->parent_ptes[0] = parent_pte;
}

1027
static void mmu_page_remove_parent_pte(struct kvm_mmu_page *sp,
1028 1029 1030 1031 1032 1033
				       u64 *parent_pte)
{
	struct kvm_pte_chain *pte_chain;
	struct hlist_node *node;
	int i;

1034 1035 1036
	if (!sp->multimapped) {
		BUG_ON(sp->parent_pte != parent_pte);
		sp->parent_pte = NULL;
1037 1038
		return;
	}
1039
	hlist_for_each_entry(pte_chain, node, &sp->parent_ptes, link)
1040 1041 1042 1043 1044
		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;
1045 1046
			while (i + 1 < NR_PTE_CHAIN_ENTRIES
				&& pte_chain->parent_ptes[i + 1]) {
1047 1048 1049 1050 1051
				pte_chain->parent_ptes[i]
					= pte_chain->parent_ptes[i + 1];
				++i;
			}
			pte_chain->parent_ptes[i] = NULL;
1052 1053
			if (i == 0) {
				hlist_del(&pte_chain->link);
1054
				mmu_free_pte_chain(pte_chain);
1055 1056 1057
				if (hlist_empty(&sp->parent_ptes)) {
					sp->multimapped = 0;
					sp->parent_pte = NULL;
1058 1059
				}
			}
1060 1061 1062 1063 1064
			return;
		}
	BUG();
}

1065
static void mmu_parent_walk(struct kvm_mmu_page *sp, mmu_parent_walk_fn fn)
M
Marcelo Tosatti 已提交
1066 1067 1068 1069 1070 1071 1072 1073
{
	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));
1074
		fn(parent_sp, sp->parent_pte);
M
Marcelo Tosatti 已提交
1075 1076
		return;
	}
1077

M
Marcelo Tosatti 已提交
1078 1079
	hlist_for_each_entry(pte_chain, node, &sp->parent_ptes, link)
		for (i = 0; i < NR_PTE_CHAIN_ENTRIES; ++i) {
1080 1081 1082
			u64 *spte = pte_chain->parent_ptes[i];

			if (!spte)
M
Marcelo Tosatti 已提交
1083
				break;
1084 1085
			parent_sp = page_header(__pa(spte));
			fn(parent_sp, spte);
M
Marcelo Tosatti 已提交
1086 1087 1088
		}
}

1089 1090
static void mark_unsync(struct kvm_mmu_page *sp, u64 *spte);
static void kvm_mmu_mark_parents_unsync(struct kvm_mmu_page *sp)
1091
{
1092
	mmu_parent_walk(sp, mark_unsync);
1093 1094
}

1095
static void mark_unsync(struct kvm_mmu_page *sp, u64 *spte)
1096
{
1097
	unsigned int index;
1098

1099 1100
	index = spte - sp->spt;
	if (__test_and_set_bit(index, sp->unsync_child_bitmap))
1101
		return;
1102
	if (sp->unsync_children++)
1103
		return;
1104
	kvm_mmu_mark_parents_unsync(sp);
1105 1106
}

1107 1108 1109 1110 1111 1112 1113 1114 1115
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;
}

1116
static int nonpaging_sync_page(struct kvm_vcpu *vcpu,
1117
			       struct kvm_mmu_page *sp, bool clear_unsync)
1118 1119 1120 1121
{
	return 1;
}

M
Marcelo Tosatti 已提交
1122 1123 1124 1125
static void nonpaging_invlpg(struct kvm_vcpu *vcpu, gva_t gva)
{
}

1126 1127 1128 1129 1130 1131 1132 1133 1134 1135
#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;
};

1136 1137 1138 1139 1140
#define for_each_unsync_children(bitmap, idx)		\
	for (idx = find_first_bit(bitmap, 512);		\
	     idx < 512;					\
	     idx = find_next_bit(bitmap, 512, idx+1))

1141 1142
static int mmu_pages_add(struct kvm_mmu_pages *pvec, struct kvm_mmu_page *sp,
			 int idx)
1143
{
1144
	int i;
1145

1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160
	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;
1161

1162
	for_each_unsync_children(sp->unsync_child_bitmap, i) {
1163
		struct kvm_mmu_page *child;
1164 1165
		u64 ent = sp->spt[i];

1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194
		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);
1195 1196 1197
	}


1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208
	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);
1209 1210 1211 1212 1213
}

static void kvm_unlink_unsync_page(struct kvm *kvm, struct kvm_mmu_page *sp)
{
	WARN_ON(!sp->unsync);
1214
	trace_kvm_mmu_sync_page(sp);
1215 1216 1217 1218
	sp->unsync = 0;
	--kvm->stat.mmu_unsync;
}

1219 1220 1221 1222
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);
1223

1224 1225
#define for_each_gfn_sp(kvm, sp, gfn, pos)				\
  hlist_for_each_entry(sp, pos,						\
1226 1227 1228
   &(kvm)->arch.mmu_page_hash[kvm_page_table_hashfn(gfn)], hash_link)	\
	if ((sp)->gfn != (gfn)) {} else

1229 1230
#define for_each_gfn_indirect_valid_sp(kvm, sp, gfn, pos)		\
  hlist_for_each_entry(sp, pos,						\
1231 1232 1233 1234
   &(kvm)->arch.mmu_page_hash[kvm_page_table_hashfn(gfn)], hash_link)	\
		if ((sp)->gfn != (gfn) || (sp)->role.direct ||		\
			(sp)->role.invalid) {} else

1235
/* @sp->gfn should be write-protected at the call site */
1236
static int __kvm_sync_page(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp,
1237
			   struct list_head *invalid_list, bool clear_unsync)
1238
{
1239
	if (sp->role.cr4_pae != !!is_pae(vcpu)) {
1240
		kvm_mmu_prepare_zap_page(vcpu->kvm, sp, invalid_list);
1241 1242 1243
		return 1;
	}

1244
	if (clear_unsync)
1245 1246
		kvm_unlink_unsync_page(vcpu->kvm, sp);

1247
	if (vcpu->arch.mmu.sync_page(vcpu, sp, clear_unsync)) {
1248
		kvm_mmu_prepare_zap_page(vcpu->kvm, sp, invalid_list);
1249 1250 1251 1252 1253 1254 1255
		return 1;
	}

	kvm_mmu_flush_tlb(vcpu);
	return 0;
}

1256 1257 1258
static int kvm_sync_page_transient(struct kvm_vcpu *vcpu,
				   struct kvm_mmu_page *sp)
{
1259
	LIST_HEAD(invalid_list);
1260 1261
	int ret;

1262
	ret = __kvm_sync_page(vcpu, sp, &invalid_list, false);
1263
	if (ret)
1264 1265
		kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);

1266 1267 1268
	return ret;
}

1269 1270
static int kvm_sync_page(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp,
			 struct list_head *invalid_list)
1271
{
1272
	return __kvm_sync_page(vcpu, sp, invalid_list, true);
1273 1274
}

1275 1276 1277 1278
/* @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;
1279
	struct hlist_node *node;
1280
	LIST_HEAD(invalid_list);
1281 1282
	bool flush = false;

1283
	for_each_gfn_indirect_valid_sp(vcpu->kvm, s, gfn, node) {
1284
		if (!s->unsync)
1285 1286 1287 1288
			continue;

		WARN_ON(s->role.level != PT_PAGE_TABLE_LEVEL);
		if ((s->role.cr4_pae != !!is_pae(vcpu)) ||
1289
			(vcpu->arch.mmu.sync_page(vcpu, s, true))) {
1290
			kvm_mmu_prepare_zap_page(vcpu->kvm, s, &invalid_list);
1291 1292 1293 1294 1295 1296
			continue;
		}
		kvm_unlink_unsync_page(vcpu->kvm, s);
		flush = true;
	}

1297
	kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
1298 1299 1300 1301
	if (flush)
		kvm_mmu_flush_tlb(vcpu);
}

1302 1303 1304
struct mmu_page_path {
	struct kvm_mmu_page *parent[PT64_ROOT_LEVEL-1];
	unsigned int idx[PT64_ROOT_LEVEL-1];
1305 1306
};

1307 1308 1309 1310 1311 1312
#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))

1313 1314 1315
static int mmu_pages_next(struct kvm_mmu_pages *pvec,
			  struct mmu_page_path *parents,
			  int i)
1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333
{
	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;
}

1334
static void mmu_pages_clear_parents(struct mmu_page_path *parents)
1335
{
1336 1337 1338 1339 1340
	struct kvm_mmu_page *sp;
	unsigned int level = 0;

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

1342 1343 1344 1345 1346 1347 1348 1349 1350
		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);
1351 1352
}

1353 1354 1355
static void kvm_mmu_pages_init(struct kvm_mmu_page *parent,
			       struct mmu_page_path *parents,
			       struct kvm_mmu_pages *pvec)
1356
{
1357 1358 1359
	parents->parent[parent->role.level-1] = NULL;
	pvec->nr = 0;
}
1360

1361 1362 1363 1364 1365 1366 1367
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;
1368
	LIST_HEAD(invalid_list);
1369 1370 1371

	kvm_mmu_pages_init(parent, &parents, &pages);
	while (mmu_unsync_walk(parent, &pages)) {
1372 1373 1374 1375 1376 1377 1378 1379
		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);

1380
		for_each_sp(pages, sp, parents, i) {
1381
			kvm_sync_page(vcpu, sp, &invalid_list);
1382 1383
			mmu_pages_clear_parents(&parents);
		}
1384
		kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
1385
		cond_resched_lock(&vcpu->kvm->mmu_lock);
1386 1387
		kvm_mmu_pages_init(parent, &parents, &pages);
	}
1388 1389
}

1390 1391 1392 1393
static struct kvm_mmu_page *kvm_mmu_get_page(struct kvm_vcpu *vcpu,
					     gfn_t gfn,
					     gva_t gaddr,
					     unsigned level,
1394
					     int direct,
1395
					     unsigned access,
1396
					     u64 *parent_pte)
1397 1398 1399
{
	union kvm_mmu_page_role role;
	unsigned quadrant;
1400
	struct kvm_mmu_page *sp;
1401
	struct hlist_node *node;
1402
	bool need_sync = false;
1403

1404
	role = vcpu->arch.mmu.base_role;
1405
	role.level = level;
1406
	role.direct = direct;
1407
	if (role.direct)
1408
		role.cr4_pae = 0;
1409
	role.access = access;
1410
	if (!tdp_enabled && vcpu->arch.mmu.root_level <= PT32_ROOT_LEVEL) {
1411 1412 1413 1414
		quadrant = gaddr >> (PAGE_SHIFT + (PT64_PT_BITS * level));
		quadrant &= (1 << ((PT32_PT_BITS - PT64_PT_BITS) * level)) - 1;
		role.quadrant = quadrant;
	}
1415
	for_each_gfn_sp(vcpu->kvm, sp, gfn, node) {
1416 1417
		if (!need_sync && sp->unsync)
			need_sync = true;
1418

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

1422 1423
		if (sp->unsync && kvm_sync_page_transient(vcpu, sp))
			break;
1424

1425 1426
		mmu_page_add_parent_pte(vcpu, sp, parent_pte);
		if (sp->unsync_children) {
1427
			kvm_make_request(KVM_REQ_MMU_SYNC, vcpu);
1428 1429 1430
			kvm_mmu_mark_parents_unsync(sp);
		} else if (sp->unsync)
			kvm_mmu_mark_parents_unsync(sp);
1431

1432 1433 1434
		trace_kvm_mmu_get_page(sp, false);
		return sp;
	}
A
Avi Kivity 已提交
1435
	++vcpu->kvm->stat.mmu_cache_miss;
1436
	sp = kvm_mmu_alloc_page(vcpu, parent_pte, direct);
1437 1438 1439 1440
	if (!sp)
		return sp;
	sp->gfn = gfn;
	sp->role = role;
1441 1442
	hlist_add_head(&sp->hash_link,
		&vcpu->kvm->arch.mmu_page_hash[kvm_page_table_hashfn(gfn)]);
1443
	if (!direct) {
1444 1445
		if (rmap_write_protect(vcpu->kvm, gfn))
			kvm_flush_remote_tlbs(vcpu->kvm);
1446 1447 1448
		if (level > PT_PAGE_TABLE_LEVEL && need_sync)
			kvm_sync_pages(vcpu, gfn);

1449 1450
		account_shadowed(vcpu->kvm, gfn);
	}
1451 1452 1453 1454
	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 已提交
1455
	trace_kvm_mmu_get_page(sp, true);
1456
	return sp;
1457 1458
}

1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478
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;
1479 1480 1481 1482 1483

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

1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494
	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;
}

1495 1496 1497 1498 1499 1500 1501
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;
1502
	__set_spte(sptep, spte);
1503 1504
}

1505 1506 1507 1508 1509 1510 1511 1512
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);
	}
}

1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535
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);
	}
}

1536
static void kvm_mmu_page_unlink_children(struct kvm *kvm,
1537
					 struct kvm_mmu_page *sp)
1538
{
1539 1540 1541 1542
	unsigned i;
	u64 *pt;
	u64 ent;

1543
	pt = sp->spt;
1544 1545 1546 1547

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

M
Marcelo Tosatti 已提交
1548
		if (is_shadow_present_pte(ent)) {
1549
			if (!is_last_spte(ent, sp->role.level)) {
M
Marcelo Tosatti 已提交
1550 1551 1552 1553
				ent &= PT64_BASE_ADDR_MASK;
				mmu_page_remove_parent_pte(page_header(ent),
							   &pt[i]);
			} else {
1554 1555
				if (is_large_pte(ent))
					--kvm->stat.lpages;
A
Avi Kivity 已提交
1556 1557
				drop_spte(kvm, &pt[i],
					  shadow_trap_nonpresent_pte);
M
Marcelo Tosatti 已提交
1558 1559
			}
		}
1560
		pt[i] = shadow_trap_nonpresent_pte;
1561
	}
1562 1563
}

1564
static void kvm_mmu_put_page(struct kvm_mmu_page *sp, u64 *parent_pte)
1565
{
1566
	mmu_page_remove_parent_pte(sp, parent_pte);
1567 1568
}

1569 1570 1571
static void kvm_mmu_reset_last_pte_updated(struct kvm *kvm)
{
	int i;
1572
	struct kvm_vcpu *vcpu;
1573

1574 1575
	kvm_for_each_vcpu(i, vcpu, kvm)
		vcpu->arch.last_pte_updated = NULL;
1576 1577
}

1578
static void kvm_mmu_unlink_parents(struct kvm *kvm, struct kvm_mmu_page *sp)
1579 1580 1581
{
	u64 *parent_pte;

1582 1583 1584
	while (sp->multimapped || sp->parent_pte) {
		if (!sp->multimapped)
			parent_pte = sp->parent_pte;
1585 1586 1587
		else {
			struct kvm_pte_chain *chain;

1588
			chain = container_of(sp->parent_ptes.first,
1589 1590 1591
					     struct kvm_pte_chain, link);
			parent_pte = chain->parent_ptes[0];
		}
1592
		BUG_ON(!parent_pte);
1593
		kvm_mmu_put_page(sp, parent_pte);
A
Avi Kivity 已提交
1594
		__set_spte(parent_pte, shadow_trap_nonpresent_pte);
1595
	}
1596 1597
}

1598
static int mmu_zap_unsync_children(struct kvm *kvm,
1599 1600
				   struct kvm_mmu_page *parent,
				   struct list_head *invalid_list)
1601
{
1602 1603 1604
	int i, zapped = 0;
	struct mmu_page_path parents;
	struct kvm_mmu_pages pages;
1605

1606
	if (parent->role.level == PT_PAGE_TABLE_LEVEL)
1607
		return 0;
1608 1609 1610 1611 1612 1613

	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) {
1614
			kvm_mmu_prepare_zap_page(kvm, sp, invalid_list);
1615
			mmu_pages_clear_parents(&parents);
1616
			zapped++;
1617 1618 1619 1620 1621
		}
		kvm_mmu_pages_init(parent, &parents, &pages);
	}

	return zapped;
1622 1623
}

1624 1625
static int kvm_mmu_prepare_zap_page(struct kvm *kvm, struct kvm_mmu_page *sp,
				    struct list_head *invalid_list)
1626
{
1627
	int ret;
A
Avi Kivity 已提交
1628

1629
	trace_kvm_mmu_prepare_zap_page(sp);
1630
	++kvm->stat.mmu_shadow_zapped;
1631
	ret = mmu_zap_unsync_children(kvm, sp, invalid_list);
1632
	kvm_mmu_page_unlink_children(kvm, sp);
1633
	kvm_mmu_unlink_parents(kvm, sp);
1634
	if (!sp->role.invalid && !sp->role.direct)
A
Avi Kivity 已提交
1635
		unaccount_shadowed(kvm, sp->gfn);
1636 1637
	if (sp->unsync)
		kvm_unlink_unsync_page(kvm, sp);
1638
	if (!sp->root_count) {
1639 1640
		/* Count self */
		ret++;
1641
		list_move(&sp->link, invalid_list);
1642
	} else {
A
Avi Kivity 已提交
1643
		list_move(&sp->link, &kvm->arch.active_mmu_pages);
1644 1645
		kvm_reload_remote_mmus(kvm);
	}
1646 1647

	sp->role.invalid = 1;
1648
	kvm_mmu_reset_last_pte_updated(kvm);
1649
	return ret;
1650 1651
}

1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669
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));

}

1670 1671 1672 1673 1674 1675
/*
 * 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)
{
1676
	int used_pages;
1677
	LIST_HEAD(invalid_list);
1678 1679 1680 1681

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

1682 1683 1684 1685 1686 1687
	/*
	 * 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
	 */

1688
	if (used_pages > kvm_nr_mmu_pages) {
1689 1690
		while (used_pages > kvm_nr_mmu_pages &&
			!list_empty(&kvm->arch.active_mmu_pages)) {
1691 1692
			struct kvm_mmu_page *page;

1693
			page = container_of(kvm->arch.active_mmu_pages.prev,
1694
					    struct kvm_mmu_page, link);
1695 1696
			used_pages -= kvm_mmu_prepare_zap_page(kvm, page,
							       &invalid_list);
1697
		}
1698
		kvm_mmu_commit_zap_page(kvm, &invalid_list);
1699
		kvm_nr_mmu_pages = used_pages;
1700
		kvm->arch.n_free_mmu_pages = 0;
1701 1702
	}
	else
1703 1704
		kvm->arch.n_free_mmu_pages += kvm_nr_mmu_pages
					 - kvm->arch.n_alloc_mmu_pages;
1705

1706
	kvm->arch.n_alloc_mmu_pages = kvm_nr_mmu_pages;
1707 1708
}

1709
static int kvm_mmu_unprotect_page(struct kvm *kvm, gfn_t gfn)
1710
{
1711
	struct kvm_mmu_page *sp;
1712
	struct hlist_node *node;
1713
	LIST_HEAD(invalid_list);
1714 1715
	int r;

1716
	pgprintk("%s: looking for gfn %lx\n", __func__, gfn);
1717
	r = 0;
1718 1719

	for_each_gfn_indirect_valid_sp(kvm, sp, gfn, node) {
1720 1721 1722
		pgprintk("%s: gfn %lx role %x\n", __func__, gfn,
			 sp->role.word);
		r = 1;
1723
		kvm_mmu_prepare_zap_page(kvm, sp, &invalid_list);
1724
	}
1725
	kvm_mmu_commit_zap_page(kvm, &invalid_list);
1726
	return r;
1727 1728
}

1729
static void mmu_unshadow(struct kvm *kvm, gfn_t gfn)
1730
{
1731
	struct kvm_mmu_page *sp;
1732
	struct hlist_node *node;
1733
	LIST_HEAD(invalid_list);
1734

1735
	for_each_gfn_indirect_valid_sp(kvm, sp, gfn, node) {
1736 1737
		pgprintk("%s: zap %lx %x\n",
			 __func__, gfn, sp->role.word);
1738
		kvm_mmu_prepare_zap_page(kvm, sp, &invalid_list);
1739
	}
1740
	kvm_mmu_commit_zap_page(kvm, &invalid_list);
1741 1742
}

1743
static void page_header_update_slot(struct kvm *kvm, void *pte, gfn_t gfn)
A
Avi Kivity 已提交
1744
{
1745
	int slot = memslot_id(kvm, gfn);
1746
	struct kvm_mmu_page *sp = page_header(__pa(pte));
A
Avi Kivity 已提交
1747

1748
	__set_bit(slot, sp->slot_bitmap);
A
Avi Kivity 已提交
1749 1750
}

1751 1752 1753 1754 1755 1756 1757 1758 1759 1760
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 已提交
1761
			__set_spte(&pt[i], shadow_trap_nonpresent_pte);
1762 1763 1764
	}
}

1765 1766 1767 1768 1769 1770 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
/*
 * 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;
}

1858
u8 kvm_get_guest_memory_type(struct kvm_vcpu *vcpu, gfn_t gfn)
1859 1860 1861 1862 1863 1864 1865 1866 1867
{
	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;
}
1868
EXPORT_SYMBOL_GPL(kvm_get_guest_memory_type);
1869

1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880
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)
1881 1882
{
	struct kvm_mmu_page *s;
1883
	struct hlist_node *node;
1884

1885
	for_each_gfn_indirect_valid_sp(vcpu->kvm, s, gfn, node) {
1886
		if (s->unsync)
1887
			continue;
1888 1889
		WARN_ON(s->role.level != PT_PAGE_TABLE_LEVEL);
		__kvm_unsync_page(vcpu, s);
1890 1891 1892 1893 1894 1895
	}
}

static int mmu_need_write_protect(struct kvm_vcpu *vcpu, gfn_t gfn,
				  bool can_unsync)
{
1896
	struct kvm_mmu_page *s;
1897
	struct hlist_node *node;
1898 1899
	bool need_unsync = false;

1900
	for_each_gfn_indirect_valid_sp(vcpu->kvm, s, gfn, node) {
1901 1902 1903
		if (!can_unsync)
			return 1;

1904
		if (s->role.level != PT_PAGE_TABLE_LEVEL)
1905
			return 1;
1906 1907

		if (!need_unsync && !s->unsync) {
1908
			if (!oos_shadow)
1909 1910 1911
				return 1;
			need_unsync = true;
		}
1912
	}
1913 1914
	if (need_unsync)
		kvm_unsync_pages(vcpu, gfn);
1915 1916 1917
	return 0;
}

A
Avi Kivity 已提交
1918
static int set_spte(struct kvm_vcpu *vcpu, u64 *sptep,
M
Marcelo Tosatti 已提交
1919
		    unsigned pte_access, int user_fault,
1920
		    int write_fault, int dirty, int level,
1921
		    gfn_t gfn, pfn_t pfn, bool speculative,
1922
		    bool can_unsync, bool reset_host_protection)
1923 1924
{
	u64 spte;
M
Marcelo Tosatti 已提交
1925
	int ret = 0;
S
Sheng Yang 已提交
1926

1927 1928 1929 1930 1931
	/*
	 * 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 已提交
1932
	spte = shadow_base_present_pte | shadow_dirty_mask;
1933
	if (!speculative)
1934
		spte |= shadow_accessed_mask;
1935 1936
	if (!dirty)
		pte_access &= ~ACC_WRITE_MASK;
S
Sheng Yang 已提交
1937 1938 1939 1940
	if (pte_access & ACC_EXEC_MASK)
		spte |= shadow_x_mask;
	else
		spte |= shadow_nx_mask;
1941
	if (pte_access & ACC_USER_MASK)
S
Sheng Yang 已提交
1942
		spte |= shadow_user_mask;
1943
	if (level > PT_PAGE_TABLE_LEVEL)
M
Marcelo Tosatti 已提交
1944
		spte |= PT_PAGE_SIZE_MASK;
1945 1946 1947
	if (tdp_enabled)
		spte |= kvm_x86_ops->get_mt_mask(vcpu, gfn,
			kvm_is_mmio_pfn(pfn));
1948

1949 1950 1951
	if (reset_host_protection)
		spte |= SPTE_HOST_WRITEABLE;

1952
	spte |= (u64)pfn << PAGE_SHIFT;
1953 1954

	if ((pte_access & ACC_WRITE_MASK)
1955 1956
	    || (!tdp_enabled && write_fault && !is_write_protection(vcpu)
		&& !user_fault)) {
1957

1958 1959
		if (level > PT_PAGE_TABLE_LEVEL &&
		    has_wrprotected_page(vcpu->kvm, gfn, level)) {
1960
			ret = 1;
A
Avi Kivity 已提交
1961 1962
			drop_spte(vcpu->kvm, sptep, shadow_trap_nonpresent_pte);
			goto done;
1963 1964
		}

1965 1966
		spte |= PT_WRITABLE_MASK;

1967 1968 1969
		if (!tdp_enabled && !(pte_access & ACC_WRITE_MASK))
			spte &= ~PT_USER_MASK;

1970 1971 1972 1973 1974 1975
		/*
		 * 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.
		 */
1976
		if (!can_unsync && is_writable_pte(*sptep))
1977 1978
			goto set_pte;

1979
		if (mmu_need_write_protect(vcpu, gfn, can_unsync)) {
1980
			pgprintk("%s: found shadow page for %lx, marking ro\n",
1981
				 __func__, gfn);
M
Marcelo Tosatti 已提交
1982
			ret = 1;
1983
			pte_access &= ~ACC_WRITE_MASK;
1984
			if (is_writable_pte(spte))
1985 1986 1987 1988 1989 1990 1991
				spte &= ~PT_WRITABLE_MASK;
		}
	}

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

1992
set_pte:
1993 1994
	if (is_writable_pte(*sptep) && !is_writable_pte(spte))
		kvm_set_pfn_dirty(pfn);
1995
	update_spte(sptep, spte);
A
Avi Kivity 已提交
1996
done:
M
Marcelo Tosatti 已提交
1997 1998 1999
	return ret;
}

A
Avi Kivity 已提交
2000
static void mmu_set_spte(struct kvm_vcpu *vcpu, u64 *sptep,
M
Marcelo Tosatti 已提交
2001 2002
			 unsigned pt_access, unsigned pte_access,
			 int user_fault, int write_fault, int dirty,
2003
			 int *ptwrite, int level, gfn_t gfn,
2004 2005
			 pfn_t pfn, bool speculative,
			 bool reset_host_protection)
M
Marcelo Tosatti 已提交
2006 2007
{
	int was_rmapped = 0;
2008
	int rmap_count;
M
Marcelo Tosatti 已提交
2009 2010 2011

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

A
Avi Kivity 已提交
2015
	if (is_rmap_spte(*sptep)) {
M
Marcelo Tosatti 已提交
2016 2017 2018 2019
		/*
		 * If we overwrite a PTE page pointer with a 2MB PMD, unlink
		 * the parent of the now unreachable PTE.
		 */
2020 2021
		if (level > PT_PAGE_TABLE_LEVEL &&
		    !is_large_pte(*sptep)) {
M
Marcelo Tosatti 已提交
2022
			struct kvm_mmu_page *child;
A
Avi Kivity 已提交
2023
			u64 pte = *sptep;
M
Marcelo Tosatti 已提交
2024 2025

			child = page_header(pte & PT64_BASE_ADDR_MASK);
A
Avi Kivity 已提交
2026
			mmu_page_remove_parent_pte(child, sptep);
2027 2028
			__set_spte(sptep, shadow_trap_nonpresent_pte);
			kvm_flush_remote_tlbs(vcpu->kvm);
A
Avi Kivity 已提交
2029
		} else if (pfn != spte_to_pfn(*sptep)) {
M
Marcelo Tosatti 已提交
2030
			pgprintk("hfn old %lx new %lx\n",
A
Avi Kivity 已提交
2031
				 spte_to_pfn(*sptep), pfn);
A
Avi Kivity 已提交
2032
			drop_spte(vcpu->kvm, sptep, shadow_trap_nonpresent_pte);
2033
			kvm_flush_remote_tlbs(vcpu->kvm);
2034 2035
		} else
			was_rmapped = 1;
M
Marcelo Tosatti 已提交
2036
	}
2037

A
Avi Kivity 已提交
2038
	if (set_spte(vcpu, sptep, pte_access, user_fault, write_fault,
2039 2040
		      dirty, level, gfn, pfn, speculative, true,
		      reset_host_protection)) {
M
Marcelo Tosatti 已提交
2041 2042
		if (write_fault)
			*ptwrite = 1;
2043
		kvm_mmu_flush_tlb(vcpu);
2044
	}
M
Marcelo Tosatti 已提交
2045

A
Avi Kivity 已提交
2046
	pgprintk("%s: setting spte %llx\n", __func__, *sptep);
M
Marcelo Tosatti 已提交
2047
	pgprintk("instantiating %s PTE (%s) at %ld (%llx) addr %p\n",
A
Avi Kivity 已提交
2048
		 is_large_pte(*sptep)? "2MB" : "4kB",
2049 2050
		 *sptep & PT_PRESENT_MASK ?"RW":"R", gfn,
		 *sptep, sptep);
A
Avi Kivity 已提交
2051
	if (!was_rmapped && is_large_pte(*sptep))
M
Marcelo Tosatti 已提交
2052 2053
		++vcpu->kvm->stat.lpages;

A
Avi Kivity 已提交
2054
	page_header_update_slot(vcpu->kvm, sptep, gfn);
2055
	if (!was_rmapped) {
2056
		rmap_count = rmap_add(vcpu, sptep, gfn);
2057
		if (rmap_count > RMAP_RECYCLE_THRESHOLD)
2058
			rmap_recycle(vcpu, sptep, gfn);
2059
	}
2060
	kvm_release_pfn_clean(pfn);
2061
	if (speculative) {
A
Avi Kivity 已提交
2062
		vcpu->arch.last_pte_updated = sptep;
2063 2064
		vcpu->arch.last_pte_gfn = gfn;
	}
2065 2066
}

A
Avi Kivity 已提交
2067 2068 2069 2070
static void nonpaging_new_cr3(struct kvm_vcpu *vcpu)
{
}

2071
static int __direct_map(struct kvm_vcpu *vcpu, gpa_t v, int write,
2072
			int level, gfn_t gfn, pfn_t pfn)
2073
{
2074
	struct kvm_shadow_walk_iterator iterator;
2075
	struct kvm_mmu_page *sp;
2076
	int pt_write = 0;
2077
	gfn_t pseudo_gfn;
A
Avi Kivity 已提交
2078

2079
	for_each_shadow_entry(vcpu, (u64)gfn << PAGE_SHIFT, iterator) {
2080
		if (iterator.level == level) {
2081 2082
			mmu_set_spte(vcpu, iterator.sptep, ACC_ALL, ACC_ALL,
				     0, write, 1, &pt_write,
2083
				     level, gfn, pfn, false, true);
2084 2085
			++vcpu->stat.pf_fixed;
			break;
A
Avi Kivity 已提交
2086 2087
		}

2088
		if (*iterator.sptep == shadow_trap_nonpresent_pte) {
2089 2090 2091 2092
			u64 base_addr = iterator.addr;

			base_addr &= PT64_LVL_ADDR_MASK(iterator.level);
			pseudo_gfn = base_addr >> PAGE_SHIFT;
2093 2094 2095 2096 2097 2098 2099 2100
			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;
			}
2101

A
Avi Kivity 已提交
2102 2103 2104 2105
			__set_spte(iterator.sptep,
				   __pa(sp->spt)
				   | PT_PRESENT_MASK | PT_WRITABLE_MASK
				   | shadow_user_mask | shadow_x_mask);
2106 2107 2108
		}
	}
	return pt_write;
A
Avi Kivity 已提交
2109 2110
}

2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127
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;
2128 2129 2130
	} else if (is_fault_pfn(pfn))
		return -EFAULT;

2131 2132 2133
	return 1;
}

2134 2135 2136
static int nonpaging_map(struct kvm_vcpu *vcpu, gva_t v, int write, gfn_t gfn)
{
	int r;
2137
	int level;
2138
	pfn_t pfn;
2139
	unsigned long mmu_seq;
2140

2141 2142 2143 2144 2145 2146 2147 2148 2149 2150
	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 已提交
2151

2152
	mmu_seq = vcpu->kvm->mmu_notifier_seq;
2153
	smp_rmb();
2154
	pfn = gfn_to_pfn(vcpu->kvm, gfn);
2155

2156
	/* mmio */
2157 2158
	if (is_error_pfn(pfn))
		return kvm_handle_bad_page(vcpu->kvm, gfn, pfn);
2159

2160
	spin_lock(&vcpu->kvm->mmu_lock);
2161 2162
	if (mmu_notifier_retry(vcpu, mmu_seq))
		goto out_unlock;
2163
	kvm_mmu_free_some_pages(vcpu);
2164
	r = __direct_map(vcpu, v, write, level, gfn, pfn);
2165 2166 2167
	spin_unlock(&vcpu->kvm->mmu_lock);


2168
	return r;
2169 2170 2171 2172 2173

out_unlock:
	spin_unlock(&vcpu->kvm->mmu_lock);
	kvm_release_pfn_clean(pfn);
	return 0;
2174 2175 2176
}


2177 2178 2179
static void mmu_free_roots(struct kvm_vcpu *vcpu)
{
	int i;
2180
	struct kvm_mmu_page *sp;
2181
	LIST_HEAD(invalid_list);
2182

2183
	if (!VALID_PAGE(vcpu->arch.mmu.root_hpa))
A
Avi Kivity 已提交
2184
		return;
2185
	spin_lock(&vcpu->kvm->mmu_lock);
2186 2187
	if (vcpu->arch.mmu.shadow_root_level == PT64_ROOT_LEVEL) {
		hpa_t root = vcpu->arch.mmu.root_hpa;
2188

2189 2190
		sp = page_header(root);
		--sp->root_count;
2191 2192 2193 2194
		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);
		}
2195
		vcpu->arch.mmu.root_hpa = INVALID_PAGE;
2196
		spin_unlock(&vcpu->kvm->mmu_lock);
2197 2198 2199
		return;
	}
	for (i = 0; i < 4; ++i) {
2200
		hpa_t root = vcpu->arch.mmu.pae_root[i];
2201

A
Avi Kivity 已提交
2202 2203
		if (root) {
			root &= PT64_BASE_ADDR_MASK;
2204 2205
			sp = page_header(root);
			--sp->root_count;
2206
			if (!sp->root_count && sp->role.invalid)
2207 2208
				kvm_mmu_prepare_zap_page(vcpu->kvm, sp,
							 &invalid_list);
A
Avi Kivity 已提交
2209
		}
2210
		vcpu->arch.mmu.pae_root[i] = INVALID_PAGE;
2211
	}
2212
	kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
2213
	spin_unlock(&vcpu->kvm->mmu_lock);
2214
	vcpu->arch.mmu.root_hpa = INVALID_PAGE;
2215 2216
}

2217 2218 2219 2220 2221
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)) {
2222
		kvm_make_request(KVM_REQ_TRIPLE_FAULT, vcpu);
2223 2224 2225 2226 2227 2228 2229
		ret = 1;
	}

	return ret;
}

static int mmu_alloc_roots(struct kvm_vcpu *vcpu)
2230 2231
{
	int i;
2232
	gfn_t root_gfn;
2233
	struct kvm_mmu_page *sp;
2234
	int direct = 0;
A
Avi Kivity 已提交
2235
	u64 pdptr;
2236

2237
	root_gfn = vcpu->arch.cr3 >> PAGE_SHIFT;
2238

2239 2240
	if (vcpu->arch.mmu.shadow_root_level == PT64_ROOT_LEVEL) {
		hpa_t root = vcpu->arch.mmu.root_hpa;
2241 2242

		ASSERT(!VALID_PAGE(root));
2243 2244
		if (mmu_check_root(vcpu, root_gfn))
			return 1;
2245 2246 2247 2248
		if (tdp_enabled) {
			direct = 1;
			root_gfn = 0;
		}
2249
		spin_lock(&vcpu->kvm->mmu_lock);
2250
		kvm_mmu_free_some_pages(vcpu);
2251
		sp = kvm_mmu_get_page(vcpu, root_gfn, 0,
2252
				      PT64_ROOT_LEVEL, direct,
2253
				      ACC_ALL, NULL);
2254 2255
		root = __pa(sp->spt);
		++sp->root_count;
2256
		spin_unlock(&vcpu->kvm->mmu_lock);
2257
		vcpu->arch.mmu.root_hpa = root;
2258
		return 0;
2259
	}
2260
	direct = !is_paging(vcpu);
2261
	for (i = 0; i < 4; ++i) {
2262
		hpa_t root = vcpu->arch.mmu.pae_root[i];
2263 2264

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

2289
		vcpu->arch.mmu.pae_root[i] = root | PT_PRESENT_MASK;
2290
	}
2291
	vcpu->arch.mmu.root_hpa = __pa(vcpu->arch.mmu.pae_root);
2292
	return 0;
2293 2294
}

2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310
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];

2311
		if (root && VALID_PAGE(root)) {
2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322
			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);
2323
	spin_unlock(&vcpu->kvm->mmu_lock);
2324 2325
}

2326 2327
static gpa_t nonpaging_gva_to_gpa(struct kvm_vcpu *vcpu, gva_t vaddr,
				  u32 access, u32 *error)
A
Avi Kivity 已提交
2328
{
2329 2330
	if (error)
		*error = 0;
A
Avi Kivity 已提交
2331 2332 2333 2334
	return vaddr;
}

static int nonpaging_page_fault(struct kvm_vcpu *vcpu, gva_t gva,
A
Avi Kivity 已提交
2335
				u32 error_code)
A
Avi Kivity 已提交
2336
{
2337
	gfn_t gfn;
2338
	int r;
A
Avi Kivity 已提交
2339

2340
	pgprintk("%s: gva %lx error %x\n", __func__, gva, error_code);
2341 2342 2343
	r = mmu_topup_memory_caches(vcpu);
	if (r)
		return r;
2344

A
Avi Kivity 已提交
2345
	ASSERT(vcpu);
2346
	ASSERT(VALID_PAGE(vcpu->arch.mmu.root_hpa));
A
Avi Kivity 已提交
2347

2348
	gfn = gva >> PAGE_SHIFT;
A
Avi Kivity 已提交
2349

2350 2351
	return nonpaging_map(vcpu, gva & PAGE_MASK,
			     error_code & PFERR_WRITE_MASK, gfn);
A
Avi Kivity 已提交
2352 2353
}

2354 2355 2356
static int tdp_page_fault(struct kvm_vcpu *vcpu, gva_t gpa,
				u32 error_code)
{
2357
	pfn_t pfn;
2358
	int r;
2359
	int level;
M
Marcelo Tosatti 已提交
2360
	gfn_t gfn = gpa >> PAGE_SHIFT;
2361
	unsigned long mmu_seq;
2362 2363 2364 2365 2366 2367 2368 2369

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

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

2370 2371 2372 2373
	level = mapping_level(vcpu, gfn);

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

2374
	mmu_seq = vcpu->kvm->mmu_notifier_seq;
2375
	smp_rmb();
2376
	pfn = gfn_to_pfn(vcpu->kvm, gfn);
2377 2378
	if (is_error_pfn(pfn))
		return kvm_handle_bad_page(vcpu->kvm, gfn, pfn);
2379
	spin_lock(&vcpu->kvm->mmu_lock);
2380 2381
	if (mmu_notifier_retry(vcpu, mmu_seq))
		goto out_unlock;
2382 2383
	kvm_mmu_free_some_pages(vcpu);
	r = __direct_map(vcpu, gpa, error_code & PFERR_WRITE_MASK,
2384
			 level, gfn, pfn);
2385 2386 2387
	spin_unlock(&vcpu->kvm->mmu_lock);

	return r;
2388 2389 2390 2391 2392

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

A
Avi Kivity 已提交
2395 2396
static void nonpaging_free(struct kvm_vcpu *vcpu)
{
2397
	mmu_free_roots(vcpu);
A
Avi Kivity 已提交
2398 2399 2400 2401
}

static int nonpaging_init_context(struct kvm_vcpu *vcpu)
{
2402
	struct kvm_mmu *context = &vcpu->arch.mmu;
A
Avi Kivity 已提交
2403 2404 2405 2406 2407

	context->new_cr3 = nonpaging_new_cr3;
	context->page_fault = nonpaging_page_fault;
	context->gva_to_gpa = nonpaging_gva_to_gpa;
	context->free = nonpaging_free;
2408
	context->prefetch_page = nonpaging_prefetch_page;
2409
	context->sync_page = nonpaging_sync_page;
M
Marcelo Tosatti 已提交
2410
	context->invlpg = nonpaging_invlpg;
2411
	context->root_level = 0;
A
Avi Kivity 已提交
2412
	context->shadow_root_level = PT32E_ROOT_LEVEL;
A
Avi Kivity 已提交
2413
	context->root_hpa = INVALID_PAGE;
A
Avi Kivity 已提交
2414 2415 2416
	return 0;
}

2417
void kvm_mmu_flush_tlb(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2418
{
A
Avi Kivity 已提交
2419
	++vcpu->stat.tlb_flush;
2420
	kvm_make_request(KVM_REQ_TLB_FLUSH, vcpu);
A
Avi Kivity 已提交
2421 2422 2423 2424
}

static void paging_new_cr3(struct kvm_vcpu *vcpu)
{
2425
	pgprintk("%s: cr3 %lx\n", __func__, vcpu->arch.cr3);
2426
	mmu_free_roots(vcpu);
A
Avi Kivity 已提交
2427 2428 2429 2430 2431 2432
}

static void inject_page_fault(struct kvm_vcpu *vcpu,
			      u64 addr,
			      u32 err_code)
{
2433
	kvm_inject_page_fault(vcpu, addr, err_code);
A
Avi Kivity 已提交
2434 2435 2436 2437 2438 2439 2440
}

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

2441 2442 2443 2444 2445 2446 2447 2448
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 已提交
2449 2450 2451 2452 2453 2454 2455 2456
#define PTTYPE 64
#include "paging_tmpl.h"
#undef PTTYPE

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

2457 2458 2459 2460 2461 2462 2463 2464 2465 2466 2467 2468 2469
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;
2470 2471 2472 2473 2474 2475 2476
		context->rsvd_bits_mask[1][0] = context->rsvd_bits_mask[0][0];

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

2477 2478 2479 2480 2481 2482 2483 2484
		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:
2485 2486 2487
		context->rsvd_bits_mask[0][2] =
			rsvd_bits(maxphyaddr, 63) |
			rsvd_bits(7, 8) | rsvd_bits(1, 2);	/* PDPTE */
2488
		context->rsvd_bits_mask[0][1] = exb_bit_rsvd |
2489
			rsvd_bits(maxphyaddr, 62);	/* PDE */
2490 2491 2492 2493 2494
		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 */
2495
		context->rsvd_bits_mask[1][0] = context->rsvd_bits_mask[0][0];
2496 2497 2498 2499 2500 2501 2502
		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 |
2503
			rsvd_bits(maxphyaddr, 51);
2504 2505 2506
		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];
2507 2508 2509
		context->rsvd_bits_mask[1][2] = exb_bit_rsvd |
			rsvd_bits(maxphyaddr, 51) |
			rsvd_bits(13, 29);
2510
		context->rsvd_bits_mask[1][1] = exb_bit_rsvd |
2511 2512
			rsvd_bits(maxphyaddr, 51) |
			rsvd_bits(13, 20);		/* large page */
2513
		context->rsvd_bits_mask[1][0] = context->rsvd_bits_mask[0][0];
2514 2515 2516 2517
		break;
	}
}

2518
static int paging64_init_context_common(struct kvm_vcpu *vcpu, int level)
A
Avi Kivity 已提交
2519
{
2520
	struct kvm_mmu *context = &vcpu->arch.mmu;
A
Avi Kivity 已提交
2521 2522 2523 2524 2525

	ASSERT(is_pae(vcpu));
	context->new_cr3 = paging_new_cr3;
	context->page_fault = paging64_page_fault;
	context->gva_to_gpa = paging64_gva_to_gpa;
2526
	context->prefetch_page = paging64_prefetch_page;
2527
	context->sync_page = paging64_sync_page;
M
Marcelo Tosatti 已提交
2528
	context->invlpg = paging64_invlpg;
A
Avi Kivity 已提交
2529
	context->free = paging_free;
2530 2531
	context->root_level = level;
	context->shadow_root_level = level;
A
Avi Kivity 已提交
2532
	context->root_hpa = INVALID_PAGE;
A
Avi Kivity 已提交
2533 2534 2535
	return 0;
}

2536 2537
static int paging64_init_context(struct kvm_vcpu *vcpu)
{
2538
	reset_rsvds_bits_mask(vcpu, PT64_ROOT_LEVEL);
2539 2540 2541
	return paging64_init_context_common(vcpu, PT64_ROOT_LEVEL);
}

A
Avi Kivity 已提交
2542 2543
static int paging32_init_context(struct kvm_vcpu *vcpu)
{
2544
	struct kvm_mmu *context = &vcpu->arch.mmu;
A
Avi Kivity 已提交
2545

2546
	reset_rsvds_bits_mask(vcpu, PT32_ROOT_LEVEL);
A
Avi Kivity 已提交
2547 2548 2549 2550
	context->new_cr3 = paging_new_cr3;
	context->page_fault = paging32_page_fault;
	context->gva_to_gpa = paging32_gva_to_gpa;
	context->free = paging_free;
2551
	context->prefetch_page = paging32_prefetch_page;
2552
	context->sync_page = paging32_sync_page;
M
Marcelo Tosatti 已提交
2553
	context->invlpg = paging32_invlpg;
A
Avi Kivity 已提交
2554 2555
	context->root_level = PT32_ROOT_LEVEL;
	context->shadow_root_level = PT32E_ROOT_LEVEL;
A
Avi Kivity 已提交
2556
	context->root_hpa = INVALID_PAGE;
A
Avi Kivity 已提交
2557 2558 2559 2560 2561
	return 0;
}

static int paging32E_init_context(struct kvm_vcpu *vcpu)
{
2562
	reset_rsvds_bits_mask(vcpu, PT32E_ROOT_LEVEL);
2563
	return paging64_init_context_common(vcpu, PT32E_ROOT_LEVEL);
A
Avi Kivity 已提交
2564 2565
}

2566 2567 2568 2569 2570 2571 2572 2573
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;
2574
	context->sync_page = nonpaging_sync_page;
M
Marcelo Tosatti 已提交
2575
	context->invlpg = nonpaging_invlpg;
2576
	context->shadow_root_level = kvm_x86_ops->get_tdp_level();
2577 2578 2579 2580 2581 2582
	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)) {
2583
		reset_rsvds_bits_mask(vcpu, PT64_ROOT_LEVEL);
2584 2585 2586
		context->gva_to_gpa = paging64_gva_to_gpa;
		context->root_level = PT64_ROOT_LEVEL;
	} else if (is_pae(vcpu)) {
2587
		reset_rsvds_bits_mask(vcpu, PT32E_ROOT_LEVEL);
2588 2589 2590
		context->gva_to_gpa = paging64_gva_to_gpa;
		context->root_level = PT32E_ROOT_LEVEL;
	} else {
2591
		reset_rsvds_bits_mask(vcpu, PT32_ROOT_LEVEL);
2592 2593 2594 2595 2596 2597 2598 2599
		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 已提交
2600
{
2601 2602
	int r;

A
Avi Kivity 已提交
2603
	ASSERT(vcpu);
2604
	ASSERT(!VALID_PAGE(vcpu->arch.mmu.root_hpa));
A
Avi Kivity 已提交
2605 2606

	if (!is_paging(vcpu))
2607
		r = nonpaging_init_context(vcpu);
A
Avi Kivity 已提交
2608
	else if (is_long_mode(vcpu))
2609
		r = paging64_init_context(vcpu);
A
Avi Kivity 已提交
2610
	else if (is_pae(vcpu))
2611
		r = paging32E_init_context(vcpu);
A
Avi Kivity 已提交
2612
	else
2613 2614
		r = paging32_init_context(vcpu);

2615
	vcpu->arch.mmu.base_role.cr4_pae = !!is_pae(vcpu);
2616
	vcpu->arch.mmu.base_role.cr0_wp = is_write_protection(vcpu);
2617 2618

	return r;
A
Avi Kivity 已提交
2619 2620
}

2621 2622
static int init_kvm_mmu(struct kvm_vcpu *vcpu)
{
2623 2624
	vcpu->arch.update_pte.pfn = bad_pfn;

2625 2626 2627 2628 2629 2630
	if (tdp_enabled)
		return init_kvm_tdp_mmu(vcpu);
	else
		return init_kvm_softmmu(vcpu);
}

A
Avi Kivity 已提交
2631 2632 2633
static void destroy_kvm_mmu(struct kvm_vcpu *vcpu)
{
	ASSERT(vcpu);
2634 2635
	if (VALID_PAGE(vcpu->arch.mmu.root_hpa))
		/* mmu.free() should set root_hpa = INVALID_PAGE */
2636
		vcpu->arch.mmu.free(vcpu);
A
Avi Kivity 已提交
2637 2638 2639
}

int kvm_mmu_reset_context(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2640 2641 2642 2643
{
	destroy_kvm_mmu(vcpu);
	return init_kvm_mmu(vcpu);
}
2644
EXPORT_SYMBOL_GPL(kvm_mmu_reset_context);
A
Avi Kivity 已提交
2645 2646

int kvm_mmu_load(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2647
{
2648 2649
	int r;

2650
	r = mmu_topup_memory_caches(vcpu);
A
Avi Kivity 已提交
2651 2652
	if (r)
		goto out;
2653
	r = mmu_alloc_roots(vcpu);
2654
	spin_lock(&vcpu->kvm->mmu_lock);
2655
	mmu_sync_roots(vcpu);
2656
	spin_unlock(&vcpu->kvm->mmu_lock);
2657 2658
	if (r)
		goto out;
2659
	/* set_cr3() should ensure TLB has been flushed */
2660
	kvm_x86_ops->set_cr3(vcpu, vcpu->arch.mmu.root_hpa);
2661 2662
out:
	return r;
A
Avi Kivity 已提交
2663
}
A
Avi Kivity 已提交
2664 2665 2666 2667 2668 2669
EXPORT_SYMBOL_GPL(kvm_mmu_load);

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

2671
static void mmu_pte_write_zap_pte(struct kvm_vcpu *vcpu,
2672
				  struct kvm_mmu_page *sp,
2673 2674 2675 2676 2677 2678
				  u64 *spte)
{
	u64 pte;
	struct kvm_mmu_page *child;

	pte = *spte;
2679
	if (is_shadow_present_pte(pte)) {
2680
		if (is_last_spte(pte, sp->role.level))
A
Avi Kivity 已提交
2681
			drop_spte(vcpu->kvm, spte, shadow_trap_nonpresent_pte);
2682 2683
		else {
			child = page_header(pte & PT64_BASE_ADDR_MASK);
2684
			mmu_page_remove_parent_pte(child, spte);
2685 2686
		}
	}
A
Avi Kivity 已提交
2687
	__set_spte(spte, shadow_trap_nonpresent_pte);
M
Marcelo Tosatti 已提交
2688 2689
	if (is_large_pte(pte))
		--vcpu->kvm->stat.lpages;
2690 2691
}

2692
static void mmu_pte_write_new_pte(struct kvm_vcpu *vcpu,
2693
				  struct kvm_mmu_page *sp,
2694
				  u64 *spte,
2695
				  const void *new)
2696
{
2697
	if (sp->role.level != PT_PAGE_TABLE_LEVEL) {
2698 2699
		++vcpu->kvm->stat.mmu_pde_zapped;
		return;
2700
        }
2701

2702 2703 2704
	if (is_rsvd_bits_set(vcpu, *(u64 *)new, PT_PAGE_TABLE_LEVEL))
		return;

A
Avi Kivity 已提交
2705
	++vcpu->kvm->stat.mmu_pte_updated;
2706
	if (!sp->role.cr4_pae)
2707
		paging32_update_pte(vcpu, sp, spte, new);
2708
	else
2709
		paging64_update_pte(vcpu, sp, spte, new);
2710 2711
}

2712 2713 2714 2715 2716 2717 2718 2719 2720 2721 2722 2723 2724
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;
}

2725 2726
static void mmu_pte_write_flush_tlb(struct kvm_vcpu *vcpu, bool zap_page,
				    bool remote_flush, bool local_flush)
2727
{
2728 2729 2730 2731
	if (zap_page)
		return;

	if (remote_flush)
2732
		kvm_flush_remote_tlbs(vcpu->kvm);
2733
	else if (local_flush)
2734 2735 2736
		kvm_mmu_flush_tlb(vcpu);
}

2737 2738
static bool last_updated_pte_accessed(struct kvm_vcpu *vcpu)
{
2739
	u64 *spte = vcpu->arch.last_pte_updated;
2740

S
Sheng Yang 已提交
2741
	return !!(spte && (*spte & shadow_accessed_mask));
2742 2743
}

2744
static void mmu_guess_page_from_pte_write(struct kvm_vcpu *vcpu, gpa_t gpa,
2745
					  u64 gpte)
2746 2747
{
	gfn_t gfn;
2748
	pfn_t pfn;
2749

2750
	if (!is_present_gpte(gpte))
2751 2752
		return;
	gfn = (gpte & PT64_BASE_ADDR_MASK) >> PAGE_SHIFT;
2753

2754
	vcpu->arch.update_pte.mmu_seq = vcpu->kvm->mmu_notifier_seq;
2755
	smp_rmb();
2756
	pfn = gfn_to_pfn(vcpu->kvm, gfn);
2757

2758 2759
	if (is_error_pfn(pfn)) {
		kvm_release_pfn_clean(pfn);
2760 2761
		return;
	}
2762
	vcpu->arch.update_pte.gfn = gfn;
2763
	vcpu->arch.update_pte.pfn = pfn;
2764 2765
}

2766 2767 2768 2769 2770 2771 2772 2773 2774 2775 2776 2777
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);
}

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

	zap_page = remote_flush = local_flush = false;
2802

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

2805
	invlpg_counter = atomic_read(&vcpu->kvm->arch.invlpg_counter);
2806 2807 2808 2809 2810 2811 2812

	/*
	 * 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().
	 */
2813
	if ((is_pae(vcpu) && bytes == 4) || !new) {
2814
		/* Handle a 32-bit guest writing two halves of a 64-bit gpte */
2815 2816 2817 2818 2819
		if (is_pae(vcpu)) {
			gpa &= ~(gpa_t)7;
			bytes = 8;
		}
		r = kvm_read_guest(vcpu->kvm, gpa, &gentry, min(bytes, 8));
2820 2821
		if (r)
			gentry = 0;
2822 2823 2824 2825 2826 2827 2828 2829 2830 2831 2832 2833 2834
		new = (const u8 *)&gentry;
	}

	switch (bytes) {
	case 4:
		gentry = *(const u32 *)new;
		break;
	case 8:
		gentry = *(const u64 *)new;
		break;
	default:
		gentry = 0;
		break;
2835 2836 2837
	}

	mmu_guess_page_from_pte_write(vcpu, gpa, gentry);
2838
	spin_lock(&vcpu->kvm->mmu_lock);
2839 2840
	if (atomic_read(&vcpu->kvm->arch.invlpg_counter) != invlpg_counter)
		gentry = 0;
2841
	kvm_mmu_access_page(vcpu, gfn);
2842
	kvm_mmu_free_some_pages(vcpu);
A
Avi Kivity 已提交
2843
	++vcpu->kvm->stat.mmu_pte_write;
2844
	kvm_mmu_audit(vcpu, "pre pte write");
2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855
	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;
		}
2856
	}
2857

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

2925 2926
int kvm_mmu_unprotect_page_virt(struct kvm_vcpu *vcpu, gva_t gva)
{
2927 2928
	gpa_t gpa;
	int r;
2929

2930 2931 2932
	if (tdp_enabled)
		return 0;

2933
	gpa = kvm_mmu_gva_to_gpa_read(vcpu, gva, NULL);
2934

2935
	spin_lock(&vcpu->kvm->mmu_lock);
2936
	r = kvm_mmu_unprotect_page(vcpu->kvm, gpa >> PAGE_SHIFT);
2937
	spin_unlock(&vcpu->kvm->mmu_lock);
2938
	return r;
2939
}
2940
EXPORT_SYMBOL_GPL(kvm_mmu_unprotect_page_virt);
2941

2942
void __kvm_mmu_free_some_pages(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2943
{
2944
	int free_pages;
2945
	LIST_HEAD(invalid_list);
2946 2947 2948

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

2952
		sp = container_of(vcpu->kvm->arch.active_mmu_pages.prev,
2953
				  struct kvm_mmu_page, link);
2954 2955
		free_pages += kvm_mmu_prepare_zap_page(vcpu->kvm, sp,
						       &invalid_list);
A
Avi Kivity 已提交
2956
		++vcpu->kvm->stat.mmu_recycled;
A
Avi Kivity 已提交
2957
	}
2958
	kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
A
Avi Kivity 已提交
2959 2960
}

2961 2962 2963 2964 2965
int kvm_mmu_page_fault(struct kvm_vcpu *vcpu, gva_t cr2, u32 error_code)
{
	int r;
	enum emulation_result er;

2966
	r = vcpu->arch.mmu.page_fault(vcpu, cr2, error_code);
2967 2968 2969 2970 2971 2972 2973 2974
	if (r < 0)
		goto out;

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

2975 2976 2977 2978
	r = mmu_topup_memory_caches(vcpu);
	if (r)
		goto out;

A
Avi Kivity 已提交
2979
	er = emulate_instruction(vcpu, cr2, error_code, 0);
2980 2981 2982 2983 2984 2985

	switch (er) {
	case EMULATE_DONE:
		return 1;
	case EMULATE_DO_MMIO:
		++vcpu->stat.mmio_exits;
2986
		/* fall through */
2987
	case EMULATE_FAIL:
2988
		return 0;
2989 2990 2991 2992 2993 2994 2995 2996
	default:
		BUG();
	}
out:
	return r;
}
EXPORT_SYMBOL_GPL(kvm_mmu_page_fault);

M
Marcelo Tosatti 已提交
2997 2998 2999 3000 3001 3002 3003 3004
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);

3005 3006 3007 3008 3009 3010
void kvm_enable_tdp(void)
{
	tdp_enabled = true;
}
EXPORT_SYMBOL_GPL(kvm_enable_tdp);

3011 3012 3013 3014 3015 3016
void kvm_disable_tdp(void)
{
	tdp_enabled = false;
}
EXPORT_SYMBOL_GPL(kvm_disable_tdp);

A
Avi Kivity 已提交
3017 3018
static void free_mmu_pages(struct kvm_vcpu *vcpu)
{
3019
	free_page((unsigned long)vcpu->arch.mmu.pae_root);
A
Avi Kivity 已提交
3020 3021 3022 3023
}

static int alloc_mmu_pages(struct kvm_vcpu *vcpu)
{
3024
	struct page *page;
A
Avi Kivity 已提交
3025 3026 3027 3028
	int i;

	ASSERT(vcpu);

3029 3030 3031 3032 3033 3034 3035
	/*
	 * 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)
3036 3037
		return -ENOMEM;

3038
	vcpu->arch.mmu.pae_root = page_address(page);
3039
	for (i = 0; i < 4; ++i)
3040
		vcpu->arch.mmu.pae_root[i] = INVALID_PAGE;
3041

A
Avi Kivity 已提交
3042 3043 3044
	return 0;
}

3045
int kvm_mmu_create(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
3046 3047
{
	ASSERT(vcpu);
3048
	ASSERT(!VALID_PAGE(vcpu->arch.mmu.root_hpa));
A
Avi Kivity 已提交
3049

3050 3051
	return alloc_mmu_pages(vcpu);
}
A
Avi Kivity 已提交
3052

3053 3054 3055
int kvm_mmu_setup(struct kvm_vcpu *vcpu)
{
	ASSERT(vcpu);
3056
	ASSERT(!VALID_PAGE(vcpu->arch.mmu.root_hpa));
3057

3058
	return init_kvm_mmu(vcpu);
A
Avi Kivity 已提交
3059 3060 3061 3062 3063 3064 3065 3066
}

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

	destroy_kvm_mmu(vcpu);
	free_mmu_pages(vcpu);
3067
	mmu_free_memory_caches(vcpu);
A
Avi Kivity 已提交
3068 3069
}

3070
void kvm_mmu_slot_remove_write_access(struct kvm *kvm, int slot)
A
Avi Kivity 已提交
3071
{
3072
	struct kvm_mmu_page *sp;
A
Avi Kivity 已提交
3073

3074
	list_for_each_entry(sp, &kvm->arch.active_mmu_pages, link) {
A
Avi Kivity 已提交
3075 3076 3077
		int i;
		u64 *pt;

3078
		if (!test_bit(slot, sp->slot_bitmap))
A
Avi Kivity 已提交
3079 3080
			continue;

3081
		pt = sp->spt;
A
Avi Kivity 已提交
3082 3083
		for (i = 0; i < PT64_ENT_PER_PAGE; ++i)
			/* avoid RMW */
3084
			if (is_writable_pte(pt[i]))
A
Avi Kivity 已提交
3085 3086
				pt[i] &= ~PT_WRITABLE_MASK;
	}
3087
	kvm_flush_remote_tlbs(kvm);
A
Avi Kivity 已提交
3088
}
3089

3090
void kvm_mmu_zap_all(struct kvm *kvm)
D
Dor Laor 已提交
3091
{
3092
	struct kvm_mmu_page *sp, *node;
3093
	LIST_HEAD(invalid_list);
D
Dor Laor 已提交
3094

3095
	spin_lock(&kvm->mmu_lock);
3096
restart:
3097
	list_for_each_entry_safe(sp, node, &kvm->arch.active_mmu_pages, link)
3098
		if (kvm_mmu_prepare_zap_page(kvm, sp, &invalid_list))
3099 3100
			goto restart;

3101
	kvm_mmu_commit_zap_page(kvm, &invalid_list);
3102
	spin_unlock(&kvm->mmu_lock);
D
Dor Laor 已提交
3103 3104
}

3105 3106
static int kvm_mmu_remove_some_alloc_mmu_pages(struct kvm *kvm,
					       struct list_head *invalid_list)
3107 3108 3109 3110 3111
{
	struct kvm_mmu_page *page;

	page = container_of(kvm->arch.active_mmu_pages.prev,
			    struct kvm_mmu_page, link);
3112
	return kvm_mmu_prepare_zap_page(kvm, page, invalid_list);
3113 3114
}

3115
static int mmu_shrink(struct shrinker *shrink, int nr_to_scan, gfp_t gfp_mask)
3116 3117 3118 3119 3120 3121 3122 3123
{
	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 已提交
3124
		int npages, idx, freed_pages;
3125
		LIST_HEAD(invalid_list);
3126

3127
		idx = srcu_read_lock(&kvm->srcu);
3128 3129 3130 3131 3132
		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) {
3133 3134
			freed_pages = kvm_mmu_remove_some_alloc_mmu_pages(kvm,
							  &invalid_list);
G
Gui Jianfeng 已提交
3135
			cache_count -= freed_pages;
3136 3137 3138 3139
			kvm_freed = kvm;
		}
		nr_to_scan--;

3140
		kvm_mmu_commit_zap_page(kvm, &invalid_list);
3141
		spin_unlock(&kvm->mmu_lock);
3142
		srcu_read_unlock(&kvm->srcu, idx);
3143 3144 3145 3146 3147 3148 3149 3150 3151 3152 3153 3154 3155 3156
	}
	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 已提交
3157
static void mmu_destroy_caches(void)
3158 3159 3160 3161 3162
{
	if (pte_chain_cache)
		kmem_cache_destroy(pte_chain_cache);
	if (rmap_desc_cache)
		kmem_cache_destroy(rmap_desc_cache);
3163 3164
	if (mmu_page_header_cache)
		kmem_cache_destroy(mmu_page_header_cache);
3165 3166
}

3167 3168 3169 3170 3171 3172
void kvm_mmu_module_exit(void)
{
	mmu_destroy_caches();
	unregister_shrinker(&mmu_shrinker);
}

3173 3174 3175 3176
int kvm_mmu_module_init(void)
{
	pte_chain_cache = kmem_cache_create("kvm_pte_chain",
					    sizeof(struct kvm_pte_chain),
3177
					    0, 0, NULL);
3178 3179 3180 3181
	if (!pte_chain_cache)
		goto nomem;
	rmap_desc_cache = kmem_cache_create("kvm_rmap_desc",
					    sizeof(struct kvm_rmap_desc),
3182
					    0, 0, NULL);
3183 3184 3185
	if (!rmap_desc_cache)
		goto nomem;

3186 3187
	mmu_page_header_cache = kmem_cache_create("kvm_mmu_page_header",
						  sizeof(struct kvm_mmu_page),
3188
						  0, 0, NULL);
3189 3190 3191
	if (!mmu_page_header_cache)
		goto nomem;

3192 3193
	register_shrinker(&mmu_shrinker);

3194 3195 3196
	return 0;

nomem:
3197
	mmu_destroy_caches();
3198 3199 3200
	return -ENOMEM;
}

3201 3202 3203 3204 3205 3206 3207 3208
/*
 * 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;
3209
	struct kvm_memslots *slots;
3210

3211 3212
	slots = kvm_memslots(kvm);

3213 3214
	for (i = 0; i < slots->nmemslots; i++)
		nr_pages += slots->memslots[i].npages;
3215 3216 3217 3218 3219 3220 3221 3222

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

3223 3224 3225 3226 3227 3228 3229 3230 3231 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
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;

3258
	if (!emulator_write_phys(vcpu, addr, &value, bytes))
3259 3260 3261 3262 3263 3264 3265
		return -EFAULT;

	return 1;
}

static int kvm_pv_mmu_flush_tlb(struct kvm_vcpu *vcpu)
{
3266
	(void)kvm_set_cr3(vcpu, vcpu->arch.cr3);
3267 3268 3269 3270 3271 3272 3273 3274 3275 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
	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;
3320
	struct kvm_pv_mmu_op_buffer *buffer = &vcpu->arch.mmu_op_buffer;
3321

3322 3323 3324
	buffer->ptr = buffer->buf;
	buffer->len = min_t(unsigned long, bytes, sizeof buffer->buf);
	buffer->processed = 0;
3325

3326
	r = kvm_read_guest(vcpu->kvm, addr, buffer->buf, buffer->len);
3327 3328 3329
	if (r)
		goto out;

3330 3331
	while (buffer->len) {
		r = kvm_pv_mmu_op_one(vcpu, buffer);
3332 3333 3334 3335 3336 3337 3338 3339
		if (r < 0)
			goto out;
		if (r == 0)
			break;
	}

	r = 1;
out:
3340
	*ret = buffer->processed;
3341 3342 3343
	return r;
}

3344 3345 3346 3347 3348 3349 3350 3351 3352 3353 3354 3355 3356 3357 3358 3359 3360 3361
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);

3362 3363 3364 3365 3366 3367 3368 3369 3370 3371 3372 3373
#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;
}

3374

3375
typedef void (*inspect_spte_fn) (struct kvm *kvm, u64 *sptep);
3376 3377 3378 3379 3380 3381 3382 3383 3384 3385

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)) {
3386
			if (!is_last_spte(ent, sp->role.level)) {
3387 3388 3389
				struct kvm_mmu_page *child;
				child = page_header(ent & PT64_BASE_ADDR_MASK);
				__mmu_spte_walk(kvm, child, fn);
3390
			} else
3391
				fn(kvm, &sp->spt[i]);
3392 3393 3394 3395 3396 3397 3398 3399 3400 3401 3402 3403 3404 3405 3406 3407 3408 3409 3410 3411 3412 3413 3414 3415 3416 3417 3418 3419 3420
		}
	}
}

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

3421 3422 3423 3424 3425 3426 3427 3428 3429 3430
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];

3431
		if (ent == shadow_trap_nonpresent_pte)
3432 3433 3434
			continue;

		va = canonicalize(va);
3435 3436 3437
		if (is_shadow_present_pte(ent) && !is_last_spte(ent, level))
			audit_mappings_page(vcpu, ent, va, level - 1);
		else {
3438
			gpa_t gpa = kvm_mmu_gva_to_gpa_read(vcpu, va, NULL);
J
Jan Kiszka 已提交
3439 3440 3441
			gfn_t gfn = gpa >> PAGE_SHIFT;
			pfn_t pfn = gfn_to_pfn(vcpu->kvm, gfn);
			hpa_t hpa = (hpa_t)pfn << PAGE_SHIFT;
3442

3443 3444 3445 3446 3447
			if (is_error_pfn(pfn)) {
				kvm_release_pfn_clean(pfn);
				continue;
			}

3448
			if (is_shadow_present_pte(ent)
3449
			    && (ent & PT64_BASE_ADDR_MASK) != hpa)
3450 3451
				printk(KERN_ERR "xx audit error: (%s) levels %d"
				       " gva %lx gpa %llx hpa %llx ent %llx %d\n",
3452
				       audit_msg, vcpu->arch.mmu.root_level,
M
Mike Day 已提交
3453 3454
				       va, gpa, hpa, ent,
				       is_shadow_present_pte(ent));
3455 3456 3457 3458
			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);
3459
			kvm_release_pfn_clean(pfn);
3460

3461 3462 3463 3464 3465 3466
		}
	}
}

static void audit_mappings(struct kvm_vcpu *vcpu)
{
3467
	unsigned i;
3468

3469 3470
	if (vcpu->arch.mmu.root_level == 4)
		audit_mappings_page(vcpu, vcpu->arch.mmu.root_hpa, 0, 4);
3471 3472
	else
		for (i = 0; i < 4; ++i)
3473
			if (vcpu->arch.mmu.pae_root[i] & PT_PRESENT_MASK)
3474
				audit_mappings_page(vcpu,
3475
						    vcpu->arch.mmu.pae_root[i],
3476 3477 3478 3479 3480 3481
						    i << 30,
						    2);
}

static int count_rmaps(struct kvm_vcpu *vcpu)
{
3482 3483
	struct kvm *kvm = vcpu->kvm;
	struct kvm_memslots *slots;
3484
	int nmaps = 0;
3485
	int i, j, k, idx;
3486

3487
	idx = srcu_read_lock(&kvm->srcu);
3488
	slots = kvm_memslots(kvm);
3489
	for (i = 0; i < KVM_MEMORY_SLOTS; ++i) {
3490
		struct kvm_memory_slot *m = &slots->memslots[i];
3491 3492 3493
		struct kvm_rmap_desc *d;

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

3496
			if (!*rmapp)
3497
				continue;
3498
			if (!(*rmapp & 1)) {
3499 3500 3501
				++nmaps;
				continue;
			}
3502
			d = (struct kvm_rmap_desc *)(*rmapp & ~1ul);
3503 3504
			while (d) {
				for (k = 0; k < RMAP_EXT; ++k)
A
Avi Kivity 已提交
3505
					if (d->sptes[k])
3506 3507 3508 3509 3510 3511 3512
						++nmaps;
					else
						break;
				d = d->more;
			}
		}
	}
3513
	srcu_read_unlock(&kvm->srcu, idx);
3514 3515 3516
	return nmaps;
}

3517
void inspect_spte_has_rmap(struct kvm *kvm, u64 *sptep)
3518 3519 3520 3521 3522
{
	unsigned long *rmapp;
	struct kvm_mmu_page *rev_sp;
	gfn_t gfn;

3523
	if (is_writable_pte(*sptep)) {
3524
		rev_sp = page_header(__pa(sptep));
3525
		gfn = kvm_mmu_page_get_gfn(rev_sp, sptep - rev_sp->spt);
3526 3527 3528 3529 3530 3531 3532

		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",
3533
			       audit_msg, (long int)(sptep - rev_sp->spt),
3534 3535 3536 3537 3538
					rev_sp->gfn);
			dump_stack();
			return;
		}

3539
		rmapp = gfn_to_rmap(kvm, gfn, rev_sp->role.level);
3540 3541 3542 3543 3544 3545 3546 3547 3548 3549 3550 3551 3552 3553 3554 3555 3556
		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)
3557
{
3558
	struct kvm_mmu_page *sp;
3559 3560
	int i;

3561
	list_for_each_entry(sp, &vcpu->kvm->arch.active_mmu_pages, link) {
3562
		u64 *pt = sp->spt;
3563

3564
		if (sp->role.level != PT_PAGE_TABLE_LEVEL)
3565 3566 3567 3568 3569 3570 3571
			continue;

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

			if (!(ent & PT_PRESENT_MASK))
				continue;
3572
			if (!is_writable_pte(ent))
3573
				continue;
3574
			inspect_spte_has_rmap(vcpu->kvm, &pt[i]);
3575 3576
		}
	}
3577
	return;
3578 3579 3580 3581
}

static void audit_rmap(struct kvm_vcpu *vcpu)
{
3582 3583
	check_writable_mappings_rmap(vcpu);
	count_rmaps(vcpu);
3584 3585 3586 3587
}

static void audit_write_protection(struct kvm_vcpu *vcpu)
{
3588
	struct kvm_mmu_page *sp;
3589 3590
	struct kvm_memory_slot *slot;
	unsigned long *rmapp;
3591
	u64 *spte;
3592
	gfn_t gfn;
3593

3594
	list_for_each_entry(sp, &vcpu->kvm->arch.active_mmu_pages, link) {
3595
		if (sp->role.direct)
3596
			continue;
3597 3598
		if (sp->unsync)
			continue;
3599

A
Avi Kivity 已提交
3600
		slot = gfn_to_memslot(vcpu->kvm, sp->gfn);
3601
		rmapp = &slot->rmap[gfn - slot->base_gfn];
3602 3603 3604

		spte = rmap_next(vcpu->kvm, rmapp, NULL);
		while (spte) {
3605
			if (is_writable_pte(*spte))
3606 3607
				printk(KERN_ERR "%s: (%s) shadow page has "
				"writable mappings: gfn %lx role %x\n",
3608
			       __func__, audit_msg, sp->gfn,
3609
			       sp->role.word);
3610 3611
			spte = rmap_next(vcpu->kvm, rmapp, spte);
		}
3612 3613 3614 3615 3616 3617 3618 3619 3620 3621 3622
	}
}

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);
3623 3624
	if (strcmp("pre pte write", audit_msg) != 0)
		audit_mappings(vcpu);
3625
	audit_writable_sptes_have_rmaps(vcpu);
3626 3627 3628 3629
	dbg = olddbg;
}

#endif