page_tables.c 24.6 KB
Newer Older
1 2 3 4 5 6 7 8
/*P:700 The pagetable code, on the other hand, still shows the scars of
 * previous encounters.  It's functional, and as neat as it can be in the
 * circumstances, but be wary, for these things are subtle and break easily.
 * The Guest provides a virtual to physical mapping, but we can neither trust
 * it nor use it: we verify and convert it here to point the hardware to the
 * actual Guest pages when running the Guest. :*/

/* Copyright (C) Rusty Russell IBM Corporation 2006.
R
Rusty Russell 已提交
9 10 11 12 13 14 15 16 17
 * GPL v2 and any later version */
#include <linux/mm.h>
#include <linux/types.h>
#include <linux/spinlock.h>
#include <linux/random.h>
#include <linux/percpu.h>
#include <asm/tlbflush.h>
#include "lg.h"

R
Rusty Russell 已提交
18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43
/*H:300
 * The Page Table Code
 *
 * We use two-level page tables for the Guest.  If you're not entirely
 * comfortable with virtual addresses, physical addresses and page tables then
 * I recommend you review lguest.c's "Page Table Handling" (with diagrams!).
 *
 * The Guest keeps page tables, but we maintain the actual ones here: these are
 * called "shadow" page tables.  Which is a very Guest-centric name: these are
 * the real page tables the CPU uses, although we keep them up to date to
 * reflect the Guest's.  (See what I mean about weird naming?  Since when do
 * shadows reflect anything?)
 *
 * Anyway, this is the most complicated part of the Host code.  There are seven
 * parts to this:
 *  (i) Setting up a page table entry for the Guest when it faults,
 *  (ii) Setting up the page table entry for the Guest stack,
 *  (iii) Setting up a page table entry when the Guest tells us it has changed,
 *  (iv) Switching page tables,
 *  (v) Flushing (thowing away) page tables,
 *  (vi) Mapping the Switcher when the Guest is about to run,
 *  (vii) Setting up the page tables initially.
 :*/

/* Pages a 4k long, and each page table entry is 4 bytes long, giving us 1024
 * (or 2^10) entries per page. */
R
Rusty Russell 已提交
44 45
#define PTES_PER_PAGE_SHIFT 10
#define PTES_PER_PAGE (1 << PTES_PER_PAGE_SHIFT)
R
Rusty Russell 已提交
46 47 48 49

/* 1024 entries in a page table page maps 1024 pages: 4MB.  The Switcher is
 * conveniently placed at the top 4MB, so it uses a separate, complete PTE
 * page.  */
R
Rusty Russell 已提交
50 51
#define SWITCHER_PGD_INDEX (PTES_PER_PAGE - 1)

R
Rusty Russell 已提交
52 53 54
/* We actually need a separate PTE page for each CPU.  Remember that after the
 * Switcher code itself comes two pages for each CPU, and we don't want this
 * CPU's guest to see the pages of any other CPU. */
R
Rusty Russell 已提交
55 56 57
static DEFINE_PER_CPU(spte_t *, switcher_pte_pages);
#define switcher_pte_page(cpu) per_cpu(switcher_pte_pages, cpu)

R
Rusty Russell 已提交
58 59 60 61 62 63 64
/*H:320 With our shadow and Guest types established, we need to deal with
 * them: the page table code is curly enough to need helper functions to keep
 * it clear and clean.
 *
 * The first helper takes a virtual address, and says which entry in the top
 * level page table deals with that address.  Since each top level entry deals
 * with 4M, this effectively divides by 4M. */
R
Rusty Russell 已提交
65 66 67 68 69
static unsigned vaddr_to_pgd_index(unsigned long vaddr)
{
	return vaddr >> (PAGE_SHIFT + PTES_PER_PAGE_SHIFT);
}

R
Rusty Russell 已提交
70 71 72 73 74 75 76
/* There are two functions which return pointers to the shadow (aka "real")
 * page tables.
 *
 * spgd_addr() takes the virtual address and returns a pointer to the top-level
 * page directory entry for that address.  Since we keep track of several page
 * tables, the "i" argument tells us which one we're interested in (it's
 * usually the current one). */
R
Rusty Russell 已提交
77 78 79 80
static spgd_t *spgd_addr(struct lguest *lg, u32 i, unsigned long vaddr)
{
	unsigned int index = vaddr_to_pgd_index(vaddr);

R
Rusty Russell 已提交
81
	/* We kill any Guest trying to touch the Switcher addresses. */
R
Rusty Russell 已提交
82 83 84 85
	if (index >= SWITCHER_PGD_INDEX) {
		kill_guest(lg, "attempt to access switcher pages");
		index = 0;
	}
R
Rusty Russell 已提交
86
	/* Return a pointer index'th pgd entry for the i'th page table. */
R
Rusty Russell 已提交
87 88 89
	return &lg->pgdirs[i].pgdir[index];
}

