mmu.c 85.7 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
	u64 old_spte;
686

687 688
	old_spte = __xchg_spte(sptep, new_spte);
	if (!is_rmap_spte(old_spte))
689
		return;
690
	pfn = spte_to_pfn(old_spte);
691
	if (!shadow_accessed_mask || old_spte & shadow_accessed_mask)
692
		kvm_set_pfn_accessed(pfn);
693
	if (is_writable_pte(old_spte))
694
		kvm_set_pfn_dirty(pfn);
695 696 697 698 699
}

static void drop_spte(struct kvm *kvm, u64 *sptep, u64 new_spte)
{
	set_spte_track_bits(sptep, new_spte);
A
Avi Kivity 已提交
700 701 702
	rmap_remove(kvm, sptep);
}

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

729
static int rmap_write_protect(struct kvm *kvm, u64 gfn)
730
{
731
	unsigned long *rmapp;
732
	u64 *spte;
733
	int i, write_protected = 0;
734

735
	rmapp = gfn_to_rmap(kvm, gfn, PT_PAGE_TABLE_LEVEL);
736

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

		spte = rmap_next(kvm, rmapp, NULL);
752 753
		pfn = spte_to_pfn(*spte);
		kvm_set_pfn_dirty(pfn);
754 755
	}

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

777
	return write_protected;
778 779
}

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

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

	return 0;
}

F
Frederik Deweerdt 已提交
830 831
static int kvm_handle_hva(struct kvm *kvm, unsigned long hva,
			  unsigned long data,
832
			  int (*handler)(struct kvm *kvm, unsigned long *rmapp,
F
Frederik Deweerdt 已提交
833
					 unsigned long data))
834
{
835
	int i, j;
836
	int ret;
837
	int retval = 0;
838 839
	struct kvm_memslots *slots;

840
	slots = kvm_memslots(kvm);
841

842 843
	for (i = 0; i < slots->nmemslots; i++) {
		struct kvm_memory_slot *memslot = &slots->memslots[i];
844 845 846 847 848 849
		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;
850

851
			ret = handler(kvm, &memslot->rmap[gfn_offset], data);
852 853

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

	return retval;
}

int kvm_unmap_hva(struct kvm *kvm, unsigned long hva)
{
874 875 876 877 878
	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 已提交
879
	kvm_handle_hva(kvm, hva, (unsigned long)&pte, kvm_set_pte_rmapp);
880 881
}

F
Frederik Deweerdt 已提交
882 883
static int kvm_age_rmapp(struct kvm *kvm, unsigned long *rmapp,
			 unsigned long data)
884 885 886 887
{
	u64 *spte;
	int young = 0;

888 889 890 891 892 893 894
	/*
	 * 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.
	 */
895
	if (!shadow_accessed_mask)
896
		return kvm_unmap_rmapp(kvm, rmapp, data);
897

898 899 900 901 902 903 904 905 906 907 908 909 910 911 912
	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;
}

913 914
#define RMAP_RECYCLE_THRESHOLD 1000

915
static void rmap_recycle(struct kvm_vcpu *vcpu, u64 *spte, gfn_t gfn)
916 917
{
	unsigned long *rmapp;
918 919 920
	struct kvm_mmu_page *sp;

	sp = page_header(__pa(spte));
921

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

924
	kvm_unmap_rmapp(vcpu->kvm, rmapp, 0);
925 926 927
	kvm_flush_remote_tlbs(vcpu->kvm);
}

928 929
int kvm_age_hva(struct kvm *kvm, unsigned long hva)
{
930
	return kvm_handle_hva(kvm, hva, 0, kvm_age_rmapp);
931 932
}

933
#ifdef MMU_DEBUG
934
static int is_empty_shadow_page(u64 *spt)
A
Avi Kivity 已提交
935
{
936 937 938
	u64 *pos;
	u64 *end;

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

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

961 962
static unsigned kvm_page_table_hashfn(gfn_t gfn)
{
963
	return gfn & ((1 << KVM_MMU_HASH_SHIFT) - 1);
964 965
}

966
static struct kvm_mmu_page *kvm_mmu_alloc_page(struct kvm_vcpu *vcpu,
967
					       u64 *parent_pte, int direct)
A
Avi Kivity 已提交
968
{
969
	struct kvm_mmu_page *sp;
A
Avi Kivity 已提交
970

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

985
static void mmu_page_add_parent_pte(struct kvm_vcpu *vcpu,
986
				    struct kvm_mmu_page *sp, u64 *parent_pte)
987 988 989 990 991 992 993
{
	struct kvm_pte_chain *pte_chain;
	struct hlist_node *node;
	int i;

	if (!parent_pte)
		return;
994 995
	if (!sp->multimapped) {
		u64 *old = sp->parent_pte;
996 997

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

1022
static void mmu_page_remove_parent_pte(struct kvm_mmu_page *sp,
1023 1024 1025 1026 1027 1028
				       u64 *parent_pte)
{
	struct kvm_pte_chain *pte_chain;
	struct hlist_node *node;
	int i;

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

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

M
Marcelo Tosatti 已提交
1073 1074
	hlist_for_each_entry(pte_chain, node, &sp->parent_ptes, link)
		for (i = 0; i < NR_PTE_CHAIN_ENTRIES; ++i) {
1075 1076 1077
			u64 *spte = pte_chain->parent_ptes[i];

			if (!spte)
M
Marcelo Tosatti 已提交
1078
				break;
1079 1080
			parent_sp = page_header(__pa(spte));
			fn(parent_sp, spte);
M
Marcelo Tosatti 已提交
1081 1082 1083
		}
}

1084 1085
static void mark_unsync(struct kvm_mmu_page *sp, u64 *spte);
static void kvm_mmu_mark_parents_unsync(struct kvm_mmu_page *sp)
1086
{
1087
	mmu_parent_walk(sp, mark_unsync);
1088 1089
}

1090
static void mark_unsync(struct kvm_mmu_page *sp, u64 *spte)
1091
{
1092
	unsigned int index;
1093

1094 1095
	index = spte - sp->spt;
	if (__test_and_set_bit(index, sp->unsync_child_bitmap))
1096
		return;
1097
	if (sp->unsync_children++)
1098
		return;
1099
	kvm_mmu_mark_parents_unsync(sp);
1100 1101
}

1102 1103 1104 1105 1106 1107 1108 1109 1110
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;
}

1111
static int nonpaging_sync_page(struct kvm_vcpu *vcpu,
1112
			       struct kvm_mmu_page *sp, bool clear_unsync)
1113 1114 1115 1116
{
	return 1;
}

M
Marcelo Tosatti 已提交
1117 1118 1119 1120
static void nonpaging_invlpg(struct kvm_vcpu *vcpu, gva_t gva)
{
}

1121 1122 1123 1124 1125 1126 1127 1128 1129 1130
#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;
};

1131 1132 1133 1134 1135
#define for_each_unsync_children(bitmap, idx)		\
	for (idx = find_first_bit(bitmap, 512);		\
	     idx < 512;					\
	     idx = find_next_bit(bitmap, 512, idx+1))

1136 1137
static int mmu_pages_add(struct kvm_mmu_pages *pvec, struct kvm_mmu_page *sp,
			 int idx)
1138
{
1139
	int i;
1140

1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155
	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;
1156

1157
	for_each_unsync_children(sp->unsync_child_bitmap, i) {
1158
		struct kvm_mmu_page *child;
1159 1160
		u64 ent = sp->spt[i];

1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189
		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);
1190 1191 1192
	}


1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203
	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);
1204 1205 1206 1207 1208
}

static void kvm_unlink_unsync_page(struct kvm *kvm, struct kvm_mmu_page *sp)
{
	WARN_ON(!sp->unsync);
1209
	trace_kvm_mmu_sync_page(sp);
1210 1211 1212 1213
	sp->unsync = 0;
	--kvm->stat.mmu_unsync;
}

1214 1215 1216 1217
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);
1218

