boot.c 45 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239
  1. /*P:010
  2. * A hypervisor allows multiple Operating Systems to run on a single machine.
  3. * To quote David Wheeler: "Any problem in computer science can be solved with
  4. * another layer of indirection."
  5. *
  6. * We keep things simple in two ways. First, we start with a normal Linux
  7. * kernel and insert a module (lg.ko) which allows us to run other Linux
  8. * kernels the same way we'd run processes. We call the first kernel the Host,
  9. * and the others the Guests. The program which sets up and configures Guests
  10. * (such as the example in Documentation/lguest/lguest.c) is called the
  11. * Launcher.
  12. *
  13. * Secondly, we only run specially modified Guests, not normal kernels: setting
  14. * CONFIG_LGUEST_GUEST to "y" compiles this file into the kernel so it knows
  15. * how to be a Guest at boot time. This means that you can use the same kernel
  16. * you boot normally (ie. as a Host) as a Guest.
  17. *
  18. * These Guests know that they cannot do privileged operations, such as disable
  19. * interrupts, and that they have to ask the Host to do such things explicitly.
  20. * This file consists of all the replacements for such low-level native
  21. * hardware operations: these special Guest versions call the Host.
  22. *
  23. * So how does the kernel know it's a Guest? We'll see that later, but let's
  24. * just say that we end up here where we replace the native functions various
  25. * "paravirt" structures with our Guest versions, then boot like normal. :*/
  26. /*
  27. * Copyright (C) 2006, Rusty Russell <rusty@rustcorp.com.au> IBM Corporation.
  28. *
  29. * This program is free software; you can redistribute it and/or modify
  30. * it under the terms of the GNU General Public License as published by
  31. * the Free Software Foundation; either version 2 of the License, or
  32. * (at your option) any later version.
  33. *
  34. * This program is distributed in the hope that it will be useful, but
  35. * WITHOUT ANY WARRANTY; without even the implied warranty of
  36. * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
  37. * NON INFRINGEMENT. See the GNU General Public License for more
  38. * details.
  39. *
  40. * You should have received a copy of the GNU General Public License
  41. * along with this program; if not, write to the Free Software
  42. * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  43. */
  44. #include <linux/kernel.h>
  45. #include <linux/start_kernel.h>
  46. #include <linux/string.h>
  47. #include <linux/console.h>
  48. #include <linux/screen_info.h>
  49. #include <linux/irq.h>
  50. #include <linux/interrupt.h>
  51. #include <linux/clocksource.h>
  52. #include <linux/clockchips.h>
  53. #include <linux/lguest.h>
  54. #include <linux/lguest_launcher.h>
  55. #include <linux/virtio_console.h>
  56. #include <linux/pm.h>
  57. #include <asm/apic.h>
  58. #include <asm/lguest.h>
  59. #include <asm/paravirt.h>
  60. #include <asm/param.h>
  61. #include <asm/page.h>
  62. #include <asm/pgtable.h>
  63. #include <asm/desc.h>
  64. #include <asm/setup.h>
  65. #include <asm/e820.h>
  66. #include <asm/mce.h>
  67. #include <asm/io.h>
  68. #include <asm/i387.h>
  69. #include <asm/stackprotector.h>
  70. #include <asm/reboot.h> /* for struct machine_ops */
  71. /*G:010 Welcome to the Guest!
  72. *
  73. * The Guest in our tale is a simple creature: identical to the Host but
  74. * behaving in simplified but equivalent ways. In particular, the Guest is the
  75. * same kernel as the Host (or at least, built from the same source code). :*/
  76. struct lguest_data lguest_data = {
  77. .hcall_status = { [0 ... LHCALL_RING_SIZE-1] = 0xFF },
  78. .noirq_start = (u32)lguest_noirq_start,
  79. .noirq_end = (u32)lguest_noirq_end,
  80. .kernel_address = PAGE_OFFSET,
  81. .blocked_interrupts = { 1 }, /* Block timer interrupts */
  82. .syscall_vec = SYSCALL_VECTOR,
  83. };
  84. /*G:037 async_hcall() is pretty simple: I'm quite proud of it really. We have a
  85. * ring buffer of stored hypercalls which the Host will run though next time we
  86. * do a normal hypercall. Each entry in the ring has 5 slots for the hypercall
  87. * arguments, and a "hcall_status" word which is 0 if the call is ready to go,
  88. * and 255 once the Host has finished with it.
  89. *
  90. * If we come around to a slot which hasn't been finished, then the table is
  91. * full and we just make the hypercall directly. This has the nice side
  92. * effect of causing the Host to run all the stored calls in the ring buffer
  93. * which empties it for next time! */
  94. static void async_hcall(unsigned long call, unsigned long arg1,
  95. unsigned long arg2, unsigned long arg3,
  96. unsigned long arg4)
  97. {
  98. /* Note: This code assumes we're uniprocessor. */
  99. static unsigned int next_call;
  100. unsigned long flags;
  101. /* Disable interrupts if not already disabled: we don't want an
  102. * interrupt handler making a hypercall while we're already doing
  103. * one! */
  104. local_irq_save(flags);
  105. if (lguest_data.hcall_status[next_call] != 0xFF) {
  106. /* Table full, so do normal hcall which will flush table. */
  107. kvm_hypercall4(call, arg1, arg2, arg3, arg4);
  108. } else {
  109. lguest_data.hcalls[next_call].arg0 = call;
  110. lguest_data.hcalls[next_call].arg1 = arg1;
  111. lguest_data.hcalls[next_call].arg2 = arg2;
  112. lguest_data.hcalls[next_call].arg3 = arg3;
  113. lguest_data.hcalls[next_call].arg4 = arg4;
  114. /* Arguments must all be written before we mark it to go */
  115. wmb();
  116. lguest_data.hcall_status[next_call] = 0;
  117. if (++next_call == LHCALL_RING_SIZE)
  118. next_call = 0;
  119. }
  120. local_irq_restore(flags);
  121. }
  122. /*G:035 Notice the lazy_hcall() above, rather than hcall(). This is our first
  123. * real optimization trick!
  124. *
  125. * When lazy_mode is set, it means we're allowed to defer all hypercalls and do
  126. * them as a batch when lazy_mode is eventually turned off. Because hypercalls
  127. * are reasonably expensive, batching them up makes sense. For example, a
  128. * large munmap might update dozens of page table entries: that code calls
  129. * paravirt_enter_lazy_mmu(), does the dozen updates, then calls
  130. * lguest_leave_lazy_mode().
  131. *
  132. * So, when we're in lazy mode, we call async_hcall() to store the call for
  133. * future processing: */
  134. static void lazy_hcall1(unsigned long call,
  135. unsigned long arg1)
  136. {
  137. if (paravirt_get_lazy_mode() == PARAVIRT_LAZY_NONE)
  138. kvm_hypercall1(call, arg1);
  139. else
  140. async_hcall(call, arg1, 0, 0, 0);
  141. }
  142. static void lazy_hcall2(unsigned long call,
  143. unsigned long arg1,
  144. unsigned long arg2)
  145. {
  146. if (paravirt_get_lazy_mode() == PARAVIRT_LAZY_NONE)
  147. kvm_hypercall2(call, arg1, arg2);
  148. else
  149. async_hcall(call, arg1, arg2, 0, 0);
  150. }
  151. static void lazy_hcall3(unsigned long call,
  152. unsigned long arg1,
  153. unsigned long arg2,
  154. unsigned long arg3)
  155. {
  156. if (paravirt_get_lazy_mode() == PARAVIRT_LAZY_NONE)
  157. kvm_hypercall3(call, arg1, arg2, arg3);
  158. else
  159. async_hcall(call, arg1, arg2, arg3, 0);
  160. }
  161. #ifdef CONFIG_X86_PAE
  162. static void lazy_hcall4(unsigned long call,
  163. unsigned long arg1,
  164. unsigned long arg2,
  165. unsigned long arg3,
  166. unsigned long arg4)
  167. {
  168. if (paravirt_get_lazy_mode() == PARAVIRT_LAZY_NONE)
  169. kvm_hypercall4(call, arg1, arg2, arg3, arg4);
  170. else
  171. async_hcall(call, arg1, arg2, arg3, arg4);
  172. }
  173. #endif
  174. /* When lazy mode is turned off reset the per-cpu lazy mode variable and then
  175. * issue the do-nothing hypercall to flush any stored calls. */
  176. static void lguest_leave_lazy_mmu_mode(void)
  177. {
  178. kvm_hypercall0(LHCALL_FLUSH_ASYNC);
  179. paravirt_leave_lazy_mmu();
  180. }
  181. static void lguest_end_context_switch(struct task_struct *next)
  182. {
  183. kvm_hypercall0(LHCALL_FLUSH_ASYNC);
  184. paravirt_end_context_switch(next);
  185. }
  186. /*G:032
  187. * After that diversion we return to our first native-instruction
  188. * replacements: four functions for interrupt control.
  189. *
  190. * The simplest way of implementing these would be to have "turn interrupts
  191. * off" and "turn interrupts on" hypercalls. Unfortunately, this is too slow:
  192. * these are by far the most commonly called functions of those we override.
  193. *
  194. * So instead we keep an "irq_enabled" field inside our "struct lguest_data",
  195. * which the Guest can update with a single instruction. The Host knows to
  196. * check there before it tries to deliver an interrupt.
  197. */
  198. /* save_flags() is expected to return the processor state (ie. "flags"). The
  199. * flags word contains all kind of stuff, but in practice Linux only cares
  200. * about the interrupt flag. Our "save_flags()" just returns that. */
  201. static unsigned long save_fl(void)
  202. {
  203. return lguest_data.irq_enabled;
  204. }
  205. /* Interrupts go off... */
  206. static void irq_disable(void)
  207. {
  208. lguest_data.irq_enabled = 0;
  209. }
  210. /* Let's pause a moment. Remember how I said these are called so often?
  211. * Jeremy Fitzhardinge optimized them so hard early in 2009 that he had to
  212. * break some rules. In particular, these functions are assumed to save their
  213. * own registers if they need to: normal C functions assume they can trash the
  214. * eax register. To use normal C functions, we use
  215. * PV_CALLEE_SAVE_REGS_THUNK(), which pushes %eax onto the stack, calls the
  216. * C function, then restores it. */
  217. PV_CALLEE_SAVE_REGS_THUNK(save_fl);
  218. PV_CALLEE_SAVE_REGS_THUNK(irq_disable);
  219. /*:*/
  220. /* These are in i386_head.S */
  221. extern void lg_irq_enable(void);
  222. extern void lg_restore_fl(unsigned long flags);
  223. /*M:003 Note that we don't check for outstanding interrupts when we re-enable
  224. * them (or when we unmask an interrupt). This seems to work for the moment,
  225. * since interrupts are rare and we'll just get the interrupt on the next timer
  226. * tick, but now we can run with CONFIG_NO_HZ, we should revisit this. One way
  227. * would be to put the "irq_enabled" field in a page by itself, and have the
  228. * Host write-protect it when an interrupt comes in when irqs are disabled.
  229. * There will then be a page fault as soon as interrupts are re-enabled.
  230. *
  231. * A better method is to implement soft interrupt disable generally for x86:
  232. * instead of disabling interrupts, we set a flag. If an interrupt does come
  233. * in, we then disable them for real. This is uncommon, so we could simply use
  234. * a hypercall for interrupt control and not worry about efficiency. :*/
  235. /*G:034
  236. * The Interrupt Descriptor Table (IDT).
  237. *
  238. * The IDT tells the processor what to do when an interrupt comes in. Each
  239. * entry in the table is a 64-bit descriptor: this holds the privilege level,
  240. * address of the handler, and... well, who cares? The Guest just asks the
  241. * Host to make the change anyway, because the Host controls the real IDT.
  242. */
  243. static void lguest_write_idt_entry(gate_desc *dt,
  244. int entrynum, const gate_desc *g)
  245. {
  246. /* The gate_desc structure is 8 bytes long: we hand it to the Host in
  247. * two 32-bit chunks. The whole 32-bit kernel used to hand descriptors
  248. * around like this; typesafety wasn't a big concern in Linux's early
  249. * years. */
  250. u32 *desc = (u32 *)g;
  251. /* Keep the local copy up to date. */
  252. native_write_idt_entry(dt, entrynum, g);
  253. /* Tell Host about this new entry. */
  254. kvm_hypercall3(LHCALL_LOAD_IDT_ENTRY, entrynum, desc[0], desc[1]);
  255. }
  256. /* Changing to a different IDT is very rare: we keep the IDT up-to-date every
  257. * time it is written, so we can simply loop through all entries and tell the
  258. * Host about them. */
  259. static void lguest_load_idt(const struct desc_ptr *desc)
  260. {
  261. unsigned int i;
  262. struct desc_struct *idt = (void *)desc->address;
  263. for (i = 0; i < (desc->size+1)/8; i++)
  264. kvm_hypercall3(LHCALL_LOAD_IDT_ENTRY, i, idt[i].a, idt[i].b);
  265. }
  266. /*
  267. * The Global Descriptor Table.
  268. *
  269. * The Intel architecture defines another table, called the Global Descriptor
  270. * Table (GDT). You tell the CPU where it is (and its size) using the "lgdt"
  271. * instruction, and then several other instructions refer to entries in the
  272. * table. There are three entries which the Switcher needs, so the Host simply
  273. * controls the entire thing and the Guest asks it to make changes using the
  274. * LOAD_GDT hypercall.
  275. *
  276. * This is the exactly like the IDT code.
  277. */
  278. static void lguest_load_gdt(const struct desc_ptr *desc)
  279. {
  280. unsigned int i;
  281. struct desc_struct *gdt = (void *)desc->address;
  282. for (i = 0; i < (desc->size+1)/8; i++)
  283. kvm_hypercall3(LHCALL_LOAD_GDT_ENTRY, i, gdt[i].a, gdt[i].b);
  284. }
  285. /* For a single GDT entry which changes, we do the lazy thing: alter our GDT,
  286. * then tell the Host to reload the entire thing. This operation is so rare
  287. * that this naive implementation is reasonable. */
  288. static void lguest_write_gdt_entry(struct desc_struct *dt, int entrynum,
  289. const void *desc, int type)
  290. {
  291. native_write_gdt_entry(dt, entrynum, desc, type);
  292. /* Tell Host about this new entry. */
  293. kvm_hypercall3(LHCALL_LOAD_GDT_ENTRY, entrynum,
  294. dt[entrynum].a, dt[entrynum].b);
  295. }
  296. /* OK, I lied. There are three "thread local storage" GDT entries which change
  297. * on every context switch (these three entries are how glibc implements
  298. * __thread variables). So we have a hypercall specifically for this case. */
  299. static void lguest_load_tls(struct thread_struct *t, unsigned int cpu)
  300. {
  301. /* There's one problem which normal hardware doesn't have: the Host
  302. * can't handle us removing entries we're currently using. So we clear
  303. * the GS register here: if it's needed it'll be reloaded anyway. */
  304. lazy_load_gs(0);
  305. lazy_hcall2(LHCALL_LOAD_TLS, __pa(&t->tls_array), cpu);
  306. }
  307. /*G:038 That's enough excitement for now, back to ploughing through each of
  308. * the different pv_ops structures (we're about 1/3 of the way through).
  309. *
  310. * This is the Local Descriptor Table, another weird Intel thingy. Linux only
  311. * uses this for some strange applications like Wine. We don't do anything
  312. * here, so they'll get an informative and friendly Segmentation Fault. */
  313. static void lguest_set_ldt(const void *addr, unsigned entries)
  314. {
  315. }
  316. /* This loads a GDT entry into the "Task Register": that entry points to a
  317. * structure called the Task State Segment. Some comments scattered though the
  318. * kernel code indicate that this used for task switching in ages past, along
  319. * with blood sacrifice and astrology.
  320. *
  321. * Now there's nothing interesting in here that we don't get told elsewhere.
  322. * But the native version uses the "ltr" instruction, which makes the Host
  323. * complain to the Guest about a Segmentation Fault and it'll oops. So we
  324. * override the native version with a do-nothing version. */
  325. static void lguest_load_tr_desc(void)
  326. {
  327. }
  328. /* The "cpuid" instruction is a way of querying both the CPU identity
  329. * (manufacturer, model, etc) and its features. It was introduced before the
  330. * Pentium in 1993 and keeps getting extended by both Intel, AMD and others.
  331. * As you might imagine, after a decade and a half this treatment, it is now a
  332. * giant ball of hair. Its entry in the current Intel manual runs to 28 pages.
  333. *
  334. * This instruction even it has its own Wikipedia entry. The Wikipedia entry
  335. * has been translated into 4 languages. I am not making this up!
  336. *
  337. * We could get funky here and identify ourselves as "GenuineLguest", but
  338. * instead we just use the real "cpuid" instruction. Then I pretty much turned
  339. * off feature bits until the Guest booted. (Don't say that: you'll damage
  340. * lguest sales!) Shut up, inner voice! (Hey, just pointing out that this is
  341. * hardly future proof.) Noone's listening! They don't like you anyway,
  342. * parenthetic weirdo!
  343. *
  344. * Replacing the cpuid so we can turn features off is great for the kernel, but
  345. * anyone (including userspace) can just use the raw "cpuid" instruction and
  346. * the Host won't even notice since it isn't privileged. So we try not to get
  347. * too worked up about it. */
  348. static void lguest_cpuid(unsigned int *ax, unsigned int *bx,
  349. unsigned int *cx, unsigned int *dx)
  350. {
  351. int function = *ax;
  352. native_cpuid(ax, bx, cx, dx);
  353. switch (function) {
  354. case 1: /* Basic feature request. */
  355. /* We only allow kernel to see SSE3, CMPXCHG16B and SSSE3 */
  356. *cx &= 0x00002201;
  357. /* SSE, SSE2, FXSR, MMX, CMOV, CMPXCHG8B, TSC, FPU, PAE. */
  358. *dx &= 0x07808151;
  359. /* The Host can do a nice optimization if it knows that the
  360. * kernel mappings (addresses above 0xC0000000 or whatever
  361. * PAGE_OFFSET is set to) haven't changed. But Linux calls
  362. * flush_tlb_user() for both user and kernel mappings unless
  363. * the Page Global Enable (PGE) feature bit is set. */
  364. *dx |= 0x00002000;
  365. /* We also lie, and say we're family id 5. 6 or greater
  366. * leads to a rdmsr in early_init_intel which we can't handle.
  367. * Family ID is returned as bits 8-12 in ax. */
  368. *ax &= 0xFFFFF0FF;
  369. *ax |= 0x00000500;
  370. break;
  371. case 0x80000000:
  372. /* Futureproof this a little: if they ask how much extended
  373. * processor information there is, limit it to known fields. */
  374. if (*ax > 0x80000008)
  375. *ax = 0x80000008;
  376. break;
  377. case 0x80000001:
  378. /* Here we should fix nx cap depending on host. */
  379. /* For this version of PAE, we just clear NX bit. */
  380. *dx &= ~(1 << 20);
  381. break;
  382. }
  383. }
  384. /* Intel has four control registers, imaginatively named cr0, cr2, cr3 and cr4.
  385. * I assume there's a cr1, but it hasn't bothered us yet, so we'll not bother
  386. * it. The Host needs to know when the Guest wants to change them, so we have
  387. * a whole series of functions like read_cr0() and write_cr0().
  388. *
  389. * We start with cr0. cr0 allows you to turn on and off all kinds of basic
  390. * features, but Linux only really cares about one: the horrifically-named Task
  391. * Switched (TS) bit at bit 3 (ie. 8)
  392. *
  393. * What does the TS bit do? Well, it causes the CPU to trap (interrupt 7) if
  394. * the floating point unit is used. Which allows us to restore FPU state
  395. * lazily after a task switch, and Linux uses that gratefully, but wouldn't a
  396. * name like "FPUTRAP bit" be a little less cryptic?
  397. *
  398. * We store cr0 locally because the Host never changes it. The Guest sometimes
  399. * wants to read it and we'd prefer not to bother the Host unnecessarily. */
  400. static unsigned long current_cr0;
  401. static void lguest_write_cr0(unsigned long val)
  402. {
  403. lazy_hcall1(LHCALL_TS, val & X86_CR0_TS);
  404. current_cr0 = val;
  405. }
  406. static unsigned long lguest_read_cr0(void)
  407. {
  408. return current_cr0;
  409. }
  410. /* Intel provided a special instruction to clear the TS bit for people too cool
  411. * to use write_cr0() to do it. This "clts" instruction is faster, because all
  412. * the vowels have been optimized out. */
  413. static void lguest_clts(void)
  414. {
  415. lazy_hcall1(LHCALL_TS, 0);
  416. current_cr0 &= ~X86_CR0_TS;
  417. }
  418. /* cr2 is the virtual address of the last page fault, which the Guest only ever
  419. * reads. The Host kindly writes this into our "struct lguest_data", so we
  420. * just read it out of there. */
  421. static unsigned long lguest_read_cr2(void)
  422. {
  423. return lguest_data.cr2;
  424. }
  425. /* See lguest_set_pte() below. */
  426. static bool cr3_changed = false;
  427. /* cr3 is the current toplevel pagetable page: the principle is the same as
  428. * cr0. Keep a local copy, and tell the Host when it changes. The only
  429. * difference is that our local copy is in lguest_data because the Host needs
  430. * to set it upon our initial hypercall. */
  431. static void lguest_write_cr3(unsigned long cr3)
  432. {
  433. lguest_data.pgdir = cr3;
  434. lazy_hcall1(LHCALL_NEW_PGTABLE, cr3);
  435. cr3_changed = true;
  436. }
  437. static unsigned long lguest_read_cr3(void)
  438. {
  439. return lguest_data.pgdir;
  440. }
  441. /* cr4 is used to enable and disable PGE, but we don't care. */
  442. static unsigned long lguest_read_cr4(void)
  443. {
  444. return 0;
  445. }
  446. static void lguest_write_cr4(unsigned long val)
  447. {
  448. }
  449. /*
  450. * Page Table Handling.
  451. *
  452. * Now would be a good time to take a rest and grab a coffee or similarly
  453. * relaxing stimulant. The easy parts are behind us, and the trek gradually
  454. * winds uphill from here.
  455. *
  456. * Quick refresher: memory is divided into "pages" of 4096 bytes each. The CPU
  457. * maps virtual addresses to physical addresses using "page tables". We could
  458. * use one huge index of 1 million entries: each address is 4 bytes, so that's
  459. * 1024 pages just to hold the page tables. But since most virtual addresses
  460. * are unused, we use a two level index which saves space. The cr3 register
  461. * contains the physical address of the top level "page directory" page, which
  462. * contains physical addresses of up to 1024 second-level pages. Each of these
  463. * second level pages contains up to 1024 physical addresses of actual pages,
  464. * or Page Table Entries (PTEs).
  465. *
  466. * Here's a diagram, where arrows indicate physical addresses:
  467. *
  468. * cr3 ---> +---------+
  469. * | --------->+---------+
  470. * | | | PADDR1 |
  471. * Top-level | | PADDR2 |
  472. * (PMD) page | | |
  473. * | | Lower-level |
  474. * | | (PTE) page |
  475. * | | | |
  476. * .... ....
  477. *
  478. * So to convert a virtual address to a physical address, we look up the top
  479. * level, which points us to the second level, which gives us the physical
  480. * address of that page. If the top level entry was not present, or the second
  481. * level entry was not present, then the virtual address is invalid (we
  482. * say "the page was not mapped").
  483. *
  484. * Put another way, a 32-bit virtual address is divided up like so:
  485. *
  486. * 1 1 0 0 0 0 0 0 0 0 0 1 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0
  487. * |<---- 10 bits ---->|<---- 10 bits ---->|<------ 12 bits ------>|
  488. * Index into top Index into second Offset within page
  489. * page directory page pagetable page
  490. *
  491. * The kernel spends a lot of time changing both the top-level page directory
  492. * and lower-level pagetable pages. The Guest doesn't know physical addresses,
  493. * so while it maintains these page tables exactly like normal, it also needs
  494. * to keep the Host informed whenever it makes a change: the Host will create
  495. * the real page tables based on the Guests'.
  496. */
  497. /* The Guest calls this to set a second-level entry (pte), ie. to map a page
  498. * into a process' address space. We set the entry then tell the Host the
  499. * toplevel and address this corresponds to. The Guest uses one pagetable per
  500. * process, so we need to tell the Host which one we're changing (mm->pgd). */
  501. static void lguest_pte_update(struct mm_struct *mm, unsigned long addr,
  502. pte_t *ptep)
  503. {
  504. #ifdef CONFIG_X86_PAE
  505. lazy_hcall4(LHCALL_SET_PTE, __pa(mm->pgd), addr,
  506. ptep->pte_low, ptep->pte_high);
  507. #else
  508. lazy_hcall3(LHCALL_SET_PTE, __pa(mm->pgd), addr, ptep->pte_low);
  509. #endif
  510. }
  511. static void lguest_set_pte_at(struct mm_struct *mm, unsigned long addr,
  512. pte_t *ptep, pte_t pteval)
  513. {
  514. native_set_pte(ptep, pteval);
  515. lguest_pte_update(mm, addr, ptep);
  516. }
  517. /* The Guest calls lguest_set_pud to set a top-level entry and lguest_set_pmd
  518. * to set a middle-level entry when PAE is activated.
  519. * Again, we set the entry then tell the Host which page we changed,
  520. * and the index of the entry we changed. */
  521. #ifdef CONFIG_X86_PAE
  522. static void lguest_set_pud(pud_t *pudp, pud_t pudval)
  523. {
  524. native_set_pud(pudp, pudval);
  525. /* 32 bytes aligned pdpt address and the index. */
  526. lazy_hcall2(LHCALL_SET_PGD, __pa(pudp) & 0xFFFFFFE0,
  527. (__pa(pudp) & 0x1F) / sizeof(pud_t));
  528. }
  529. static void lguest_set_pmd(pmd_t *pmdp, pmd_t pmdval)
  530. {
  531. native_set_pmd(pmdp, pmdval);
  532. lazy_hcall2(LHCALL_SET_PMD, __pa(pmdp) & PAGE_MASK,
  533. (__pa(pmdp) & (PAGE_SIZE - 1)) / sizeof(pmd_t));
  534. }
  535. #else
  536. /* The Guest calls lguest_set_pmd to set a top-level entry when PAE is not
  537. * activated. */
  538. static void lguest_set_pmd(pmd_t *pmdp, pmd_t pmdval)
  539. {
  540. native_set_pmd(pmdp, pmdval);
  541. lazy_hcall2(LHCALL_SET_PGD, __pa(pmdp) & PAGE_MASK,
  542. (__pa(pmdp) & (PAGE_SIZE - 1)) / sizeof(pmd_t));
  543. }
  544. #endif
  545. /* There are a couple of legacy places where the kernel sets a PTE, but we
  546. * don't know the top level any more. This is useless for us, since we don't
  547. * know which pagetable is changing or what address, so we just tell the Host
  548. * to forget all of them. Fortunately, this is very rare.
  549. *
  550. * ... except in early boot when the kernel sets up the initial pagetables,
  551. * which makes booting astonishingly slow: 1.83 seconds! So we don't even tell
  552. * the Host anything changed until we've done the first page table switch,
  553. * which brings boot back to 0.25 seconds. */
  554. static void lguest_set_pte(pte_t *ptep, pte_t pteval)
  555. {
  556. native_set_pte(ptep, pteval);
  557. if (cr3_changed)
  558. lazy_hcall1(LHCALL_FLUSH_TLB, 1);
  559. }
  560. #ifdef CONFIG_X86_PAE
  561. static void lguest_set_pte_atomic(pte_t *ptep, pte_t pte)
  562. {
  563. native_set_pte_atomic(ptep, pte);
  564. if (cr3_changed)
  565. lazy_hcall1(LHCALL_FLUSH_TLB, 1);
  566. }
  567. void lguest_pte_clear(struct mm_struct *mm, unsigned long addr, pte_t *ptep)
  568. {
  569. native_pte_clear(mm, addr, ptep);
  570. lguest_pte_update(mm, addr, ptep);
  571. }
  572. void lguest_pmd_clear(pmd_t *pmdp)
  573. {
  574. lguest_set_pmd(pmdp, __pmd(0));
  575. }
  576. #endif
  577. /* Unfortunately for Lguest, the pv_mmu_ops for page tables were based on
  578. * native page table operations. On native hardware you can set a new page
  579. * table entry whenever you want, but if you want to remove one you have to do
  580. * a TLB flush (a TLB is a little cache of page table entries kept by the CPU).
  581. *
  582. * So the lguest_set_pte_at() and lguest_set_pmd() functions above are only
  583. * called when a valid entry is written, not when it's removed (ie. marked not
  584. * present). Instead, this is where we come when the Guest wants to remove a
  585. * page table entry: we tell the Host to set that entry to 0 (ie. the present
  586. * bit is zero). */
  587. static void lguest_flush_tlb_single(unsigned long addr)
  588. {
  589. /* Simply set it to zero: if it was not, it will fault back in. */
  590. lazy_hcall3(LHCALL_SET_PTE, lguest_data.pgdir, addr, 0);
  591. }
  592. /* This is what happens after the Guest has removed a large number of entries.
  593. * This tells the Host that any of the page table entries for userspace might
  594. * have changed, ie. virtual addresses below PAGE_OFFSET. */
  595. static void lguest_flush_tlb_user(void)
  596. {
  597. lazy_hcall1(LHCALL_FLUSH_TLB, 0);
  598. }
  599. /* This is called when the kernel page tables have changed. That's not very
  600. * common (unless the Guest is using highmem, which makes the Guest extremely
  601. * slow), so it's worth separating this from the user flushing above. */
  602. static void lguest_flush_tlb_kernel(void)
  603. {
  604. lazy_hcall1(LHCALL_FLUSH_TLB, 1);
  605. }
  606. /*
  607. * The Unadvanced Programmable Interrupt Controller.
  608. *
  609. * This is an attempt to implement the simplest possible interrupt controller.
  610. * I spent some time looking though routines like set_irq_chip_and_handler,
  611. * set_irq_chip_and_handler_name, set_irq_chip_data and set_phasers_to_stun and
  612. * I *think* this is as simple as it gets.
  613. *
  614. * We can tell the Host what interrupts we want blocked ready for using the
  615. * lguest_data.interrupts bitmap, so disabling (aka "masking") them is as
  616. * simple as setting a bit. We don't actually "ack" interrupts as such, we
  617. * just mask and unmask them. I wonder if we should be cleverer?
  618. */
  619. static void disable_lguest_irq(unsigned int irq)
  620. {
  621. set_bit(irq, lguest_data.blocked_interrupts);
  622. }
  623. static void enable_lguest_irq(unsigned int irq)
  624. {
  625. clear_bit(irq, lguest_data.blocked_interrupts);
  626. }
  627. /* This structure describes the lguest IRQ controller. */
  628. static struct irq_chip lguest_irq_controller = {
  629. .name = "lguest",
  630. .mask = disable_lguest_irq,
  631. .mask_ack = disable_lguest_irq,
  632. .unmask = enable_lguest_irq,
  633. };
  634. /* This sets up the Interrupt Descriptor Table (IDT) entry for each hardware
  635. * interrupt (except 128, which is used for system calls), and then tells the
  636. * Linux infrastructure that each interrupt is controlled by our level-based
  637. * lguest interrupt controller. */
  638. static void __init lguest_init_IRQ(void)
  639. {
  640. unsigned int i;
  641. for (i = FIRST_EXTERNAL_VECTOR; i < NR_VECTORS; i++) {
  642. /* Some systems map "vectors" to interrupts weirdly. Lguest has
  643. * a straightforward 1 to 1 mapping, so force that here. */
  644. __get_cpu_var(vector_irq)[i] = i - FIRST_EXTERNAL_VECTOR;
  645. if (i != SYSCALL_VECTOR)
  646. set_intr_gate(i, interrupt[i - FIRST_EXTERNAL_VECTOR]);
  647. }
  648. /* This call is required to set up for 4k stacks, where we have
  649. * separate stacks for hard and soft interrupts. */
  650. irq_ctx_init(smp_processor_id());
  651. }
  652. void lguest_setup_irq(unsigned int irq)
  653. {
  654. irq_to_desc_alloc_node(irq, 0);
  655. set_irq_chip_and_handler_name(irq, &lguest_irq_controller,
  656. handle_level_irq, "level");
  657. }
  658. /*
  659. * Time.
  660. *
  661. * It would be far better for everyone if the Guest had its own clock, but
  662. * until then the Host gives us the time on every interrupt.
  663. */
  664. static unsigned long lguest_get_wallclock(void)
  665. {
  666. return lguest_data.time.tv_sec;
  667. }
  668. /* The TSC is an Intel thing called the Time Stamp Counter. The Host tells us
  669. * what speed it runs at, or 0 if it's unusable as a reliable clock source.
  670. * This matches what we want here: if we return 0 from this function, the x86
  671. * TSC clock will give up and not register itself. */
  672. static unsigned long lguest_tsc_khz(void)
  673. {
  674. return lguest_data.tsc_khz;
  675. }
  676. /* If we can't use the TSC, the kernel falls back to our lower-priority
  677. * "lguest_clock", where we read the time value given to us by the Host. */
  678. static cycle_t lguest_clock_read(struct clocksource *cs)
  679. {
  680. unsigned long sec, nsec;
  681. /* Since the time is in two parts (seconds and nanoseconds), we risk
  682. * reading it just as it's changing from 99 & 0.999999999 to 100 and 0,
  683. * and getting 99 and 0. As Linux tends to come apart under the stress
  684. * of time travel, we must be careful: */
  685. do {
  686. /* First we read the seconds part. */
  687. sec = lguest_data.time.tv_sec;
  688. /* This read memory barrier tells the compiler and the CPU that
  689. * this can't be reordered: we have to complete the above
  690. * before going on. */
  691. rmb();
  692. /* Now we read the nanoseconds part. */
  693. nsec = lguest_data.time.tv_nsec;
  694. /* Make sure we've done that. */
  695. rmb();
  696. /* Now if the seconds part has changed, try again. */
  697. } while (unlikely(lguest_data.time.tv_sec != sec));
  698. /* Our lguest clock is in real nanoseconds. */
  699. return sec*1000000000ULL + nsec;
  700. }
  701. /* This is the fallback clocksource: lower priority than the TSC clocksource. */
  702. static struct clocksource lguest_clock = {
  703. .name = "lguest",
  704. .rating = 200,
  705. .read = lguest_clock_read,
  706. .mask = CLOCKSOURCE_MASK(64),
  707. .mult = 1 << 22,
  708. .shift = 22,
  709. .flags = CLOCK_SOURCE_IS_CONTINUOUS,
  710. };
  711. /* We also need a "struct clock_event_device": Linux asks us to set it to go
  712. * off some time in the future. Actually, James Morris figured all this out, I
  713. * just applied the patch. */
  714. static int lguest_clockevent_set_next_event(unsigned long delta,
  715. struct clock_event_device *evt)
  716. {
  717. /* FIXME: I don't think this can ever happen, but James tells me he had
  718. * to put this code in. Maybe we should remove it now. Anyone? */
  719. if (delta < LG_CLOCK_MIN_DELTA) {
  720. if (printk_ratelimit())
  721. printk(KERN_DEBUG "%s: small delta %lu ns\n",
  722. __func__, delta);
  723. return -ETIME;
  724. }
  725. /* Please wake us this far in the future. */
  726. kvm_hypercall1(LHCALL_SET_CLOCKEVENT, delta);
  727. return 0;
  728. }
  729. static void lguest_clockevent_set_mode(enum clock_event_mode mode,
  730. struct clock_event_device *evt)
  731. {
  732. switch (mode) {
  733. case CLOCK_EVT_MODE_UNUSED:
  734. case CLOCK_EVT_MODE_SHUTDOWN:
  735. /* A 0 argument shuts the clock down. */
  736. kvm_hypercall0(LHCALL_SET_CLOCKEVENT);
  737. break;
  738. case CLOCK_EVT_MODE_ONESHOT:
  739. /* This is what we expect. */
  740. break;
  741. case CLOCK_EVT_MODE_PERIODIC:
  742. BUG();
  743. case CLOCK_EVT_MODE_RESUME:
  744. break;
  745. }
  746. }
  747. /* This describes our primitive timer chip. */
  748. static struct clock_event_device lguest_clockevent = {
  749. .name = "lguest",
  750. .features = CLOCK_EVT_FEAT_ONESHOT,
  751. .set_next_event = lguest_clockevent_set_next_event,
  752. .set_mode = lguest_clockevent_set_mode,
  753. .rating = INT_MAX,
  754. .mult = 1,
  755. .shift = 0,
  756. .min_delta_ns = LG_CLOCK_MIN_DELTA,
  757. .max_delta_ns = LG_CLOCK_MAX_DELTA,
  758. };
  759. /* This is the Guest timer interrupt handler (hardware interrupt 0). We just
  760. * call the clockevent infrastructure and it does whatever needs doing. */
  761. static void lguest_time_irq(unsigned int irq, struct irq_desc *desc)
  762. {
  763. unsigned long flags;
  764. /* Don't interrupt us while this is running. */
  765. local_irq_save(flags);
  766. lguest_clockevent.event_handler(&lguest_clockevent);
  767. local_irq_restore(flags);
  768. }
  769. /* At some point in the boot process, we get asked to set up our timing
  770. * infrastructure. The kernel doesn't expect timer interrupts before this, but
  771. * we cleverly initialized the "blocked_interrupts" field of "struct
  772. * lguest_data" so that timer interrupts were blocked until now. */
  773. static void lguest_time_init(void)
  774. {
  775. /* Set up the timer interrupt (0) to go to our simple timer routine */
  776. set_irq_handler(0, lguest_time_irq);
  777. clocksource_register(&lguest_clock);
  778. /* We can't set cpumask in the initializer: damn C limitations! Set it
  779. * here and register our timer device. */
  780. lguest_clockevent.cpumask = cpumask_of(0);
  781. clockevents_register_device(&lguest_clockevent);
  782. /* Finally, we unblock the timer interrupt. */
  783. enable_lguest_irq(0);
  784. }
  785. /*
  786. * Miscellaneous bits and pieces.
  787. *
  788. * Here is an oddball collection of functions which the Guest needs for things
  789. * to work. They're pretty simple.
  790. */
  791. /* The Guest needs to tell the Host what stack it expects traps to use. For
  792. * native hardware, this is part of the Task State Segment mentioned above in
  793. * lguest_load_tr_desc(), but to help hypervisors there's this special call.
  794. *
  795. * We tell the Host the segment we want to use (__KERNEL_DS is the kernel data
  796. * segment), the privilege level (we're privilege level 1, the Host is 0 and
  797. * will not tolerate us trying to use that), the stack pointer, and the number
  798. * of pages in the stack. */
  799. static void lguest_load_sp0(struct tss_struct *tss,
  800. struct thread_struct *thread)
  801. {
  802. lazy_hcall3(LHCALL_SET_STACK, __KERNEL_DS | 0x1, thread->sp0,
  803. THREAD_SIZE / PAGE_SIZE);
  804. }
  805. /* Let's just say, I wouldn't do debugging under a Guest. */
  806. static void lguest_set_debugreg(int regno, unsigned long value)
  807. {
  808. /* FIXME: Implement */
  809. }
  810. /* There are times when the kernel wants to make sure that no memory writes are
  811. * caught in the cache (that they've all reached real hardware devices). This
  812. * doesn't matter for the Guest which has virtual hardware.
  813. *
  814. * On the Pentium 4 and above, cpuid() indicates that the Cache Line Flush
  815. * (clflush) instruction is available and the kernel uses that. Otherwise, it
  816. * uses the older "Write Back and Invalidate Cache" (wbinvd) instruction.
  817. * Unlike clflush, wbinvd can only be run at privilege level 0. So we can
  818. * ignore clflush, but replace wbinvd.
  819. */
  820. static void lguest_wbinvd(void)
  821. {
  822. }
  823. /* If the Guest expects to have an Advanced Programmable Interrupt Controller,
  824. * we play dumb by ignoring writes and returning 0 for reads. So it's no
  825. * longer Programmable nor Controlling anything, and I don't think 8 lines of
  826. * code qualifies for Advanced. It will also never interrupt anything. It
  827. * does, however, allow us to get through the Linux boot code. */
  828. #ifdef CONFIG_X86_LOCAL_APIC
  829. static void lguest_apic_write(u32 reg, u32 v)
  830. {
  831. }
  832. static u32 lguest_apic_read(u32 reg)
  833. {
  834. return 0;
  835. }
  836. static u64 lguest_apic_icr_read(void)
  837. {
  838. return 0;
  839. }
  840. static void lguest_apic_icr_write(u32 low, u32 id)
  841. {
  842. /* Warn to see if there's any stray references */
  843. WARN_ON(1);
  844. }
  845. static void lguest_apic_wait_icr_idle(void)
  846. {
  847. return;
  848. }
  849. static u32 lguest_apic_safe_wait_icr_idle(void)
  850. {
  851. return 0;
  852. }
  853. static void set_lguest_basic_apic_ops(void)
  854. {
  855. apic->read = lguest_apic_read;
  856. apic->write = lguest_apic_write;
  857. apic->icr_read = lguest_apic_icr_read;
  858. apic->icr_write = lguest_apic_icr_write;
  859. apic->wait_icr_idle = lguest_apic_wait_icr_idle;
  860. apic->safe_wait_icr_idle = lguest_apic_safe_wait_icr_idle;
  861. };
  862. #endif
  863. /* STOP! Until an interrupt comes in. */
  864. static void lguest_safe_halt(void)
  865. {
  866. kvm_hypercall0(LHCALL_HALT);
  867. }
  868. /* The SHUTDOWN hypercall takes a string to describe what's happening, and
  869. * an argument which says whether this to restart (reboot) the Guest or not.
  870. *
  871. * Note that the Host always prefers that the Guest speak in physical addresses
  872. * rather than virtual addresses, so we use __pa() here. */
  873. static void lguest_power_off(void)
  874. {
  875. kvm_hypercall2(LHCALL_SHUTDOWN, __pa("Power down"),
  876. LGUEST_SHUTDOWN_POWEROFF);
  877. }
  878. /*
  879. * Panicing.
  880. *
  881. * Don't. But if you did, this is what happens.
  882. */
  883. static int lguest_panic(struct notifier_block *nb, unsigned long l, void *p)
  884. {
  885. kvm_hypercall2(LHCALL_SHUTDOWN, __pa(p), LGUEST_SHUTDOWN_POWEROFF);
  886. /* The hcall won't return, but to keep gcc happy, we're "done". */
  887. return NOTIFY_DONE;
  888. }
  889. static struct notifier_block paniced = {
  890. .notifier_call = lguest_panic
  891. };
  892. /* Setting up memory is fairly easy. */
  893. static __init char *lguest_memory_setup(void)
  894. {
  895. /* We do this here and not earlier because lockcheck used to barf if we
  896. * did it before start_kernel(). I think we fixed that, so it'd be
  897. * nice to move it back to lguest_init. Patch welcome... */
  898. atomic_notifier_chain_register(&panic_notifier_list, &paniced);
  899. /* The Linux bootloader header contains an "e820" memory map: the
  900. * Launcher populated the first entry with our memory limit. */
  901. e820_add_region(boot_params.e820_map[0].addr,
  902. boot_params.e820_map[0].size,
  903. boot_params.e820_map[0].type);
  904. /* This string is for the boot messages. */
  905. return "LGUEST";
  906. }
  907. /* We will eventually use the virtio console device to produce console output,
  908. * but before that is set up we use LHCALL_NOTIFY on normal memory to produce
  909. * console output. */
  910. static __init int early_put_chars(u32 vtermno, const char *buf, int count)
  911. {
  912. char scratch[17];
  913. unsigned int len = count;
  914. /* We use a nul-terminated string, so we have to make a copy. Icky,
  915. * huh? */
  916. if (len > sizeof(scratch) - 1)
  917. len = sizeof(scratch) - 1;
  918. scratch[len] = '\0';
  919. memcpy(scratch, buf, len);
  920. kvm_hypercall1(LHCALL_NOTIFY, __pa(scratch));
  921. /* This routine returns the number of bytes actually written. */
  922. return len;
  923. }
  924. /* Rebooting also tells the Host we're finished, but the RESTART flag tells the
  925. * Launcher to reboot us. */
  926. static void lguest_restart(char *reason)
  927. {
  928. kvm_hypercall2(LHCALL_SHUTDOWN, __pa(reason), LGUEST_SHUTDOWN_RESTART);
  929. }
  930. /*G:050
  931. * Patching (Powerfully Placating Performance Pedants)
  932. *
  933. * We have already seen that pv_ops structures let us replace simple native
  934. * instructions with calls to the appropriate back end all throughout the
  935. * kernel. This allows the same kernel to run as a Guest and as a native
  936. * kernel, but it's slow because of all the indirect branches.
  937. *
  938. * Remember that David Wheeler quote about "Any problem in computer science can
  939. * be solved with another layer of indirection"? The rest of that quote is
  940. * "... But that usually will create another problem." This is the first of
  941. * those problems.
  942. *
  943. * Our current solution is to allow the paravirt back end to optionally patch
  944. * over the indirect calls to replace them with something more efficient. We
  945. * patch two of the simplest of the most commonly called functions: disable
  946. * interrupts and save interrupts. We usually have 6 or 10 bytes to patch
  947. * into: the Guest versions of these operations are small enough that we can
  948. * fit comfortably.
  949. *
  950. * First we need assembly templates of each of the patchable Guest operations,
  951. * and these are in i386_head.S. */
  952. /*G:060 We construct a table from the assembler templates: */
  953. static const struct lguest_insns
  954. {
  955. const char *start, *end;
  956. } lguest_insns[] = {
  957. [PARAVIRT_PATCH(pv_irq_ops.irq_disable)] = { lgstart_cli, lgend_cli },
  958. [PARAVIRT_PATCH(pv_irq_ops.save_fl)] = { lgstart_pushf, lgend_pushf },
  959. };
  960. /* Now our patch routine is fairly simple (based on the native one in
  961. * paravirt.c). If we have a replacement, we copy it in and return how much of
  962. * the available space we used. */
  963. static unsigned lguest_patch(u8 type, u16 clobber, void *ibuf,
  964. unsigned long addr, unsigned len)
  965. {
  966. unsigned int insn_len;
  967. /* Don't do anything special if we don't have a replacement */
  968. if (type >= ARRAY_SIZE(lguest_insns) || !lguest_insns[type].start)
  969. return paravirt_patch_default(type, clobber, ibuf, addr, len);
  970. insn_len = lguest_insns[type].end - lguest_insns[type].start;
  971. /* Similarly if we can't fit replacement (shouldn't happen, but let's
  972. * be thorough). */
  973. if (len < insn_len)
  974. return paravirt_patch_default(type, clobber, ibuf, addr, len);
  975. /* Copy in our instructions. */
  976. memcpy(ibuf, lguest_insns[type].start, insn_len);
  977. return insn_len;
  978. }
  979. /*G:030 Once we get to lguest_init(), we know we're a Guest. The various
  980. * pv_ops structures in the kernel provide points for (almost) every routine we
  981. * have to override to avoid privileged instructions. */
  982. __init void lguest_init(void)
  983. {
  984. /* We're under lguest, paravirt is enabled, and we're running at
  985. * privilege level 1, not 0 as normal. */
  986. pv_info.name = "lguest";
  987. pv_info.paravirt_enabled = 1;
  988. pv_info.kernel_rpl = 1;
  989. pv_info.shared_kernel_pmd = 1;
  990. /* We set up all the lguest overrides for sensitive operations. These
  991. * are detailed with the operations themselves. */
  992. /* interrupt-related operations */
  993. pv_irq_ops.init_IRQ = lguest_init_IRQ;
  994. pv_irq_ops.save_fl = PV_CALLEE_SAVE(save_fl);
  995. pv_irq_ops.restore_fl = __PV_IS_CALLEE_SAVE(lg_restore_fl);
  996. pv_irq_ops.irq_disable = PV_CALLEE_SAVE(irq_disable);
  997. pv_irq_ops.irq_enable = __PV_IS_CALLEE_SAVE(lg_irq_enable);
  998. pv_irq_ops.safe_halt = lguest_safe_halt;
  999. /* init-time operations */
  1000. pv_init_ops.memory_setup = lguest_memory_setup;
  1001. pv_init_ops.patch = lguest_patch;
  1002. /* Intercepts of various cpu instructions */
  1003. pv_cpu_ops.load_gdt = lguest_load_gdt;
  1004. pv_cpu_ops.cpuid = lguest_cpuid;
  1005. pv_cpu_ops.load_idt = lguest_load_idt;
  1006. pv_cpu_ops.iret = lguest_iret;
  1007. pv_cpu_ops.load_sp0 = lguest_load_sp0;
  1008. pv_cpu_ops.load_tr_desc = lguest_load_tr_desc;
  1009. pv_cpu_ops.set_ldt = lguest_set_ldt;
  1010. pv_cpu_ops.load_tls = lguest_load_tls;
  1011. pv_cpu_ops.set_debugreg = lguest_set_debugreg;
  1012. pv_cpu_ops.clts = lguest_clts;
  1013. pv_cpu_ops.read_cr0 = lguest_read_cr0;
  1014. pv_cpu_ops.write_cr0 = lguest_write_cr0;
  1015. pv_cpu_ops.read_cr4 = lguest_read_cr4;
  1016. pv_cpu_ops.write_cr4 = lguest_write_cr4;
  1017. pv_cpu_ops.write_gdt_entry = lguest_write_gdt_entry;
  1018. pv_cpu_ops.write_idt_entry = lguest_write_idt_entry;
  1019. pv_cpu_ops.wbinvd = lguest_wbinvd;
  1020. pv_cpu_ops.start_context_switch = paravirt_start_context_switch;
  1021. pv_cpu_ops.end_context_switch = lguest_end_context_switch;
  1022. /* pagetable management */
  1023. pv_mmu_ops.write_cr3 = lguest_write_cr3;
  1024. pv_mmu_ops.flush_tlb_user = lguest_flush_tlb_user;
  1025. pv_mmu_ops.flush_tlb_single = lguest_flush_tlb_single;
  1026. pv_mmu_ops.flush_tlb_kernel = lguest_flush_tlb_kernel;
  1027. pv_mmu_ops.set_pte = lguest_set_pte;
  1028. pv_mmu_ops.set_pte_at = lguest_set_pte_at;
  1029. pv_mmu_ops.set_pmd = lguest_set_pmd;
  1030. #ifdef CONFIG_X86_PAE
  1031. pv_mmu_ops.set_pte_atomic = lguest_set_pte_atomic;
  1032. pv_mmu_ops.pte_clear = lguest_pte_clear;
  1033. pv_mmu_ops.pmd_clear = lguest_pmd_clear;
  1034. pv_mmu_ops.set_pud = lguest_set_pud;
  1035. #endif
  1036. pv_mmu_ops.read_cr2 = lguest_read_cr2;
  1037. pv_mmu_ops.read_cr3 = lguest_read_cr3;
  1038. pv_mmu_ops.lazy_mode.enter = paravirt_enter_lazy_mmu;
  1039. pv_mmu_ops.lazy_mode.leave = lguest_leave_lazy_mmu_mode;
  1040. pv_mmu_ops.pte_update = lguest_pte_update;
  1041. pv_mmu_ops.pte_update_defer = lguest_pte_update;
  1042. #ifdef CONFIG_X86_LOCAL_APIC
  1043. /* apic read/write intercepts */
  1044. set_lguest_basic_apic_ops();
  1045. #endif
  1046. /* time operations */
  1047. pv_time_ops.get_wallclock = lguest_get_wallclock;
  1048. pv_time_ops.time_init = lguest_time_init;
  1049. pv_time_ops.get_tsc_khz = lguest_tsc_khz;
  1050. /* Now is a good time to look at the implementations of these functions
  1051. * before returning to the rest of lguest_init(). */
  1052. /*G:070 Now we've seen all the paravirt_ops, we return to
  1053. * lguest_init() where the rest of the fairly chaotic boot setup
  1054. * occurs. */
  1055. /* The stack protector is a weird thing where gcc places a canary
  1056. * value on the stack and then checks it on return. This file is
  1057. * compiled with -fno-stack-protector it, so we got this far without
  1058. * problems. The value of the canary is kept at offset 20 from the
  1059. * %gs register, so we need to set that up before calling C functions
  1060. * in other files. */
  1061. setup_stack_canary_segment(0);
  1062. /* We could just call load_stack_canary_segment(), but we might as
  1063. * call switch_to_new_gdt() which loads the whole table and sets up
  1064. * the per-cpu segment descriptor register %fs as well. */
  1065. switch_to_new_gdt(0);
  1066. /* As described in head_32.S, we map the first 128M of memory. */
  1067. max_pfn_mapped = (128*1024*1024) >> PAGE_SHIFT;
  1068. /* The Host<->Guest Switcher lives at the top of our address space, and
  1069. * the Host told us how big it is when we made LGUEST_INIT hypercall:
  1070. * it put the answer in lguest_data.reserve_mem */
  1071. reserve_top_address(lguest_data.reserve_mem);
  1072. /* If we don't initialize the lock dependency checker now, it crashes
  1073. * paravirt_disable_iospace. */
  1074. lockdep_init();
  1075. /* The IDE code spends about 3 seconds probing for disks: if we reserve
  1076. * all the I/O ports up front it can't get them and so doesn't probe.
  1077. * Other device drivers are similar (but less severe). This cuts the
  1078. * kernel boot time on my machine from 4.1 seconds to 0.45 seconds. */
  1079. paravirt_disable_iospace();
  1080. /* This is messy CPU setup stuff which the native boot code does before
  1081. * start_kernel, so we have to do, too: */
  1082. cpu_detect(&new_cpu_data);
  1083. /* head.S usually sets up the first capability word, so do it here. */
  1084. new_cpu_data.x86_capability[0] = cpuid_edx(1);
  1085. /* Math is always hard! */
  1086. new_cpu_data.hard_math = 1;
  1087. /* We don't have features. We have puppies! Puppies! */
  1088. #ifdef CONFIG_X86_MCE
  1089. mce_disabled = 1;
  1090. #endif
  1091. #ifdef CONFIG_ACPI
  1092. acpi_disabled = 1;
  1093. acpi_ht = 0;
  1094. #endif
  1095. /* We set the preferred console to "hvc". This is the "hypervisor
  1096. * virtual console" driver written by the PowerPC people, which we also
  1097. * adapted for lguest's use. */
  1098. add_preferred_console("hvc", 0, NULL);
  1099. /* Register our very early console. */
  1100. virtio_cons_early_init(early_put_chars);
  1101. /* Last of all, we set the power management poweroff hook to point to
  1102. * the Guest routine to power off, and the reboot hook to our restart
  1103. * routine. */
  1104. pm_power_off = lguest_power_off;
  1105. machine_ops.restart = lguest_restart;
  1106. /* Now we're set up, call i386_start_kernel() in head32.c and we proceed
  1107. * to boot as normal. It never returns. */
  1108. i386_start_kernel();
  1109. }
  1110. /*
  1111. * This marks the end of stage II of our journey, The Guest.
  1112. *
  1113. * It is now time for us to explore the layer of virtual drivers and complete
  1114. * our understanding of the Guest in "make Drivers".
  1115. */