R
Rusty Russell 已提交
90 91 92
/* This routine then takes the PGD entry given above, which contains the
 * address of the PTE page.  It then returns a pointer to the PTE entry for the
 * given address. */
R
Rusty Russell 已提交
93 94 95
static spte_t *spte_addr(struct lguest *lg, spgd_t spgd, unsigned long vaddr)
{
	spte_t *page = __va(spgd.pfn << PAGE_SHIFT);
R
Rusty Russell 已提交
96
	/* You should never call this if the PGD entry wasn't valid */
R
Rusty Russell 已提交
97 98 99 100
	BUG_ON(!(spgd.flags & _PAGE_PRESENT));
	return &page[(vaddr >> PAGE_SHIFT) % PTES_PER_PAGE];
}

R
Rusty Russell 已提交
101 102
/* These two functions just like the above two, except they access the Guest
 * page tables.  Hence they return a Guest address. */
R
Rusty Russell 已提交
103 104 105 106 107 108 109 110 111 112 113 114 115 116
static unsigned long gpgd_addr(struct lguest *lg, unsigned long vaddr)
{
	unsigned int index = vaddr >> (PAGE_SHIFT + PTES_PER_PAGE_SHIFT);
	return lg->pgdirs[lg->pgdidx].cr3 + index * sizeof(gpgd_t);
}

static unsigned long gpte_addr(struct lguest *lg,
			       gpgd_t gpgd, unsigned long vaddr)
{
	unsigned long gpage = gpgd.pfn << PAGE_SHIFT;
	BUG_ON(!(gpgd.flags & _PAGE_PRESENT));
	return gpage + ((vaddr>>PAGE_SHIFT) % PTES_PER_PAGE) * sizeof(gpte_t);
}

R
Rusty Russell 已提交
117 118 119 120 121 122 123 124
/*H:350 This routine takes a page number given by the Guest and converts it to
 * an actual, physical page number.  It can fail for several reasons: the
 * virtual address might not be mapped by the Launcher, the write flag is set
 * and the page is read-only, or the write flag was set and the page was
 * shared so had to be copied, but we ran out of memory.
 *
 * This holds a reference to the page, so release_pte() is careful to
 * put that back. */
R
Rusty Russell 已提交
125 126 127
static unsigned long get_pfn(unsigned long virtpfn, int write)
{
	struct page *page;
R
Rusty Russell 已提交
128
	/* This value indicates failure. */
R
Rusty Russell 已提交
129 130
	unsigned long ret = -1UL;

R
Rusty Russell 已提交
131 132 133 134
	/* get_user_pages() is a complex interface: it gets the "struct
	 * vm_area_struct" and "struct page" assocated with a range of pages.
	 * It also needs the task's mmap_sem held, and is not very quick.
	 * It returns the number of pages it got. */
R
Rusty Russell 已提交
135 136 137 138 139 140 141 142
	down_read(&current->mm->mmap_sem);
	if (get_user_pages(current, current->mm, virtpfn << PAGE_SHIFT,
			   1, write, 1, &page, NULL) == 1)
		ret = page_to_pfn(page);
	up_read(&current->mm->mmap_sem);
	return ret;
}

R
Rusty Russell 已提交
143 144 145 146
/*H:340 Converting a Guest page table entry to a shadow (ie. real) page table
 * entry can be a little tricky.  The flags are (almost) the same, but the
 * Guest PTE contains a virtual page number: the CPU needs the real page
 * number. */
R
Rusty Russell 已提交
147 148 149 150 151
static spte_t gpte_to_spte(struct lguest *lg, gpte_t gpte, int write)
{
	spte_t spte;
	unsigned long pfn;

R
Rusty Russell 已提交
152 153 154 155
	/* The Guest sets the global flag, because it thinks that it is using
	 * PGE.  We only told it to use PGE so it would tell us whether it was
	 * flushing a kernel mapping or a userspace mapping.  We don't actually
	 * use the global bit, so throw it away. */
R
Rusty Russell 已提交
156
	spte.flags = (gpte.flags & ~_PAGE_GLOBAL);
R
Rusty Russell 已提交
157 158 159 160 161

	/* We need a temporary "unsigned long" variable to hold the answer from
	 * get_pfn(), because it returns 0xFFFFFFFF on failure, which wouldn't
	 * fit in spte.pfn.  get_pfn() finds the real physical number of the
	 * page, given the virtual number. */
R
Rusty Russell 已提交
162 163 164
	pfn = get_pfn(gpte.pfn, write);
	if (pfn == -1UL) {
		kill_guest(lg, "failed to get page %u", gpte.pfn);
R
Rusty Russell 已提交
165 166 167
		/* When we destroy the Guest, we'll go through the shadow page
		 * tables and release_pte() them.  Make sure we don't think
		 * this one is valid! */
R
Rusty Russell 已提交
168 169
		spte.flags = 0;
	}
R
Rusty Russell 已提交
170
	/* Now we assign the page number, and our shadow PTE is complete. */
R
Rusty Russell 已提交
171 172 173 174
	spte.pfn = pfn;
	return spte;
}

