]> bbs.cooldavid.org Git - net-next-2.6.git/blob - arch/x86/kvm/mmu.c
36c62f33513fb2d0f534c5bf63bfa709ab40d8a2
[net-next-2.6.git] / arch / x86 / kvm / mmu.c
1 /*
2  * Kernel-based Virtual Machine driver for Linux
3  *
4  * This module enables machines with Intel VT-x extensions to run virtual
5  * machines without emulation or binary translation.
6  *
7  * MMU support
8  *
9  * Copyright (C) 2006 Qumranet, Inc.
10  * Copyright 2010 Red Hat, Inc. and/or its affilates.
11  *
12  * Authors:
13  *   Yaniv Kamay  <yaniv@qumranet.com>
14  *   Avi Kivity   <avi@qumranet.com>
15  *
16  * This work is licensed under the terms of the GNU GPL, version 2.  See
17  * the COPYING file in the top-level directory.
18  *
19  */
20
21 #include "mmu.h"
22 #include "x86.h"
23 #include "kvm_cache_regs.h"
24
25 #include <linux/kvm_host.h>
26 #include <linux/types.h>
27 #include <linux/string.h>
28 #include <linux/mm.h>
29 #include <linux/highmem.h>
30 #include <linux/module.h>
31 #include <linux/swap.h>
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>
37
38 #include <asm/page.h>
39 #include <asm/cmpxchg.h>
40 #include <asm/io.h>
41 #include <asm/vmx.h>
42
43 /*
44  * When setting this variable to true it enables Two-Dimensional-Paging
45  * where the hardware walks 2 page tables:
46  * 1. the guest-virtual to guest-physical
47  * 2. while doing 1. it walks guest-physical to host-physical
48  * If the hardware supports that we don't need to do shadow paging.
49  */
50 bool tdp_enabled = false;
51
52 #undef MMU_DEBUG
53
54 #undef AUDIT
55
56 #ifdef AUDIT
57 static void kvm_mmu_audit(struct kvm_vcpu *vcpu, const char *msg);
58 #else
59 static void kvm_mmu_audit(struct kvm_vcpu *vcpu, const char *msg) {}
60 #endif
61
62 #ifdef MMU_DEBUG
63
64 #define pgprintk(x...) do { if (dbg) printk(x); } while (0)
65 #define rmap_printk(x...) do { if (dbg) printk(x); } while (0)
66
67 #else
68
69 #define pgprintk(x...) do { } while (0)
70 #define rmap_printk(x...) do { } while (0)
71
72 #endif
73
74 #if defined(MMU_DEBUG) || defined(AUDIT)
75 static int dbg = 0;
76 module_param(dbg, bool, 0644);
77 #endif
78
79 static int oos_shadow = 1;
80 module_param(oos_shadow, bool, 0644);
81
82 #ifndef MMU_DEBUG
83 #define ASSERT(x) do { } while (0)
84 #else
85 #define ASSERT(x)                                                       \
86         if (!(x)) {                                                     \
87                 printk(KERN_WARNING "assertion failed %s:%d: %s\n",     \
88                        __FILE__, __LINE__, #x);                         \
89         }
90 #endif
91
92 #define PT_FIRST_AVAIL_BITS_SHIFT 9
93 #define PT64_SECOND_AVAIL_BITS_SHIFT 52
94
95 #define PT64_LEVEL_BITS 9
96
97 #define PT64_LEVEL_SHIFT(level) \
98                 (PAGE_SHIFT + (level - 1) * PT64_LEVEL_BITS)
99
100 #define PT64_LEVEL_MASK(level) \
101                 (((1ULL << PT64_LEVEL_BITS) - 1) << PT64_LEVEL_SHIFT(level))
102
103 #define PT64_INDEX(address, level)\
104         (((address) >> PT64_LEVEL_SHIFT(level)) & ((1 << PT64_LEVEL_BITS) - 1))
105
106
107 #define PT32_LEVEL_BITS 10
108
109 #define PT32_LEVEL_SHIFT(level) \
110                 (PAGE_SHIFT + (level - 1) * PT32_LEVEL_BITS)
111
112 #define PT32_LEVEL_MASK(level) \
113                 (((1ULL << PT32_LEVEL_BITS) - 1) << PT32_LEVEL_SHIFT(level))
114 #define PT32_LVL_OFFSET_MASK(level) \
115         (PT32_BASE_ADDR_MASK & ((1ULL << (PAGE_SHIFT + (((level) - 1) \
116                                                 * PT32_LEVEL_BITS))) - 1))
117
118 #define PT32_INDEX(address, level)\
119         (((address) >> PT32_LEVEL_SHIFT(level)) & ((1 << PT32_LEVEL_BITS) - 1))
120
121
122 #define PT64_BASE_ADDR_MASK (((1ULL << 52) - 1) & ~(u64)(PAGE_SIZE-1))
123 #define PT64_DIR_BASE_ADDR_MASK \
124         (PT64_BASE_ADDR_MASK & ~((1ULL << (PAGE_SHIFT + PT64_LEVEL_BITS)) - 1))
125 #define PT64_LVL_ADDR_MASK(level) \
126         (PT64_BASE_ADDR_MASK & ~((1ULL << (PAGE_SHIFT + (((level) - 1) \
127                                                 * PT64_LEVEL_BITS))) - 1))
128 #define PT64_LVL_OFFSET_MASK(level) \
129         (PT64_BASE_ADDR_MASK & ((1ULL << (PAGE_SHIFT + (((level) - 1) \
130                                                 * PT64_LEVEL_BITS))) - 1))
131
132 #define PT32_BASE_ADDR_MASK PAGE_MASK
133 #define PT32_DIR_BASE_ADDR_MASK \
134         (PAGE_MASK & ~((1ULL << (PAGE_SHIFT + PT32_LEVEL_BITS)) - 1))
135 #define PT32_LVL_ADDR_MASK(level) \
136         (PAGE_MASK & ~((1ULL << (PAGE_SHIFT + (((level) - 1) \
137                                             * PT32_LEVEL_BITS))) - 1))
138
139 #define PT64_PERM_MASK (PT_PRESENT_MASK | PT_WRITABLE_MASK | PT_USER_MASK \
140                         | PT64_NX_MASK)
141
142 #define RMAP_EXT 4
143
144 #define ACC_EXEC_MASK    1
145 #define ACC_WRITE_MASK   PT_WRITABLE_MASK
146 #define ACC_USER_MASK    PT_USER_MASK
147 #define ACC_ALL          (ACC_EXEC_MASK | ACC_WRITE_MASK | ACC_USER_MASK)
148
149 #include <trace/events/kvm.h>
150
151 #define CREATE_TRACE_POINTS
152 #include "mmutrace.h"
153
154 #define SPTE_HOST_WRITEABLE (1ULL << PT_FIRST_AVAIL_BITS_SHIFT)
155
156 #define SHADOW_PT_INDEX(addr, level) PT64_INDEX(addr, level)
157
158 struct kvm_rmap_desc {
159         u64 *sptes[RMAP_EXT];
160         struct kvm_rmap_desc *more;
161 };
162
163 struct kvm_shadow_walk_iterator {
164         u64 addr;
165         hpa_t shadow_addr;
166         int level;
167         u64 *sptep;
168         unsigned index;
169 };
170
171 #define for_each_shadow_entry(_vcpu, _addr, _walker)    \
172         for (shadow_walk_init(&(_walker), _vcpu, _addr);        \
173              shadow_walk_okay(&(_walker));                      \
174              shadow_walk_next(&(_walker)))
175
176 typedef void (*mmu_parent_walk_fn) (struct kvm_mmu_page *sp, u64 *spte);
177
178 static struct kmem_cache *pte_chain_cache;
179 static struct kmem_cache *rmap_desc_cache;
180 static struct kmem_cache *mmu_page_header_cache;
181
182 static u64 __read_mostly shadow_trap_nonpresent_pte;
183 static u64 __read_mostly shadow_notrap_nonpresent_pte;
184 static u64 __read_mostly shadow_base_present_pte;
185 static u64 __read_mostly shadow_nx_mask;
186 static u64 __read_mostly shadow_x_mask; /* mutual exclusive with nx_mask */
187 static u64 __read_mostly shadow_user_mask;
188 static u64 __read_mostly shadow_accessed_mask;
189 static u64 __read_mostly shadow_dirty_mask;
190
191 static inline u64 rsvd_bits(int s, int e)
192 {
193         return ((1ULL << (e - s + 1)) - 1) << s;
194 }
195
196 void kvm_mmu_set_nonpresent_ptes(u64 trap_pte, u64 notrap_pte)
197 {
198         shadow_trap_nonpresent_pte = trap_pte;
199         shadow_notrap_nonpresent_pte = notrap_pte;
200 }
201 EXPORT_SYMBOL_GPL(kvm_mmu_set_nonpresent_ptes);
202
203 void kvm_mmu_set_base_ptes(u64 base_pte)
204 {
205         shadow_base_present_pte = base_pte;
206 }
207 EXPORT_SYMBOL_GPL(kvm_mmu_set_base_ptes);
208
209 void kvm_mmu_set_mask_ptes(u64 user_mask, u64 accessed_mask,
210                 u64 dirty_mask, u64 nx_mask, u64 x_mask)
211 {
212         shadow_user_mask = user_mask;
213         shadow_accessed_mask = accessed_mask;
214         shadow_dirty_mask = dirty_mask;
215         shadow_nx_mask = nx_mask;
216         shadow_x_mask = x_mask;
217 }
218 EXPORT_SYMBOL_GPL(kvm_mmu_set_mask_ptes);
219
220 static bool is_write_protection(struct kvm_vcpu *vcpu)
221 {
222         return kvm_read_cr0_bits(vcpu, X86_CR0_WP);
223 }
224
225 static int is_cpuid_PSE36(void)
226 {
227         return 1;
228 }
229
230 static int is_nx(struct kvm_vcpu *vcpu)
231 {
232         return vcpu->arch.efer & EFER_NX;
233 }
234
235 static int is_shadow_present_pte(u64 pte)
236 {
237         return pte != shadow_trap_nonpresent_pte
238                 && pte != shadow_notrap_nonpresent_pte;
239 }
240
241 static int is_large_pte(u64 pte)
242 {
243         return pte & PT_PAGE_SIZE_MASK;
244 }
245
246 static int is_writable_pte(unsigned long pte)
247 {
248         return pte & PT_WRITABLE_MASK;
249 }
250
251 static int is_dirty_gpte(unsigned long pte)
252 {
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 static int is_last_spte(u64 pte, int level)
262 {
263         if (level == PT_PAGE_TABLE_LEVEL)
264                 return 1;
265         if (is_large_pte(pte))
266                 return 1;
267         return 0;
268 }
269
270 static pfn_t spte_to_pfn(u64 pte)
271 {
272         return (pte & PT64_BASE_ADDR_MASK) >> PAGE_SHIFT;
273 }
274
275 static gfn_t pse36_gfn_delta(u32 gpte)
276 {
277         int shift = 32 - PT32_DIR_PSE36_SHIFT - PAGE_SHIFT;
278
279         return (gpte & PT32_DIR_PSE36_MASK) << shift;
280 }
281
282 static void __set_spte(u64 *sptep, u64 spte)
283 {
284 #ifdef CONFIG_X86_64
285         set_64bit((unsigned long *)sptep, spte);
286 #else
287         set_64bit((unsigned long long *)sptep, spte);
288 #endif
289 }
290
291 static u64 __xchg_spte(u64 *sptep, u64 new_spte)
292 {
293 #ifdef CONFIG_X86_64
294         return xchg(sptep, new_spte);
295 #else
296         u64 old_spte;
297
298         do {
299                 old_spte = *sptep;
300         } while (cmpxchg64(sptep, old_spte, new_spte) != old_spte);
301
302         return old_spte;
303 #endif
304 }
305
306 static void update_spte(u64 *sptep, u64 new_spte)
307 {
308         u64 old_spte;
309
310         if (!shadow_accessed_mask || (new_spte & shadow_accessed_mask)) {
311                 __set_spte(sptep, new_spte);
312         } else {
313                 old_spte = __xchg_spte(sptep, new_spte);
314                 if (old_spte & shadow_accessed_mask)
315                         mark_page_accessed(pfn_to_page(spte_to_pfn(old_spte)));
316         }
317 }
318
319 static int mmu_topup_memory_cache(struct kvm_mmu_memory_cache *cache,
320                                   struct kmem_cache *base_cache, int min)
321 {
322         void *obj;
323
324         if (cache->nobjs >= min)
325                 return 0;
326         while (cache->nobjs < ARRAY_SIZE(cache->objects)) {
327                 obj = kmem_cache_zalloc(base_cache, GFP_KERNEL);
328                 if (!obj)
329                         return -ENOMEM;
330                 cache->objects[cache->nobjs++] = obj;
331         }
332         return 0;
333 }
334
335 static void mmu_free_memory_cache(struct kvm_mmu_memory_cache *mc,
336                                   struct kmem_cache *cache)
337 {
338         while (mc->nobjs)
339                 kmem_cache_free(cache, mc->objects[--mc->nobjs]);
340 }
341
342 static int mmu_topup_memory_cache_page(struct kvm_mmu_memory_cache *cache,
343                                        int min)
344 {
345         struct page *page;
346
347         if (cache->nobjs >= min)
348                 return 0;
349         while (cache->nobjs < ARRAY_SIZE(cache->objects)) {
350                 page = alloc_page(GFP_KERNEL);
351                 if (!page)
352                         return -ENOMEM;
353                 cache->objects[cache->nobjs++] = page_address(page);
354         }
355         return 0;
356 }
357
358 static void mmu_free_memory_cache_page(struct kvm_mmu_memory_cache *mc)
359 {
360         while (mc->nobjs)
361                 free_page((unsigned long)mc->objects[--mc->nobjs]);
362 }
363
364 static int mmu_topup_memory_caches(struct kvm_vcpu *vcpu)
365 {
366         int r;
367
368         r = mmu_topup_memory_cache(&vcpu->arch.mmu_pte_chain_cache,
369                                    pte_chain_cache, 4);
370         if (r)
371                 goto out;
372         r = mmu_topup_memory_cache(&vcpu->arch.mmu_rmap_desc_cache,
373                                    rmap_desc_cache, 4);
374         if (r)
375                 goto out;
376         r = mmu_topup_memory_cache_page(&vcpu->arch.mmu_page_cache, 8);
377         if (r)
378                 goto out;
379         r = mmu_topup_memory_cache(&vcpu->arch.mmu_page_header_cache,
380                                    mmu_page_header_cache, 4);
381 out:
382         return r;
383 }
384
385 static void mmu_free_memory_caches(struct kvm_vcpu *vcpu)
386 {
387         mmu_free_memory_cache(&vcpu->arch.mmu_pte_chain_cache, pte_chain_cache);
388         mmu_free_memory_cache(&vcpu->arch.mmu_rmap_desc_cache, rmap_desc_cache);
389         mmu_free_memory_cache_page(&vcpu->arch.mmu_page_cache);
390         mmu_free_memory_cache(&vcpu->arch.mmu_page_header_cache,
391                                 mmu_page_header_cache);
392 }
393
394 static void *mmu_memory_cache_alloc(struct kvm_mmu_memory_cache *mc,
395                                     size_t size)
396 {
397         void *p;
398
399         BUG_ON(!mc->nobjs);
400         p = mc->objects[--mc->nobjs];
401         return p;
402 }
403
404 static struct kvm_pte_chain *mmu_alloc_pte_chain(struct kvm_vcpu *vcpu)
405 {
406         return mmu_memory_cache_alloc(&vcpu->arch.mmu_pte_chain_cache,
407                                       sizeof(struct kvm_pte_chain));
408 }
409
410 static void mmu_free_pte_chain(struct kvm_pte_chain *pc)
411 {
412         kmem_cache_free(pte_chain_cache, pc);
413 }
414
415 static struct kvm_rmap_desc *mmu_alloc_rmap_desc(struct kvm_vcpu *vcpu)
416 {
417         return mmu_memory_cache_alloc(&vcpu->arch.mmu_rmap_desc_cache,
418                                       sizeof(struct kvm_rmap_desc));
419 }
420
421 static void mmu_free_rmap_desc(struct kvm_rmap_desc *rd)
422 {
423         kmem_cache_free(rmap_desc_cache, rd);
424 }
425
426 static gfn_t kvm_mmu_page_get_gfn(struct kvm_mmu_page *sp, int index)
427 {
428         if (!sp->role.direct)
429                 return sp->gfns[index];
430
431         return sp->gfn + (index << ((sp->role.level - 1) * PT64_LEVEL_BITS));
432 }
433
434 static void kvm_mmu_page_set_gfn(struct kvm_mmu_page *sp, int index, gfn_t gfn)
435 {
436         if (sp->role.direct)
437                 BUG_ON(gfn != kvm_mmu_page_get_gfn(sp, index));
438         else
439                 sp->gfns[index] = gfn;
440 }
441
442 /*
443  * Return the pointer to the largepage write count for a given
444  * gfn, handling slots that are not large page aligned.
445  */
446 static int *slot_largepage_idx(gfn_t gfn,
447                                struct kvm_memory_slot *slot,
448                                int level)
449 {
450         unsigned long idx;
451
452         idx = (gfn >> KVM_HPAGE_GFN_SHIFT(level)) -
453               (slot->base_gfn >> KVM_HPAGE_GFN_SHIFT(level));
454         return &slot->lpage_info[level - 2][idx].write_count;
455 }
456
457 static void account_shadowed(struct kvm *kvm, gfn_t gfn)
458 {
459         struct kvm_memory_slot *slot;
460         int *write_count;
461         int i;
462
463         slot = gfn_to_memslot(kvm, gfn);
464         for (i = PT_DIRECTORY_LEVEL;
465              i < PT_PAGE_TABLE_LEVEL + KVM_NR_PAGE_SIZES; ++i) {
466                 write_count   = slot_largepage_idx(gfn, slot, i);
467                 *write_count += 1;
468         }
469 }
470
471 static void unaccount_shadowed(struct kvm *kvm, gfn_t gfn)
472 {
473         struct kvm_memory_slot *slot;
474         int *write_count;
475         int i;
476
477         slot = gfn_to_memslot(kvm, gfn);
478         for (i = PT_DIRECTORY_LEVEL;
479              i < PT_PAGE_TABLE_LEVEL + KVM_NR_PAGE_SIZES; ++i) {
480                 write_count   = slot_largepage_idx(gfn, slot, i);
481                 *write_count -= 1;
482                 WARN_ON(*write_count < 0);
483         }
484 }
485
486 static int has_wrprotected_page(struct kvm *kvm,
487                                 gfn_t gfn,
488                                 int level)
489 {
490         struct kvm_memory_slot *slot;
491         int *largepage_idx;
492
493         slot = gfn_to_memslot(kvm, gfn);
494         if (slot) {
495                 largepage_idx = slot_largepage_idx(gfn, slot, level);
496                 return *largepage_idx;
497         }
498
499         return 1;
500 }
501
502 static int host_mapping_level(struct kvm *kvm, gfn_t gfn)
503 {
504         unsigned long page_size;
505         int i, ret = 0;
506
507         page_size = kvm_host_page_size(kvm, gfn);
508
509         for (i = PT_PAGE_TABLE_LEVEL;
510              i < (PT_PAGE_TABLE_LEVEL + KVM_NR_PAGE_SIZES); ++i) {
511                 if (page_size >= KVM_HPAGE_SIZE(i))
512                         ret = i;
513                 else
514                         break;
515         }
516
517         return ret;
518 }
519
520 static int mapping_level(struct kvm_vcpu *vcpu, gfn_t large_gfn)
521 {
522         struct kvm_memory_slot *slot;
523         int host_level, level, max_level;
524
525         slot = gfn_to_memslot(vcpu->kvm, large_gfn);
526         if (slot && slot->dirty_bitmap)
527                 return PT_PAGE_TABLE_LEVEL;
528
529         host_level = host_mapping_level(vcpu->kvm, large_gfn);
530
531         if (host_level == PT_PAGE_TABLE_LEVEL)
532                 return host_level;
533
534         max_level = kvm_x86_ops->get_lpage_level() < host_level ?
535                 kvm_x86_ops->get_lpage_level() : host_level;
536
537         for (level = PT_DIRECTORY_LEVEL; level <= max_level; ++level)
538                 if (has_wrprotected_page(vcpu->kvm, large_gfn, level))
539                         break;
540
541         return level - 1;
542 }
543
544 /*
545  * Take gfn and return the reverse mapping to it.
546  */
547
548 static unsigned long *gfn_to_rmap(struct kvm *kvm, gfn_t gfn, int level)
549 {
550         struct kvm_memory_slot *slot;
551         unsigned long idx;
552
553         slot = gfn_to_memslot(kvm, gfn);
554         if (likely(level == PT_PAGE_TABLE_LEVEL))
555                 return &slot->rmap[gfn - slot->base_gfn];
556
557         idx = (gfn >> KVM_HPAGE_GFN_SHIFT(level)) -
558                 (slot->base_gfn >> KVM_HPAGE_GFN_SHIFT(level));
559
560         return &slot->lpage_info[level - 2][idx].rmap_pde;
561 }
562
563 /*
564  * Reverse mapping data structures:
565  *
566  * If rmapp bit zero is zero, then rmapp point to the shadw page table entry
567  * that points to page_address(page).
568  *
569  * If rmapp bit zero is one, (then rmap & ~1) points to a struct kvm_rmap_desc
570  * containing more mappings.
571  *
572  * Returns the number of rmap entries before the spte was added or zero if
573  * the spte was not added.
574  *
575  */
576 static int rmap_add(struct kvm_vcpu *vcpu, u64 *spte, gfn_t gfn)
577 {
578         struct kvm_mmu_page *sp;
579         struct kvm_rmap_desc *desc;
580         unsigned long *rmapp;
581         int i, count = 0;
582
583         if (!is_rmap_spte(*spte))
584                 return count;
585         sp = page_header(__pa(spte));
586         kvm_mmu_page_set_gfn(sp, spte - sp->spt, gfn);
587         rmapp = gfn_to_rmap(vcpu->kvm, gfn, sp->role.level);
588         if (!*rmapp) {
589                 rmap_printk("rmap_add: %p %llx 0->1\n", spte, *spte);
590                 *rmapp = (unsigned long)spte;
591         } else if (!(*rmapp & 1)) {
592                 rmap_printk("rmap_add: %p %llx 1->many\n", spte, *spte);
593                 desc = mmu_alloc_rmap_desc(vcpu);
594                 desc->sptes[0] = (u64 *)*rmapp;
595                 desc->sptes[1] = spte;
596                 *rmapp = (unsigned long)desc | 1;
597         } else {
598                 rmap_printk("rmap_add: %p %llx many->many\n", spte, *spte);
599                 desc = (struct kvm_rmap_desc *)(*rmapp & ~1ul);
600                 while (desc->sptes[RMAP_EXT-1] && desc->more) {
601                         desc = desc->more;
602                         count += RMAP_EXT;
603                 }
604                 if (desc->sptes[RMAP_EXT-1]) {
605                         desc->more = mmu_alloc_rmap_desc(vcpu);
606                         desc = desc->more;
607                 }
608                 for (i = 0; desc->sptes[i]; ++i)
609                         ;
610                 desc->sptes[i] = spte;
611         }
612         return count;
613 }
614
615 static void rmap_desc_remove_entry(unsigned long *rmapp,
616                                    struct kvm_rmap_desc *desc,
617                                    int i,
618                                    struct kvm_rmap_desc *prev_desc)
619 {
620         int j;
621
622         for (j = RMAP_EXT - 1; !desc->sptes[j] && j > i; --j)
623                 ;
624         desc->sptes[i] = desc->sptes[j];
625         desc->sptes[j] = NULL;
626         if (j != 0)
627                 return;
628         if (!prev_desc && !desc->more)
629                 *rmapp = (unsigned long)desc->sptes[0];
630         else
631                 if (prev_desc)
632                         prev_desc->more = desc->more;
633                 else
634                         *rmapp = (unsigned long)desc->more | 1;
635         mmu_free_rmap_desc(desc);
636 }
637
638 static void rmap_remove(struct kvm *kvm, u64 *spte)
639 {
640         struct kvm_rmap_desc *desc;
641         struct kvm_rmap_desc *prev_desc;
642         struct kvm_mmu_page *sp;
643         gfn_t gfn;
644         unsigned long *rmapp;
645         int i;
646
647         sp = page_header(__pa(spte));
648         gfn = kvm_mmu_page_get_gfn(sp, spte - sp->spt);
649         rmapp = gfn_to_rmap(kvm, gfn, sp->role.level);
650         if (!*rmapp) {
651                 printk(KERN_ERR "rmap_remove: %p %llx 0->BUG\n", spte, *spte);
652                 BUG();
653         } else if (!(*rmapp & 1)) {
654                 rmap_printk("rmap_remove:  %p %llx 1->0\n", spte, *spte);
655                 if ((u64 *)*rmapp != spte) {
656                         printk(KERN_ERR "rmap_remove:  %p %llx 1->BUG\n",
657                                spte, *spte);
658                         BUG();
659                 }
660                 *rmapp = 0;
661         } else {
662                 rmap_printk("rmap_remove:  %p %llx many->many\n", spte, *spte);
663                 desc = (struct kvm_rmap_desc *)(*rmapp & ~1ul);
664                 prev_desc = NULL;
665                 while (desc) {
666                         for (i = 0; i < RMAP_EXT && desc->sptes[i]; ++i)
667                                 if (desc->sptes[i] == spte) {
668                                         rmap_desc_remove_entry(rmapp,
669                                                                desc, i,
670                                                                prev_desc);
671                                         return;
672                                 }
673                         prev_desc = desc;
674                         desc = desc->more;
675                 }
676                 pr_err("rmap_remove: %p %llx many->many\n", spte, *spte);
677                 BUG();
678         }
679 }
680
681 static void drop_spte(struct kvm *kvm, u64 *sptep, u64 new_spte)
682 {
683         pfn_t pfn;
684         u64 old_spte;
685
686         old_spte = __xchg_spte(sptep, new_spte);
687         if (!is_rmap_spte(old_spte))
688                 return;
689         pfn = spte_to_pfn(old_spte);
690         if (old_spte & shadow_accessed_mask)
691                 kvm_set_pfn_accessed(pfn);
692         if (is_writable_pte(old_spte))
693                 kvm_set_pfn_dirty(pfn);
694         rmap_remove(kvm, sptep);
695 }
696
697 static u64 *rmap_next(struct kvm *kvm, unsigned long *rmapp, u64 *spte)
698 {
699         struct kvm_rmap_desc *desc;
700         u64 *prev_spte;
701         int i;
702
703         if (!*rmapp)
704                 return NULL;
705         else if (!(*rmapp & 1)) {
706                 if (!spte)
707                         return (u64 *)*rmapp;
708                 return NULL;
709         }
710         desc = (struct kvm_rmap_desc *)(*rmapp & ~1ul);
711         prev_spte = NULL;
712         while (desc) {
713                 for (i = 0; i < RMAP_EXT && desc->sptes[i]; ++i) {
714                         if (prev_spte == spte)
715                                 return desc->sptes[i];
716                         prev_spte = desc->sptes[i];
717                 }
718                 desc = desc->more;
719         }
720         return NULL;
721 }
722
723 static int rmap_write_protect(struct kvm *kvm, u64 gfn)
724 {
725         unsigned long *rmapp;
726         u64 *spte;
727         int i, write_protected = 0;
728
729         rmapp = gfn_to_rmap(kvm, gfn, PT_PAGE_TABLE_LEVEL);
730
731         spte = rmap_next(kvm, rmapp, NULL);
732         while (spte) {
733                 BUG_ON(!spte);
734                 BUG_ON(!(*spte & PT_PRESENT_MASK));
735                 rmap_printk("rmap_write_protect: spte %p %llx\n", spte, *spte);
736                 if (is_writable_pte(*spte)) {
737                         update_spte(spte, *spte & ~PT_WRITABLE_MASK);
738                         write_protected = 1;
739                 }
740                 spte = rmap_next(kvm, rmapp, spte);
741         }
742         if (write_protected) {
743                 pfn_t pfn;
744
745                 spte = rmap_next(kvm, rmapp, NULL);
746                 pfn = spte_to_pfn(*spte);
747                 kvm_set_pfn_dirty(pfn);
748         }
749
750         /* check for huge page mappings */
751         for (i = PT_DIRECTORY_LEVEL;
752              i < PT_PAGE_TABLE_LEVEL + KVM_NR_PAGE_SIZES; ++i) {
753                 rmapp = gfn_to_rmap(kvm, gfn, i);
754                 spte = rmap_next(kvm, rmapp, NULL);
755                 while (spte) {
756                         BUG_ON(!spte);
757                         BUG_ON(!(*spte & PT_PRESENT_MASK));
758                         BUG_ON((*spte & (PT_PAGE_SIZE_MASK|PT_PRESENT_MASK)) != (PT_PAGE_SIZE_MASK|PT_PRESENT_MASK));
759                         pgprintk("rmap_write_protect(large): spte %p %llx %lld\n", spte, *spte, gfn);
760                         if (is_writable_pte(*spte)) {
761                                 drop_spte(kvm, spte,
762                                           shadow_trap_nonpresent_pte);
763                                 --kvm->stat.lpages;
764                                 spte = NULL;
765                                 write_protected = 1;
766                         }
767                         spte = rmap_next(kvm, rmapp, spte);
768                 }
769         }
770
771         return write_protected;
772 }
773
774 static int kvm_unmap_rmapp(struct kvm *kvm, unsigned long *rmapp,
775                            unsigned long data)
776 {
777         u64 *spte;
778         int need_tlb_flush = 0;
779
780         while ((spte = rmap_next(kvm, rmapp, NULL))) {
781                 BUG_ON(!(*spte & PT_PRESENT_MASK));
782                 rmap_printk("kvm_rmap_unmap_hva: spte %p %llx\n", spte, *spte);
783                 drop_spte(kvm, spte, shadow_trap_nonpresent_pte);
784                 need_tlb_flush = 1;
785         }
786         return need_tlb_flush;
787 }
788
789 static int kvm_set_pte_rmapp(struct kvm *kvm, unsigned long *rmapp,
790                              unsigned long data)
791 {
792         int need_flush = 0;
793         u64 *spte, new_spte, old_spte;
794         pte_t *ptep = (pte_t *)data;
795         pfn_t new_pfn;
796
797         WARN_ON(pte_huge(*ptep));
798         new_pfn = pte_pfn(*ptep);
799         spte = rmap_next(kvm, rmapp, NULL);
800         while (spte) {
801                 BUG_ON(!is_shadow_present_pte(*spte));
802                 rmap_printk("kvm_set_pte_rmapp: spte %p %llx\n", spte, *spte);
803                 need_flush = 1;
804                 if (pte_write(*ptep)) {
805                         drop_spte(kvm, spte, shadow_trap_nonpresent_pte);
806                         spte = rmap_next(kvm, rmapp, NULL);
807                 } else {
808                         new_spte = *spte &~ (PT64_BASE_ADDR_MASK);
809                         new_spte |= (u64)new_pfn << PAGE_SHIFT;
810
811                         new_spte &= ~PT_WRITABLE_MASK;
812                         new_spte &= ~SPTE_HOST_WRITEABLE;
813                         new_spte &= ~shadow_accessed_mask;
814                         if (is_writable_pte(*spte))
815                                 kvm_set_pfn_dirty(spte_to_pfn(*spte));
816                         old_spte = __xchg_spte(spte, new_spte);
817                         if (is_shadow_present_pte(old_spte)
818                             && (old_spte & shadow_accessed_mask))
819                                 mark_page_accessed(pfn_to_page(spte_to_pfn(old_spte)));
820                         spte = rmap_next(kvm, rmapp, spte);
821                 }
822         }
823         if (need_flush)
824                 kvm_flush_remote_tlbs(kvm);
825
826         return 0;
827 }
828
829 static int kvm_handle_hva(struct kvm *kvm, unsigned long hva,
830                           unsigned long data,
831                           int (*handler)(struct kvm *kvm, unsigned long *rmapp,
832                                          unsigned long data))
833 {
834         int i, j;
835         int ret;
836         int retval = 0;
837         struct kvm_memslots *slots;
838
839         slots = kvm_memslots(kvm);
840
841         for (i = 0; i < slots->nmemslots; i++) {
842                 struct kvm_memory_slot *memslot = &slots->memslots[i];
843                 unsigned long start = memslot->userspace_addr;
844                 unsigned long end;
845
846                 end = start + (memslot->npages << PAGE_SHIFT);
847                 if (hva >= start && hva < end) {
848                         gfn_t gfn_offset = (hva - start) >> PAGE_SHIFT;
849
850                         ret = handler(kvm, &memslot->rmap[gfn_offset], data);
851
852                         for (j = 0; j < KVM_NR_PAGE_SIZES - 1; ++j) {
853                                 int idx = gfn_offset;
854                                 idx /= KVM_PAGES_PER_HPAGE(PT_DIRECTORY_LEVEL + j);
855                                 ret |= handler(kvm,
856                                         &memslot->lpage_info[j][idx].rmap_pde,
857                                         data);
858                         }
859                         trace_kvm_age_page(hva, memslot, ret);
860                         retval |= ret;
861                 }
862         }
863
864         return retval;
865 }
866
867 int kvm_unmap_hva(struct kvm *kvm, unsigned long hva)
868 {
869         return kvm_handle_hva(kvm, hva, 0, kvm_unmap_rmapp);
870 }
871
872 void kvm_set_spte_hva(struct kvm *kvm, unsigned long hva, pte_t pte)
873 {
874         kvm_handle_hva(kvm, hva, (unsigned long)&pte, kvm_set_pte_rmapp);
875 }
876
877 static int kvm_age_rmapp(struct kvm *kvm, unsigned long *rmapp,
878                          unsigned long data)
879 {
880         u64 *spte;
881         int young = 0;
882
883         /*
884          * Emulate the accessed bit for EPT, by checking if this page has
885          * an EPT mapping, and clearing it if it does. On the next access,
886          * a new EPT mapping will be established.
887          * This has some overhead, but not as much as the cost of swapping
888          * out actively used pages or breaking up actively used hugepages.
889          */
890         if (!shadow_accessed_mask)
891                 return kvm_unmap_rmapp(kvm, rmapp, data);
892
893         spte = rmap_next(kvm, rmapp, NULL);
894         while (spte) {
895                 int _young;
896                 u64 _spte = *spte;
897                 BUG_ON(!(_spte & PT_PRESENT_MASK));
898                 _young = _spte & PT_ACCESSED_MASK;
899                 if (_young) {
900                         young = 1;
901                         clear_bit(PT_ACCESSED_SHIFT, (unsigned long *)spte);
902                 }
903                 spte = rmap_next(kvm, rmapp, spte);
904         }
905         return young;
906 }
907
908 #define RMAP_RECYCLE_THRESHOLD 1000
909
910 static void rmap_recycle(struct kvm_vcpu *vcpu, u64 *spte, gfn_t gfn)
911 {
912         unsigned long *rmapp;
913         struct kvm_mmu_page *sp;
914
915         sp = page_header(__pa(spte));
916
917         rmapp = gfn_to_rmap(vcpu->kvm, gfn, sp->role.level);
918
919         kvm_unmap_rmapp(vcpu->kvm, rmapp, 0);
920         kvm_flush_remote_tlbs(vcpu->kvm);
921 }
922
923 int kvm_age_hva(struct kvm *kvm, unsigned long hva)
924 {
925         return kvm_handle_hva(kvm, hva, 0, kvm_age_rmapp);
926 }
927
928 #ifdef MMU_DEBUG
929 static int is_empty_shadow_page(u64 *spt)
930 {
931         u64 *pos;
932         u64 *end;
933
934         for (pos = spt, end = pos + PAGE_SIZE / sizeof(u64); pos != end; pos++)
935                 if (is_shadow_present_pte(*pos)) {
936                         printk(KERN_ERR "%s: %p %llx\n", __func__,
937                                pos, *pos);
938                         return 0;
939                 }
940         return 1;
941 }
942 #endif
943
944 static void kvm_mmu_free_page(struct kvm *kvm, struct kvm_mmu_page *sp)
945 {
946         ASSERT(is_empty_shadow_page(sp->spt));
947         hlist_del(&sp->hash_link);
948         list_del(&sp->link);
949         __free_page(virt_to_page(sp->spt));
950         if (!sp->role.direct)
951                 __free_page(virt_to_page(sp->gfns));
952         kmem_cache_free(mmu_page_header_cache, sp);
953         ++kvm->arch.n_free_mmu_pages;
954 }
955
956 static unsigned kvm_page_table_hashfn(gfn_t gfn)
957 {
958         return gfn & ((1 << KVM_MMU_HASH_SHIFT) - 1);
959 }
960
961 static struct kvm_mmu_page *kvm_mmu_alloc_page(struct kvm_vcpu *vcpu,
962                                                u64 *parent_pte, int direct)
963 {
964         struct kvm_mmu_page *sp;
965
966         sp = mmu_memory_cache_alloc(&vcpu->arch.mmu_page_header_cache, sizeof *sp);
967         sp->spt = mmu_memory_cache_alloc(&vcpu->arch.mmu_page_cache, PAGE_SIZE);
968         if (!direct)
969                 sp->gfns = mmu_memory_cache_alloc(&vcpu->arch.mmu_page_cache,
970                                                   PAGE_SIZE);
971         set_page_private(virt_to_page(sp->spt), (unsigned long)sp);
972         list_add(&sp->link, &vcpu->kvm->arch.active_mmu_pages);
973         bitmap_zero(sp->slot_bitmap, KVM_MEMORY_SLOTS + KVM_PRIVATE_MEM_SLOTS);
974         sp->multimapped = 0;
975         sp->parent_pte = parent_pte;
976         --vcpu->kvm->arch.n_free_mmu_pages;
977         return sp;
978 }
979
980 static void mmu_page_add_parent_pte(struct kvm_vcpu *vcpu,
981                                     struct kvm_mmu_page *sp, u64 *parent_pte)
982 {
983         struct kvm_pte_chain *pte_chain;
984         struct hlist_node *node;
985         int i;
986
987         if (!parent_pte)
988                 return;
989         if (!sp->multimapped) {
990                 u64 *old = sp->parent_pte;
991
992                 if (!old) {
993                         sp->parent_pte = parent_pte;
994                         return;
995                 }
996                 sp->multimapped = 1;
997                 pte_chain = mmu_alloc_pte_chain(vcpu);
998                 INIT_HLIST_HEAD(&sp->parent_ptes);
999                 hlist_add_head(&pte_chain->link, &sp->parent_ptes);
1000                 pte_chain->parent_ptes[0] = old;
1001         }
1002         hlist_for_each_entry(pte_chain, node, &sp->parent_ptes, link) {
1003                 if (pte_chain->parent_ptes[NR_PTE_CHAIN_ENTRIES-1])
1004                         continue;
1005                 for (i = 0; i < NR_PTE_CHAIN_ENTRIES; ++i)
1006                         if (!pte_chain->parent_ptes[i]) {
1007                                 pte_chain->parent_ptes[i] = parent_pte;
1008                                 return;
1009                         }
1010         }
1011         pte_chain = mmu_alloc_pte_chain(vcpu);
1012         BUG_ON(!pte_chain);
1013         hlist_add_head(&pte_chain->link, &sp->parent_ptes);
1014         pte_chain->parent_ptes[0] = parent_pte;
1015 }
1016
1017 static void mmu_page_remove_parent_pte(struct kvm_mmu_page *sp,
1018                                        u64 *parent_pte)
1019 {
1020         struct kvm_pte_chain *pte_chain;
1021         struct hlist_node *node;
1022         int i;
1023
1024         if (!sp->multimapped) {
1025                 BUG_ON(sp->parent_pte != parent_pte);
1026                 sp->parent_pte = NULL;
1027                 return;
1028         }
1029         hlist_for_each_entry(pte_chain, node, &sp->parent_ptes, link)
1030                 for (i = 0; i < NR_PTE_CHAIN_ENTRIES; ++i) {
1031                         if (!pte_chain->parent_ptes[i])
1032                                 break;
1033                         if (pte_chain->parent_ptes[i] != parent_pte)
1034                                 continue;
1035                         while (i + 1 < NR_PTE_CHAIN_ENTRIES
1036                                 && pte_chain->parent_ptes[i + 1]) {
1037                                 pte_chain->parent_ptes[i]
1038                                         = pte_chain->parent_ptes[i + 1];
1039                                 ++i;
1040                         }
1041                         pte_chain->parent_ptes[i] = NULL;
1042                         if (i == 0) {
1043                                 hlist_del(&pte_chain->link);
1044                                 mmu_free_pte_chain(pte_chain);
1045                                 if (hlist_empty(&sp->parent_ptes)) {
1046                                         sp->multimapped = 0;
1047                                         sp->parent_pte = NULL;
1048                                 }
1049                         }
1050                         return;
1051                 }
1052         BUG();
1053 }
1054
1055 static void mmu_parent_walk(struct kvm_mmu_page *sp, mmu_parent_walk_fn fn)
1056 {
1057         struct kvm_pte_chain *pte_chain;
1058         struct hlist_node *node;
1059         struct kvm_mmu_page *parent_sp;
1060         int i;
1061
1062         if (!sp->multimapped && sp->parent_pte) {
1063                 parent_sp = page_header(__pa(sp->parent_pte));
1064                 fn(parent_sp, sp->parent_pte);
1065                 return;
1066         }
1067
1068         hlist_for_each_entry(pte_chain, node, &sp->parent_ptes, link)
1069                 for (i = 0; i < NR_PTE_CHAIN_ENTRIES; ++i) {
1070                         u64 *spte = pte_chain->parent_ptes[i];
1071
1072                         if (!spte)
1073                                 break;
1074                         parent_sp = page_header(__pa(spte));
1075                         fn(parent_sp, spte);
1076                 }
1077 }
1078
1079 static void mark_unsync(struct kvm_mmu_page *sp, u64 *spte);
1080 static void kvm_mmu_mark_parents_unsync(struct kvm_mmu_page *sp)
1081 {
1082         mmu_parent_walk(sp, mark_unsync);
1083 }
1084
1085 static void mark_unsync(struct kvm_mmu_page *sp, u64 *spte)
1086 {
1087         unsigned int index;
1088
1089         index = spte - sp->spt;
1090         if (__test_and_set_bit(index, sp->unsync_child_bitmap))
1091                 return;
1092         if (sp->unsync_children++)
1093                 return;
1094         kvm_mmu_mark_parents_unsync(sp);
1095 }
1096
1097 static void nonpaging_prefetch_page(struct kvm_vcpu *vcpu,
1098                                     struct kvm_mmu_page *sp)
1099 {
1100         int i;
1101
1102         for (i = 0; i < PT64_ENT_PER_PAGE; ++i)
1103                 sp->spt[i] = shadow_trap_nonpresent_pte;
1104 }
1105
1106 static int nonpaging_sync_page(struct kvm_vcpu *vcpu,
1107                                struct kvm_mmu_page *sp, bool clear_unsync)
1108 {
1109         return 1;
1110 }
1111
1112 static void nonpaging_invlpg(struct kvm_vcpu *vcpu, gva_t gva)
1113 {
1114 }
1115
1116 #define KVM_PAGE_ARRAY_NR 16
1117
1118 struct kvm_mmu_pages {
1119         struct mmu_page_and_offset {
1120                 struct kvm_mmu_page *sp;
1121                 unsigned int idx;
1122         } page[KVM_PAGE_ARRAY_NR];
1123         unsigned int nr;
1124 };
1125
1126 #define for_each_unsync_children(bitmap, idx)           \
1127         for (idx = find_first_bit(bitmap, 512);         \
1128              idx < 512;                                 \
1129              idx = find_next_bit(bitmap, 512, idx+1))
1130
1131 static int mmu_pages_add(struct kvm_mmu_pages *pvec, struct kvm_mmu_page *sp,
1132                          int idx)
1133 {
1134         int i;
1135
1136         if (sp->unsync)
1137                 for (i=0; i < pvec->nr; i++)
1138                         if (pvec->page[i].sp == sp)
1139                                 return 0;
1140
1141         pvec->page[pvec->nr].sp = sp;
1142         pvec->page[pvec->nr].idx = idx;
1143         pvec->nr++;
1144         return (pvec->nr == KVM_PAGE_ARRAY_NR);
1145 }
1146
1147 static int __mmu_unsync_walk(struct kvm_mmu_page *sp,
1148                            struct kvm_mmu_pages *pvec)
1149 {
1150         int i, ret, nr_unsync_leaf = 0;
1151
1152         for_each_unsync_children(sp->unsync_child_bitmap, i) {
1153                 struct kvm_mmu_page *child;
1154                 u64 ent = sp->spt[i];
1155
1156                 if (!is_shadow_present_pte(ent) || is_large_pte(ent))
1157                         goto clear_child_bitmap;
1158
1159                 child = page_header(ent & PT64_BASE_ADDR_MASK);
1160
1161                 if (child->unsync_children) {
1162                         if (mmu_pages_add(pvec, child, i))
1163                                 return -ENOSPC;
1164
1165                         ret = __mmu_unsync_walk(child, pvec);
1166                         if (!ret)
1167                                 goto clear_child_bitmap;
1168                         else if (ret > 0)
1169                                 nr_unsync_leaf += ret;
1170                         else
1171                                 return ret;
1172                 } else if (child->unsync) {
1173                         nr_unsync_leaf++;
1174                         if (mmu_pages_add(pvec, child, i))
1175                                 return -ENOSPC;
1176                 } else
1177                          goto clear_child_bitmap;
1178
1179                 continue;
1180
1181 clear_child_bitmap:
1182                 __clear_bit(i, sp->unsync_child_bitmap);
1183                 sp->unsync_children--;
1184                 WARN_ON((int)sp->unsync_children < 0);
1185         }
1186
1187
1188         return nr_unsync_leaf;
1189 }
1190
1191 static int mmu_unsync_walk(struct kvm_mmu_page *sp,
1192                            struct kvm_mmu_pages *pvec)
1193 {
1194         if (!sp->unsync_children)
1195                 return 0;
1196
1197         mmu_pages_add(pvec, sp, 0);
1198         return __mmu_unsync_walk(sp, pvec);
1199 }
1200
1201 static void kvm_unlink_unsync_page(struct kvm *kvm, struct kvm_mmu_page *sp)
1202 {
1203         WARN_ON(!sp->unsync);
1204         trace_kvm_mmu_sync_page(sp);
1205         sp->unsync = 0;
1206         --kvm->stat.mmu_unsync;
1207 }
1208
1209 static int kvm_mmu_prepare_zap_page(struct kvm *kvm, struct kvm_mmu_page *sp,
1210                                     struct list_head *invalid_list);
1211 static void kvm_mmu_commit_zap_page(struct kvm *kvm,
1212                                     struct list_head *invalid_list);
1213
1214 #define for_each_gfn_sp(kvm, sp, gfn, pos)                              \
1215   hlist_for_each_entry(sp, pos,                                         \
1216    &(kvm)->arch.mmu_page_hash[kvm_page_table_hashfn(gfn)], hash_link)   \
1217         if ((sp)->gfn != (gfn)) {} else
1218
1219 #define for_each_gfn_indirect_valid_sp(kvm, sp, gfn, pos)               \
1220   hlist_for_each_entry(sp, pos,                                         \
1221    &(kvm)->arch.mmu_page_hash[kvm_page_table_hashfn(gfn)], hash_link)   \
1222                 if ((sp)->gfn != (gfn) || (sp)->role.direct ||          \
1223                         (sp)->role.invalid) {} else
1224
1225 /* @sp->gfn should be write-protected at the call site */
1226 static int __kvm_sync_page(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp,
1227                            struct list_head *invalid_list, bool clear_unsync)
1228 {
1229         if (sp->role.cr4_pae != !!is_pae(vcpu)) {
1230                 kvm_mmu_prepare_zap_page(vcpu->kvm, sp, invalid_list);
1231                 return 1;
1232         }
1233
1234         if (clear_unsync)
1235                 kvm_unlink_unsync_page(vcpu->kvm, sp);
1236
1237         if (vcpu->arch.mmu.sync_page(vcpu, sp, clear_unsync)) {
1238                 kvm_mmu_prepare_zap_page(vcpu->kvm, sp, invalid_list);
1239                 return 1;
1240         }
1241
1242         kvm_mmu_flush_tlb(vcpu);
1243         return 0;
1244 }
1245
1246 static int kvm_sync_page_transient(struct kvm_vcpu *vcpu,
1247                                    struct kvm_mmu_page *sp)
1248 {
1249         LIST_HEAD(invalid_list);
1250         int ret;
1251
1252         ret = __kvm_sync_page(vcpu, sp, &invalid_list, false);
1253         if (ret)
1254                 kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
1255
1256         return ret;
1257 }
1258
1259 static int kvm_sync_page(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp,
1260                          struct list_head *invalid_list)
1261 {
1262         return __kvm_sync_page(vcpu, sp, invalid_list, true);
1263 }
1264
1265 /* @gfn should be write-protected at the call site */
1266 static void kvm_sync_pages(struct kvm_vcpu *vcpu,  gfn_t gfn)
1267 {
1268         struct kvm_mmu_page *s;
1269         struct hlist_node *node;
1270         LIST_HEAD(invalid_list);
1271         bool flush = false;
1272
1273         for_each_gfn_indirect_valid_sp(vcpu->kvm, s, gfn, node) {
1274                 if (!s->unsync)
1275                         continue;
1276
1277                 WARN_ON(s->role.level != PT_PAGE_TABLE_LEVEL);
1278                 if ((s->role.cr4_pae != !!is_pae(vcpu)) ||
1279                         (vcpu->arch.mmu.sync_page(vcpu, s, true))) {
1280                         kvm_mmu_prepare_zap_page(vcpu->kvm, s, &invalid_list);
1281                         continue;
1282                 }
1283                 kvm_unlink_unsync_page(vcpu->kvm, s);
1284                 flush = true;
1285         }
1286
1287         kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
1288         if (flush)
1289                 kvm_mmu_flush_tlb(vcpu);
1290 }
1291
1292 struct mmu_page_path {
1293         struct kvm_mmu_page *parent[PT64_ROOT_LEVEL-1];
1294         unsigned int idx[PT64_ROOT_LEVEL-1];
1295 };
1296
1297 #define for_each_sp(pvec, sp, parents, i)                       \
1298                 for (i = mmu_pages_next(&pvec, &parents, -1),   \
1299                         sp = pvec.page[i].sp;                   \
1300                         i < pvec.nr && ({ sp = pvec.page[i].sp; 1;});   \
1301                         i = mmu_pages_next(&pvec, &parents, i))
1302
1303 static int mmu_pages_next(struct kvm_mmu_pages *pvec,
1304                           struct mmu_page_path *parents,
1305                           int i)
1306 {
1307         int n;
1308
1309         for (n = i+1; n < pvec->nr; n++) {
1310                 struct kvm_mmu_page *sp = pvec->page[n].sp;
1311
1312                 if (sp->role.level == PT_PAGE_TABLE_LEVEL) {
1313                         parents->idx[0] = pvec->page[n].idx;
1314                         return n;
1315                 }
1316
1317                 parents->parent[sp->role.level-2] = sp;
1318                 parents->idx[sp->role.level-1] = pvec->page[n].idx;
1319         }
1320
1321         return n;
1322 }
1323
1324 static void mmu_pages_clear_parents(struct mmu_page_path *parents)
1325 {
1326         struct kvm_mmu_page *sp;
1327         unsigned int level = 0;
1328
1329         do {
1330                 unsigned int idx = parents->idx[level];
1331
1332                 sp = parents->parent[level];
1333                 if (!sp)
1334                         return;
1335
1336                 --sp->unsync_children;
1337                 WARN_ON((int)sp->unsync_children < 0);
1338                 __clear_bit(idx, sp->unsync_child_bitmap);
1339                 level++;
1340         } while (level < PT64_ROOT_LEVEL-1 && !sp->unsync_children);
1341 }
1342
1343 static void kvm_mmu_pages_init(struct kvm_mmu_page *parent,
1344                                struct mmu_page_path *parents,
1345                                struct kvm_mmu_pages *pvec)
1346 {
1347         parents->parent[parent->role.level-1] = NULL;
1348         pvec->nr = 0;
1349 }
1350
1351 static void mmu_sync_children(struct kvm_vcpu *vcpu,
1352                               struct kvm_mmu_page *parent)
1353 {
1354         int i;
1355         struct kvm_mmu_page *sp;
1356         struct mmu_page_path parents;
1357         struct kvm_mmu_pages pages;
1358         LIST_HEAD(invalid_list);
1359
1360         kvm_mmu_pages_init(parent, &parents, &pages);
1361         while (mmu_unsync_walk(parent, &pages)) {
1362                 int protected = 0;
1363
1364                 for_each_sp(pages, sp, parents, i)
1365                         protected |= rmap_write_protect(vcpu->kvm, sp->gfn);
1366
1367                 if (protected)
1368                         kvm_flush_remote_tlbs(vcpu->kvm);
1369
1370                 for_each_sp(pages, sp, parents, i) {
1371                         kvm_sync_page(vcpu, sp, &invalid_list);
1372                         mmu_pages_clear_parents(&parents);
1373                 }
1374                 kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
1375                 cond_resched_lock(&vcpu->kvm->mmu_lock);
1376                 kvm_mmu_pages_init(parent, &parents, &pages);
1377         }
1378 }
1379
1380 static struct kvm_mmu_page *kvm_mmu_get_page(struct kvm_vcpu *vcpu,
1381                                              gfn_t gfn,
1382                                              gva_t gaddr,
1383                                              unsigned level,
1384                                              int direct,
1385                                              unsigned access,
1386                                              u64 *parent_pte)
1387 {
1388         union kvm_mmu_page_role role;
1389         unsigned quadrant;
1390         struct kvm_mmu_page *sp;
1391         struct hlist_node *node;
1392         bool need_sync = false;
1393
1394         role = vcpu->arch.mmu.base_role;
1395         role.level = level;
1396         role.direct = direct;
1397         if (role.direct)
1398                 role.cr4_pae = 0;
1399         role.access = access;
1400         if (!tdp_enabled && vcpu->arch.mmu.root_level <= PT32_ROOT_LEVEL) {
1401                 quadrant = gaddr >> (PAGE_SHIFT + (PT64_PT_BITS * level));
1402                 quadrant &= (1 << ((PT32_PT_BITS - PT64_PT_BITS) * level)) - 1;
1403                 role.quadrant = quadrant;
1404         }
1405         for_each_gfn_sp(vcpu->kvm, sp, gfn, node) {
1406                 if (!need_sync && sp->unsync)
1407                         need_sync = true;
1408
1409                 if (sp->role.word != role.word)
1410                         continue;
1411
1412                 if (sp->unsync && kvm_sync_page_transient(vcpu, sp))
1413                         break;
1414
1415                 mmu_page_add_parent_pte(vcpu, sp, parent_pte);
1416                 if (sp->unsync_children) {
1417                         kvm_make_request(KVM_REQ_MMU_SYNC, vcpu);
1418                         kvm_mmu_mark_parents_unsync(sp);
1419                 } else if (sp->unsync)
1420                         kvm_mmu_mark_parents_unsync(sp);
1421
1422                 trace_kvm_mmu_get_page(sp, false);
1423                 return sp;
1424         }
1425         ++vcpu->kvm->stat.mmu_cache_miss;
1426         sp = kvm_mmu_alloc_page(vcpu, parent_pte, direct);
1427         if (!sp)
1428                 return sp;
1429         sp->gfn = gfn;
1430         sp->role = role;
1431         hlist_add_head(&sp->hash_link,
1432                 &vcpu->kvm->arch.mmu_page_hash[kvm_page_table_hashfn(gfn)]);
1433         if (!direct) {
1434                 if (rmap_write_protect(vcpu->kvm, gfn))
1435                         kvm_flush_remote_tlbs(vcpu->kvm);
1436                 if (level > PT_PAGE_TABLE_LEVEL && need_sync)
1437                         kvm_sync_pages(vcpu, gfn);
1438
1439                 account_shadowed(vcpu->kvm, gfn);
1440         }
1441         if (shadow_trap_nonpresent_pte != shadow_notrap_nonpresent_pte)
1442                 vcpu->arch.mmu.prefetch_page(vcpu, sp);
1443         else
1444                 nonpaging_prefetch_page(vcpu, sp);
1445         trace_kvm_mmu_get_page(sp, true);
1446         return sp;
1447 }
1448
1449 static void shadow_walk_init(struct kvm_shadow_walk_iterator *iterator,
1450                              struct kvm_vcpu *vcpu, u64 addr)
1451 {
1452         iterator->addr = addr;
1453         iterator->shadow_addr = vcpu->arch.mmu.root_hpa;
1454         iterator->level = vcpu->arch.mmu.shadow_root_level;
1455         if (iterator->level == PT32E_ROOT_LEVEL) {
1456                 iterator->shadow_addr
1457                         = vcpu->arch.mmu.pae_root[(addr >> 30) & 3];
1458                 iterator->shadow_addr &= PT64_BASE_ADDR_MASK;
1459                 --iterator->level;
1460                 if (!iterator->shadow_addr)
1461                         iterator->level = 0;
1462         }
1463 }
1464
1465 static bool shadow_walk_okay(struct kvm_shadow_walk_iterator *iterator)
1466 {
1467         if (iterator->level < PT_PAGE_TABLE_LEVEL)
1468                 return false;
1469
1470         if (iterator->level == PT_PAGE_TABLE_LEVEL)
1471                 if (is_large_pte(*iterator->sptep))
1472                         return false;
1473
1474         iterator->index = SHADOW_PT_INDEX(iterator->addr, iterator->level);
1475         iterator->sptep = ((u64 *)__va(iterator->shadow_addr)) + iterator->index;
1476         return true;
1477 }
1478
1479 static void shadow_walk_next(struct kvm_shadow_walk_iterator *iterator)
1480 {
1481         iterator->shadow_addr = *iterator->sptep & PT64_BASE_ADDR_MASK;
1482         --iterator->level;
1483 }
1484
1485 static void link_shadow_page(u64 *sptep, struct kvm_mmu_page *sp)
1486 {
1487         u64 spte;
1488
1489         spte = __pa(sp->spt)
1490                 | PT_PRESENT_MASK | PT_ACCESSED_MASK
1491                 | PT_WRITABLE_MASK | PT_USER_MASK;
1492         __set_spte(sptep, spte);
1493 }
1494
1495 static void drop_large_spte(struct kvm_vcpu *vcpu, u64 *sptep)
1496 {
1497         if (is_large_pte(*sptep)) {
1498                 drop_spte(vcpu->kvm, sptep, shadow_trap_nonpresent_pte);
1499                 kvm_flush_remote_tlbs(vcpu->kvm);
1500         }
1501 }
1502
1503 static void validate_direct_spte(struct kvm_vcpu *vcpu, u64 *sptep,
1504                                    unsigned direct_access)
1505 {
1506         if (is_shadow_present_pte(*sptep) && !is_large_pte(*sptep)) {
1507                 struct kvm_mmu_page *child;
1508
1509                 /*
1510                  * For the direct sp, if the guest pte's dirty bit
1511                  * changed form clean to dirty, it will corrupt the
1512                  * sp's access: allow writable in the read-only sp,
1513                  * so we should update the spte at this point to get
1514                  * a new sp with the correct access.
1515                  */
1516                 child = page_header(*sptep & PT64_BASE_ADDR_MASK);
1517                 if (child->role.access == direct_access)
1518                         return;
1519
1520                 mmu_page_remove_parent_pte(child, sptep);
1521                 __set_spte(sptep, shadow_trap_nonpresent_pte);
1522                 kvm_flush_remote_tlbs(vcpu->kvm);
1523         }
1524 }
1525
1526 static void kvm_mmu_page_unlink_children(struct kvm *kvm,
1527                                          struct kvm_mmu_page *sp)
1528 {
1529         unsigned i;
1530         u64 *pt;
1531         u64 ent;
1532
1533         pt = sp->spt;
1534
1535         for (i = 0; i < PT64_ENT_PER_PAGE; ++i) {
1536                 ent = pt[i];
1537
1538                 if (is_shadow_present_pte(ent)) {
1539                         if (!is_last_spte(ent, sp->role.level)) {
1540                                 ent &= PT64_BASE_ADDR_MASK;
1541                                 mmu_page_remove_parent_pte(page_header(ent),
1542                                                            &pt[i]);
1543                         } else {
1544                                 if (is_large_pte(ent))
1545                                         --kvm->stat.lpages;
1546                                 drop_spte(kvm, &pt[i],
1547                                           shadow_trap_nonpresent_pte);
1548                         }
1549                 }
1550                 pt[i] = shadow_trap_nonpresent_pte;
1551         }
1552 }
1553
1554 static void kvm_mmu_put_page(struct kvm_mmu_page *sp, u64 *parent_pte)
1555 {
1556         mmu_page_remove_parent_pte(sp, parent_pte);
1557 }
1558
1559 static void kvm_mmu_reset_last_pte_updated(struct kvm *kvm)
1560 {
1561         int i;
1562         struct kvm_vcpu *vcpu;
1563
1564         kvm_for_each_vcpu(i, vcpu, kvm)
1565                 vcpu->arch.last_pte_updated = NULL;
1566 }
1567
1568 static void kvm_mmu_unlink_parents(struct kvm *kvm, struct kvm_mmu_page *sp)
1569 {
1570         u64 *parent_pte;
1571
1572         while (sp->multimapped || sp->parent_pte) {
1573                 if (!sp->multimapped)
1574                         parent_pte = sp->parent_pte;
1575                 else {
1576                         struct kvm_pte_chain *chain;
1577
1578                         chain = container_of(sp->parent_ptes.first,
1579                                              struct kvm_pte_chain, link);
1580                         parent_pte = chain->parent_ptes[0];
1581                 }
1582                 BUG_ON(!parent_pte);
1583                 kvm_mmu_put_page(sp, parent_pte);
1584                 __set_spte(parent_pte, shadow_trap_nonpresent_pte);
1585         }
1586 }
1587
1588 static int mmu_zap_unsync_children(struct kvm *kvm,
1589                                    struct kvm_mmu_page *parent,
1590                                    struct list_head *invalid_list)
1591 {
1592         int i, zapped = 0;
1593         struct mmu_page_path parents;
1594         struct kvm_mmu_pages pages;
1595
1596         if (parent->role.level == PT_PAGE_TABLE_LEVEL)
1597                 return 0;
1598
1599         kvm_mmu_pages_init(parent, &parents, &pages);
1600         while (mmu_unsync_walk(parent, &pages)) {
1601                 struct kvm_mmu_page *sp;
1602
1603                 for_each_sp(pages, sp, parents, i) {
1604                         kvm_mmu_prepare_zap_page(kvm, sp, invalid_list);
1605                         mmu_pages_clear_parents(&parents);
1606                         zapped++;
1607                 }
1608                 kvm_mmu_pages_init(parent, &parents, &pages);
1609         }
1610
1611         return zapped;
1612 }
1613
1614 static int kvm_mmu_prepare_zap_page(struct kvm *kvm, struct kvm_mmu_page *sp,
1615                                     struct list_head *invalid_list)
1616 {
1617         int ret;
1618
1619         trace_kvm_mmu_prepare_zap_page(sp);
1620         ++kvm->stat.mmu_shadow_zapped;
1621         ret = mmu_zap_unsync_children(kvm, sp, invalid_list);
1622         kvm_mmu_page_unlink_children(kvm, sp);
1623         kvm_mmu_unlink_parents(kvm, sp);
1624         if (!sp->role.invalid && !sp->role.direct)
1625                 unaccount_shadowed(kvm, sp->gfn);
1626         if (sp->unsync)
1627                 kvm_unlink_unsync_page(kvm, sp);
1628         if (!sp->root_count) {
1629                 /* Count self */
1630                 ret++;
1631                 list_move(&sp->link, invalid_list);
1632         } else {
1633                 list_move(&sp->link, &kvm->arch.active_mmu_pages);
1634                 kvm_reload_remote_mmus(kvm);
1635         }
1636
1637         sp->role.invalid = 1;
1638         kvm_mmu_reset_last_pte_updated(kvm);
1639         return ret;
1640 }
1641
1642 static void kvm_mmu_commit_zap_page(struct kvm *kvm,
1643                                     struct list_head *invalid_list)
1644 {
1645         struct kvm_mmu_page *sp;
1646
1647         if (list_empty(invalid_list))
1648                 return;
1649
1650         kvm_flush_remote_tlbs(kvm);
1651
1652         do {
1653                 sp = list_first_entry(invalid_list, struct kvm_mmu_page, link);
1654                 WARN_ON(!sp->role.invalid || sp->root_count);
1655                 kvm_mmu_free_page(kvm, sp);
1656         } while (!list_empty(invalid_list));
1657
1658 }
1659
1660 /*
1661  * Changing the number of mmu pages allocated to the vm
1662  * Note: if kvm_nr_mmu_pages is too small, you will get dead lock
1663  */
1664 void kvm_mmu_change_mmu_pages(struct kvm *kvm, unsigned int kvm_nr_mmu_pages)
1665 {
1666         int used_pages;
1667         LIST_HEAD(invalid_list);
1668
1669         used_pages = kvm->arch.n_alloc_mmu_pages - kvm->arch.n_free_mmu_pages;
1670         used_pages = max(0, used_pages);
1671
1672         /*
1673          * If we set the number of mmu pages to be smaller be than the
1674          * number of actived pages , we must to free some mmu pages before we
1675          * change the value
1676          */
1677
1678         if (used_pages > kvm_nr_mmu_pages) {
1679                 while (used_pages > kvm_nr_mmu_pages &&
1680                         !list_empty(&kvm->arch.active_mmu_pages)) {
1681                         struct kvm_mmu_page *page;
1682
1683                         page = container_of(kvm->arch.active_mmu_pages.prev,
1684                                             struct kvm_mmu_page, link);
1685                         used_pages -= kvm_mmu_prepare_zap_page(kvm, page,
1686                                                                &invalid_list);
1687                 }
1688                 kvm_mmu_commit_zap_page(kvm, &invalid_list);
1689                 kvm_nr_mmu_pages = used_pages;
1690                 kvm->arch.n_free_mmu_pages = 0;
1691         }
1692         else
1693                 kvm->arch.n_free_mmu_pages += kvm_nr_mmu_pages
1694                                          - kvm->arch.n_alloc_mmu_pages;
1695
1696         kvm->arch.n_alloc_mmu_pages = kvm_nr_mmu_pages;
1697 }
1698
1699 static int kvm_mmu_unprotect_page(struct kvm *kvm, gfn_t gfn)
1700 {
1701         struct kvm_mmu_page *sp;
1702         struct hlist_node *node;
1703         LIST_HEAD(invalid_list);
1704         int r;
1705
1706         pgprintk("%s: looking for gfn %lx\n", __func__, gfn);
1707         r = 0;
1708
1709         for_each_gfn_indirect_valid_sp(kvm, sp, gfn, node) {
1710                 pgprintk("%s: gfn %lx role %x\n", __func__, gfn,
1711                          sp->role.word);
1712                 r = 1;
1713                 kvm_mmu_prepare_zap_page(kvm, sp, &invalid_list);
1714         }
1715         kvm_mmu_commit_zap_page(kvm, &invalid_list);
1716         return r;
1717 }
1718
1719 static void mmu_unshadow(struct kvm *kvm, gfn_t gfn)
1720 {
1721         struct kvm_mmu_page *sp;
1722         struct hlist_node *node;
1723         LIST_HEAD(invalid_list);
1724
1725         for_each_gfn_indirect_valid_sp(kvm, sp, gfn, node) {
1726                 pgprintk("%s: zap %lx %x\n",
1727                          __func__, gfn, sp->role.word);
1728                 kvm_mmu_prepare_zap_page(kvm, sp, &invalid_list);
1729         }
1730         kvm_mmu_commit_zap_page(kvm, &invalid_list);
1731 }
1732
1733 static void page_header_update_slot(struct kvm *kvm, void *pte, gfn_t gfn)
1734 {
1735         int slot = memslot_id(kvm, gfn);
1736         struct kvm_mmu_page *sp = page_header(__pa(pte));
1737
1738         __set_bit(slot, sp->slot_bitmap);
1739 }
1740
1741 static void mmu_convert_notrap(struct kvm_mmu_page *sp)
1742 {
1743         int i;
1744         u64 *pt = sp->spt;
1745
1746         if (shadow_trap_nonpresent_pte == shadow_notrap_nonpresent_pte)
1747                 return;
1748
1749         for (i = 0; i < PT64_ENT_PER_PAGE; ++i) {
1750                 if (pt[i] == shadow_notrap_nonpresent_pte)
1751                         __set_spte(&pt[i], shadow_trap_nonpresent_pte);
1752         }
1753 }
1754
1755 /*
1756  * The function is based on mtrr_type_lookup() in
1757  * arch/x86/kernel/cpu/mtrr/generic.c
1758  */
1759 static int get_mtrr_type(struct mtrr_state_type *mtrr_state,
1760                          u64 start, u64 end)
1761 {
1762         int i;
1763         u64 base, mask;
1764         u8 prev_match, curr_match;
1765         int num_var_ranges = KVM_NR_VAR_MTRR;
1766
1767         if (!mtrr_state->enabled)
1768                 return 0xFF;
1769
1770         /* Make end inclusive end, instead of exclusive */
1771         end--;
1772
1773         /* Look in fixed ranges. Just return the type as per start */
1774         if (mtrr_state->have_fixed && (start < 0x100000)) {
1775                 int idx;
1776
1777                 if (start < 0x80000) {
1778                         idx = 0;
1779                         idx += (start >> 16);
1780                         return mtrr_state->fixed_ranges[idx];
1781                 } else if (start < 0xC0000) {
1782                         idx = 1 * 8;
1783                         idx += ((start - 0x80000) >> 14);
1784                         return mtrr_state->fixed_ranges[idx];
1785                 } else if (start < 0x1000000) {
1786                         idx = 3 * 8;
1787                         idx += ((start - 0xC0000) >> 12);
1788                         return mtrr_state->fixed_ranges[idx];
1789                 }
1790         }
1791
1792         /*
1793          * Look in variable ranges
1794          * Look of multiple ranges matching this address and pick type
1795          * as per MTRR precedence
1796          */
1797         if (!(mtrr_state->enabled & 2))
1798                 return mtrr_state->def_type;
1799
1800         prev_match = 0xFF;
1801         for (i = 0; i < num_var_ranges; ++i) {
1802                 unsigned short start_state, end_state;
1803
1804                 if (!(mtrr_state->var_ranges[i].mask_lo & (1 << 11)))
1805                         continue;
1806
1807                 base = (((u64)mtrr_state->var_ranges[i].base_hi) << 32) +
1808                        (mtrr_state->var_ranges[i].base_lo & PAGE_MASK);
1809                 mask = (((u64)mtrr_state->var_ranges[i].mask_hi) << 32) +
1810                        (mtrr_state->var_ranges[i].mask_lo & PAGE_MASK);
1811
1812                 start_state = ((start & mask) == (base & mask));
1813                 end_state = ((end & mask) == (base & mask));
1814                 if (start_state != end_state)
1815                         return 0xFE;
1816
1817                 if ((start & mask) != (base & mask))
1818                         continue;
1819
1820                 curr_match = mtrr_state->var_ranges[i].base_lo & 0xff;
1821                 if (prev_match == 0xFF) {
1822                         prev_match = curr_match;
1823                         continue;
1824                 }
1825
1826                 if (prev_match == MTRR_TYPE_UNCACHABLE ||
1827                     curr_match == MTRR_TYPE_UNCACHABLE)
1828                         return MTRR_TYPE_UNCACHABLE;
1829
1830                 if ((prev_match == MTRR_TYPE_WRBACK &&
1831                      curr_match == MTRR_TYPE_WRTHROUGH) ||
1832                     (prev_match == MTRR_TYPE_WRTHROUGH &&
1833                      curr_match == MTRR_TYPE_WRBACK)) {
1834                         prev_match = MTRR_TYPE_WRTHROUGH;
1835                         curr_match = MTRR_TYPE_WRTHROUGH;
1836                 }
1837
1838                 if (prev_match != curr_match)
1839                         return MTRR_TYPE_UNCACHABLE;
1840         }
1841
1842         if (prev_match != 0xFF)
1843                 return prev_match;
1844
1845         return mtrr_state->def_type;
1846 }
1847
1848 u8 kvm_get_guest_memory_type(struct kvm_vcpu *vcpu, gfn_t gfn)
1849 {
1850         u8 mtrr;
1851
1852         mtrr = get_mtrr_type(&vcpu->arch.mtrr_state, gfn << PAGE_SHIFT,
1853                              (gfn << PAGE_SHIFT) + PAGE_SIZE);
1854         if (mtrr == 0xfe || mtrr == 0xff)
1855                 mtrr = MTRR_TYPE_WRBACK;
1856         return mtrr;
1857 }
1858 EXPORT_SYMBOL_GPL(kvm_get_guest_memory_type);
1859
1860 static void __kvm_unsync_page(struct kvm_vcpu *vcpu, struct kvm_mmu_page *sp)
1861 {
1862         trace_kvm_mmu_unsync_page(sp);
1863         ++vcpu->kvm->stat.mmu_unsync;
1864         sp->unsync = 1;
1865
1866         kvm_mmu_mark_parents_unsync(sp);
1867         mmu_convert_notrap(sp);
1868 }
1869
1870 static void kvm_unsync_pages(struct kvm_vcpu *vcpu,  gfn_t gfn)
1871 {
1872         struct kvm_mmu_page *s;
1873         struct hlist_node *node;
1874
1875         for_each_gfn_indirect_valid_sp(vcpu->kvm, s, gfn, node) {
1876                 if (s->unsync)
1877                         continue;
1878                 WARN_ON(s->role.level != PT_PAGE_TABLE_LEVEL);
1879                 __kvm_unsync_page(vcpu, s);
1880         }
1881 }
1882
1883 static int mmu_need_write_protect(struct kvm_vcpu *vcpu, gfn_t gfn,
1884                                   bool can_unsync)
1885 {
1886         struct kvm_mmu_page *s;
1887         struct hlist_node *node;
1888         bool need_unsync = false;
1889
1890         for_each_gfn_indirect_valid_sp(vcpu->kvm, s, gfn, node) {
1891                 if (!can_unsync)
1892                         return 1;
1893
1894                 if (s->role.level != PT_PAGE_TABLE_LEVEL)
1895                         return 1;
1896
1897                 if (!need_unsync && !s->unsync) {
1898                         if (!oos_shadow)
1899                                 return 1;
1900                         need_unsync = true;
1901                 }
1902         }
1903         if (need_unsync)
1904                 kvm_unsync_pages(vcpu, gfn);
1905         return 0;
1906 }
1907
1908 static int set_spte(struct kvm_vcpu *vcpu, u64 *sptep,
1909                     unsigned pte_access, int user_fault,
1910                     int write_fault, int dirty, int level,
1911                     gfn_t gfn, pfn_t pfn, bool speculative,
1912                     bool can_unsync, bool reset_host_protection)
1913 {
1914         u64 spte;
1915         int ret = 0;
1916
1917         /*
1918          * We don't set the accessed bit, since we sometimes want to see
1919          * whether the guest actually used the pte (in order to detect
1920          * demand paging).
1921          */
1922         spte = shadow_base_present_pte | shadow_dirty_mask;
1923         if (!speculative)
1924                 spte |= shadow_accessed_mask;
1925         if (!dirty)
1926                 pte_access &= ~ACC_WRITE_MASK;
1927         if (pte_access & ACC_EXEC_MASK)
1928                 spte |= shadow_x_mask;
1929         else
1930                 spte |= shadow_nx_mask;
1931         if (pte_access & ACC_USER_MASK)
1932                 spte |= shadow_user_mask;
1933         if (level > PT_PAGE_TABLE_LEVEL)
1934                 spte |= PT_PAGE_SIZE_MASK;
1935         if (tdp_enabled)
1936                 spte |= kvm_x86_ops->get_mt_mask(vcpu, gfn,
1937                         kvm_is_mmio_pfn(pfn));
1938
1939         if (reset_host_protection)
1940                 spte |= SPTE_HOST_WRITEABLE;
1941
1942         spte |= (u64)pfn << PAGE_SHIFT;
1943
1944         if ((pte_access & ACC_WRITE_MASK)
1945             || (!tdp_enabled && write_fault && !is_write_protection(vcpu)
1946                 && !user_fault)) {
1947
1948                 if (level > PT_PAGE_TABLE_LEVEL &&
1949                     has_wrprotected_page(vcpu->kvm, gfn, level)) {
1950                         ret = 1;
1951                         drop_spte(vcpu->kvm, sptep, shadow_trap_nonpresent_pte);
1952                         goto done;
1953                 }
1954
1955                 spte |= PT_WRITABLE_MASK;
1956
1957                 if (!tdp_enabled && !(pte_access & ACC_WRITE_MASK))
1958                         spte &= ~PT_USER_MASK;
1959
1960                 /*
1961                  * Optimization: for pte sync, if spte was writable the hash
1962                  * lookup is unnecessary (and expensive). Write protection
1963                  * is responsibility of mmu_get_page / kvm_sync_page.
1964                  * Same reasoning can be applied to dirty page accounting.
1965                  */
1966                 if (!can_unsync && is_writable_pte(*sptep))
1967                         goto set_pte;
1968
1969                 if (mmu_need_write_protect(vcpu, gfn, can_unsync)) {
1970                         pgprintk("%s: found shadow page for %lx, marking ro\n",
1971                                  __func__, gfn);
1972                         ret = 1;
1973                         pte_access &= ~ACC_WRITE_MASK;
1974                         if (is_writable_pte(spte))
1975                                 spte &= ~PT_WRITABLE_MASK;
1976                 }
1977         }
1978
1979         if (pte_access & ACC_WRITE_MASK)
1980                 mark_page_dirty(vcpu->kvm, gfn);
1981
1982 set_pte:
1983         update_spte(sptep, spte);
1984 done:
1985         return ret;
1986 }
1987
1988 static void mmu_set_spte(struct kvm_vcpu *vcpu, u64 *sptep,
1989                          unsigned pt_access, unsigned pte_access,
1990                          int user_fault, int write_fault, int dirty,
1991                          int *ptwrite, int level, gfn_t gfn,
1992                          pfn_t pfn, bool speculative,
1993                          bool reset_host_protection)
1994 {
1995         int was_rmapped = 0;
1996         int was_writable = is_writable_pte(*sptep);
1997         int rmap_count;
1998
1999         pgprintk("%s: spte %llx access %x write_fault %d"
2000                  " user_fault %d gfn %lx\n",
2001                  __func__, *sptep, pt_access,
2002                  write_fault, user_fault, gfn);
2003
2004         if (is_rmap_spte(*sptep)) {
2005                 /*
2006                  * If we overwrite a PTE page pointer with a 2MB PMD, unlink
2007                  * the parent of the now unreachable PTE.
2008                  */
2009                 if (level > PT_PAGE_TABLE_LEVEL &&
2010                     !is_large_pte(*sptep)) {
2011                         struct kvm_mmu_page *child;
2012                         u64 pte = *sptep;
2013
2014                         child = page_header(pte & PT64_BASE_ADDR_MASK);
2015                         mmu_page_remove_parent_pte(child, sptep);
2016                         __set_spte(sptep, shadow_trap_nonpresent_pte);
2017                         kvm_flush_remote_tlbs(vcpu->kvm);
2018                 } else if (pfn != spte_to_pfn(*sptep)) {
2019                         pgprintk("hfn old %lx new %lx\n",
2020                                  spte_to_pfn(*sptep), pfn);
2021                         drop_spte(vcpu->kvm, sptep, shadow_trap_nonpresent_pte);
2022                         kvm_flush_remote_tlbs(vcpu->kvm);
2023                 } else
2024                         was_rmapped = 1;
2025         }
2026
2027         if (set_spte(vcpu, sptep, pte_access, user_fault, write_fault,
2028                       dirty, level, gfn, pfn, speculative, true,
2029                       reset_host_protection)) {
2030                 if (write_fault)
2031                         *ptwrite = 1;
2032                 kvm_mmu_flush_tlb(vcpu);
2033         }
2034
2035         pgprintk("%s: setting spte %llx\n", __func__, *sptep);
2036         pgprintk("instantiating %s PTE (%s) at %ld (%llx) addr %p\n",
2037                  is_large_pte(*sptep)? "2MB" : "4kB",
2038                  *sptep & PT_PRESENT_MASK ?"RW":"R", gfn,
2039                  *sptep, sptep);
2040         if (!was_rmapped && is_large_pte(*sptep))
2041                 ++vcpu->kvm->stat.lpages;
2042
2043         page_header_update_slot(vcpu->kvm, sptep, gfn);
2044         if (!was_rmapped) {
2045                 rmap_count = rmap_add(vcpu, sptep, gfn);
2046                 kvm_release_pfn_clean(pfn);
2047                 if (rmap_count > RMAP_RECYCLE_THRESHOLD)
2048                         rmap_recycle(vcpu, sptep, gfn);
2049         } else {
2050                 if (was_writable)
2051                         kvm_release_pfn_dirty(pfn);
2052                 else
2053                         kvm_release_pfn_clean(pfn);
2054         }
2055         if (speculative) {
2056                 vcpu->arch.last_pte_updated = sptep;
2057                 vcpu->arch.last_pte_gfn = gfn;
2058         }
2059 }
2060
2061 static void nonpaging_new_cr3(struct kvm_vcpu *vcpu)
2062 {
2063 }
2064
2065 static int __direct_map(struct kvm_vcpu *vcpu, gpa_t v, int write,
2066                         int level, gfn_t gfn, pfn_t pfn)
2067 {
2068         struct kvm_shadow_walk_iterator iterator;
2069         struct kvm_mmu_page *sp;
2070         int pt_write = 0;
2071         gfn_t pseudo_gfn;
2072
2073         for_each_shadow_entry(vcpu, (u64)gfn << PAGE_SHIFT, iterator) {
2074                 if (iterator.level == level) {
2075                         mmu_set_spte(vcpu, iterator.sptep, ACC_ALL, ACC_ALL,
2076                                      0, write, 1, &pt_write,
2077                                      level, gfn, pfn, false, true);
2078                         ++vcpu->stat.pf_fixed;
2079                         break;
2080                 }
2081
2082                 if (*iterator.sptep == shadow_trap_nonpresent_pte) {
2083                         u64 base_addr = iterator.addr;
2084
2085                         base_addr &= PT64_LVL_ADDR_MASK(iterator.level);
2086                         pseudo_gfn = base_addr >> PAGE_SHIFT;
2087                         sp = kvm_mmu_get_page(vcpu, pseudo_gfn, iterator.addr,
2088                                               iterator.level - 1,
2089                                               1, ACC_ALL, iterator.sptep);
2090                         if (!sp) {
2091                                 pgprintk("nonpaging_map: ENOMEM\n");
2092                                 kvm_release_pfn_clean(pfn);
2093                                 return -ENOMEM;
2094                         }
2095
2096                         __set_spte(iterator.sptep,
2097                                    __pa(sp->spt)
2098                                    | PT_PRESENT_MASK | PT_WRITABLE_MASK
2099                                    | shadow_user_mask | shadow_x_mask);
2100                 }
2101         }
2102         return pt_write;
2103 }
2104
2105 static void kvm_send_hwpoison_signal(struct kvm *kvm, gfn_t gfn)
2106 {
2107         char buf[1];
2108         void __user *hva;
2109         int r;
2110
2111         /* Touch the page, so send SIGBUS */
2112         hva = (void __user *)gfn_to_hva(kvm, gfn);
2113         r = copy_from_user(buf, hva, 1);
2114 }
2115
2116 static int kvm_handle_bad_page(struct kvm *kvm, gfn_t gfn, pfn_t pfn)
2117 {
2118         kvm_release_pfn_clean(pfn);
2119         if (is_hwpoison_pfn(pfn)) {
2120                 kvm_send_hwpoison_signal(kvm, gfn);
2121                 return 0;
2122         } else if (is_fault_pfn(pfn))
2123                 return -EFAULT;
2124
2125         return 1;
2126 }
2127
2128 static int nonpaging_map(struct kvm_vcpu *vcpu, gva_t v, int write, gfn_t gfn)
2129 {
2130         int r;
2131         int level;
2132         pfn_t pfn;
2133         unsigned long mmu_seq;
2134
2135         level = mapping_level(vcpu, gfn);
2136
2137         /*
2138          * This path builds a PAE pagetable - so we can map 2mb pages at
2139          * maximum. Therefore check if the level is larger than that.
2140          */
2141         if (level > PT_DIRECTORY_LEVEL)
2142                 level = PT_DIRECTORY_LEVEL;
2143
2144         gfn &= ~(KVM_PAGES_PER_HPAGE(level) - 1);
2145
2146         mmu_seq = vcpu->kvm->mmu_notifier_seq;
2147         smp_rmb();
2148         pfn = gfn_to_pfn(vcpu->kvm, gfn);
2149
2150         /* mmio */
2151         if (is_error_pfn(pfn))
2152                 return kvm_handle_bad_page(vcpu->kvm, gfn, pfn);
2153
2154         spin_lock(&vcpu->kvm->mmu_lock);
2155         if (mmu_notifier_retry(vcpu, mmu_seq))
2156                 goto out_unlock;
2157         kvm_mmu_free_some_pages(vcpu);
2158         r = __direct_map(vcpu, v, write, level, gfn, pfn);
2159         spin_unlock(&vcpu->kvm->mmu_lock);
2160
2161
2162         return r;
2163
2164 out_unlock:
2165         spin_unlock(&vcpu->kvm->mmu_lock);
2166         kvm_release_pfn_clean(pfn);
2167         return 0;
2168 }
2169
2170
2171 static void mmu_free_roots(struct kvm_vcpu *vcpu)
2172 {
2173         int i;
2174         struct kvm_mmu_page *sp;
2175         LIST_HEAD(invalid_list);
2176
2177         if (!VALID_PAGE(vcpu->arch.mmu.root_hpa))
2178                 return;
2179         spin_lock(&vcpu->kvm->mmu_lock);
2180         if (vcpu->arch.mmu.shadow_root_level == PT64_ROOT_LEVEL) {
2181                 hpa_t root = vcpu->arch.mmu.root_hpa;
2182
2183                 sp = page_header(root);
2184                 --sp->root_count;
2185                 if (!sp->root_count && sp->role.invalid) {
2186                         kvm_mmu_prepare_zap_page(vcpu->kvm, sp, &invalid_list);
2187                         kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
2188                 }
2189                 vcpu->arch.mmu.root_hpa = INVALID_PAGE;
2190                 spin_unlock(&vcpu->kvm->mmu_lock);
2191                 return;
2192         }
2193         for (i = 0; i < 4; ++i) {
2194                 hpa_t root = vcpu->arch.mmu.pae_root[i];
2195
2196                 if (root) {
2197                         root &= PT64_BASE_ADDR_MASK;
2198                         sp = page_header(root);
2199                         --sp->root_count;
2200                         if (!sp->root_count && sp->role.invalid)
2201                                 kvm_mmu_prepare_zap_page(vcpu->kvm, sp,
2202                                                          &invalid_list);
2203                 }
2204                 vcpu->arch.mmu.pae_root[i] = INVALID_PAGE;
2205         }
2206         kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
2207         spin_unlock(&vcpu->kvm->mmu_lock);
2208         vcpu->arch.mmu.root_hpa = INVALID_PAGE;
2209 }
2210
2211 static int mmu_check_root(struct kvm_vcpu *vcpu, gfn_t root_gfn)
2212 {
2213         int ret = 0;
2214
2215         if (!kvm_is_visible_gfn(vcpu->kvm, root_gfn)) {
2216                 kvm_make_request(KVM_REQ_TRIPLE_FAULT, vcpu);
2217                 ret = 1;
2218         }
2219
2220         return ret;
2221 }
2222
2223 static int mmu_alloc_roots(struct kvm_vcpu *vcpu)
2224 {
2225         int i;
2226         gfn_t root_gfn;
2227         struct kvm_mmu_page *sp;
2228         int direct = 0;
2229         u64 pdptr;
2230
2231         root_gfn = vcpu->arch.cr3 >> PAGE_SHIFT;
2232
2233         if (vcpu->arch.mmu.shadow_root_level == PT64_ROOT_LEVEL) {
2234                 hpa_t root = vcpu->arch.mmu.root_hpa;
2235
2236                 ASSERT(!VALID_PAGE(root));
2237                 if (mmu_check_root(vcpu, root_gfn))
2238                         return 1;
2239                 if (tdp_enabled) {
2240                         direct = 1;
2241                         root_gfn = 0;
2242                 }
2243                 spin_lock(&vcpu->kvm->mmu_lock);
2244                 kvm_mmu_free_some_pages(vcpu);
2245                 sp = kvm_mmu_get_page(vcpu, root_gfn, 0,
2246                                       PT64_ROOT_LEVEL, direct,
2247                                       ACC_ALL, NULL);
2248                 root = __pa(sp->spt);
2249                 ++sp->root_count;
2250                 spin_unlock(&vcpu->kvm->mmu_lock);
2251                 vcpu->arch.mmu.root_hpa = root;
2252                 return 0;
2253         }
2254         direct = !is_paging(vcpu);
2255         for (i = 0; i < 4; ++i) {
2256                 hpa_t root = vcpu->arch.mmu.pae_root[i];
2257
2258                 ASSERT(!VALID_PAGE(root));
2259                 if (vcpu->arch.mmu.root_level == PT32E_ROOT_LEVEL) {
2260                         pdptr = kvm_pdptr_read(vcpu, i);
2261                         if (!is_present_gpte(pdptr)) {
2262                                 vcpu->arch.mmu.pae_root[i] = 0;
2263                                 continue;
2264                         }
2265                         root_gfn = pdptr >> PAGE_SHIFT;
2266                 } else if (vcpu->arch.mmu.root_level == 0)
2267                         root_gfn = 0;
2268                 if (mmu_check_root(vcpu, root_gfn))
2269                         return 1;
2270                 if (tdp_enabled) {
2271                         direct = 1;
2272                         root_gfn = i << 30;
2273                 }
2274                 spin_lock(&vcpu->kvm->mmu_lock);
2275                 kvm_mmu_free_some_pages(vcpu);
2276                 sp = kvm_mmu_get_page(vcpu, root_gfn, i << 30,
2277                                       PT32_ROOT_LEVEL, direct,
2278                                       ACC_ALL, NULL);
2279                 root = __pa(sp->spt);
2280                 ++sp->root_count;
2281                 spin_unlock(&vcpu->kvm->mmu_lock);
2282
2283                 vcpu->arch.mmu.pae_root[i] = root | PT_PRESENT_MASK;
2284         }
2285         vcpu->arch.mmu.root_hpa = __pa(vcpu->arch.mmu.pae_root);
2286         return 0;
2287 }
2288
2289 static void mmu_sync_roots(struct kvm_vcpu *vcpu)
2290 {
2291         int i;
2292         struct kvm_mmu_page *sp;
2293
2294         if (!VALID_PAGE(vcpu->arch.mmu.root_hpa))
2295                 return;
2296         if (vcpu->arch.mmu.shadow_root_level == PT64_ROOT_LEVEL) {
2297                 hpa_t root = vcpu->arch.mmu.root_hpa;
2298                 sp = page_header(root);
2299                 mmu_sync_children(vcpu, sp);
2300                 return;
2301         }
2302         for (i = 0; i < 4; ++i) {
2303                 hpa_t root = vcpu->arch.mmu.pae_root[i];
2304
2305                 if (root && VALID_PAGE(root)) {
2306                         root &= PT64_BASE_ADDR_MASK;
2307                         sp = page_header(root);
2308                         mmu_sync_children(vcpu, sp);
2309                 }
2310         }
2311 }
2312
2313 void kvm_mmu_sync_roots(struct kvm_vcpu *vcpu)
2314 {
2315         spin_lock(&vcpu->kvm->mmu_lock);
2316         mmu_sync_roots(vcpu);
2317         spin_unlock(&vcpu->kvm->mmu_lock);
2318 }
2319
2320 static gpa_t nonpaging_gva_to_gpa(struct kvm_vcpu *vcpu, gva_t vaddr,
2321                                   u32 access, u32 *error)
2322 {
2323         if (error)
2324                 *error = 0;
2325         return vaddr;
2326 }
2327
2328 static int nonpaging_page_fault(struct kvm_vcpu *vcpu, gva_t gva,
2329                                 u32 error_code)
2330 {
2331         gfn_t gfn;
2332         int r;
2333
2334         pgprintk("%s: gva %lx error %x\n", __func__, gva, error_code);
2335         r = mmu_topup_memory_caches(vcpu);
2336         if (r)
2337                 return r;
2338
2339         ASSERT(vcpu);
2340         ASSERT(VALID_PAGE(vcpu->arch.mmu.root_hpa));
2341
2342         gfn = gva >> PAGE_SHIFT;
2343
2344         return nonpaging_map(vcpu, gva & PAGE_MASK,
2345                              error_code & PFERR_WRITE_MASK, gfn);
2346 }
2347
2348 static int tdp_page_fault(struct kvm_vcpu *vcpu, gva_t gpa,
2349                                 u32 error_code)
2350 {
2351         pfn_t pfn;
2352         int r;
2353         int level;
2354         gfn_t gfn = gpa >> PAGE_SHIFT;
2355         unsigned long mmu_seq;
2356
2357         ASSERT(vcpu);
2358         ASSERT(VALID_PAGE(vcpu->arch.mmu.root_hpa));
2359
2360         r = mmu_topup_memory_caches(vcpu);
2361         if (r)
2362                 return r;
2363
2364         level = mapping_level(vcpu, gfn);
2365
2366         gfn &= ~(KVM_PAGES_PER_HPAGE(level) - 1);
2367
2368         mmu_seq = vcpu->kvm->mmu_notifier_seq;
2369         smp_rmb();
2370         pfn = gfn_to_pfn(vcpu->kvm, gfn);
2371         if (is_error_pfn(pfn))
2372                 return kvm_handle_bad_page(vcpu->kvm, gfn, pfn);
2373         spin_lock(&vcpu->kvm->mmu_lock);
2374         if (mmu_notifier_retry(vcpu, mmu_seq))
2375                 goto out_unlock;
2376         kvm_mmu_free_some_pages(vcpu);
2377         r = __direct_map(vcpu, gpa, error_code & PFERR_WRITE_MASK,
2378                          level, gfn, pfn);
2379         spin_unlock(&vcpu->kvm->mmu_lock);
2380
2381         return r;
2382
2383 out_unlock:
2384         spin_unlock(&vcpu->kvm->mmu_lock);
2385         kvm_release_pfn_clean(pfn);
2386         return 0;
2387 }
2388
2389 static void nonpaging_free(struct kvm_vcpu *vcpu)
2390 {
2391         mmu_free_roots(vcpu);
2392 }
2393
2394 static int nonpaging_init_context(struct kvm_vcpu *vcpu)
2395 {
2396         struct kvm_mmu *context = &vcpu->arch.mmu;
2397
2398         context->new_cr3 = nonpaging_new_cr3;
2399         context->page_fault = nonpaging_page_fault;
2400         context->gva_to_gpa = nonpaging_gva_to_gpa;
2401         context->free = nonpaging_free;
2402         context->prefetch_page = nonpaging_prefetch_page;
2403         context->sync_page = nonpaging_sync_page;
2404         context->invlpg = nonpaging_invlpg;
2405         context->root_level = 0;
2406         context->shadow_root_level = PT32E_ROOT_LEVEL;
2407         context->root_hpa = INVALID_PAGE;
2408         return 0;
2409 }
2410
2411 void kvm_mmu_flush_tlb(struct kvm_vcpu *vcpu)
2412 {
2413         ++vcpu->stat.tlb_flush;
2414         kvm_make_request(KVM_REQ_TLB_FLUSH, vcpu);
2415 }
2416
2417 static void paging_new_cr3(struct kvm_vcpu *vcpu)
2418 {
2419         pgprintk("%s: cr3 %lx\n", __func__, vcpu->arch.cr3);
2420         mmu_free_roots(vcpu);
2421 }
2422
2423 static void inject_page_fault(struct kvm_vcpu *vcpu,
2424                               u64 addr,
2425                               u32 err_code)
2426 {
2427         kvm_inject_page_fault(vcpu, addr, err_code);
2428 }
2429
2430 static void paging_free(struct kvm_vcpu *vcpu)
2431 {
2432         nonpaging_free(vcpu);
2433 }
2434
2435 static bool is_rsvd_bits_set(struct kvm_vcpu *vcpu, u64 gpte, int level)
2436 {
2437         int bit7;
2438
2439         bit7 = (gpte >> 7) & 1;
2440         return (gpte & vcpu->arch.mmu.rsvd_bits_mask[bit7][level-1]) != 0;
2441 }
2442
2443 #define PTTYPE 64
2444 #include "paging_tmpl.h"
2445 #undef PTTYPE
2446
2447 #define PTTYPE 32
2448 #include "paging_tmpl.h"
2449 #undef PTTYPE
2450
2451 static void reset_rsvds_bits_mask(struct kvm_vcpu *vcpu, int level)
2452 {
2453         struct kvm_mmu *context = &vcpu->arch.mmu;
2454         int maxphyaddr = cpuid_maxphyaddr(vcpu);
2455         u64 exb_bit_rsvd = 0;
2456
2457         if (!is_nx(vcpu))
2458                 exb_bit_rsvd = rsvd_bits(63, 63);
2459         switch (level) {
2460         case PT32_ROOT_LEVEL:
2461                 /* no rsvd bits for 2 level 4K page table entries */
2462                 context->rsvd_bits_mask[0][1] = 0;
2463                 context->rsvd_bits_mask[0][0] = 0;
2464                 context->rsvd_bits_mask[1][0] = context->rsvd_bits_mask[0][0];
2465
2466                 if (!is_pse(vcpu)) {
2467                         context->rsvd_bits_mask[1][1] = 0;
2468                         break;
2469                 }
2470
2471                 if (is_cpuid_PSE36())
2472                         /* 36bits PSE 4MB page */
2473                         context->rsvd_bits_mask[1][1] = rsvd_bits(17, 21);
2474                 else
2475                         /* 32 bits PSE 4MB page */
2476                         context->rsvd_bits_mask[1][1] = rsvd_bits(13, 21);
2477                 break;
2478         case PT32E_ROOT_LEVEL:
2479                 context->rsvd_bits_mask[0][2] =
2480                         rsvd_bits(maxphyaddr, 63) |
2481                         rsvd_bits(7, 8) | rsvd_bits(1, 2);      /* PDPTE */
2482                 context->rsvd_bits_mask[0][1] = exb_bit_rsvd |
2483                         rsvd_bits(maxphyaddr, 62);      /* PDE */
2484                 context->rsvd_bits_mask[0][0] = exb_bit_rsvd |
2485                         rsvd_bits(maxphyaddr, 62);      /* PTE */
2486                 context->rsvd_bits_mask[1][1] = exb_bit_rsvd |
2487                         rsvd_bits(maxphyaddr, 62) |
2488                         rsvd_bits(13, 20);              /* large page */
2489                 context->rsvd_bits_mask[1][0] = context->rsvd_bits_mask[0][0];
2490                 break;
2491         case PT64_ROOT_LEVEL:
2492                 context->rsvd_bits_mask[0][3] = exb_bit_rsvd |
2493                         rsvd_bits(maxphyaddr, 51) | rsvd_bits(7, 8);
2494                 context->rsvd_bits_mask[0][2] = exb_bit_rsvd |
2495                         rsvd_bits(maxphyaddr, 51) | rsvd_bits(7, 8);
2496                 context->rsvd_bits_mask[0][1] = exb_bit_rsvd |
2497                         rsvd_bits(maxphyaddr, 51);
2498                 context->rsvd_bits_mask[0][0] = exb_bit_rsvd |
2499                         rsvd_bits(maxphyaddr, 51);
2500                 context->rsvd_bits_mask[1][3] = context->rsvd_bits_mask[0][3];
2501                 context->rsvd_bits_mask[1][2] = exb_bit_rsvd |
2502                         rsvd_bits(maxphyaddr, 51) |
2503                         rsvd_bits(13, 29);
2504                 context->rsvd_bits_mask[1][1] = exb_bit_rsvd |
2505                         rsvd_bits(maxphyaddr, 51) |
2506                         rsvd_bits(13, 20);              /* large page */
2507                 context->rsvd_bits_mask[1][0] = context->rsvd_bits_mask[0][0];
2508                 break;
2509         }
2510 }
2511
2512 static int paging64_init_context_common(struct kvm_vcpu *vcpu, int level)
2513 {
2514         struct kvm_mmu *context = &vcpu->arch.mmu;
2515
2516         ASSERT(is_pae(vcpu));
2517         context->new_cr3 = paging_new_cr3;
2518         context->page_fault = paging64_page_fault;
2519         context->gva_to_gpa = paging64_gva_to_gpa;
2520         context->prefetch_page = paging64_prefetch_page;
2521         context->sync_page = paging64_sync_page;
2522         context->invlpg = paging64_invlpg;
2523         context->free = paging_free;
2524         context->root_level = level;
2525         context->shadow_root_level = level;
2526         context->root_hpa = INVALID_PAGE;
2527         return 0;
2528 }
2529
2530 static int paging64_init_context(struct kvm_vcpu *vcpu)
2531 {
2532         reset_rsvds_bits_mask(vcpu, PT64_ROOT_LEVEL);
2533         return paging64_init_context_common(vcpu, PT64_ROOT_LEVEL);
2534 }
2535
2536 static int paging32_init_context(struct kvm_vcpu *vcpu)
2537 {
2538         struct kvm_mmu *context = &vcpu->arch.mmu;
2539
2540         reset_rsvds_bits_mask(vcpu, PT32_ROOT_LEVEL);
2541         context->new_cr3 = paging_new_cr3;
2542         context->page_fault = paging32_page_fault;
2543         context->gva_to_gpa = paging32_gva_to_gpa;
2544         context->free = paging_free;
2545         context->prefetch_page = paging32_prefetch_page;
2546         context->sync_page = paging32_sync_page;
2547         context->invlpg = paging32_invlpg;
2548         context->root_level = PT32_ROOT_LEVEL;
2549         context->shadow_root_level = PT32E_ROOT_LEVEL;
2550         context->root_hpa = INVALID_PAGE;
2551         return 0;
2552 }
2553
2554 static int paging32E_init_context(struct kvm_vcpu *vcpu)
2555 {
2556         reset_rsvds_bits_mask(vcpu, PT32E_ROOT_LEVEL);
2557         return paging64_init_context_common(vcpu, PT32E_ROOT_LEVEL);
2558 }
2559
2560 static int init_kvm_tdp_mmu(struct kvm_vcpu *vcpu)
2561 {
2562         struct kvm_mmu *context = &vcpu->arch.mmu;
2563
2564         context->new_cr3 = nonpaging_new_cr3;
2565         context->page_fault = tdp_page_fault;
2566         context->free = nonpaging_free;
2567         context->prefetch_page = nonpaging_prefetch_page;
2568         context->sync_page = nonpaging_sync_page;
2569         context->invlpg = nonpaging_invlpg;
2570         context->shadow_root_level = kvm_x86_ops->get_tdp_level();
2571         context->root_hpa = INVALID_PAGE;
2572
2573         if (!is_paging(vcpu)) {
2574                 context->gva_to_gpa = nonpaging_gva_to_gpa;
2575                 context->root_level = 0;
2576         } else if (is_long_mode(vcpu)) {
2577                 reset_rsvds_bits_mask(vcpu, PT64_ROOT_LEVEL);
2578                 context->gva_to_gpa = paging64_gva_to_gpa;
2579                 context->root_level = PT64_ROOT_LEVEL;
2580         } else if (is_pae(vcpu)) {
2581                 reset_rsvds_bits_mask(vcpu, PT32E_ROOT_LEVEL);
2582                 context->gva_to_gpa = paging64_gva_to_gpa;
2583                 context->root_level = PT32E_ROOT_LEVEL;
2584         } else {
2585                 reset_rsvds_bits_mask(vcpu, PT32_ROOT_LEVEL);
2586                 context->gva_to_gpa = paging32_gva_to_gpa;
2587                 context->root_level = PT32_ROOT_LEVEL;
2588         }
2589
2590         return 0;
2591 }
2592
2593 static int init_kvm_softmmu(struct kvm_vcpu *vcpu)
2594 {
2595         int r;
2596
2597         ASSERT(vcpu);
2598         ASSERT(!VALID_PAGE(vcpu->arch.mmu.root_hpa));
2599
2600         if (!is_paging(vcpu))
2601                 r = nonpaging_init_context(vcpu);
2602         else if (is_long_mode(vcpu))
2603                 r = paging64_init_context(vcpu);
2604         else if (is_pae(vcpu))
2605                 r = paging32E_init_context(vcpu);
2606         else
2607                 r = paging32_init_context(vcpu);
2608
2609         vcpu->arch.mmu.base_role.cr4_pae = !!is_pae(vcpu);
2610         vcpu->arch.mmu.base_role.cr0_wp = is_write_protection(vcpu);
2611
2612         return r;
2613 }
2614
2615 static int init_kvm_mmu(struct kvm_vcpu *vcpu)
2616 {
2617         vcpu->arch.update_pte.pfn = bad_pfn;
2618
2619         if (tdp_enabled)
2620                 return init_kvm_tdp_mmu(vcpu);
2621         else
2622                 return init_kvm_softmmu(vcpu);
2623 }
2624
2625 static void destroy_kvm_mmu(struct kvm_vcpu *vcpu)
2626 {
2627         ASSERT(vcpu);
2628         if (VALID_PAGE(vcpu->arch.mmu.root_hpa))
2629                 /* mmu.free() should set root_hpa = INVALID_PAGE */
2630                 vcpu->arch.mmu.free(vcpu);
2631 }
2632
2633 int kvm_mmu_reset_context(struct kvm_vcpu *vcpu)
2634 {
2635         destroy_kvm_mmu(vcpu);
2636         return init_kvm_mmu(vcpu);
2637 }
2638 EXPORT_SYMBOL_GPL(kvm_mmu_reset_context);
2639
2640 int kvm_mmu_load(struct kvm_vcpu *vcpu)
2641 {
2642         int r;
2643
2644         r = mmu_topup_memory_caches(vcpu);
2645         if (r)
2646                 goto out;
2647         r = mmu_alloc_roots(vcpu);
2648         spin_lock(&vcpu->kvm->mmu_lock);
2649         mmu_sync_roots(vcpu);
2650         spin_unlock(&vcpu->kvm->mmu_lock);
2651         if (r)
2652                 goto out;
2653         /* set_cr3() should ensure TLB has been flushed */
2654         kvm_x86_ops->set_cr3(vcpu, vcpu->arch.mmu.root_hpa);
2655 out:
2656         return r;
2657 }
2658 EXPORT_SYMBOL_GPL(kvm_mmu_load);
2659
2660 void kvm_mmu_unload(struct kvm_vcpu *vcpu)
2661 {
2662         mmu_free_roots(vcpu);
2663 }
2664
2665 static void mmu_pte_write_zap_pte(struct kvm_vcpu *vcpu,
2666                                   struct kvm_mmu_page *sp,
2667                                   u64 *spte)
2668 {
2669         u64 pte;
2670         struct kvm_mmu_page *child;
2671
2672         pte = *spte;
2673         if (is_shadow_present_pte(pte)) {
2674                 if (is_last_spte(pte, sp->role.level))
2675                         drop_spte(vcpu->kvm, spte, shadow_trap_nonpresent_pte);
2676                 else {
2677                         child = page_header(pte & PT64_BASE_ADDR_MASK);
2678                         mmu_page_remove_parent_pte(child, spte);
2679                 }
2680         }
2681         __set_spte(spte, shadow_trap_nonpresent_pte);
2682         if (is_large_pte(pte))
2683                 --vcpu->kvm->stat.lpages;
2684 }
2685
2686 static void mmu_pte_write_new_pte(struct kvm_vcpu *vcpu,
2687                                   struct kvm_mmu_page *sp,
2688                                   u64 *spte,
2689                                   const void *new)
2690 {
2691         if (sp->role.level != PT_PAGE_TABLE_LEVEL) {
2692                 ++vcpu->kvm->stat.mmu_pde_zapped;
2693                 return;
2694         }
2695
2696         ++vcpu->kvm->stat.mmu_pte_updated;
2697         if (!sp->role.cr4_pae)
2698                 paging32_update_pte(vcpu, sp, spte, new);
2699         else
2700                 paging64_update_pte(vcpu, sp, spte, new);
2701 }
2702
2703 static bool need_remote_flush(u64 old, u64 new)
2704 {
2705         if (!is_shadow_present_pte(old))
2706                 return false;
2707         if (!is_shadow_present_pte(new))
2708                 return true;
2709         if ((old ^ new) & PT64_BASE_ADDR_MASK)
2710                 return true;
2711         old ^= PT64_NX_MASK;
2712         new ^= PT64_NX_MASK;
2713         return (old & ~new & PT64_PERM_MASK) != 0;
2714 }
2715
2716 static void mmu_pte_write_flush_tlb(struct kvm_vcpu *vcpu, bool zap_page,
2717                                     bool remote_flush, bool local_flush)
2718 {
2719         if (zap_page)
2720                 return;
2721
2722         if (remote_flush)
2723                 kvm_flush_remote_tlbs(vcpu->kvm);
2724         else if (local_flush)
2725                 kvm_mmu_flush_tlb(vcpu);
2726 }
2727
2728 static bool last_updated_pte_accessed(struct kvm_vcpu *vcpu)
2729 {
2730         u64 *spte = vcpu->arch.last_pte_updated;
2731
2732         return !!(spte && (*spte & shadow_accessed_mask));
2733 }
2734
2735 static void mmu_guess_page_from_pte_write(struct kvm_vcpu *vcpu, gpa_t gpa,
2736                                           u64 gpte)
2737 {
2738         gfn_t gfn;
2739         pfn_t pfn;
2740
2741         if (!is_present_gpte(gpte))
2742                 return;
2743         gfn = (gpte & PT64_BASE_ADDR_MASK) >> PAGE_SHIFT;
2744
2745         vcpu->arch.update_pte.mmu_seq = vcpu->kvm->mmu_notifier_seq;
2746         smp_rmb();
2747         pfn = gfn_to_pfn(vcpu->kvm, gfn);
2748
2749         if (is_error_pfn(pfn)) {
2750                 kvm_release_pfn_clean(pfn);
2751                 return;
2752         }
2753         vcpu->arch.update_pte.gfn = gfn;
2754         vcpu->arch.update_pte.pfn = pfn;
2755 }
2756
2757 static void kvm_mmu_access_page(struct kvm_vcpu *vcpu, gfn_t gfn)
2758 {
2759         u64 *spte = vcpu->arch.last_pte_updated;
2760
2761         if (spte
2762             && vcpu->arch.last_pte_gfn == gfn
2763             && shadow_accessed_mask
2764             && !(*spte & shadow_accessed_mask)
2765             && is_shadow_present_pte(*spte))
2766                 set_bit(PT_ACCESSED_SHIFT, (unsigned long *)spte);
2767 }
2768
2769 void kvm_mmu_pte_write(struct kvm_vcpu *vcpu, gpa_t gpa,
2770                        const u8 *new, int bytes,
2771                        bool guest_initiated)
2772 {
2773         gfn_t gfn = gpa >> PAGE_SHIFT;
2774         struct kvm_mmu_page *sp;
2775         struct hlist_node *node;
2776         LIST_HEAD(invalid_list);
2777         u64 entry, gentry;
2778         u64 *spte;
2779         unsigned offset = offset_in_page(gpa);
2780         unsigned pte_size;
2781         unsigned page_offset;
2782         unsigned misaligned;
2783         unsigned quadrant;
2784         int level;
2785         int flooded = 0;
2786         int npte;
2787         int r;
2788         int invlpg_counter;
2789         bool remote_flush, local_flush, zap_page;
2790
2791         zap_page = remote_flush = local_flush = false;
2792
2793         pgprintk("%s: gpa %llx bytes %d\n", __func__, gpa, bytes);
2794
2795         invlpg_counter = atomic_read(&vcpu->kvm->arch.invlpg_counter);
2796
2797         /*
2798          * Assume that the pte write on a page table of the same type
2799          * as the current vcpu paging mode.  This is nearly always true
2800          * (might be false while changing modes).  Note it is verified later
2801          * by update_pte().
2802          */
2803         if ((is_pae(vcpu) && bytes == 4) || !new) {
2804                 /* Handle a 32-bit guest writing two halves of a 64-bit gpte */
2805                 if (is_pae(vcpu)) {
2806                         gpa &= ~(gpa_t)7;
2807                         bytes = 8;
2808                 }
2809                 r = kvm_read_guest(vcpu->kvm, gpa, &gentry, min(bytes, 8));
2810                 if (r)
2811                         gentry = 0;
2812                 new = (const u8 *)&gentry;
2813         }
2814
2815         switch (bytes) {
2816         case 4:
2817                 gentry = *(const u32 *)new;
2818                 break;
2819         case 8:
2820                 gentry = *(const u64 *)new;
2821                 break;
2822         default:
2823                 gentry = 0;
2824                 break;
2825         }
2826
2827         mmu_guess_page_from_pte_write(vcpu, gpa, gentry);
2828         spin_lock(&vcpu->kvm->mmu_lock);
2829         if (atomic_read(&vcpu->kvm->arch.invlpg_counter) != invlpg_counter)
2830                 gentry = 0;
2831         kvm_mmu_access_page(vcpu, gfn);
2832         kvm_mmu_free_some_pages(vcpu);
2833         ++vcpu->kvm->stat.mmu_pte_write;
2834         kvm_mmu_audit(vcpu, "pre pte write");
2835         if (guest_initiated) {
2836                 if (gfn == vcpu->arch.last_pt_write_gfn
2837                     && !last_updated_pte_accessed(vcpu)) {
2838                         ++vcpu->arch.last_pt_write_count;
2839                         if (vcpu->arch.last_pt_write_count >= 3)
2840                                 flooded = 1;
2841                 } else {
2842                         vcpu->arch.last_pt_write_gfn = gfn;
2843                         vcpu->arch.last_pt_write_count = 1;
2844                         vcpu->arch.last_pte_updated = NULL;
2845                 }
2846         }
2847
2848         for_each_gfn_indirect_valid_sp(vcpu->kvm, sp, gfn, node) {
2849                 pte_size = sp->role.cr4_pae ? 8 : 4;
2850                 misaligned = (offset ^ (offset + bytes - 1)) & ~(pte_size - 1);
2851                 misaligned |= bytes < 4;
2852                 if (misaligned || flooded) {
2853                         /*
2854                          * Misaligned accesses are too much trouble to fix
2855                          * up; also, they usually indicate a page is not used
2856                          * as a page table.
2857                          *
2858                          * If we're seeing too many writes to a page,
2859                          * it may no longer be a page table, or we may be
2860                          * forking, in which case it is better to unmap the
2861                          * page.
2862                          */
2863                         pgprintk("misaligned: gpa %llx bytes %d role %x\n",
2864                                  gpa, bytes, sp->role.word);
2865                         zap_page |= !!kvm_mmu_prepare_zap_page(vcpu->kvm, sp,
2866                                                      &invalid_list);
2867                         ++vcpu->kvm->stat.mmu_flooded;
2868                         continue;
2869                 }
2870                 page_offset = offset;
2871                 level = sp->role.level;
2872                 npte = 1;
2873                 if (!sp->role.cr4_pae) {
2874                         page_offset <<= 1;      /* 32->64 */
2875                         /*
2876                          * A 32-bit pde maps 4MB while the shadow pdes map
2877                          * only 2MB.  So we need to double the offset again
2878                          * and zap two pdes instead of one.
2879                          */
2880                         if (level == PT32_ROOT_LEVEL) {
2881                                 page_offset &= ~7; /* kill rounding error */
2882                                 page_offset <<= 1;
2883                                 npte = 2;
2884                         }
2885                         quadrant = page_offset >> PAGE_SHIFT;
2886                         page_offset &= ~PAGE_MASK;
2887                         if (quadrant != sp->role.quadrant)
2888                                 continue;
2889                 }
2890                 local_flush = true;
2891                 spte = &sp->spt[page_offset / sizeof(*spte)];
2892                 while (npte--) {
2893                         entry = *spte;
2894                         mmu_pte_write_zap_pte(vcpu, sp, spte);
2895                         if (gentry)
2896                                 mmu_pte_write_new_pte(vcpu, sp, spte, &gentry);
2897                         if (!remote_flush && need_remote_flush(entry, *spte))
2898                                 remote_flush = true;
2899                         ++spte;
2900                 }
2901         }
2902         mmu_pte_write_flush_tlb(vcpu, zap_page, remote_flush, local_flush);
2903         kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
2904         kvm_mmu_audit(vcpu, "post pte write");
2905         spin_unlock(&vcpu->kvm->mmu_lock);
2906         if (!is_error_pfn(vcpu->arch.update_pte.pfn)) {
2907                 kvm_release_pfn_clean(vcpu->arch.update_pte.pfn);
2908                 vcpu->arch.update_pte.pfn = bad_pfn;
2909         }
2910 }
2911
2912 int kvm_mmu_unprotect_page_virt(struct kvm_vcpu *vcpu, gva_t gva)
2913 {
2914         gpa_t gpa;
2915         int r;
2916
2917         if (tdp_enabled)
2918                 return 0;
2919
2920         gpa = kvm_mmu_gva_to_gpa_read(vcpu, gva, NULL);
2921
2922         spin_lock(&vcpu->kvm->mmu_lock);
2923         r = kvm_mmu_unprotect_page(vcpu->kvm, gpa >> PAGE_SHIFT);
2924         spin_unlock(&vcpu->kvm->mmu_lock);
2925         return r;
2926 }
2927 EXPORT_SYMBOL_GPL(kvm_mmu_unprotect_page_virt);
2928
2929 void __kvm_mmu_free_some_pages(struct kvm_vcpu *vcpu)
2930 {
2931         int free_pages;
2932         LIST_HEAD(invalid_list);
2933
2934         free_pages = vcpu->kvm->arch.n_free_mmu_pages;
2935         while (free_pages < KVM_REFILL_PAGES &&
2936                !list_empty(&vcpu->kvm->arch.active_mmu_pages)) {
2937                 struct kvm_mmu_page *sp;
2938
2939                 sp = container_of(vcpu->kvm->arch.active_mmu_pages.prev,
2940                                   struct kvm_mmu_page, link);
2941                 free_pages += kvm_mmu_prepare_zap_page(vcpu->kvm, sp,
2942                                                        &invalid_list);
2943                 ++vcpu->kvm->stat.mmu_recycled;
2944         }
2945         kvm_mmu_commit_zap_page(vcpu->kvm, &invalid_list);
2946 }
2947
2948 int kvm_mmu_page_fault(struct kvm_vcpu *vcpu, gva_t cr2, u32 error_code)
2949 {
2950         int r;
2951         enum emulation_result er;
2952
2953         r = vcpu->arch.mmu.page_fault(vcpu, cr2, error_code);
2954         if (r < 0)
2955                 goto out;
2956
2957         if (!r) {
2958                 r = 1;
2959                 goto out;
2960         }
2961
2962         r = mmu_topup_memory_caches(vcpu);
2963         if (r)
2964                 goto out;
2965
2966         er = emulate_instruction(vcpu, cr2, error_code, 0);
2967
2968         switch (er) {
2969         case EMULATE_DONE:
2970                 return 1;
2971         case EMULATE_DO_MMIO:
2972                 ++vcpu->stat.mmio_exits;
2973                 /* fall through */
2974         case EMULATE_FAIL:
2975                 return 0;
2976         default:
2977                 BUG();
2978         }
2979 out:
2980         return r;
2981 }
2982 EXPORT_SYMBOL_GPL(kvm_mmu_page_fault);
2983
2984 void kvm_mmu_invlpg(struct kvm_vcpu *vcpu, gva_t gva)
2985 {
2986         vcpu->arch.mmu.invlpg(vcpu, gva);
2987         kvm_mmu_flush_tlb(vcpu);
2988         ++vcpu->stat.invlpg;
2989 }
2990 EXPORT_SYMBOL_GPL(kvm_mmu_invlpg);
2991
2992 void kvm_enable_tdp(void)
2993 {
2994         tdp_enabled = true;
2995 }
2996 EXPORT_SYMBOL_GPL(kvm_enable_tdp);
2997
2998 void kvm_disable_tdp(void)
2999 {
3000         tdp_enabled = false;
3001 }
3002 EXPORT_SYMBOL_GPL(kvm_disable_tdp);
3003
3004 static void free_mmu_pages(struct kvm_vcpu *vcpu)
3005 {
3006         free_page((unsigned long)vcpu->arch.mmu.pae_root);
3007 }
3008
3009 static int alloc_mmu_pages(struct kvm_vcpu *vcpu)
3010 {
3011         struct page *page;
3012         int i;
3013
3014         ASSERT(vcpu);
3015
3016         /*
3017          * When emulating 32-bit mode, cr3 is only 32 bits even on x86_64.
3018          * Therefore we need to allocate shadow page tables in the first
3019          * 4GB of memory, which happens to fit the DMA32 zone.
3020          */
3021         page = alloc_page(GFP_KERNEL | __GFP_DMA32);
3022         if (!page)
3023                 return -ENOMEM;
3024
3025         vcpu->arch.mmu.pae_root = page_address(page);
3026         for (i = 0; i < 4; ++i)
3027                 vcpu->arch.mmu.pae_root[i] = INVALID_PAGE;
3028
3029         return 0;
3030 }
3031
3032 int kvm_mmu_create(struct kvm_vcpu *vcpu)
3033 {
3034         ASSERT(vcpu);
3035         ASSERT(!VALID_PAGE(vcpu->arch.mmu.root_hpa));
3036
3037         return alloc_mmu_pages(vcpu);
3038 }
3039
3040 int kvm_mmu_setup(struct kvm_vcpu *vcpu)
3041 {
3042         ASSERT(vcpu);
3043         ASSERT(!VALID_PAGE(vcpu->arch.mmu.root_hpa));
3044
3045         return init_kvm_mmu(vcpu);
3046 }
3047
3048 void kvm_mmu_destroy(struct kvm_vcpu *vcpu)
3049 {
3050         ASSERT(vcpu);
3051
3052         destroy_kvm_mmu(vcpu);
3053         free_mmu_pages(vcpu);
3054         mmu_free_memory_caches(vcpu);
3055 }
3056
3057 void kvm_mmu_slot_remove_write_access(struct kvm *kvm, int slot)
3058 {
3059         struct kvm_mmu_page *sp;
3060
3061         list_for_each_entry(sp, &kvm->arch.active_mmu_pages, link) {
3062                 int i;
3063                 u64 *pt;
3064
3065                 if (!test_bit(slot, sp->slot_bitmap))
3066                         continue;
3067
3068                 pt = sp->spt;
3069                 for (i = 0; i < PT64_ENT_PER_PAGE; ++i)
3070                         /* avoid RMW */
3071                         if (is_writable_pte(pt[i]))
3072                                 pt[i] &= ~PT_WRITABLE_MASK;
3073         }
3074         kvm_flush_remote_tlbs(kvm);
3075 }
3076
3077 void kvm_mmu_zap_all(struct kvm *kvm)
3078 {
3079         struct kvm_mmu_page *sp, *node;
3080         LIST_HEAD(invalid_list);
3081
3082         spin_lock(&kvm->mmu_lock);
3083 restart:
3084         list_for_each_entry_safe(sp, node, &kvm->arch.active_mmu_pages, link)
3085                 if (kvm_mmu_prepare_zap_page(kvm, sp, &invalid_list))
3086                         goto restart;
3087
3088         kvm_mmu_commit_zap_page(kvm, &invalid_list);
3089         spin_unlock(&kvm->mmu_lock);
3090 }
3091
3092 static int kvm_mmu_remove_some_alloc_mmu_pages(struct kvm *kvm,
3093                                                struct list_head *invalid_list)
3094 {
3095         struct kvm_mmu_page *page;
3096
3097         page = container_of(kvm->arch.active_mmu_pages.prev,
3098                             struct kvm_mmu_page, link);
3099         return kvm_mmu_prepare_zap_page(kvm, page, invalid_list);
3100 }
3101
3102 static int mmu_shrink(struct shrinker *shrink, int nr_to_scan, gfp_t gfp_mask)
3103 {
3104         struct kvm *kvm;
3105         struct kvm *kvm_freed = NULL;
3106         int cache_count = 0;
3107
3108         spin_lock(&kvm_lock);
3109
3110         list_for_each_entry(kvm, &vm_list, vm_list) {
3111                 int npages, idx, freed_pages;
3112                 LIST_HEAD(invalid_list);
3113
3114                 idx = srcu_read_lock(&kvm->srcu);
3115                 spin_lock(&kvm->mmu_lock);
3116                 npages = kvm->arch.n_alloc_mmu_pages -
3117                          kvm->arch.n_free_mmu_pages;
3118                 cache_count += npages;
3119                 if (!kvm_freed && nr_to_scan > 0 && npages > 0) {
3120                         freed_pages = kvm_mmu_remove_some_alloc_mmu_pages(kvm,
3121                                                           &invalid_list);
3122                         cache_count -= freed_pages;
3123                         kvm_freed = kvm;
3124                 }
3125                 nr_to_scan--;
3126
3127                 kvm_mmu_commit_zap_page(kvm, &invalid_list);
3128                 spin_unlock(&kvm->mmu_lock);
3129                 srcu_read_unlock(&kvm->srcu, idx);
3130         }
3131         if (kvm_freed)
3132                 list_move_tail(&kvm_freed->vm_list, &vm_list);
3133
3134         spin_unlock(&kvm_lock);
3135
3136         return cache_count;
3137 }
3138
3139 static struct shrinker mmu_shrinker = {
3140         .shrink = mmu_shrink,
3141         .seeks = DEFAULT_SEEKS * 10,
3142 };
3143
3144 static void mmu_destroy_caches(void)
3145 {
3146         if (pte_chain_cache)
3147                 kmem_cache_destroy(pte_chain_cache);
3148         if (rmap_desc_cache)
3149                 kmem_cache_destroy(rmap_desc_cache);
3150         if (mmu_page_header_cache)
3151                 kmem_cache_destroy(mmu_page_header_cache);
3152 }
3153
3154 void kvm_mmu_module_exit(void)
3155 {
3156         mmu_destroy_caches();
3157         unregister_shrinker(&mmu_shrinker);
3158 }
3159
3160 int kvm_mmu_module_init(void)
3161 {
3162         pte_chain_cache = kmem_cache_create("kvm_pte_chain",
3163                                             sizeof(struct kvm_pte_chain),
3164                                             0, 0, NULL);
3165         if (!pte_chain_cache)
3166                 goto nomem;
3167         rmap_desc_cache = kmem_cache_create("kvm_rmap_desc",
3168                                             sizeof(struct kvm_rmap_desc),
3169                                             0, 0, NULL);
3170         if (!rmap_desc_cache)
3171                 goto nomem;
3172
3173         mmu_page_header_cache = kmem_cache_create("kvm_mmu_page_header",
3174                                                   sizeof(struct kvm_mmu_page),
3175                                                   0, 0, NULL);
3176         if (!mmu_page_header_cache)
3177                 goto nomem;
3178
3179         register_shrinker(&mmu_shrinker);
3180
3181         return 0;
3182
3183 nomem:
3184         mmu_destroy_caches();
3185         return -ENOMEM;
3186 }
3187
3188 /*
3189  * Caculate mmu pages needed for kvm.
3190  */
3191 unsigned int kvm_mmu_calculate_mmu_pages(struct kvm *kvm)
3192 {
3193         int i;
3194         unsigned int nr_mmu_pages;
3195         unsigned int  nr_pages = 0;
3196         struct kvm_memslots *slots;
3197
3198         slots = kvm_memslots(kvm);
3199
3200         for (i = 0; i < slots->nmemslots; i++)
3201                 nr_pages += slots->memslots[i].npages;
3202
3203         nr_mmu_pages = nr_pages * KVM_PERMILLE_MMU_PAGES / 1000;
3204         nr_mmu_pages = max(nr_mmu_pages,
3205                         (unsigned int) KVM_MIN_ALLOC_MMU_PAGES);
3206
3207         return nr_mmu_pages;
3208 }
3209
3210 static void *pv_mmu_peek_buffer(struct kvm_pv_mmu_op_buffer *buffer,
3211                                 unsigned len)
3212 {
3213         if (len > buffer->len)
3214                 return NULL;
3215         return buffer->ptr;
3216 }
3217
3218 static void *pv_mmu_read_buffer(struct kvm_pv_mmu_op_buffer *buffer,
3219                                 unsigned len)
3220 {
3221         void *ret;
3222
3223         ret = pv_mmu_peek_buffer(buffer, len);
3224         if (!ret)
3225                 return ret;
3226         buffer->ptr += len;
3227         buffer->len -= len;
3228         buffer->processed += len;
3229         return ret;
3230 }
3231
3232 static int kvm_pv_mmu_write(struct kvm_vcpu *vcpu,
3233                              gpa_t addr, gpa_t value)
3234 {
3235         int bytes = 8;
3236         int r;
3237
3238         if (!is_long_mode(vcpu) && !is_pae(vcpu))
3239                 bytes = 4;
3240
3241         r = mmu_topup_memory_caches(vcpu);
3242         if (r)
3243                 return r;
3244
3245         if (!emulator_write_phys(vcpu, addr, &value, bytes))
3246                 return -EFAULT;
3247
3248         return 1;
3249 }
3250
3251 static int kvm_pv_mmu_flush_tlb(struct kvm_vcpu *vcpu)
3252 {
3253         (void)kvm_set_cr3(vcpu, vcpu->arch.cr3);
3254         return 1;
3255 }
3256
3257 static int kvm_pv_mmu_release_pt(struct kvm_vcpu *vcpu, gpa_t addr)
3258 {
3259         spin_lock(&vcpu->kvm->mmu_lock);
3260         mmu_unshadow(vcpu->kvm, addr >> PAGE_SHIFT);
3261         spin_unlock(&vcpu->kvm->mmu_lock);
3262         return 1;
3263 }
3264
3265 static int kvm_pv_mmu_op_one(struct kvm_vcpu *vcpu,
3266                              struct kvm_pv_mmu_op_buffer *buffer)
3267 {
3268         struct kvm_mmu_op_header *header;
3269
3270         header = pv_mmu_peek_buffer(buffer, sizeof *header);
3271         if (!header)
3272                 return 0;
3273         switch (header->op) {
3274         case KVM_MMU_OP_WRITE_PTE: {
3275                 struct kvm_mmu_op_write_pte *wpte;
3276
3277                 wpte = pv_mmu_read_buffer(buffer, sizeof *wpte);
3278                 if (!wpte)
3279                         return 0;
3280                 return kvm_pv_mmu_write(vcpu, wpte->pte_phys,
3281                                         wpte->pte_val);
3282         }
3283         case KVM_MMU_OP_FLUSH_TLB: {
3284                 struct kvm_mmu_op_flush_tlb *ftlb;
3285
3286                 ftlb = pv_mmu_read_buffer(buffer, sizeof *ftlb);
3287                 if (!ftlb)
3288                         return 0;
3289                 return kvm_pv_mmu_flush_tlb(vcpu);
3290         }
3291         case KVM_MMU_OP_RELEASE_PT: {
3292                 struct kvm_mmu_op_release_pt *rpt;
3293
3294                 rpt = pv_mmu_read_buffer(buffer, sizeof *rpt);
3295                 if (!rpt)
3296                         return 0;
3297                 return kvm_pv_mmu_release_pt(vcpu, rpt->pt_phys);
3298         }
3299         default: return 0;
3300         }
3301 }
3302
3303 int kvm_pv_mmu_op(struct kvm_vcpu *vcpu, unsigned long bytes,
3304                   gpa_t addr, unsigned long *ret)
3305 {
3306         int r;
3307         struct kvm_pv_mmu_op_buffer *buffer = &vcpu->arch.mmu_op_buffer;
3308
3309         buffer->ptr = buffer->buf;
3310         buffer->len = min_t(unsigned long, bytes, sizeof buffer->buf);
3311         buffer->processed = 0;
3312
3313         r = kvm_read_guest(vcpu->kvm, addr, buffer->buf, buffer->len);
3314         if (r)
3315                 goto out;
3316
3317         while (buffer->len) {
3318                 r = kvm_pv_mmu_op_one(vcpu, buffer);
3319                 if (r < 0)
3320                         goto out;
3321                 if (r == 0)
3322                         break;
3323         }
3324
3325         r = 1;
3326 out:
3327         *ret = buffer->processed;
3328         return r;
3329 }
3330
3331 int kvm_mmu_get_spte_hierarchy(struct kvm_vcpu *vcpu, u64 addr, u64 sptes[4])
3332 {
3333         struct kvm_shadow_walk_iterator iterator;
3334         int nr_sptes = 0;
3335
3336         spin_lock(&vcpu->kvm->mmu_lock);
3337         for_each_shadow_entry(vcpu, addr, iterator) {
3338                 sptes[iterator.level-1] = *iterator.sptep;
3339                 nr_sptes++;
3340                 if (!is_shadow_present_pte(*iterator.sptep))
3341                         break;
3342         }
3343         spin_unlock(&vcpu->kvm->mmu_lock);
3344
3345         return nr_sptes;
3346 }
3347 EXPORT_SYMBOL_GPL(kvm_mmu_get_spte_hierarchy);
3348
3349 #ifdef AUDIT
3350
3351 static const char *audit_msg;
3352
3353 static gva_t canonicalize(gva_t gva)
3354 {
3355 #ifdef CONFIG_X86_64
3356         gva = (long long)(gva << 16) >> 16;
3357 #endif
3358         return gva;
3359 }
3360
3361
3362 typedef void (*inspect_spte_fn) (struct kvm *kvm, u64 *sptep);
3363
3364 static void __mmu_spte_walk(struct kvm *kvm, struct kvm_mmu_page *sp,
3365                             inspect_spte_fn fn)
3366 {
3367         int i;
3368
3369         for (i = 0; i < PT64_ENT_PER_PAGE; ++i) {
3370                 u64 ent = sp->spt[i];
3371
3372                 if (is_shadow_present_pte(ent)) {
3373                         if (!is_last_spte(ent, sp->role.level)) {
3374                                 struct kvm_mmu_page *child;
3375                                 child = page_header(ent & PT64_BASE_ADDR_MASK);
3376                                 __mmu_spte_walk(kvm, child, fn);
3377                         } else
3378                                 fn(kvm, &sp->spt[i]);
3379                 }
3380         }
3381 }
3382
3383 static void mmu_spte_walk(struct kvm_vcpu *vcpu, inspect_spte_fn fn)
3384 {
3385         int i;
3386         struct kvm_mmu_page *sp;
3387
3388         if (!VALID_PAGE(vcpu->arch.mmu.root_hpa))
3389                 return;
3390         if (vcpu->arch.mmu.shadow_root_level == PT64_ROOT_LEVEL) {
3391                 hpa_t root = vcpu->arch.mmu.root_hpa;
3392                 sp = page_header(root);
3393                 __mmu_spte_walk(vcpu->kvm, sp, fn);
3394                 return;
3395         }
3396         for (i = 0; i < 4; ++i) {
3397                 hpa_t root = vcpu->arch.mmu.pae_root[i];
3398
3399                 if (root && VALID_PAGE(root)) {
3400                         root &= PT64_BASE_ADDR_MASK;
3401                         sp = page_header(root);
3402                         __mmu_spte_walk(vcpu->kvm, sp, fn);
3403                 }
3404         }
3405         return;
3406 }
3407
3408 static void audit_mappings_page(struct kvm_vcpu *vcpu, u64 page_pte,
3409                                 gva_t va, int level)
3410 {
3411         u64 *pt = __va(page_pte & PT64_BASE_ADDR_MASK);
3412         int i;
3413         gva_t va_delta = 1ul << (PAGE_SHIFT + 9 * (level - 1));
3414
3415         for (i = 0; i < PT64_ENT_PER_PAGE; ++i, va += va_delta) {
3416                 u64 ent = pt[i];
3417
3418                 if (ent == shadow_trap_nonpresent_pte)
3419                         continue;
3420
3421                 va = canonicalize(va);
3422                 if (is_shadow_present_pte(ent) && !is_last_spte(ent, level))
3423                         audit_mappings_page(vcpu, ent, va, level - 1);
3424                 else {
3425                         gpa_t gpa = kvm_mmu_gva_to_gpa_read(vcpu, va, NULL);
3426                         gfn_t gfn = gpa >> PAGE_SHIFT;
3427                         pfn_t pfn = gfn_to_pfn(vcpu->kvm, gfn);
3428                         hpa_t hpa = (hpa_t)pfn << PAGE_SHIFT;
3429
3430                         if (is_error_pfn(pfn)) {
3431                                 kvm_release_pfn_clean(pfn);
3432                                 continue;
3433                         }
3434
3435                         if (is_shadow_present_pte(ent)
3436                             && (ent & PT64_BASE_ADDR_MASK) != hpa)
3437                                 printk(KERN_ERR "xx audit error: (%s) levels %d"
3438                                        " gva %lx gpa %llx hpa %llx ent %llx %d\n",
3439                                        audit_msg, vcpu->arch.mmu.root_level,
3440                                        va, gpa, hpa, ent,
3441                                        is_shadow_present_pte(ent));
3442                         else if (ent == shadow_notrap_nonpresent_pte
3443                                  && !is_error_hpa(hpa))
3444                                 printk(KERN_ERR "audit: (%s) notrap shadow,"
3445                                        " valid guest gva %lx\n", audit_msg, va);
3446                         kvm_release_pfn_clean(pfn);
3447
3448                 }
3449         }
3450 }
3451
3452 static void audit_mappings(struct kvm_vcpu *vcpu)
3453 {
3454         unsigned i;
3455
3456         if (vcpu->arch.mmu.root_level == 4)
3457                 audit_mappings_page(vcpu, vcpu->arch.mmu.root_hpa, 0, 4);
3458         else
3459                 for (i = 0; i < 4; ++i)
3460                         if (vcpu->arch.mmu.pae_root[i] & PT_PRESENT_MASK)
3461                                 audit_mappings_page(vcpu,
3462                                                     vcpu->arch.mmu.pae_root[i],
3463                                                     i << 30,
3464                                                     2);
3465 }
3466
3467 static int count_rmaps(struct kvm_vcpu *vcpu)
3468 {
3469         struct kvm *kvm = vcpu->kvm;
3470         struct kvm_memslots *slots;
3471         int nmaps = 0;
3472         int i, j, k, idx;
3473
3474         idx = srcu_read_lock(&kvm->srcu);
3475         slots = kvm_memslots(kvm);
3476         for (i = 0; i < KVM_MEMORY_SLOTS; ++i) {
3477                 struct kvm_memory_slot *m = &slots->memslots[i];
3478                 struct kvm_rmap_desc *d;
3479
3480                 for (j = 0; j < m->npages; ++j) {
3481                         unsigned long *rmapp = &m->rmap[j];
3482
3483                         if (!*rmapp)
3484                                 continue;
3485                         if (!(*rmapp & 1)) {
3486                                 ++nmaps;
3487                                 continue;
3488                         }
3489                         d = (struct kvm_rmap_desc *)(*rmapp & ~1ul);
3490                         while (d) {
3491                                 for (k = 0; k < RMAP_EXT; ++k)
3492                                         if (d->sptes[k])
3493                                                 ++nmaps;
3494                                         else
3495                                                 break;
3496                                 d = d->more;
3497                         }
3498                 }
3499         }
3500         srcu_read_unlock(&kvm->srcu, idx);
3501         return nmaps;
3502 }
3503
3504 void inspect_spte_has_rmap(struct kvm *kvm, u64 *sptep)
3505 {
3506         unsigned long *rmapp;
3507         struct kvm_mmu_page *rev_sp;
3508         gfn_t gfn;
3509
3510         if (is_writable_pte(*sptep)) {
3511                 rev_sp = page_header(__pa(sptep));
3512                 gfn = kvm_mmu_page_get_gfn(rev_sp, sptep - rev_sp->spt);
3513
3514                 if (!gfn_to_memslot(kvm, gfn)) {
3515                         if (!printk_ratelimit())
3516                                 return;
3517                         printk(KERN_ERR "%s: no memslot for gfn %ld\n",
3518                                          audit_msg, gfn);
3519                         printk(KERN_ERR "%s: index %ld of sp (gfn=%lx)\n",
3520                                audit_msg, (long int)(sptep - rev_sp->spt),
3521                                         rev_sp->gfn);
3522                         dump_stack();
3523                         return;
3524                 }
3525
3526                 rmapp = gfn_to_rmap(kvm, gfn, rev_sp->role.level);
3527                 if (!*rmapp) {
3528                         if (!printk_ratelimit())
3529                                 return;
3530                         printk(KERN_ERR "%s: no rmap for writable spte %llx\n",
3531                                          audit_msg, *sptep);
3532                         dump_stack();
3533                 }
3534         }
3535
3536 }
3537
3538 void audit_writable_sptes_have_rmaps(struct kvm_vcpu *vcpu)
3539 {
3540         mmu_spte_walk(vcpu, inspect_spte_has_rmap);
3541 }
3542
3543 static void check_writable_mappings_rmap(struct kvm_vcpu *vcpu)
3544 {
3545         struct kvm_mmu_page *sp;
3546         int i;
3547
3548         list_for_each_entry(sp, &vcpu->kvm->arch.active_mmu_pages, link) {
3549                 u64 *pt = sp->spt;
3550
3551                 if (sp->role.level != PT_PAGE_TABLE_LEVEL)
3552                         continue;
3553
3554                 for (i = 0; i < PT64_ENT_PER_PAGE; ++i) {
3555                         u64 ent = pt[i];
3556
3557                         if (!(ent & PT_PRESENT_MASK))
3558                                 continue;
3559                         if (!is_writable_pte(ent))
3560                                 continue;
3561                         inspect_spte_has_rmap(vcpu->kvm, &pt[i]);
3562                 }
3563         }
3564         return;
3565 }
3566
3567 static void audit_rmap(struct kvm_vcpu *vcpu)
3568 {
3569         check_writable_mappings_rmap(vcpu);
3570         count_rmaps(vcpu);
3571 }
3572
3573 static void audit_write_protection(struct kvm_vcpu *vcpu)
3574 {
3575         struct kvm_mmu_page *sp;
3576         struct kvm_memory_slot *slot;
3577         unsigned long *rmapp;
3578         u64 *spte;
3579         gfn_t gfn;
3580
3581         list_for_each_entry(sp, &vcpu->kvm->arch.active_mmu_pages, link) {
3582                 if (sp->role.direct)
3583                         continue;
3584                 if (sp->unsync)
3585                         continue;
3586
3587                 slot = gfn_to_memslot(vcpu->kvm, sp->gfn);
3588                 rmapp = &slot->rmap[gfn - slot->base_gfn];
3589
3590                 spte = rmap_next(vcpu->kvm, rmapp, NULL);
3591                 while (spte) {
3592                         if (is_writable_pte(*spte))
3593                                 printk(KERN_ERR "%s: (%s) shadow page has "
3594                                 "writable mappings: gfn %lx role %x\n",
3595                                __func__, audit_msg, sp->gfn,
3596                                sp->role.word);
3597                         spte = rmap_next(vcpu->kvm, rmapp, spte);
3598                 }
3599         }
3600 }
3601
3602 static void kvm_mmu_audit(struct kvm_vcpu *vcpu, const char *msg)
3603 {
3604         int olddbg = dbg;
3605
3606         dbg = 0;
3607         audit_msg = msg;
3608         audit_rmap(vcpu);
3609         audit_write_protection(vcpu);
3610         if (strcmp("pre pte write", audit_msg) != 0)
3611                 audit_mappings(vcpu);
3612         audit_writable_sptes_have_rmaps(vcpu);
3613         dbg = olddbg;
3614 }
3615
3616 #endif