1219 1220
#define for_each_gfn_sp(kvm, sp, gfn, pos)				\
  hlist_for_each_entry(sp, pos,						\
1221 1222 1223
   &(kvm)->arch.mmu_page_hash[kvm_page_table_hashfn(gfn)], hash_link)	\
	if ((sp)->gfn != (gfn)) {} else

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

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

1239
	if (clear_unsync)
1240 1241
		kvm_unlink_unsync_page(vcpu->kvm, sp);

1242
	if (vcpu->arch.mmu.sync_page(vcpu, sp, clear_unsync)) {
1243
		kvm_mmu_prepare_zap_page(vcpu->kvm, sp, invalid_list);
1244 1245 1246 1247 1248 1249 1250
		return 1;
	}

	kvm_mmu_flush_tlb(vcpu);
	return 0;
}

1251 1252 1253
static int kvm_sync_page_transient(struct kvm_vcpu *vcpu,
				   struct kvm_mmu_page *sp)
{
1254
	LIST_HEAD(invalid_list);
1255 1256
	int ret;

1257
	ret = __kvm_sync_page(vcpu, sp, &invalid_list, false);
1258
	if (ret)
1259 1260
		kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);

1261 1262 1263
	return ret;
}

1264 1265
static int kvm_sync_page(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp,
			 struct list_head *invalid_list)
1266
{
1267
	return __kvm_sync_page(vcpu, sp, invalid_list, true);
1268 1269
}

1270 1271 1272 1273
/* @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;
1274
	struct hlist_node *node;
1275
	LIST_HEAD(invalid_list);
1276 1277
	bool flush = false;

1278
	for_each_gfn_indirect_valid_sp(vcpu->kvm, s, gfn, node) {
1279
		if (!s->unsync)
1280 1281 1282 1283
			continue;

		WARN_ON(s->role.level != PT_PAGE_TABLE_LEVEL);
		if ((s->role.cr4_pae != !!is_pae(vcpu)) ||
1284
			(vcpu->arch.mmu.sync_page(vcpu, s, true))) {
1285
			kvm_mmu_prepare_zap_page(vcpu->kvm, s, &invalid_list);
1286 1287 1288 1289 1290 1291
			continue;
		}
		kvm_unlink_unsync_page(vcpu->kvm, s);
		flush = true;
	}

1292
	kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
1293 1294 1295 1296
	if (flush)
		kvm_mmu_flush_tlb(vcpu);
}

1297 1298 1299
struct mmu_page_path {
	struct kvm_mmu_page *parent[PT64_ROOT_LEVEL-1];
	unsigned int idx[PT64_ROOT_LEVEL-1];
1300 1301
};

1302 1303 1304 1305 1306 1307
#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))

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

1329
static void mmu_pages_clear_parents(struct mmu_page_path *parents)
1330
{
1331 1332 1333 1334 1335
	struct kvm_mmu_page *sp;
	unsigned int level = 0;

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

1337 1338 1339 1340 1341 1342 1343 1344 1345
		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);
1346 1347
}

1348 1349 1350
static void kvm_mmu_pages_init(struct kvm_mmu_page *parent,
			       struct mmu_page_path *parents,
			       struct kvm_mmu_pages *pvec)
1351
{
1352 1353 1354
	parents->parent[parent->role.level-1] = NULL;
	pvec->nr = 0;
}
1355

1356 1357 1358 1359 1360 1361 1362
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;
1363
	LIST_HEAD(invalid_list);
1364 1365 1366

	kvm_mmu_pages_init(parent, &parents, &pages);
	while (mmu_unsync_walk(parent, &pages)) {
1367 1368 1369 1370 1371 1372 1373 1374
		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);

1375
		for_each_sp(pages, sp, parents, i) {
1376
			kvm_sync_page(vcpu, sp, &invalid_list);
1377 1378
			mmu_pages_clear_parents(&parents);
		}
1379
		kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
1380
		cond_resched_lock(&vcpu->kvm->mmu_lock);
1381 1382
		kvm_mmu_pages_init(parent, &parents, &pages);
	}
1383 1384
}

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

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

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

1417 1418
		if (sp->unsync && kvm_sync_page_transient(vcpu, sp))
			break;
1419

1420 1421
		mmu_page_add_parent_pte(vcpu, sp, parent_pte);
		if (sp->unsync_children) {
1422
			kvm_make_request(KVM_REQ_MMU_SYNC, vcpu);
1423 1424 1425
			kvm_mmu_mark_parents_unsync(sp);
		} else if (sp->unsync)
			kvm_mmu_mark_parents_unsync(sp);
1426

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

1444 1445
		account_shadowed(vcpu->kvm, gfn);
	}
1446 1447 1448 1449
	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 已提交
1450
	trace_kvm_mmu_get_page(sp, true);
1451
	return sp;
1452 1453
}

1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473
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;
1474 1475 1476 1477 1478

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

1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489
	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;
}

1490 1491 1492 1493 1494 1495 1496
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;
1497
	__set_spte(sptep, spte);
1498 1499
}

1500 1501 1502 1503 1504 1505 1506 1507
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);
	}
}

1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530
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);
	}
}

1531
static void kvm_mmu_page_unlink_children(struct kvm *kvm,
1532
					 struct kvm_mmu_page *sp)
1533
{
1534 1535 1536 1537
	unsigned i;
	u64 *pt;
	u64 ent;

1538
	pt = sp->spt;
1539 1540 1541 1542

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

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

1559
static void kvm_mmu_put_page(struct kvm_mmu_page *sp, u64 *parent_pte)
1560
{
1561
	mmu_page_remove_parent_pte(sp, parent_pte);
1562 1563
}

1564 1565 1566
static void kvm_mmu_reset_last_pte_updated(struct kvm *kvm)
{
	int i;
1567
	struct kvm_vcpu *vcpu;
1568

1569 1570
	kvm_for_each_vcpu(i, vcpu, kvm)
		vcpu->arch.last_pte_updated = NULL;
1571 1572
}

1573
static void kvm_mmu_unlink_parents(struct kvm *kvm, struct kvm_mmu_page *sp)
1574 1575 1576
{
	u64 *parent_pte;

1577 1578 1579
	while (sp->multimapped || sp->parent_pte) {
		if (!sp->multimapped)
			parent_pte = sp->parent_pte;
1580 1581 1582
		else {
			struct kvm_pte_chain *chain;

1583
			chain = container_of(sp->parent_ptes.first,
1584 1585 1586
					     struct kvm_pte_chain, link);
			parent_pte = chain->parent_ptes[0];
		}
1587
		BUG_ON(!parent_pte);
1588
		kvm_mmu_put_page(sp, parent_pte);
A
Avi Kivity 已提交
1589
		__set_spte(parent_pte, shadow_trap_nonpresent_pte);
1590
	}
1591 1592
}

1593
static int mmu_zap_unsync_children(struct kvm *kvm,
1594 1595
				   struct kvm_mmu_page *parent,
				   struct list_head *invalid_list)
1596
{
1597 1598 1599
	int i, zapped = 0;
	struct mmu_page_path parents;
	struct kvm_mmu_pages pages;
1600

1601
	if (parent->role.level == PT_PAGE_TABLE_LEVEL)
1602
		return 0;
1603 1604 1605 1606 1607 1608

	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) {
1609
			kvm_mmu_prepare_zap_page(kvm, sp, invalid_list);
1610
			mmu_pages_clear_parents(&parents);
1611
			zapped++;
1612 1613 1614 1615 1616
		}
		kvm_mmu_pages_init(parent, &parents, &pages);
	}

	return zapped;
1617 1618
}

1619 1620
static int kvm_mmu_prepare_zap_page(struct kvm *kvm, struct kvm_mmu_page *sp,
				    struct list_head *invalid_list)
1621
{
1622
	int ret;
A
Avi Kivity 已提交
1623

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

	sp->role.invalid = 1;
1643
	kvm_mmu_reset_last_pte_updated(kvm);
1644
	return ret;
1645 1646
}

1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664
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));

}

1665 1666 1667 1668 1669 1670
/*
 * 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)
{
1671
	int used_pages;
1672
	LIST_HEAD(invalid_list);
1673 1674 1675 1676

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

1677 1678 1679 1680 1681 1682
	/*
	 * 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
	 */