R
Rusty Russell 已提交
175
/*H:460 And to complete the chain, release_pte() looks like this: */
R
Rusty Russell 已提交
176 177
static void release_pte(spte_t pte)
{
R
Rusty Russell 已提交
178 179
	/* Remember that get_user_pages() took a reference to the page, in
	 * get_pfn()?  We have to put it back now. */
R
Rusty Russell 已提交
180 181 182
	if (pte.flags & _PAGE_PRESENT)
		put_page(pfn_to_page(pte.pfn));
}
R
Rusty Russell 已提交
183
/*:*/
R
Rusty Russell 已提交
184 185 186 187 188 189 190 191 192 193 194 195 196

static void check_gpte(struct lguest *lg, gpte_t gpte)
{
	if ((gpte.flags & (_PAGE_PWT|_PAGE_PSE)) || gpte.pfn >= lg->pfn_limit)
		kill_guest(lg, "bad page table entry");
}

static void check_gpgd(struct lguest *lg, gpgd_t gpgd)
{
	if ((gpgd.flags & ~_PAGE_TABLE) || gpgd.pfn >= lg->pfn_limit)
		kill_guest(lg, "bad page directory entry");
}

R
Rusty Russell 已提交
197 198 199 200 201 202 203 204 205 206
/*H:330
 * (i) Setting up a page table entry for the Guest when it faults
 *
 * We saw this call in run_guest(): when we see a page fault in the Guest, we
 * come here.  That's because we only set up the shadow page tables lazily as
 * they're needed, so we get page faults all the time and quietly fix them up
 * and return to the Guest without it knowing.
 *
 * If we fixed up the fault (ie. we mapped the address), this routine returns
 * true. */
R
Rusty Russell 已提交
207 208 209 210 211 212 213 214
int demand_page(struct lguest *lg, unsigned long vaddr, int errcode)
{
	gpgd_t gpgd;
	spgd_t *spgd;
	unsigned long gpte_ptr;
	gpte_t gpte;
	spte_t *spte;

R
Rusty Russell 已提交
215
	/* First step: get the top-level Guest page table entry. */
R
Rusty Russell 已提交
216
	gpgd = mkgpgd(lgread_u32(lg, gpgd_addr(lg, vaddr)));
R
Rusty Russell 已提交
217
	/* Toplevel not present?  We can't map it in. */
R
Rusty Russell 已提交
218 219 220
	if (!(gpgd.flags & _PAGE_PRESENT))
		return 0;

R
Rusty Russell 已提交
221
	/* Now look at the matching shadow entry. */
R
Rusty Russell 已提交
222 223
	spgd = spgd_addr(lg, lg->pgdidx, vaddr);
	if (!(spgd->flags & _PAGE_PRESENT)) {
R
Rusty Russell 已提交
224
		/* No shadow entry: allocate a new shadow PTE page. */
R
Rusty Russell 已提交
225
		unsigned long ptepage = get_zeroed_page(GFP_KERNEL);
R
Rusty Russell 已提交
226 227
		/* This is not really the Guest's fault, but killing it is
		 * simple for this corner case. */
R
Rusty Russell 已提交
228 229 230 231
		if (!ptepage) {
			kill_guest(lg, "out of memory allocating pte page");
			return 0;
		}
R
Rusty Russell 已提交
232
		/* We check that the Guest pgd is OK. */
R
Rusty Russell 已提交
233
		check_gpgd(lg, gpgd);
R
Rusty Russell 已提交
234 235
		/* And we copy the flags to the shadow PGD entry.  The page
		 * number in the shadow PGD is the page we just allocated. */
R
Rusty Russell 已提交
236 237 238
		spgd->raw.val = (__pa(ptepage) | gpgd.flags);
	}

R
Rusty Russell 已提交
239 240
	/* OK, now we look at the lower level in the Guest page table: keep its
	 * address, because we might update it later. */
R
Rusty Russell 已提交
241 242 243
	gpte_ptr = gpte_addr(lg, gpgd, vaddr);
	gpte = mkgpte(lgread_u32(lg, gpte_ptr));

R
Rusty Russell 已提交
244
	/* If this page isn't in the Guest page tables, we can't page it in. */
R
Rusty Russell 已提交
245 246 247
	if (!(gpte.flags & _PAGE_PRESENT))
		return 0;

R
Rusty Russell 已提交
248 249
	/* Check they're not trying to write to a page the Guest wants
	 * read-only (bit 2 of errcode == write). */
R
Rusty Russell 已提交
250 251 252
	if ((errcode & 2) && !(gpte.flags & _PAGE_RW))
		return 0;

R
Rusty Russell 已提交
253
	/* User access to a kernel page? (bit 3 == user access) */
R
Rusty Russell 已提交
254 255 256
	if ((errcode & 4) && !(gpte.flags & _PAGE_USER))
		return 0;

R
Rusty Russell 已提交
257 258
	/* Check that the Guest PTE flags are OK, and the page number is below
	 * the pfn_limit (ie. not mapping the Launcher binary). */
R
Rusty Russell 已提交
259
	check_gpte(lg, gpte);
R
Rusty Russell 已提交
260
	/* Add the _PAGE_ACCESSED and (for a write) _PAGE_DIRTY flag */
R
Rusty Russell 已提交
261 262 263 264
	gpte.flags |= _PAGE_ACCESSED;
	if (errcode & 2)
		gpte.flags |= _PAGE_DIRTY;

R
Rusty Russell 已提交
265
	/* Get the pointer to the shadow PTE entry we're going to set. */
R
Rusty Russell 已提交
266
	spte = spte_addr(lg, *spgd, vaddr);
R
Rusty Russell 已提交
267 268
	/* If there was a valid shadow PTE entry here before, we release it.
	 * This can happen with a write to a previously read-only entry. */
R
Rusty Russell 已提交
269 270
	release_pte(*spte);

R
Rusty Russell 已提交
271 272
	/* If this is a write, we insist that the Guest page is writable (the
	 * final arg to gpte_to_spte()). */
R
Rusty Russell 已提交
273 274 275
	if (gpte.flags & _PAGE_DIRTY)
		*spte = gpte_to_spte(lg, gpte, 1);
	else {
R
Rusty Russell 已提交
276 277 278 279
		/* If this is a read, don't set the "writable" bit in the page
		 * table entry, even if the Guest says it's writable.  That way
		 * we come back here when a write does actually ocur, so we can
		 * update the Guest's _PAGE_DIRTY flag. */
R
Rusty Russell 已提交
280 281 282 283 284
		gpte_t ro_gpte = gpte;
		ro_gpte.flags &= ~_PAGE_RW;
		*spte = gpte_to_spte(lg, ro_gpte, 0);
	}

R
Rusty Russell 已提交
285 286
	/* Finally, we write the Guest PTE entry back: we've set the
	 * _PAGE_ACCESSED and maybe the _PAGE_DIRTY flags. */
R
Rusty Russell 已提交
287
	lgwrite_u32(lg, gpte_ptr, gpte.raw.val);
R
Rusty Russell 已提交
288 289

	/* We succeeded in mapping the page! */
R
Rusty Russell 已提交
290 291 292
	return 1;
}

