enlighten.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999
  1. /*
  2. * Core of Xen paravirt_ops implementation.
  3. *
  4. * This file contains the xen_paravirt_ops structure itself, and the
  5. * implementations for:
  6. * - privileged instructions
  7. * - interrupt flags
  8. * - segment operations
  9. * - booting and setup
  10. *
  11. * Jeremy Fitzhardinge <jeremy@xensource.com>, XenSource Inc, 2007
  12. */
  13. #include <linux/kernel.h>
  14. #include <linux/init.h>
  15. #include <linux/smp.h>
  16. #include <linux/preempt.h>
  17. #include <linux/hardirq.h>
  18. #include <linux/percpu.h>
  19. #include <linux/delay.h>
  20. #include <linux/start_kernel.h>
  21. #include <linux/sched.h>
  22. #include <linux/bootmem.h>
  23. #include <linux/module.h>
  24. #include <linux/mm.h>
  25. #include <linux/page-flags.h>
  26. #include <linux/highmem.h>
  27. #include <linux/console.h>
  28. #include <xen/interface/xen.h>
  29. #include <xen/interface/version.h>
  30. #include <xen/interface/physdev.h>
  31. #include <xen/interface/vcpu.h>
  32. #include <xen/features.h>
  33. #include <xen/page.h>
  34. #include <xen/hvc-console.h>
  35. #include <asm/paravirt.h>
  36. #include <asm/apic.h>
  37. #include <asm/page.h>
  38. #include <asm/xen/hypercall.h>
  39. #include <asm/xen/hypervisor.h>
  40. #include <asm/fixmap.h>
  41. #include <asm/processor.h>
  42. #include <asm/msr-index.h>
  43. #include <asm/setup.h>
  44. #include <asm/desc.h>
  45. #include <asm/pgtable.h>
  46. #include <asm/tlbflush.h>
  47. #include <asm/reboot.h>
  48. #include "xen-ops.h"
  49. #include "mmu.h"
  50. #include "multicalls.h"
  51. EXPORT_SYMBOL_GPL(hypercall_page);
  52. DEFINE_PER_CPU(struct vcpu_info *, xen_vcpu);
  53. DEFINE_PER_CPU(struct vcpu_info, xen_vcpu_info);
  54. enum xen_domain_type xen_domain_type = XEN_NATIVE;
  55. EXPORT_SYMBOL_GPL(xen_domain_type);
  56. struct start_info *xen_start_info;
  57. EXPORT_SYMBOL_GPL(xen_start_info);
  58. struct shared_info xen_dummy_shared_info;
  59. void *xen_initial_gdt;
  60. /*
  61. * Point at some empty memory to start with. We map the real shared_info
  62. * page as soon as fixmap is up and running.
  63. */
  64. struct shared_info *HYPERVISOR_shared_info = (void *)&xen_dummy_shared_info;
  65. /*
  66. * Flag to determine whether vcpu info placement is available on all
  67. * VCPUs. We assume it is to start with, and then set it to zero on
  68. * the first failure. This is because it can succeed on some VCPUs
  69. * and not others, since it can involve hypervisor memory allocation,
  70. * or because the guest failed to guarantee all the appropriate
  71. * constraints on all VCPUs (ie buffer can't cross a page boundary).
  72. *
  73. * Note that any particular CPU may be using a placed vcpu structure,
  74. * but we can only optimise if the all are.
  75. *
  76. * 0: not available, 1: available
  77. */
  78. static int have_vcpu_info_placement = 1;
  79. static void xen_vcpu_setup(int cpu)
  80. {
  81. struct vcpu_register_vcpu_info info;
  82. int err;
  83. struct vcpu_info *vcpup;
  84. BUG_ON(HYPERVISOR_shared_info == &xen_dummy_shared_info);
  85. per_cpu(xen_vcpu, cpu) = &HYPERVISOR_shared_info->vcpu_info[cpu];
  86. if (!have_vcpu_info_placement)
  87. return; /* already tested, not available */
  88. vcpup = &per_cpu(xen_vcpu_info, cpu);
  89. info.mfn = arbitrary_virt_to_mfn(vcpup);
  90. info.offset = offset_in_page(vcpup);
  91. printk(KERN_DEBUG "trying to map vcpu_info %d at %p, mfn %llx, offset %d\n",
  92. cpu, vcpup, info.mfn, info.offset);
  93. /* Check to see if the hypervisor will put the vcpu_info
  94. structure where we want it, which allows direct access via
  95. a percpu-variable. */
  96. err = HYPERVISOR_vcpu_op(VCPUOP_register_vcpu_info, cpu, &info);
  97. if (err) {
  98. printk(KERN_DEBUG "register_vcpu_info failed: err=%d\n", err);
  99. have_vcpu_info_placement = 0;
  100. } else {
  101. /* This cpu is using the registered vcpu info, even if
  102. later ones fail to. */
  103. per_cpu(xen_vcpu, cpu) = vcpup;
  104. printk(KERN_DEBUG "cpu %d using vcpu_info at %p\n",
  105. cpu, vcpup);
  106. }
  107. }
  108. /*
  109. * On restore, set the vcpu placement up again.
  110. * If it fails, then we're in a bad state, since
  111. * we can't back out from using it...
  112. */
  113. void xen_vcpu_restore(void)
  114. {
  115. if (have_vcpu_info_placement) {
  116. int cpu;
  117. for_each_online_cpu(cpu) {
  118. bool other_cpu = (cpu != smp_processor_id());
  119. if (other_cpu &&
  120. HYPERVISOR_vcpu_op(VCPUOP_down, cpu, NULL))
  121. BUG();
  122. xen_vcpu_setup(cpu);
  123. if (other_cpu &&
  124. HYPERVISOR_vcpu_op(VCPUOP_up, cpu, NULL))
  125. BUG();
  126. }
  127. BUG_ON(!have_vcpu_info_placement);
  128. }
  129. }
  130. static void __init xen_banner(void)
  131. {
  132. unsigned version = HYPERVISOR_xen_version(XENVER_version, NULL);
  133. struct xen_extraversion extra;
  134. HYPERVISOR_xen_version(XENVER_extraversion, &extra);
  135. printk(KERN_INFO "Booting paravirtualized kernel on %s\n",
  136. pv_info.name);
  137. printk(KERN_INFO "Xen version: %d.%d%s%s\n",
  138. version >> 16, version & 0xffff, extra.extraversion,
  139. xen_feature(XENFEAT_mmu_pt_update_preserve_ad) ? " (preserve-AD)" : "");
  140. }
  141. static void xen_cpuid(unsigned int *ax, unsigned int *bx,
  142. unsigned int *cx, unsigned int *dx)
  143. {
  144. unsigned maskedx = ~0;
  145. /*
  146. * Mask out inconvenient features, to try and disable as many
  147. * unsupported kernel subsystems as possible.
  148. */
  149. if (*ax == 1)
  150. maskedx = ~((1 << X86_FEATURE_APIC) | /* disable APIC */
  151. (1 << X86_FEATURE_ACPI) | /* disable ACPI */
  152. (1 << X86_FEATURE_MCE) | /* disable MCE */
  153. (1 << X86_FEATURE_MCA) | /* disable MCA */
  154. (1 << X86_FEATURE_ACC)); /* thermal monitoring */
  155. asm(XEN_EMULATE_PREFIX "cpuid"
  156. : "=a" (*ax),
  157. "=b" (*bx),
  158. "=c" (*cx),
  159. "=d" (*dx)
  160. : "0" (*ax), "2" (*cx));
  161. *dx &= maskedx;
  162. }
  163. static void xen_set_debugreg(int reg, unsigned long val)
  164. {
  165. HYPERVISOR_set_debugreg(reg, val);
  166. }
  167. static unsigned long xen_get_debugreg(int reg)
  168. {
  169. return HYPERVISOR_get_debugreg(reg);
  170. }
  171. void xen_leave_lazy(void)
  172. {
  173. paravirt_leave_lazy(paravirt_get_lazy_mode());
  174. xen_mc_flush();
  175. }
  176. static unsigned long xen_store_tr(void)
  177. {
  178. return 0;
  179. }
  180. /*
  181. * Set the page permissions for a particular virtual address. If the
  182. * address is a vmalloc mapping (or other non-linear mapping), then
  183. * find the linear mapping of the page and also set its protections to
  184. * match.
  185. */
  186. static void set_aliased_prot(void *v, pgprot_t prot)
  187. {
  188. int level;
  189. pte_t *ptep;
  190. pte_t pte;
  191. unsigned long pfn;
  192. struct page *page;
  193. ptep = lookup_address((unsigned long)v, &level);
  194. BUG_ON(ptep == NULL);
  195. pfn = pte_pfn(*ptep);
  196. page = pfn_to_page(pfn);
  197. pte = pfn_pte(pfn, prot);
  198. if (HYPERVISOR_update_va_mapping((unsigned long)v, pte, 0))
  199. BUG();
  200. if (!PageHighMem(page)) {
  201. void *av = __va(PFN_PHYS(pfn));
  202. if (av != v)
  203. if (HYPERVISOR_update_va_mapping((unsigned long)av, pte, 0))
  204. BUG();
  205. } else
  206. kmap_flush_unused();
  207. }
  208. static void xen_alloc_ldt(struct desc_struct *ldt, unsigned entries)
  209. {
  210. const unsigned entries_per_page = PAGE_SIZE / LDT_ENTRY_SIZE;
  211. int i;
  212. for(i = 0; i < entries; i += entries_per_page)
  213. set_aliased_prot(ldt + i, PAGE_KERNEL_RO);
  214. }
  215. static void xen_free_ldt(struct desc_struct *ldt, unsigned entries)
  216. {
  217. const unsigned entries_per_page = PAGE_SIZE / LDT_ENTRY_SIZE;
  218. int i;
  219. for(i = 0; i < entries; i += entries_per_page)
  220. set_aliased_prot(ldt + i, PAGE_KERNEL);
  221. }
  222. static void xen_set_ldt(const void *addr, unsigned entries)
  223. {
  224. struct mmuext_op *op;
  225. struct multicall_space mcs = xen_mc_entry(sizeof(*op));
  226. op = mcs.args;
  227. op->cmd = MMUEXT_SET_LDT;
  228. op->arg1.linear_addr = (unsigned long)addr;
  229. op->arg2.nr_ents = entries;
  230. MULTI_mmuext_op(mcs.mc, op, 1, NULL, DOMID_SELF);
  231. xen_mc_issue(PARAVIRT_LAZY_CPU);
  232. }
  233. static void xen_load_gdt(const struct desc_ptr *dtr)
  234. {
  235. unsigned long va = dtr->address;
  236. unsigned int size = dtr->size + 1;
  237. unsigned pages = (size + PAGE_SIZE - 1) / PAGE_SIZE;
  238. unsigned long frames[pages];
  239. int f;
  240. /* A GDT can be up to 64k in size, which corresponds to 8192
  241. 8-byte entries, or 16 4k pages.. */
  242. BUG_ON(size > 65536);
  243. BUG_ON(va & ~PAGE_MASK);
  244. for (f = 0; va < dtr->address + size; va += PAGE_SIZE, f++) {
  245. int level;
  246. pte_t *ptep = lookup_address(va, &level);
  247. unsigned long pfn, mfn;
  248. void *virt;
  249. BUG_ON(ptep == NULL);
  250. pfn = pte_pfn(*ptep);
  251. mfn = pfn_to_mfn(pfn);
  252. virt = __va(PFN_PHYS(pfn));
  253. frames[f] = mfn;
  254. printk("xen_load_gdt: %d va=%p mfn=%lx pfn=%lx va'=%p\n",
  255. f, (void *)va, mfn, pfn, virt);
  256. make_lowmem_page_readonly((void *)va);
  257. make_lowmem_page_readonly(virt);
  258. }
  259. if (HYPERVISOR_set_gdt(frames, size / sizeof(struct desc_struct)))
  260. BUG();
  261. }
  262. static void load_TLS_descriptor(struct thread_struct *t,
  263. unsigned int cpu, unsigned int i)
  264. {
  265. struct desc_struct *gdt = get_cpu_gdt_table(cpu);
  266. xmaddr_t maddr = arbitrary_virt_to_machine(&gdt[GDT_ENTRY_TLS_MIN+i]);
  267. struct multicall_space mc = __xen_mc_entry(0);
  268. MULTI_update_descriptor(mc.mc, maddr.maddr, t->tls_array[i]);
  269. }
  270. static void xen_load_tls(struct thread_struct *t, unsigned int cpu)
  271. {
  272. /*
  273. * XXX sleazy hack: If we're being called in a lazy-cpu zone
  274. * and lazy gs handling is enabled, it means we're in a
  275. * context switch, and %gs has just been saved. This means we
  276. * can zero it out to prevent faults on exit from the
  277. * hypervisor if the next process has no %gs. Either way, it
  278. * has been saved, and the new value will get loaded properly.
  279. * This will go away as soon as Xen has been modified to not
  280. * save/restore %gs for normal hypercalls.
  281. *
  282. * On x86_64, this hack is not used for %gs, because gs points
  283. * to KERNEL_GS_BASE (and uses it for PDA references), so we
  284. * must not zero %gs on x86_64
  285. *
  286. * For x86_64, we need to zero %fs, otherwise we may get an
  287. * exception between the new %fs descriptor being loaded and
  288. * %fs being effectively cleared at __switch_to().
  289. */
  290. if (paravirt_get_lazy_mode() == PARAVIRT_LAZY_CPU) {
  291. #ifdef CONFIG_X86_32
  292. lazy_load_gs(0);
  293. #else
  294. loadsegment(fs, 0);
  295. #endif
  296. }
  297. xen_mc_batch();
  298. load_TLS_descriptor(t, cpu, 0);
  299. load_TLS_descriptor(t, cpu, 1);
  300. load_TLS_descriptor(t, cpu, 2);
  301. xen_mc_issue(PARAVIRT_LAZY_CPU);
  302. }
  303. #ifdef CONFIG_X86_64
  304. static void xen_load_gs_index(unsigned int idx)
  305. {
  306. if (HYPERVISOR_set_segment_base(SEGBASE_GS_USER_SEL, idx))
  307. BUG();
  308. }
  309. #endif
  310. static void xen_write_ldt_entry(struct desc_struct *dt, int entrynum,
  311. const void *ptr)
  312. {
  313. xmaddr_t mach_lp = arbitrary_virt_to_machine(&dt[entrynum]);
  314. u64 entry = *(u64 *)ptr;
  315. preempt_disable();
  316. xen_mc_flush();
  317. if (HYPERVISOR_update_descriptor(mach_lp.maddr, entry))
  318. BUG();
  319. preempt_enable();
  320. }
  321. static int cvt_gate_to_trap(int vector, const gate_desc *val,
  322. struct trap_info *info)
  323. {
  324. if (val->type != 0xf && val->type != 0xe)
  325. return 0;
  326. info->vector = vector;
  327. info->address = gate_offset(*val);
  328. info->cs = gate_segment(*val);
  329. info->flags = val->dpl;
  330. /* interrupt gates clear IF */
  331. if (val->type == 0xe)
  332. info->flags |= 4;
  333. return 1;
  334. }
  335. /* Locations of each CPU's IDT */
  336. static DEFINE_PER_CPU(struct desc_ptr, idt_desc);
  337. /* Set an IDT entry. If the entry is part of the current IDT, then
  338. also update Xen. */
  339. static void xen_write_idt_entry(gate_desc *dt, int entrynum, const gate_desc *g)
  340. {
  341. unsigned long p = (unsigned long)&dt[entrynum];
  342. unsigned long start, end;
  343. preempt_disable();
  344. start = __get_cpu_var(idt_desc).address;
  345. end = start + __get_cpu_var(idt_desc).size + 1;
  346. xen_mc_flush();
  347. native_write_idt_entry(dt, entrynum, g);
  348. if (p >= start && (p + 8) <= end) {
  349. struct trap_info info[2];
  350. info[1].address = 0;
  351. if (cvt_gate_to_trap(entrynum, g, &info[0]))
  352. if (HYPERVISOR_set_trap_table(info))
  353. BUG();
  354. }
  355. preempt_enable();
  356. }
  357. static void xen_convert_trap_info(const struct desc_ptr *desc,
  358. struct trap_info *traps)
  359. {
  360. unsigned in, out, count;
  361. count = (desc->size+1) / sizeof(gate_desc);
  362. BUG_ON(count > 256);
  363. for (in = out = 0; in < count; in++) {
  364. gate_desc *entry = (gate_desc*)(desc->address) + in;
  365. if (cvt_gate_to_trap(in, entry, &traps[out]))
  366. out++;
  367. }
  368. traps[out].address = 0;
  369. }
  370. void xen_copy_trap_info(struct trap_info *traps)
  371. {
  372. const struct desc_ptr *desc = &__get_cpu_var(idt_desc);
  373. xen_convert_trap_info(desc, traps);
  374. }
  375. /* Load a new IDT into Xen. In principle this can be per-CPU, so we
  376. hold a spinlock to protect the static traps[] array (static because
  377. it avoids allocation, and saves stack space). */
  378. static void xen_load_idt(const struct desc_ptr *desc)
  379. {
  380. static DEFINE_SPINLOCK(lock);
  381. static struct trap_info traps[257];
  382. spin_lock(&lock);
  383. __get_cpu_var(idt_desc) = *desc;
  384. xen_convert_trap_info(desc, traps);
  385. xen_mc_flush();
  386. if (HYPERVISOR_set_trap_table(traps))
  387. BUG();
  388. spin_unlock(&lock);
  389. }
  390. /* Write a GDT descriptor entry. Ignore LDT descriptors, since
  391. they're handled differently. */
  392. static void xen_write_gdt_entry(struct desc_struct *dt, int entry,
  393. const void *desc, int type)
  394. {
  395. preempt_disable();
  396. switch (type) {
  397. case DESC_LDT:
  398. case DESC_TSS:
  399. /* ignore */
  400. break;
  401. default: {
  402. xmaddr_t maddr = arbitrary_virt_to_machine(&dt[entry]);
  403. xen_mc_flush();
  404. if (HYPERVISOR_update_descriptor(maddr.maddr, *(u64 *)desc))
  405. BUG();
  406. }
  407. }
  408. preempt_enable();
  409. }
  410. static void xen_load_sp0(struct tss_struct *tss,
  411. struct thread_struct *thread)
  412. {
  413. struct multicall_space mcs = xen_mc_entry(0);
  414. MULTI_stack_switch(mcs.mc, __KERNEL_DS, thread->sp0);
  415. xen_mc_issue(PARAVIRT_LAZY_CPU);
  416. }
  417. static void xen_set_iopl_mask(unsigned mask)
  418. {
  419. struct physdev_set_iopl set_iopl;
  420. /* Force the change at ring 0. */
  421. set_iopl.iopl = (mask == 0) ? 1 : (mask >> 12) & 3;
  422. HYPERVISOR_physdev_op(PHYSDEVOP_set_iopl, &set_iopl);
  423. }
  424. static void xen_io_delay(void)
  425. {
  426. }
  427. #ifdef CONFIG_X86_LOCAL_APIC
  428. static u32 xen_apic_read(u32 reg)
  429. {
  430. return 0;
  431. }
  432. static void xen_apic_write(u32 reg, u32 val)
  433. {
  434. /* Warn to see if there's any stray references */
  435. WARN_ON(1);
  436. }
  437. static u64 xen_apic_icr_read(void)
  438. {
  439. return 0;
  440. }
  441. static void xen_apic_icr_write(u32 low, u32 id)
  442. {
  443. /* Warn to see if there's any stray references */
  444. WARN_ON(1);
  445. }
  446. static void xen_apic_wait_icr_idle(void)
  447. {
  448. return;
  449. }
  450. static u32 xen_safe_apic_wait_icr_idle(void)
  451. {
  452. return 0;
  453. }
  454. static void set_xen_basic_apic_ops(void)
  455. {
  456. apic->read = xen_apic_read;
  457. apic->write = xen_apic_write;
  458. apic->icr_read = xen_apic_icr_read;
  459. apic->icr_write = xen_apic_icr_write;
  460. apic->wait_icr_idle = xen_apic_wait_icr_idle;
  461. apic->safe_wait_icr_idle = xen_safe_apic_wait_icr_idle;
  462. }
  463. #endif
  464. static void xen_clts(void)
  465. {
  466. struct multicall_space mcs;
  467. mcs = xen_mc_entry(0);
  468. MULTI_fpu_taskswitch(mcs.mc, 0);
  469. xen_mc_issue(PARAVIRT_LAZY_CPU);
  470. }
  471. static void xen_write_cr0(unsigned long cr0)
  472. {
  473. struct multicall_space mcs;
  474. /* Only pay attention to cr0.TS; everything else is
  475. ignored. */
  476. mcs = xen_mc_entry(0);
  477. MULTI_fpu_taskswitch(mcs.mc, (cr0 & X86_CR0_TS) != 0);
  478. xen_mc_issue(PARAVIRT_LAZY_CPU);
  479. }
  480. static void xen_write_cr4(unsigned long cr4)
  481. {
  482. cr4 &= ~X86_CR4_PGE;
  483. cr4 &= ~X86_CR4_PSE;
  484. native_write_cr4(cr4);
  485. }
  486. static int xen_write_msr_safe(unsigned int msr, unsigned low, unsigned high)
  487. {
  488. int ret;
  489. ret = 0;
  490. switch (msr) {
  491. #ifdef CONFIG_X86_64
  492. unsigned which;
  493. u64 base;
  494. case MSR_FS_BASE: which = SEGBASE_FS; goto set;
  495. case MSR_KERNEL_GS_BASE: which = SEGBASE_GS_USER; goto set;
  496. case MSR_GS_BASE: which = SEGBASE_GS_KERNEL; goto set;
  497. set:
  498. base = ((u64)high << 32) | low;
  499. if (HYPERVISOR_set_segment_base(which, base) != 0)
  500. ret = -EFAULT;
  501. break;
  502. #endif
  503. case MSR_STAR:
  504. case MSR_CSTAR:
  505. case MSR_LSTAR:
  506. case MSR_SYSCALL_MASK:
  507. case MSR_IA32_SYSENTER_CS:
  508. case MSR_IA32_SYSENTER_ESP:
  509. case MSR_IA32_SYSENTER_EIP:
  510. /* Fast syscall setup is all done in hypercalls, so
  511. these are all ignored. Stub them out here to stop
  512. Xen console noise. */
  513. break;
  514. default:
  515. ret = native_write_msr_safe(msr, low, high);
  516. }
  517. return ret;
  518. }
  519. void xen_setup_shared_info(void)
  520. {
  521. if (!xen_feature(XENFEAT_auto_translated_physmap)) {
  522. set_fixmap(FIX_PARAVIRT_BOOTMAP,
  523. xen_start_info->shared_info);
  524. HYPERVISOR_shared_info =
  525. (struct shared_info *)fix_to_virt(FIX_PARAVIRT_BOOTMAP);
  526. } else
  527. HYPERVISOR_shared_info =
  528. (struct shared_info *)__va(xen_start_info->shared_info);
  529. #ifndef CONFIG_SMP
  530. /* In UP this is as good a place as any to set up shared info */
  531. xen_setup_vcpu_info_placement();
  532. #endif
  533. xen_setup_mfn_list_list();
  534. }
  535. /* This is called once we have the cpu_possible_map */
  536. void xen_setup_vcpu_info_placement(void)
  537. {
  538. int cpu;
  539. for_each_possible_cpu(cpu)
  540. xen_vcpu_setup(cpu);
  541. /* xen_vcpu_setup managed to place the vcpu_info within the
  542. percpu area for all cpus, so make use of it */
  543. if (have_vcpu_info_placement) {
  544. printk(KERN_INFO "Xen: using vcpu_info placement\n");
  545. pv_irq_ops.save_fl = __PV_IS_CALLEE_SAVE(xen_save_fl_direct);
  546. pv_irq_ops.restore_fl = __PV_IS_CALLEE_SAVE(xen_restore_fl_direct);
  547. pv_irq_ops.irq_disable = __PV_IS_CALLEE_SAVE(xen_irq_disable_direct);
  548. pv_irq_ops.irq_enable = __PV_IS_CALLEE_SAVE(xen_irq_enable_direct);
  549. pv_mmu_ops.read_cr2 = xen_read_cr2_direct;
  550. }
  551. }
  552. static unsigned xen_patch(u8 type, u16 clobbers, void *insnbuf,
  553. unsigned long addr, unsigned len)
  554. {
  555. char *start, *end, *reloc;
  556. unsigned ret;
  557. start = end = reloc = NULL;
  558. #define SITE(op, x) \
  559. case PARAVIRT_PATCH(op.x): \
  560. if (have_vcpu_info_placement) { \
  561. start = (char *)xen_##x##_direct; \
  562. end = xen_##x##_direct_end; \
  563. reloc = xen_##x##_direct_reloc; \
  564. } \
  565. goto patch_site
  566. switch (type) {
  567. SITE(pv_irq_ops, irq_enable);
  568. SITE(pv_irq_ops, irq_disable);
  569. SITE(pv_irq_ops, save_fl);
  570. SITE(pv_irq_ops, restore_fl);
  571. #undef SITE
  572. patch_site:
  573. if (start == NULL || (end-start) > len)
  574. goto default_patch;
  575. ret = paravirt_patch_insns(insnbuf, len, start, end);
  576. /* Note: because reloc is assigned from something that
  577. appears to be an array, gcc assumes it's non-null,
  578. but doesn't know its relationship with start and
  579. end. */
  580. if (reloc > start && reloc < end) {
  581. int reloc_off = reloc - start;
  582. long *relocp = (long *)(insnbuf + reloc_off);
  583. long delta = start - (char *)addr;
  584. *relocp += delta;
  585. }
  586. break;
  587. default_patch:
  588. default:
  589. ret = paravirt_patch_default(type, clobbers, insnbuf,
  590. addr, len);
  591. break;
  592. }
  593. return ret;
  594. }
  595. static const struct pv_info xen_info __initdata = {
  596. .paravirt_enabled = 1,
  597. .shared_kernel_pmd = 0,
  598. .name = "Xen",
  599. };
  600. static const struct pv_init_ops xen_init_ops __initdata = {
  601. .patch = xen_patch,
  602. .banner = xen_banner,
  603. .memory_setup = xen_memory_setup,
  604. .arch_setup = xen_arch_setup,
  605. .post_allocator_init = xen_post_allocator_init,
  606. };
  607. static const struct pv_time_ops xen_time_ops __initdata = {
  608. .time_init = xen_time_init,
  609. .set_wallclock = xen_set_wallclock,
  610. .get_wallclock = xen_get_wallclock,
  611. .get_tsc_khz = xen_tsc_khz,
  612. .sched_clock = xen_sched_clock,
  613. };
  614. static const struct pv_cpu_ops xen_cpu_ops __initdata = {
  615. .cpuid = xen_cpuid,
  616. .set_debugreg = xen_set_debugreg,
  617. .get_debugreg = xen_get_debugreg,
  618. .clts = xen_clts,
  619. .read_cr0 = native_read_cr0,
  620. .write_cr0 = xen_write_cr0,
  621. .read_cr4 = native_read_cr4,
  622. .read_cr4_safe = native_read_cr4_safe,
  623. .write_cr4 = xen_write_cr4,
  624. .wbinvd = native_wbinvd,
  625. .read_msr = native_read_msr_safe,
  626. .write_msr = xen_write_msr_safe,
  627. .read_tsc = native_read_tsc,
  628. .read_pmc = native_read_pmc,
  629. .iret = xen_iret,
  630. .irq_enable_sysexit = xen_sysexit,
  631. #ifdef CONFIG_X86_64
  632. .usergs_sysret32 = xen_sysret32,
  633. .usergs_sysret64 = xen_sysret64,
  634. #endif
  635. .load_tr_desc = paravirt_nop,
  636. .set_ldt = xen_set_ldt,
  637. .load_gdt = xen_load_gdt,
  638. .load_idt = xen_load_idt,
  639. .load_tls = xen_load_tls,
  640. #ifdef CONFIG_X86_64
  641. .load_gs_index = xen_load_gs_index,
  642. #endif
  643. .alloc_ldt = xen_alloc_ldt,
  644. .free_ldt = xen_free_ldt,
  645. .store_gdt = native_store_gdt,
  646. .store_idt = native_store_idt,
  647. .store_tr = xen_store_tr,
  648. .write_ldt_entry = xen_write_ldt_entry,
  649. .write_gdt_entry = xen_write_gdt_entry,
  650. .write_idt_entry = xen_write_idt_entry,
  651. .load_sp0 = xen_load_sp0,
  652. .set_iopl_mask = xen_set_iopl_mask,
  653. .io_delay = xen_io_delay,
  654. /* Xen takes care of %gs when switching to usermode for us */
  655. .swapgs = paravirt_nop,
  656. .lazy_mode = {
  657. .enter = paravirt_enter_lazy_cpu,
  658. .leave = xen_leave_lazy,
  659. },
  660. };
  661. static const struct pv_apic_ops xen_apic_ops __initdata = {
  662. #ifdef CONFIG_X86_LOCAL_APIC
  663. .setup_boot_clock = paravirt_nop,
  664. .setup_secondary_clock = paravirt_nop,
  665. .startup_ipi_hook = paravirt_nop,
  666. #endif
  667. };
  668. static void xen_reboot(int reason)
  669. {
  670. struct sched_shutdown r = { .reason = reason };
  671. #ifdef CONFIG_SMP
  672. smp_send_stop();
  673. #endif
  674. if (HYPERVISOR_sched_op(SCHEDOP_shutdown, &r))
  675. BUG();
  676. }
  677. static void xen_restart(char *msg)
  678. {
  679. xen_reboot(SHUTDOWN_reboot);
  680. }
  681. static void xen_emergency_restart(void)
  682. {
  683. xen_reboot(SHUTDOWN_reboot);
  684. }
  685. static void xen_machine_halt(void)
  686. {
  687. xen_reboot(SHUTDOWN_poweroff);
  688. }
  689. static void xen_crash_shutdown(struct pt_regs *regs)
  690. {
  691. xen_reboot(SHUTDOWN_crash);
  692. }
  693. static const struct machine_ops __initdata xen_machine_ops = {
  694. .restart = xen_restart,
  695. .halt = xen_machine_halt,
  696. .power_off = xen_machine_halt,
  697. .shutdown = xen_machine_halt,
  698. .crash_shutdown = xen_crash_shutdown,
  699. .emergency_restart = xen_emergency_restart,
  700. };
  701. /* First C function to be called on Xen boot */
  702. asmlinkage void __init xen_start_kernel(void)
  703. {
  704. pgd_t *pgd;
  705. if (!xen_start_info)
  706. return;
  707. xen_domain_type = XEN_PV_DOMAIN;
  708. BUG_ON(memcmp(xen_start_info->magic, "xen-3", 5) != 0);
  709. xen_setup_features();
  710. /* Install Xen paravirt ops */
  711. pv_info = xen_info;
  712. pv_init_ops = xen_init_ops;
  713. pv_time_ops = xen_time_ops;
  714. pv_cpu_ops = xen_cpu_ops;
  715. pv_apic_ops = xen_apic_ops;
  716. pv_mmu_ops = xen_mmu_ops;
  717. xen_init_irq_ops();
  718. #ifdef CONFIG_X86_LOCAL_APIC
  719. /*
  720. * set up the basic apic ops.
  721. */
  722. set_xen_basic_apic_ops();
  723. #endif
  724. if (xen_feature(XENFEAT_mmu_pt_update_preserve_ad)) {
  725. pv_mmu_ops.ptep_modify_prot_start = xen_ptep_modify_prot_start;
  726. pv_mmu_ops.ptep_modify_prot_commit = xen_ptep_modify_prot_commit;
  727. }
  728. machine_ops = xen_machine_ops;
  729. #ifdef CONFIG_X86_64
  730. /*
  731. * Setup percpu state. We only need to do this for 64-bit
  732. * because 32-bit already has %fs set properly.
  733. */
  734. load_percpu_segment(0);
  735. #endif
  736. /*
  737. * The only reliable way to retain the initial address of the
  738. * percpu gdt_page is to remember it here, so we can go and
  739. * mark it RW later, when the initial percpu area is freed.
  740. */
  741. xen_initial_gdt = &per_cpu(gdt_page, 0);
  742. xen_smp_init();
  743. /* Get mfn list */
  744. if (!xen_feature(XENFEAT_auto_translated_physmap))
  745. xen_build_dynamic_phys_to_machine();
  746. pgd = (pgd_t *)xen_start_info->pt_base;
  747. /* Prevent unwanted bits from being set in PTEs. */
  748. __supported_pte_mask &= ~_PAGE_GLOBAL;
  749. if (!xen_initial_domain())
  750. __supported_pte_mask &= ~(_PAGE_PWT | _PAGE_PCD);
  751. /* Don't do the full vcpu_info placement stuff until we have a
  752. possible map and a non-dummy shared_info. */
  753. per_cpu(xen_vcpu, 0) = &HYPERVISOR_shared_info->vcpu_info[0];
  754. local_irq_disable();
  755. early_boot_irqs_off();
  756. xen_raw_console_write("mapping kernel into physical memory\n");
  757. pgd = xen_setup_kernel_pagetable(pgd, xen_start_info->nr_pages);
  758. init_mm.pgd = pgd;
  759. /* keep using Xen gdt for now; no urgent need to change it */
  760. pv_info.kernel_rpl = 1;
  761. if (xen_feature(XENFEAT_supervisor_mode_kernel))
  762. pv_info.kernel_rpl = 0;
  763. /* set the limit of our address space */
  764. xen_reserve_top();
  765. #ifdef CONFIG_X86_32
  766. /* set up basic CPUID stuff */
  767. cpu_detect(&new_cpu_data);
  768. new_cpu_data.hard_math = 1;
  769. new_cpu_data.x86_capability[0] = cpuid_edx(1);
  770. #endif
  771. /* Poke various useful things into boot_params */
  772. boot_params.hdr.type_of_loader = (9 << 4) | 0;
  773. boot_params.hdr.ramdisk_image = xen_start_info->mod_start
  774. ? __pa(xen_start_info->mod_start) : 0;
  775. boot_params.hdr.ramdisk_size = xen_start_info->mod_len;
  776. boot_params.hdr.cmd_line_ptr = __pa(xen_start_info->cmd_line);
  777. if (!xen_initial_domain()) {
  778. add_preferred_console("xenboot", 0, NULL);
  779. add_preferred_console("tty", 0, NULL);
  780. add_preferred_console("hvc", 0, NULL);
  781. }
  782. xen_raw_console_write("about to get started...\n");
  783. /* Start the world */
  784. #ifdef CONFIG_X86_32
  785. i386_start_kernel();
  786. #else
  787. x86_64_start_reservations((char *)__pa_symbol(&boot_params));
  788. #endif
  789. }