1683
	if (used_pages > kvm_nr_mmu_pages) {
1684 1685
		while (used_pages > kvm_nr_mmu_pages &&
			!list_empty(&kvm->arch.active_mmu_pages)) {
1686 1687
			struct kvm_mmu_page *page;

1688
			page = container_of(kvm->arch.active_mmu_pages.prev,
1689
					    struct kvm_mmu_page, link);
1690 1691
			used_pages -= kvm_mmu_prepare_zap_page(kvm, page,
							       &invalid_list);
1692
		}
1693
		kvm_mmu_commit_zap_page(kvm, &invalid_list);
1694
		kvm_nr_mmu_pages = used_pages;
1695
		kvm->arch.n_free_mmu_pages = 0;
1696 1697
	}
	else
1698 1699
		kvm->arch.n_free_mmu_pages += kvm_nr_mmu_pages
					 - kvm->arch.n_alloc_mmu_pages;
1700

1701
	kvm->arch.n_alloc_mmu_pages = kvm_nr_mmu_pages;
1702 1703
}

1704
static int kvm_mmu_unprotect_page(struct kvm *kvm, gfn_t gfn)
1705
{
1706
	struct kvm_mmu_page *sp;
1707
	struct hlist_node *node;
1708
	LIST_HEAD(invalid_list);
1709 1710
	int r;

1711
	pgprintk("%s: looking for gfn %lx\n", __func__, gfn);
1712
	r = 0;
1713 1714

	for_each_gfn_indirect_valid_sp(kvm, sp, gfn, node) {
1715 1716 1717
		pgprintk("%s: gfn %lx role %x\n", __func__, gfn,
			 sp->role.word);
		r = 1;
1718
		kvm_mmu_prepare_zap_page(kvm, sp, &invalid_list);
1719
	}
1720
	kvm_mmu_commit_zap_page(kvm, &invalid_list);
1721
	return r;
1722 1723
}

1724
static void mmu_unshadow(struct kvm *kvm, gfn_t gfn)
1725
{
1726
	struct kvm_mmu_page *sp;
1727
	struct hlist_node *node;
1728
	LIST_HEAD(invalid_list);
1729

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

1738
static void page_header_update_slot(struct kvm *kvm, void *pte, gfn_t gfn)
A
Avi Kivity 已提交
1739
{
1740
	int slot = memslot_id(kvm, gfn);
1741
	struct kvm_mmu_page *sp = page_header(__pa(pte));
A
Avi Kivity 已提交
1742

1743
	__set_bit(slot, sp->slot_bitmap);
A
Avi Kivity 已提交
1744 1745
}

1746 1747 1748 1749 1750 1751 1752 1753 1754 1755
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 已提交
1756
			__set_spte(&pt[i], shadow_trap_nonpresent_pte);
1757 1758 1759
	}
}