R
Rusty Russell 已提交
293 294 295 296 297 298 299 300
/*H:360 (ii) Setting up the page table entry for the Guest stack.
 *
 * Remember pin_stack_pages() which makes sure the stack is mapped?  It could
 * simply call demand_page(), but as we've seen that logic is quite long, and
 * usually the stack pages are already mapped anyway, so it's not required.
 *
 * This is a quick version which answers the question: is this virtual address
 * mapped by the shadow page tables, and is it writable? */
R
Rusty Russell 已提交
301 302 303 304 305
static int page_writable(struct lguest *lg, unsigned long vaddr)
{
	spgd_t *spgd;
	unsigned long flags;

R
Rusty Russell 已提交
306
	/* Look at the top level entry: is it present? */
R
Rusty Russell 已提交
307 308 309 310
	spgd = spgd_addr(lg, lg->pgdidx, vaddr);
	if (!(spgd->flags & _PAGE_PRESENT))
		return 0;

R
Rusty Russell 已提交
311 312
	/* Check the flags on the pte entry itself: it must be present and
	 * writable. */
R
Rusty Russell 已提交
313 314 315 316
	flags = spte_addr(lg, *spgd, vaddr)->flags;
	return (flags & (_PAGE_PRESENT|_PAGE_RW)) == (_PAGE_PRESENT|_PAGE_RW);
}

R
Rusty Russell 已提交
317 318 319
/* So, when pin_stack_pages() asks us to pin a page, we check if it's already
 * in the page tables, and if not, we call demand_page() with error code 2
 * (meaning "write"). */
R
Rusty Russell 已提交
320 321 322 323 324 325
void pin_page(struct lguest *lg, unsigned long vaddr)
{
	if (!page_writable(lg, vaddr) && !demand_page(lg, vaddr, 2))
		kill_guest(lg, "bad stack page %#lx", vaddr);
}

R
Rusty Russell 已提交
326
/*H:450 If we chase down the release_pgd() code, it looks like this: */
R
Rusty Russell 已提交
327 328
static void release_pgd(struct lguest *lg, spgd_t *spgd)
{
R
Rusty Russell 已提交
329
	/* If the entry's not present, there's nothing to release. */
R
Rusty Russell 已提交
330 331
	if (spgd->flags & _PAGE_PRESENT) {
		unsigned int i;
R
Rusty Russell 已提交
332 333 334
		/* Converting the pfn to find the actual PTE page is easy: turn
		 * the page number into a physical address, then convert to a
		 * virtual address (easy for kernel pages like this one). */
R
Rusty Russell 已提交
335
		spte_t *ptepage = __va(spgd->pfn << PAGE_SHIFT);
R
Rusty Russell 已提交
336
		/* For each entry in the page, we might need to release it. */
R
Rusty Russell 已提交
337 338
		for (i = 0; i < PTES_PER_PAGE; i++)
			release_pte(ptepage[i]);
R
Rusty Russell 已提交
339
		/* Now we can free the page of PTEs */
R
Rusty Russell 已提交
340
		free_page((long)ptepage);
R
Rusty Russell 已提交
341
		/* And zero out the PGD entry we we never release it twice. */
R
Rusty Russell 已提交
342 343 344 345
		spgd->raw.val = 0;
	}
}