1760 1761 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
/*
 * 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;
}

1853
u8 kvm_get_guest_memory_type(struct kvm_vcpu *vcpu, gfn_t gfn)
1854 1855 1856 1857 1858 1859 1860 1861 1862
{
	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;
}
1863
EXPORT_SYMBOL_GPL(kvm_get_guest_memory_type);
1864

1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875
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)
1876 1877
{
	struct kvm_mmu_page *s;
1878
	struct hlist_node *node;
1879

1880
	for_each_gfn_indirect_valid_sp(vcpu->kvm, s, gfn, node) {
1881
		if (s->unsync)
1882
			continue;
1883 1884
		WARN_ON(s->role.level != PT_PAGE_TABLE_LEVEL);
		__kvm_unsync_page(vcpu, s);
1885 1886 1887 1888 1889 1890
	}
}

static int mmu_need_write_protect(struct kvm_vcpu *vcpu, gfn_t gfn,
				  bool can_unsync)
{
1891
	struct kvm_mmu_page *s;
1892
	struct hlist_node *node;
1893 1894
	bool need_unsync = false;

1895
	for_each_gfn_indirect_valid_sp(vcpu->kvm, s, gfn, node) {
1896 1897 1898
		if (!can_unsync)
			return 1;

1899
		if (s->role.level != PT_PAGE_TABLE_LEVEL)
1900
			return 1;
1901 1902

		if (!need_unsync && !s->unsync) {
1903
			if (!oos_shadow)
1904 1905 1906
				return 1;
			need_unsync = true;
		}
1907
	}
1908 1909
	if (need_unsync)
		kvm_unsync_pages(vcpu, gfn);
1910 1911 1912
	return 0;
}

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

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

1944 1945 1946
	if (reset_host_protection)
		spte |= SPTE_HOST_WRITEABLE;

1947
	spte |= (u64)pfn << PAGE_SHIFT;
1948 1949

	if ((pte_access & ACC_WRITE_MASK)
1950 1951
	    || (!tdp_enabled && write_fault && !is_write_protection(vcpu)
		&& !user_fault)) {
1952

1953 1954
		if (level > PT_PAGE_TABLE_LEVEL &&
		    has_wrprotected_page(vcpu->kvm, gfn, level)) {
1955
			ret = 1;
A
Avi Kivity 已提交
1956 1957
			drop_spte(vcpu->kvm, sptep, shadow_trap_nonpresent_pte);
			goto done;
1958 1959
		}

1960 1961
		spte |= PT_WRITABLE_MASK;

1962 1963 1964
		if (!tdp_enabled && !(pte_access & ACC_WRITE_MASK))
			spte &= ~PT_USER_MASK;

1965 1966 1967 1968 1969 1970
		/*
		 * 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.
		 */
1971
		if (!can_unsync && is_writable_pte(*sptep))
1972 1973
			goto set_pte;

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

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

1987
set_pte:
1988 1989
	if (is_writable_pte(*sptep) && !is_writable_pte(spte))
		kvm_set_pfn_dirty(pfn);
1990
	update_spte(sptep, spte);
A
Avi Kivity 已提交
1991
done:
M
Marcelo Tosatti 已提交
1992 1993 1994
	return ret;
}

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

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

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

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

A
Avi Kivity 已提交
2033
	if (set_spte(vcpu, sptep, pte_access, user_fault, write_fault,
2034 2035
		      dirty, level, gfn, pfn, speculative, true,
		      reset_host_protection)) {
M
Marcelo Tosatti 已提交
2036 2037
		if (write_fault)
			*ptwrite = 1;
2038
		kvm_mmu_flush_tlb(vcpu);
2039
	}
M
Marcelo Tosatti 已提交
2040

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

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

A
Avi Kivity 已提交
2062 2063 2064 2065
static void nonpaging_new_cr3(struct kvm_vcpu *vcpu)
{
}

2066
static int __direct_map(struct kvm_vcpu *vcpu, gpa_t v, int write,
2067
			int level, gfn_t gfn, pfn_t pfn)
2068
{
2069
	struct kvm_shadow_walk_iterator iterator;
2070
	struct kvm_mmu_page *sp;
2071
	int pt_write = 0;
2072
	gfn_t pseudo_gfn;
A
Avi Kivity 已提交
2073

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

2083
		if (*iterator.sptep == shadow_trap_nonpresent_pte) {
2084 2085 2086 2087
			u64 base_addr = iterator.addr;

			base_addr &= PT64_LVL_ADDR_MASK(iterator.level);
			pseudo_gfn = base_addr >> PAGE_SHIFT;
2088 2089 2090 2091 2092 2093 2094 2095
			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;
			}
2096

A
Avi Kivity 已提交
2097 2098 2099 2100
			__set_spte(iterator.sptep,
				   __pa(sp->spt)
				   | PT_PRESENT_MASK | PT_WRITABLE_MASK
				   | shadow_user_mask | shadow_x_mask);
2101 2102 2103
		}
	}
	return pt_write;
A
Avi Kivity 已提交
2104 2105
}

2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122
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;
2123 2124 2125
	} else if (is_fault_pfn(pfn))
		return -EFAULT;

2126 2127 2128
	return 1;
}

2129 2130 2131
static int nonpaging_map(struct kvm_vcpu *vcpu, gva_t v, int write, gfn_t gfn)
{
	int r;
2132
	int level;
2133
	pfn_t pfn;
2134
	unsigned long mmu_seq;
2135

2136 2137 2138 2139 2140 2141 2142 2143 2144 2145
	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 已提交
2146

2147
	mmu_seq = vcpu->kvm->mmu_notifier_seq;
2148
	smp_rmb();
2149
	pfn = gfn_to_pfn(vcpu->kvm, gfn);
2150

2151
	/* mmio */
2152 2153
	if (is_error_pfn(pfn))
		return kvm_handle_bad_page(vcpu->kvm, gfn, pfn);
2154

2155
	spin_lock(&vcpu->kvm->mmu_lock);
2156 2157
	if (mmu_notifier_retry(vcpu, mmu_seq))
		goto out_unlock;
2158
	kvm_mmu_free_some_pages(vcpu);
2159
	r = __direct_map(vcpu, v, write, level, gfn, pfn);
2160 2161 2162
	spin_unlock(&vcpu->kvm->mmu_lock);


2163
	return r;
2164 2165 2166 2167 2168

out_unlock:
	spin_unlock(&vcpu->kvm->mmu_lock);
	kvm_release_pfn_clean(pfn);
	return 0;
2169 2170 2171
}


2172 2173 2174
static void mmu_free_roots(struct kvm_vcpu *vcpu)
{
	int i;
2175
	struct kvm_mmu_page *sp;
2176
	LIST_HEAD(invalid_list);
2177

2178
	if (!VALID_PAGE(vcpu->arch.mmu.root_hpa))
A
Avi Kivity 已提交
2179
		return;
2180
	spin_lock(&vcpu->kvm->mmu_lock);
2181 2182
	if (vcpu->arch.mmu.shadow_root_level == PT64_ROOT_LEVEL) {
		hpa_t root = vcpu->arch.mmu.root_hpa;
2183

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

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

2212 2213 2214 2215 2216
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)) {
2217
		kvm_make_request(KVM_REQ_TRIPLE_FAULT, vcpu);
2218 2219 2220 2221 2222 2223 2224
		ret = 1;
	}

	return ret;
}