R
Rusty Russell 已提交
346 347 348 349
/*H:440 (v) Flushing (thowing away) page tables,
 *
 * We saw flush_user_mappings() called when we re-used a top-level pgdir page.
 * It simply releases every PTE page from 0 up to the kernel address. */
R
Rusty Russell 已提交
350 351 352
static void flush_user_mappings(struct lguest *lg, int idx)
{
	unsigned int i;
R
Rusty Russell 已提交
353
	/* Release every pgd entry up to the kernel's address. */
R
Rusty Russell 已提交
354 355 356 357
	for (i = 0; i < vaddr_to_pgd_index(lg->page_offset); i++)
		release_pgd(lg, lg->pgdirs[idx].pgdir + i);
}

R
Rusty Russell 已提交
358 359
/* The Guest also has a hypercall to do this manually: it's used when a large
 * number of mappings have been changed. */
R
Rusty Russell 已提交
360 361
void guest_pagetable_flush_user(struct lguest *lg)
{
R
Rusty Russell 已提交
362
	/* Drop the userspace part of the current page table. */
R
Rusty Russell 已提交
363 364
	flush_user_mappings(lg, lg->pgdidx);
}
R
Rusty Russell 已提交
365
/*:*/
R
Rusty Russell 已提交
366

R
Rusty Russell 已提交
367 368 369
/* We keep several page tables.  This is a simple routine to find the page
 * table (if any) corresponding to this top-level address the Guest has given
 * us. */
R
Rusty Russell 已提交
370 371 372 373 374 375 376 377 378
static unsigned int find_pgdir(struct lguest *lg, unsigned long pgtable)
{
	unsigned int i;
	for (i = 0; i < ARRAY_SIZE(lg->pgdirs); i++)
		if (lg->pgdirs[i].cr3 == pgtable)
			break;
	return i;
}

R
Rusty Russell 已提交
379 380 381
/*H:435 And this is us, creating the new page directory.  If we really do
 * allocate a new one (and so the kernel parts are not there), we set
 * blank_pgdir. */
R
Rusty Russell 已提交
382 383 384 385 386 387
static unsigned int new_pgdir(struct lguest *lg,
			      unsigned long cr3,
			      int *blank_pgdir)
{
	unsigned int next;

R
Rusty Russell 已提交
388 389
	/* We pick one entry at random to throw out.  Choosing the Least
	 * Recently Used might be better, but this is easy. */
R
Rusty Russell 已提交
390
	next = random32() % ARRAY_SIZE(lg->pgdirs);
R
Rusty Russell 已提交
391
	/* If it's never been allocated at all before, try now. */
R
Rusty Russell 已提交
392 393
	if (!lg->pgdirs[next].pgdir) {
		lg->pgdirs[next].pgdir = (spgd_t *)get_zeroed_page(GFP_KERNEL);
R
Rusty Russell 已提交
394
		/* If the allocation fails, just keep using the one we have */
R
Rusty Russell 已提交
395 396 397
		if (!lg->pgdirs[next].pgdir)
			next = lg->pgdidx;
		else
R
Rusty Russell 已提交
398 399
			/* This is a blank page, so there are no kernel
			 * mappings: caller must map the stack! */
R
Rusty Russell 已提交
400 401
			*blank_pgdir = 1;
	}
R
Rusty Russell 已提交
402
	/* Record which Guest toplevel this shadows. */
R
Rusty Russell 已提交
403 404 405 406 407 408 409
	lg->pgdirs[next].cr3 = cr3;
	/* Release all the non-kernel mappings. */
	flush_user_mappings(lg, next);

	return next;
}

R
Rusty Russell 已提交
410 411 412 413
/*H:430 (iv) Switching page tables
 *
 * This is what happens when the Guest changes page tables (ie. changes the
 * top-level pgdir).  This happens on almost every context switch. */
R
Rusty Russell 已提交
414 415 416 417
void guest_new_pagetable(struct lguest *lg, unsigned long pgtable)
{
	int newpgdir, repin = 0;

R
Rusty Russell 已提交
418
	/* Look to see if we have this one already. */
R
Rusty Russell 已提交
419
	newpgdir = find_pgdir(lg, pgtable);
R
Rusty Russell 已提交
420 421
	/* If not, we allocate or mug an existing one: if it's a fresh one,
	 * repin gets set to 1. */
R
Rusty Russell 已提交
422 423
	if (newpgdir == ARRAY_SIZE(lg->pgdirs))
		newpgdir = new_pgdir(lg, pgtable, &repin);
R
Rusty Russell 已提交
424
	/* Change the current pgd index to the new one. */
R
Rusty Russell 已提交
425
	lg->pgdidx = newpgdir;
R
Rusty Russell 已提交
426
	/* If it was completely blank, we map in the Guest kernel stack */
R
Rusty Russell 已提交
427 428 429 430
	if (repin)
		pin_stack_pages(lg);
}