static int mmu_alloc_roots(struct kvm_vcpu *vcpu)
2225 2226
{
	int i;
2227
	gfn_t root_gfn;
2228
	struct kvm_mmu_page *sp;
2229
	int direct = 0;
A
Avi Kivity 已提交
2230
	u64 pdptr;
2231

2232
	root_gfn = vcpu->arch.cr3 >> PAGE_SHIFT;
2233

2234 2235
	if (vcpu->arch.mmu.shadow_root_level == PT64_ROOT_LEVEL) {
		hpa_t root = vcpu->arch.mmu.root_hpa;
2236 2237

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

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

2284
		vcpu->arch.mmu.pae_root[i] = root | PT_PRESENT_MASK;
2285
	}
2286
	vcpu->arch.mmu.root_hpa = __pa(vcpu->arch.mmu.pae_root);
2287
	return 0;
2288 2289
}

2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305
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];

2306
		if (root && VALID_PAGE(root)) {
2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317
			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);
2318
	spin_unlock(&vcpu->kvm->mmu_lock);
2319 2320
}

2321 2322
static gpa_t nonpaging_gva_to_gpa(struct kvm_vcpu *vcpu, gva_t vaddr,
				  u32 access, u32 *error)
A
Avi Kivity 已提交
2323
{
2324 2325
	if (error)
		*error = 0;
A
Avi Kivity 已提交
2326 2327 2328 2329
	return vaddr;
}

static int nonpaging_page_fault(struct kvm_vcpu *vcpu, gva_t gva,
A
Avi Kivity 已提交
2330
				u32 error_code)
A
Avi Kivity 已提交
2331
{
2332
	gfn_t gfn;
2333
	int r;
A
Avi Kivity 已提交
2334

2335
	pgprintk("%s: gva %lx error %x\n", __func__, gva, error_code);
2336 2337 2338
	r = mmu_topup_memory_caches(vcpu);
	if (r)
		return r;
2339

A
Avi Kivity 已提交
2340
	ASSERT(vcpu);
2341
	ASSERT(VALID_PAGE(vcpu->arch.mmu.root_hpa));
A
Avi Kivity 已提交
2342

2343
	gfn = gva >> PAGE_SHIFT;
A
Avi Kivity 已提交
2344

2345 2346
	return nonpaging_map(vcpu, gva & PAGE_MASK,
			     error_code & PFERR_WRITE_MASK, gfn);
A
Avi Kivity 已提交
2347 2348
}

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

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

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

2365 2366 2367 2368
	level = mapping_level(vcpu, gfn);

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

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

	return r;
2383 2384 2385 2386 2387

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

A
Avi Kivity 已提交
2390 2391
static void nonpaging_free(struct kvm_vcpu *vcpu)
{
2392
	mmu_free_roots(vcpu);
A
Avi Kivity 已提交
2393 2394 2395 2396
}