R
Rusty Russell 已提交
431 432
/*H:470 Finally, a routine which throws away everything: all PGD entries in all
 * the shadow page tables.  This is used when we destroy the Guest. */
R
Rusty Russell 已提交
433 434 435 436
static void release_all_pagetables(struct lguest *lg)
{
	unsigned int i, j;

R
Rusty Russell 已提交
437
	/* Every shadow pagetable this Guest has */
R
Rusty Russell 已提交
438 439
	for (i = 0; i < ARRAY_SIZE(lg->pgdirs); i++)
		if (lg->pgdirs[i].pgdir)
R
Rusty Russell 已提交
440
			/* Every PGD entry except the Switcher at the top */
R
Rusty Russell 已提交
441 442 443 444
			for (j = 0; j < SWITCHER_PGD_INDEX; j++)
				release_pgd(lg, lg->pgdirs[i].pgdir + j);
}

R
Rusty Russell 已提交
445 446 447
/* We also throw away everything when a Guest tells us it's changed a kernel
 * mapping.  Since kernel mappings are in every page table, it's easiest to
 * throw them all away.  This is amazingly slow, but thankfully rare. */
R
Rusty Russell 已提交
448 449 450
void guest_pagetable_clear_all(struct lguest *lg)
{
	release_all_pagetables(lg);
R
Rusty Russell 已提交
451
	/* We need the Guest kernel stack mapped again. */
R
Rusty Russell 已提交
452 453 454
	pin_stack_pages(lg);
}

R
Rusty Russell 已提交
455 456 457 458 459 460 461 462 463 464 465 466 467 468
/*H:420 This is the routine which actually sets the page table entry for then
 * "idx"'th shadow page table.
 *
 * Normally, we can just throw out the old entry and replace it with 0: if they
 * use it demand_page() will put the new entry in.  We need to do this anyway:
 * The Guest expects _PAGE_ACCESSED to be set on its PTE the first time a page
 * is read from, and _PAGE_DIRTY when it's written to.
 *
 * But Avi Kivity pointed out that most Operating Systems (Linux included) set
 * these bits on PTEs immediately anyway.  This is done to save the CPU from
 * having to update them, but it helps us the same way: if they set
 * _PAGE_ACCESSED then we can put a read-only PTE entry in immediately, and if
 * they set _PAGE_DIRTY then we can put a writable PTE entry in immediately.
 */
R
Rusty Russell 已提交
469 470 471
static void do_set_pte(struct lguest *lg, int idx,
		       unsigned long vaddr, gpte_t gpte)
{
R
Rusty Russell 已提交
472
	/* Look up the matching shadow page directot entry. */
R
Rusty Russell 已提交
473
	spgd_t *spgd = spgd_addr(lg, idx, vaddr);
R
Rusty Russell 已提交
474 475

	/* If the top level isn't present, there's no entry to update. */
R
Rusty Russell 已提交
476
	if (spgd->flags & _PAGE_PRESENT) {
R
Rusty Russell 已提交
477
		/* Otherwise, we start by releasing the existing entry. */
R
Rusty Russell 已提交
478 479
		spte_t *spte = spte_addr(lg, *spgd, vaddr);
		release_pte(*spte);
R
Rusty Russell 已提交
480 481 482 483

		/* If they're setting this entry as dirty or accessed, we might
		 * as well put that entry they've given us in now.  This shaves
		 * 10% off a copy-on-write micro-benchmark. */
R
Rusty Russell 已提交
484 485 486 487
		if (gpte.flags & (_PAGE_DIRTY | _PAGE_ACCESSED)) {
			check_gpte(lg, gpte);
			*spte = gpte_to_spte(lg, gpte, gpte.flags&_PAGE_DIRTY);
		} else
R
Rusty Russell 已提交
488
			/* Otherwise we can demand_page() it in later. */
R
Rusty Russell 已提交
489 490 491 492
			spte->raw.val = 0;
	}
}

R
Rusty Russell 已提交
493 494 495 496 497 498 499 500 501 502
/*H:410 Updating a PTE entry is a little trickier.
 *
 * We keep track of several different page tables (the Guest uses one for each
 * process, so it makes sense to cache at least a few).  Each of these have
 * identical kernel parts: ie. every mapping above PAGE_OFFSET is the same for
 * all processes.  So when the page table above that address changes, we update
 * all the page tables, not just the current one.  This is rare.
 *
 * The benefit is that when we have to track a new page table, we can copy keep
 * all the kernel mappings.  This speeds up context switch immensely. */