static int nonpaging_init_context(struct kvm_vcpu *vcpu)
{
2397
	struct kvm_mmu *context = &vcpu->arch.mmu;
A
Avi Kivity 已提交
2398 2399 2400 2401 2402

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

2412
void kvm_mmu_flush_tlb(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2413
{
A
Avi Kivity 已提交
2414
	++vcpu->stat.tlb_flush;
2415
	kvm_make_request(KVM_REQ_TLB_FLUSH, vcpu);
A
Avi Kivity 已提交
2416 2417 2418 2419
}

static void paging_new_cr3(struct kvm_vcpu *vcpu)
{
2420
	pgprintk("%s: cr3 %lx\n", __func__, vcpu->arch.cr3);
2421
	mmu_free_roots(vcpu);
A
Avi Kivity 已提交
2422 2423 2424 2425 2426 2427
}

static void inject_page_fault(struct kvm_vcpu *vcpu,
			      u64 addr,
			      u32 err_code)
{
2428
	kvm_inject_page_fault(vcpu, addr, err_code);
A
Avi Kivity 已提交
2429 2430 2431 2432 2433 2434 2435
}

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

2436 2437 2438 2439 2440 2441 2442 2443
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 已提交
2444 2445 2446 2447 2448 2449 2450 2451
#define PTTYPE 64
#include "paging_tmpl.h"
#undef PTTYPE

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

2452 2453 2454 2455 2456 2457 2458 2459 2460 2461 2462 2463 2464
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;
2465 2466 2467 2468 2469 2470 2471
		context->rsvd_bits_mask[1][0] = context->rsvd_bits_mask[0][0];

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

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

2513
static int paging64_init_context_common(struct kvm_vcpu *vcpu, int level)
A
Avi Kivity 已提交
2514
{
2515
	struct kvm_mmu *context = &vcpu->arch.mmu;
A
Avi Kivity 已提交
2516 2517 2518 2519 2520

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

2531 2532
static int paging64_init_context(struct kvm_vcpu *vcpu)
{
2533
	reset_rsvds_bits_mask(vcpu, PT64_ROOT_LEVEL);
2534 2535 2536
	return paging64_init_context_common(vcpu, PT64_ROOT_LEVEL);
}

A
Avi Kivity 已提交
2537 2538
static int paging32_init_context(struct kvm_vcpu *vcpu)
{
2539
	struct kvm_mmu *context = &vcpu->arch.mmu;
A
Avi Kivity 已提交
2540

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

static int paging32E_init_context(struct kvm_vcpu *vcpu)
{
2557
	reset_rsvds_bits_mask(vcpu, PT32E_ROOT_LEVEL);
2558
	return paging64_init_context_common(vcpu, PT32E_ROOT_LEVEL);
A
Avi Kivity 已提交
2559 2560
}

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

A
Avi Kivity 已提交
2598
	ASSERT(vcpu);
2599
	ASSERT(!VALID_PAGE(vcpu->arch.mmu.root_hpa));
A
Avi Kivity 已提交
2600 2601

	if (!is_paging(vcpu))
2602
		r = nonpaging_init_context(vcpu);
A
Avi Kivity 已提交
2603
	else if (is_long_mode(vcpu))
2604
		r = paging64_init_context(vcpu);
A
Avi Kivity 已提交
2605
	else if (is_pae(vcpu))
2606
		r = paging32E_init_context(vcpu);
A
Avi Kivity 已提交
2607
	else
2608 2609
		r = paging32_init_context(vcpu);

2610
	vcpu->arch.mmu.base_role.cr4_pae = !!is_pae(vcpu);
2611
	vcpu->arch.mmu.base_role.cr0_wp = is_write_protection(vcpu);
2612 2613

	return r;
A
Avi Kivity 已提交
2614 2615
}

2616 2617
static int init_kvm_mmu(struct kvm_vcpu *vcpu)
{
2618 2619
	vcpu->arch.update_pte.pfn = bad_pfn;

2620 2621 2622 2623 2624 2625
	if (tdp_enabled)
		return init_kvm_tdp_mmu(vcpu);
	else
		return init_kvm_softmmu(vcpu);
}

A
Avi Kivity 已提交
2626 2627 2628
static void destroy_kvm_mmu(struct kvm_vcpu *vcpu)
{
	ASSERT(vcpu);
2629 2630
	if (VALID_PAGE(vcpu->arch.mmu.root_hpa))
		/* mmu.free() should set root_hpa = INVALID_PAGE */
2631
		vcpu->arch.mmu.free(vcpu);
A
Avi Kivity 已提交
2632 2633 2634
}

int kvm_mmu_reset_context(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2635 2636 2637 2638
{
	destroy_kvm_mmu(vcpu);
	return init_kvm_mmu(vcpu);
}
2639
EXPORT_SYMBOL_GPL(kvm_mmu_reset_context);
A
Avi Kivity 已提交
2640 2641

int kvm_mmu_load(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2642
{
2643 2644
	int r;

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

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

2666
static void mmu_pte_write_zap_pte(struct kvm_vcpu *vcpu,
2667
				  struct kvm_mmu_page *sp,
2668 2669 2670 2671 2672 2673
				  u64 *spte)
{
	u64 pte;
	struct kvm_mmu_page *child;

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

2687
static void mmu_pte_write_new_pte(struct kvm_vcpu *vcpu,
2688
				  struct kvm_mmu_page *sp,
2689
				  u64 *spte,
2690
				  const void *new)
2691
{
2692
	if (sp->role.level != PT_PAGE_TABLE_LEVEL) {
2693 2694
		++vcpu->kvm->stat.mmu_pde_zapped;
		return;
2695
        }
2696

2697 2698 2699
	if (is_rsvd_bits_set(vcpu, *(u64 *)new, PT_PAGE_TABLE_LEVEL))
		return;

A
Avi Kivity 已提交
2700
	++vcpu->kvm->stat.mmu_pte_updated;
2701
	if (!sp->role.cr4_pae)
2702
		paging32_update_pte(vcpu, sp, spte, new);
2703
	else
2704
		paging64_update_pte(vcpu, sp, spte, new);
2705 2706
}

2707 2708 2709 2710 2711 2712 2713 2714 2715 2716 2717 2718 2719
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;
}

2720 2721
static void mmu_pte_write_flush_tlb(struct kvm_vcpu *vcpu, bool zap_page,
				    bool remote_flush, bool local_flush)
2722
{
2723 2724 2725 2726
	if (zap_page)
		return;

	if (remote_flush)
2727
		kvm_flush_remote_tlbs(vcpu->kvm);
2728
	else if (local_flush)
2729 2730 2731
		kvm_mmu_flush_tlb(vcpu);
}

2732 2733
static bool last_updated_pte_accessed(struct kvm_vcpu *vcpu)
{
2734
	u64 *spte = vcpu->arch.last_pte_updated;
2735

S
Sheng Yang 已提交
2736
	return !!(spte && (*spte & shadow_accessed_mask));
2737 2738
}

2739
static void mmu_guess_page_from_pte_write(struct kvm_vcpu *vcpu, gpa_t gpa,
2740
					  u64 gpte)
2741 2742
{
	gfn_t gfn;
2743
	pfn_t pfn;
2744

2745
	if (!is_present_gpte(gpte))
2746 2747
		return;
	gfn = (gpte & PT64_BASE_ADDR_MASK) >> PAGE_SHIFT;
2748

2749
	vcpu->arch.update_pte.mmu_seq = vcpu->kvm->mmu_notifier_seq;
2750
	smp_rmb();
2751
	pfn = gfn_to_pfn(vcpu->kvm, gfn);
2752

2753 2754
	if (is_error_pfn(pfn)) {
		kvm_release_pfn_clean(pfn);
2755 2756
		return;
	}
2757
	vcpu->arch.update_pte.gfn = gfn;
2758
	vcpu->arch.update_pte.pfn = pfn;
2759 2760
}

2761 2762 2763 2764 2765 2766 2767 2768 2769 2770 2771 2772
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);
}

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

	zap_page = remote_flush = local_flush = false;
2797

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

2800
	invlpg_counter = atomic_read(&vcpu->kvm->arch.invlpg_counter);
2801 2802 2803 2804 2805 2806 2807

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

	switch (bytes) {
	case 4:
		gentry = *(const u32 *)new;
		break;
	case 8:
		gentry = *(const u64 *)new;
		break;
	default:
		gentry = 0;
		break;
2830 2831 2832
	}

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

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

2920 2921
int kvm_mmu_unprotect_page_virt(struct kvm_vcpu *vcpu, gva_t gva)
{
2922 2923
	gpa_t gpa;
	int r;
2924

2925 2926 2927
	if (tdp_enabled)
		return 0;

2928
	gpa = kvm_mmu_gva_to_gpa_read(vcpu, gva, NULL);
2929

2930
	spin_lock(&vcpu->kvm->mmu_lock);
2931
	r = kvm_mmu_unprotect_page(vcpu->kvm, gpa >> PAGE_SHIFT);
2932
	spin_unlock(&vcpu->kvm->mmu_lock);
2933
	return r;
2934
}
2935
EXPORT_SYMBOL_GPL(kvm_mmu_unprotect_page_virt);
2936

2937
void __kvm_mmu_free_some_pages(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
2938
{
2939
	int free_pages;
2940
	LIST_HEAD(invalid_list);
2941 2942 2943

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

2947
		sp = container_of(vcpu->kvm->arch.active_mmu_pages.prev,
2948
				  struct kvm_mmu_page, link);
2949 2950
		free_pages += kvm_mmu_prepare_zap_page(vcpu->kvm, sp,
						       &invalid_list);
A
Avi Kivity 已提交
2951
		++vcpu->kvm->stat.mmu_recycled;
A
Avi Kivity 已提交
2952
	}
2953
	kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
A
Avi Kivity 已提交
2954 2955
}

2956 2957 2958 2959 2960
int kvm_mmu_page_fault(struct kvm_vcpu *vcpu, gva_t cr2, u32 error_code)
{
	int r;
	enum emulation_result er;

2961
	r = vcpu->arch.mmu.page_fault(vcpu, cr2, error_code);
2962 2963 2964 2965 2966 2967 2968 2969
	if (r < 0)
		goto out;

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

2970 2971 2972 2973
	r = mmu_topup_memory_caches(vcpu);
	if (r)
		goto out;

A
Avi Kivity 已提交
2974
	er = emulate_instruction(vcpu, cr2, error_code, 0);
2975 2976 2977 2978 2979 2980

	switch (er) {
	case EMULATE_DONE:
		return 1;
	case EMULATE_DO_MMIO:
		++vcpu->stat.mmio_exits;
2981
		/* fall through */
2982
	case EMULATE_FAIL:
2983
		return 0;
2984 2985 2986 2987 2988 2989 2990 2991
	default:
		BUG();
	}
out:
	return r;
}
EXPORT_SYMBOL_GPL(kvm_mmu_page_fault);

M
Marcelo Tosatti 已提交
2992 2993 2994 2995 2996 2997 2998 2999
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);

3000 3001 3002 3003 3004 3005
void kvm_enable_tdp(void)
{
	tdp_enabled = true;
}
EXPORT_SYMBOL_GPL(kvm_enable_tdp);

3006 3007 3008 3009 3010 3011
void kvm_disable_tdp(void)
{
	tdp_enabled = false;
}
EXPORT_SYMBOL_GPL(kvm_disable_tdp);

A
Avi Kivity 已提交
3012 3013
static void free_mmu_pages(struct kvm_vcpu *vcpu)
{
3014
	free_page((unsigned long)vcpu->arch.mmu.pae_root);
A
Avi Kivity 已提交
3015 3016 3017 3018
}

static int alloc_mmu_pages(struct kvm_vcpu *vcpu)
{
3019
	struct page *page;
A
Avi Kivity 已提交
3020 3021 3022 3023
	int i;

	ASSERT(vcpu);

3024 3025 3026 3027 3028 3029 3030
	/*
	 * 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)
3031 3032
		return -ENOMEM;

3033
	vcpu->arch.mmu.pae_root = page_address(page);
3034
	for (i = 0; i < 4; ++i)
3035
		vcpu->arch.mmu.pae_root[i] = INVALID_PAGE;
3036

A
Avi Kivity 已提交
3037 3038 3039
	return 0;
}

3040
int kvm_mmu_create(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
3041 3042
{
	ASSERT(vcpu);
3043
	ASSERT(!VALID_PAGE(vcpu->arch.mmu.root_hpa));
A
Avi Kivity 已提交
3044

3045 3046
	return alloc_mmu_pages(vcpu);
}
A
Avi Kivity 已提交
3047

3048 3049 3050
int kvm_mmu_setup(struct kvm_vcpu *vcpu)
{
	ASSERT(vcpu);
3051
	ASSERT(!VALID_PAGE(vcpu->arch.mmu.root_hpa));
3052

3053
	return init_kvm_mmu(vcpu);
A
Avi Kivity 已提交
3054 3055 3056 3057 3058 3059 3060 3061
}

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

	destroy_kvm_mmu(vcpu);
	free_mmu_pages(vcpu);
3062
	mmu_free_memory_caches(vcpu);
A
Avi Kivity 已提交
3063 3064
}

3065
void kvm_mmu_slot_remove_write_access(struct kvm *kvm, int slot)
A
Avi Kivity 已提交
3066
{
3067
	struct kvm_mmu_page *sp;
A
Avi Kivity 已提交
3068

3069
	list_for_each_entry(sp, &kvm->arch.active_mmu_pages, link) {
A
Avi Kivity 已提交
3070 3071 3072
		int i;
		u64 *pt;

3073
		if (!test_bit(slot, sp->slot_bitmap))
A
Avi Kivity 已提交
3074 3075
			continue;

3076
		pt = sp->spt;
A
Avi Kivity 已提交
3077 3078
		for (i = 0; i < PT64_ENT_PER_PAGE; ++i)
			/* avoid RMW */
3079
			if (is_writable_pte(pt[i]))
A
Avi Kivity 已提交
3080 3081
				pt[i] &= ~PT_WRITABLE_MASK;
	}
3082
	kvm_flush_remote_tlbs(kvm);
A
Avi Kivity 已提交
3083
}
3084

3085
void kvm_mmu_zap_all(struct kvm *kvm)
D
Dor Laor 已提交
3086
{
3087
	struct kvm_mmu_page *sp, *node;
3088
	LIST_HEAD(invalid_list);
D
Dor Laor 已提交
3089

3090
	spin_lock(&kvm->mmu_lock);
3091
restart:
3092
	list_for_each_entry_safe(sp, node, &kvm->arch.active_mmu_pages, link)
3093
		if (kvm_mmu_prepare_zap_page(kvm, sp, &invalid_list))
3094 3095
			goto restart;

3096
	kvm_mmu_commit_zap_page(kvm, &invalid_list);
3097
	spin_unlock(&kvm->mmu_lock);
D
Dor Laor 已提交
3098 3099
}

3100 3101
static int kvm_mmu_remove_some_alloc_mmu_pages(struct kvm *kvm,
					       struct list_head *invalid_list)
3102 3103 3104 3105 3106
{
	struct kvm_mmu_page *page;

	page = container_of(kvm->arch.active_mmu_pages.prev,
			    struct kvm_mmu_page, link);
3107
	return kvm_mmu_prepare_zap_page(kvm, page, invalid_list);
3108 3109
}

3110
static int mmu_shrink(struct shrinker *shrink, int nr_to_scan, gfp_t gfp_mask)
3111 3112 3113 3114 3115 3116 3117 3118
{
	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 已提交
3119
		int npages, idx, freed_pages;
3120
		LIST_HEAD(invalid_list);
3121

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

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

3162 3163 3164 3165 3166 3167
void kvm_mmu_module_exit(void)
{
	mmu_destroy_caches();
	unregister_shrinker(&mmu_shrinker);
}

3168 3169 3170 3171
int kvm_mmu_module_init(void)
{
	pte_chain_cache = kmem_cache_create("kvm_pte_chain",
					    sizeof(struct kvm_pte_chain),
3172
					    0, 0, NULL);
3173 3174 3175 3176
	if (!pte_chain_cache)
		goto nomem;
	rmap_desc_cache = kmem_cache_create("kvm_rmap_desc",
					    sizeof(struct kvm_rmap_desc),
3177
					    0, 0, NULL);
3178 3179 3180
	if (!rmap_desc_cache)
		goto nomem;

3181 3182
	mmu_page_header_cache = kmem_cache_create("kvm_mmu_page_header",
						  sizeof(struct kvm_mmu_page),
3183
						  0, 0, NULL);
3184 3185 3186
	if (!mmu_page_header_cache)
		goto nomem;

3187 3188
	register_shrinker(&mmu_shrinker);

3189 3190 3191
	return 0;

nomem:
3192
	mmu_destroy_caches();
3193 3194 3195
	return -ENOMEM;
}

3196 3197 3198 3199 3200 3201 3202 3203
/*
 * 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;
3204
	struct kvm_memslots *slots;
3205

3206 3207
	slots = kvm_memslots(kvm);

3208 3209
	for (i = 0; i < slots->nmemslots; i++)
		nr_pages += slots->memslots[i].npages;
3210 3211 3212 3213 3214 3215 3216 3217

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

3218 3219 3220 3221 3222 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
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;

3253
	if (!emulator_write_phys(vcpu, addr, &value, bytes))
3254 3255 3256 3257 3258 3259 3260
		return -EFAULT;

	return 1;
}

static int kvm_pv_mmu_flush_tlb(struct kvm_vcpu *vcpu)
{
3261
	(void)kvm_set_cr3(vcpu, vcpu->arch.cr3);
3262 3263 3264 3265 3266 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
	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;
3315
	struct kvm_pv_mmu_op_buffer *buffer = &vcpu->arch.mmu_op_buffer;
3316

3317 3318 3319
	buffer->ptr = buffer->buf;
	buffer->len = min_t(unsigned long, bytes, sizeof buffer->buf);
	buffer->processed = 0;
3320

3321
	r = kvm_read_guest(vcpu->kvm, addr, buffer->buf, buffer->len);
3322 3323 3324
	if (r)
		goto out;

3325 3326
	while (buffer->len) {
		r = kvm_pv_mmu_op_one(vcpu, buffer);
3327 3328 3329 3330 3331 3332 3333 3334
		if (r < 0)
			goto out;
		if (r == 0)
			break;
	}

	r = 1;
out:
3335
	*ret = buffer->processed;
3336 3337 3338
	return r;
}

3339 3340 3341 3342 3343 3344 3345 3346 3347 3348 3349 3350 3351 3352 3353 3354 3355 3356
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);

3357 3358 3359 3360 3361 3362 3363 3364 3365 3366 3367 3368
#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;
}

3369

3370
typedef void (*inspect_spte_fn) (struct kvm *kvm, u64 *sptep);
3371 3372 3373 3374 3375 3376 3377 3378 3379 3380

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

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

3416 3417 3418 3419 3420 3421 3422 3423 3424 3425
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];

3426
		if (ent == shadow_trap_nonpresent_pte)
3427 3428 3429
			continue;

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

3438 3439 3440 3441 3442
			if (is_error_pfn(pfn)) {
				kvm_release_pfn_clean(pfn);
				continue;
			}

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

3456 3457 3458 3459 3460 3461
		}
	}
}

static void audit_mappings(struct kvm_vcpu *vcpu)
{
3462
	unsigned i;
3463

3464 3465
	if (vcpu->arch.mmu.root_level == 4)
		audit_mappings_page(vcpu, vcpu->arch.mmu.root_hpa, 0, 4);
3466 3467
	else
		for (i = 0; i < 4; ++i)
3468
			if (vcpu->arch.mmu.pae_root[i] & PT_PRESENT_MASK)
3469
				audit_mappings_page(vcpu,
3470
						    vcpu->arch.mmu.pae_root[i],
3471 3472 3473 3474 3475 3476
						    i << 30,
						    2);
}

static int count_rmaps(struct kvm_vcpu *vcpu)
{
3477 3478
	struct kvm *kvm = vcpu->kvm;
	struct kvm_memslots *slots;
3479
	int nmaps = 0;
3480
	int i, j, k, idx;
3481

3482
	idx = srcu_read_lock(&kvm->srcu);
3483
	slots = kvm_memslots(kvm);
3484
	for (i = 0; i < KVM_MEMORY_SLOTS; ++i) {
3485
		struct kvm_memory_slot *m = &slots->memslots[i];
3486 3487 3488
		struct kvm_rmap_desc *d;

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

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

3512
void inspect_spte_has_rmap(struct kvm *kvm, u64 *sptep)
3513 3514 3515 3516 3517
{
	unsigned long *rmapp;
	struct kvm_mmu_page *rev_sp;
	gfn_t gfn;

3518
	if (is_writable_pte(*sptep)) {
3519
		rev_sp = page_header(__pa(sptep));
3520
		gfn = kvm_mmu_page_get_gfn(rev_sp, sptep - rev_sp->spt);
3521 3522 3523 3524 3525 3526 3527

		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",
3528
			       audit_msg, (long int)(sptep - rev_sp->spt),
3529 3530 3531 3532 3533
					rev_sp->gfn);
			dump_stack();
			return;
		}

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

3556
	list_for_each_entry(sp, &vcpu->kvm->arch.active_mmu_pages, link) {
3557
		u64 *pt = sp->spt;
3558

3559
		if (sp->role.level != PT_PAGE_TABLE_LEVEL)
3560 3561 3562 3563 3564 3565 3566
			continue;

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

			if (!(ent & PT_PRESENT_MASK))
				continue;
3567
			if (!is_writable_pte(ent))
3568
				continue;
3569
			inspect_spte_has_rmap(vcpu->kvm, &pt[i]);
3570 3571
		}
	}
3572
	return;
3573 3574 3575 3576
}

static void audit_rmap(struct kvm_vcpu *vcpu)
{
3577 3578
	check_writable_mappings_rmap(vcpu);
	count_rmaps(vcpu);
3579 3580 3581 3582
}

static void audit_write_protection(struct kvm_vcpu *vcpu)
{
3583
	struct kvm_mmu_page *sp;
3584 3585
	struct kvm_memory_slot *slot;
	unsigned long *rmapp;
3586
	u64 *spte;
3587
	gfn_t gfn;
3588

3589
	list_for_each_entry(sp, &vcpu->kvm->arch.active_mmu_pages, link) {
3590
		if (sp->role.direct)
3591
			continue;
3592 3593
		if (sp->unsync)
			continue;
3594

A
Avi Kivity 已提交
3595
		slot = gfn_to_memslot(vcpu->kvm, sp->gfn);
3596
		rmapp = &slot->rmap[gfn - slot->base_gfn];
3597 3598 3599

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

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);
3618 3619
	if (strcmp("pre pte write", audit_msg) != 0)
		audit_mappings(vcpu);
3620
	audit_writable_sptes_have_rmaps(vcpu);
3621 3622 3623 3624
	dbg = olddbg;
}

#endif