R
Rusty Russell 已提交
503 504 505
void guest_set_pte(struct lguest *lg,
		   unsigned long cr3, unsigned long vaddr, gpte_t gpte)
{
R
Rusty Russell 已提交
506 507
	/* Kernel mappings must be changed on all top levels.  Slow, but
	 * doesn't happen often. */
R
Rusty Russell 已提交
508 509 510 511 512 513
	if (vaddr >= lg->page_offset) {
		unsigned int i;
		for (i = 0; i < ARRAY_SIZE(lg->pgdirs); i++)
			if (lg->pgdirs[i].pgdir)
				do_set_pte(lg, i, vaddr, gpte);
	} else {
R
Rusty Russell 已提交
514
		/* Is this page table one we have a shadow for? */
R
Rusty Russell 已提交
515 516
		int pgdir = find_pgdir(lg, cr3);
		if (pgdir != ARRAY_SIZE(lg->pgdirs))
R
Rusty Russell 已提交
517
			/* If so, do the update. */
R
Rusty Russell 已提交
518 519 520 521
			do_set_pte(lg, pgdir, vaddr, gpte);
	}
}

R
Rusty Russell 已提交
522 523 524 525 526 527 528 529 530 531 532 533 534 535
/*H:400
 * (iii) Setting up a page table entry when the Guest tells us it has changed.
 *
 * Just like we did in interrupts_and_traps.c, it makes sense for us to deal
 * with the other side of page tables while we're here: what happens when the
 * Guest asks for a page table to be updated?
 *
 * We already saw that demand_page() will fill in the shadow page tables when
 * needed, so we can simply remove shadow page table entries whenever the Guest
 * tells us they've changed.  When the Guest tries to use the new entry it will
 * fault and demand_page() will fix it up.
 *
 * So with that in mind here's our code to to update a (top-level) PGD entry:
 */
R
Rusty Russell 已提交
536 537 538 539
void guest_set_pmd(struct lguest *lg, unsigned long cr3, u32 idx)
{
	int pgdir;

R
Rusty Russell 已提交
540 541
	/* The kernel seems to try to initialize this early on: we ignore its
	 * attempts to map over the Switcher. */
R
Rusty Russell 已提交
542 543 544
	if (idx >= SWITCHER_PGD_INDEX)
		return;

R
Rusty Russell 已提交
545
	/* If they're talking about a page table we have a shadow for... */
R
Rusty Russell 已提交
546 547
	pgdir = find_pgdir(lg, cr3);
	if (pgdir < ARRAY_SIZE(lg->pgdirs))
R
Rusty Russell 已提交
548
		/* ... throw it away. */
R
Rusty Russell 已提交
549 550 551
		release_pgd(lg, lg->pgdirs[pgdir].pgdir + idx);
}

R
Rusty Russell 已提交
552 553 554 555
/*H:500 (vii) Setting up the page tables initially.
 *
 * When a Guest is first created, the Launcher tells us where the toplevel of
 * its first page table is.  We set some things up here: */
R
Rusty Russell 已提交
556 557
int init_guest_pagetable(struct lguest *lg, unsigned long pgtable)
{
R
Rusty Russell 已提交
558 559 560
	/* In flush_user_mappings() we loop from 0 to
	 * "vaddr_to_pgd_index(lg->page_offset)".  This assumes it won't hit
	 * the Switcher mappings, so check that now. */
R
Rusty Russell 已提交
561 562
	if (vaddr_to_pgd_index(lg->page_offset) >= SWITCHER_PGD_INDEX)
		return -EINVAL;
R
Rusty Russell 已提交
563 564
	/* We start on the first shadow page table, and give it a blank PGD
	 * page. */
R
Rusty Russell 已提交
565 566 567 568 569 570 571 572
	lg->pgdidx = 0;
	lg->pgdirs[lg->pgdidx].cr3 = pgtable;
	lg->pgdirs[lg->pgdidx].pgdir = (spgd_t*)get_zeroed_page(GFP_KERNEL);
	if (!lg->pgdirs[lg->pgdidx].pgdir)
		return -ENOMEM;
	return 0;
}

R
Rusty Russell 已提交
573
/* When a Guest dies, our cleanup is fairly simple. */
R
Rusty Russell 已提交
574 575 576 577
void free_guest_pagetable(struct lguest *lg)
{
	unsigned int i;

R
Rusty Russell 已提交
578
	/* Throw away all page table pages. */
R
Rusty Russell 已提交
579
	release_all_pagetables(lg);
R
Rusty Russell 已提交
580
	/* Now free the top levels: free_page() can handle 0 just fine. */
R
Rusty Russell 已提交
581 582 583 584
	for (i = 0; i < ARRAY_SIZE(lg->pgdirs); i++)
		free_page((long)lg->pgdirs[i].pgdir);
}

R
Rusty Russell 已提交
585 586 587 588 589
/*H:480 (vi) Mapping the Switcher when the Guest is about to run.
 *
 * The Switcher and the two pages for this CPU need to be available to the
 * Guest (and not the pages for other CPUs).  We have the appropriate PTE pages
 * for each CPU already set up, we just need to hook them in. */
R
Rusty Russell 已提交
590 591 592 593 594 595
void map_switcher_in_guest(struct lguest *lg, struct lguest_pages *pages)
{
	spte_t *switcher_pte_page = __get_cpu_var(switcher_pte_pages);
	spgd_t switcher_pgd;
	spte_t regs_pte;

R
Rusty Russell 已提交
596 597
	/* Make the last PGD entry for this Guest point to the Switcher's PTE
	 * page for this CPU (with appropriate flags). */
R
Rusty Russell 已提交
598 599 600 601
	switcher_pgd.pfn = __pa(switcher_pte_page) >> PAGE_SHIFT;
	switcher_pgd.flags = _PAGE_KERNEL;
	lg->pgdirs[lg->pgdidx].pgdir[SWITCHER_PGD_INDEX] = switcher_pgd;

R
Rusty Russell 已提交
602 603 604 605 606 607 608
	/* We also change the Switcher PTE page.  When we're running the Guest,
	 * we want the Guest's "regs" page to appear where the first Switcher
	 * page for this CPU is.  This is an optimization: when the Switcher
	 * saves the Guest registers, it saves them into the first page of this
	 * CPU's "struct lguest_pages": if we make sure the Guest's register
	 * page is already mapped there, we don't have to copy them out
	 * again. */
R
Rusty Russell 已提交
609 610 611 612 613
	regs_pte.pfn = __pa(lg->regs_page) >> PAGE_SHIFT;
	regs_pte.flags = _PAGE_KERNEL;
	switcher_pte_page[(unsigned long)pages/PAGE_SIZE%PTES_PER_PAGE]
		= regs_pte;
}
R
Rusty Russell 已提交
614
/*:*/
R
Rusty Russell 已提交
615 616 617 618 619 620 621 622 623

static void free_switcher_pte_pages(void)
{
	unsigned int i;

	for_each_possible_cpu(i)
		free_page((long)switcher_pte_page(i));
}

R
Rusty Russell 已提交
624 625 626 627
/*H:520 Setting up the Switcher PTE page for given CPU is fairly easy, given
 * the CPU number and the "struct page"s for the Switcher code itself.
 *
 * Currently the Switcher is less than a page long, so "pages" is always 1. */
R
Rusty Russell 已提交
628 629 630 631 632 633 634
static __init void populate_switcher_pte_page(unsigned int cpu,
					      struct page *switcher_page[],
					      unsigned int pages)
{
	unsigned int i;
	spte_t *pte = switcher_pte_page(cpu);

R
Rusty Russell 已提交
635
	/* The first entries are easy: they map the Switcher code. */
R
Rusty Russell 已提交
636 637 638 639 640
	for (i = 0; i < pages; i++) {
		pte[i].pfn = page_to_pfn(switcher_page[i]);
		pte[i].flags = _PAGE_PRESENT|_PAGE_ACCESSED;
	}

R
Rusty Russell 已提交
641
	/* The only other thing we map is this CPU's pair of pages. */
R
Rusty Russell 已提交
642 643
	i = pages + cpu*2;

R
Rusty Russell 已提交
644
	/* First page (Guest registers) is writable from the Guest */
R
Rusty Russell 已提交
645 646
	pte[i].pfn = page_to_pfn(switcher_page[i]);
	pte[i].flags = _PAGE_PRESENT|_PAGE_ACCESSED|_PAGE_RW;
R
Rusty Russell 已提交
647 648
	/* The second page contains the "struct lguest_ro_state", and is
	 * read-only. */
R
Rusty Russell 已提交
649 650 651 652
	pte[i+1].pfn = page_to_pfn(switcher_page[i+1]);
	pte[i+1].flags = _PAGE_PRESENT|_PAGE_ACCESSED;
}

R
Rusty Russell 已提交
653 654
/*H:510 At boot or module load time, init_pagetables() allocates and populates
 * the Switcher PTE page for each CPU. */
R
Rusty Russell 已提交
655 656 657 658 659 660 661 662 663 664 665 666 667 668
__init int init_pagetables(struct page **switcher_page, unsigned int pages)
{
	unsigned int i;

	for_each_possible_cpu(i) {
		switcher_pte_page(i) = (spte_t *)get_zeroed_page(GFP_KERNEL);
		if (!switcher_pte_page(i)) {
			free_switcher_pte_pages();
			return -ENOMEM;
		}
		populate_switcher_pte_page(i, switcher_page, pages);
	}
	return 0;
}
R
Rusty Russell 已提交
669
/*:*/
R
Rusty Russell 已提交
670

R
Rusty Russell 已提交
671
/* Cleaning up simply involves freeing the PTE page for each CPU. */
R
Rusty Russell 已提交
672 673 674 675
void free_pagetables(void)
{
	free_switcher_pte_pages();
}