enlighten.c 38 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622
  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/cpu.h>
  14. #include <linux/kernel.h>
  15. #include <linux/init.h>
  16. #include <linux/smp.h>
  17. #include <linux/preempt.h>
  18. #include <linux/hardirq.h>
  19. #include <linux/percpu.h>
  20. #include <linux/delay.h>
  21. #include <linux/start_kernel.h>
  22. #include <linux/sched.h>
  23. #include <linux/kprobes.h>
  24. #include <linux/bootmem.h>
  25. #include <linux/module.h>
  26. #include <linux/mm.h>
  27. #include <linux/page-flags.h>
  28. #include <linux/highmem.h>
  29. #include <linux/console.h>
  30. #include <linux/pci.h>
  31. #include <linux/gfp.h>
  32. #include <linux/memblock.h>
  33. #include <xen/xen.h>
  34. #include <xen/events.h>
  35. #include <xen/interface/xen.h>
  36. #include <xen/interface/version.h>
  37. #include <xen/interface/physdev.h>
  38. #include <xen/interface/vcpu.h>
  39. #include <xen/interface/memory.h>
  40. #include <xen/interface/xen-mca.h>
  41. #include <xen/features.h>
  42. #include <xen/page.h>
  43. #include <xen/hvm.h>
  44. #include <xen/hvc-console.h>
  45. #include <xen/acpi.h>
  46. #include <asm/paravirt.h>
  47. #include <asm/apic.h>
  48. #include <asm/page.h>
  49. #include <asm/xen/pci.h>
  50. #include <asm/xen/hypercall.h>
  51. #include <asm/xen/hypervisor.h>
  52. #include <asm/fixmap.h>
  53. #include <asm/processor.h>
  54. #include <asm/proto.h>
  55. #include <asm/msr-index.h>
  56. #include <asm/traps.h>
  57. #include <asm/setup.h>
  58. #include <asm/desc.h>
  59. #include <asm/pgalloc.h>
  60. #include <asm/pgtable.h>
  61. #include <asm/tlbflush.h>
  62. #include <asm/reboot.h>
  63. #include <asm/stackprotector.h>
  64. #include <asm/hypervisor.h>
  65. #include <asm/mwait.h>
  66. #include <asm/pci_x86.h>
  67. #ifdef CONFIG_ACPI
  68. #include <linux/acpi.h>
  69. #include <asm/acpi.h>
  70. #include <acpi/pdc_intel.h>
  71. #include <acpi/processor.h>
  72. #include <xen/interface/platform.h>
  73. #endif
  74. #include "xen-ops.h"
  75. #include "mmu.h"
  76. #include "smp.h"
  77. #include "multicalls.h"
  78. #include <xen/events.h>
  79. EXPORT_SYMBOL_GPL(hypercall_page);
  80. DEFINE_PER_CPU(struct vcpu_info *, xen_vcpu);
  81. DEFINE_PER_CPU(struct vcpu_info, xen_vcpu_info);
  82. enum xen_domain_type xen_domain_type = XEN_NATIVE;
  83. EXPORT_SYMBOL_GPL(xen_domain_type);
  84. unsigned long *machine_to_phys_mapping = (void *)MACH2PHYS_VIRT_START;
  85. EXPORT_SYMBOL(machine_to_phys_mapping);
  86. unsigned long machine_to_phys_nr;
  87. EXPORT_SYMBOL(machine_to_phys_nr);
  88. struct start_info *xen_start_info;
  89. EXPORT_SYMBOL_GPL(xen_start_info);
  90. struct shared_info xen_dummy_shared_info;
  91. void *xen_initial_gdt;
  92. RESERVE_BRK(shared_info_page_brk, PAGE_SIZE);
  93. __read_mostly int xen_have_vector_callback;
  94. EXPORT_SYMBOL_GPL(xen_have_vector_callback);
  95. /*
  96. * Point at some empty memory to start with. We map the real shared_info
  97. * page as soon as fixmap is up and running.
  98. */
  99. struct shared_info *HYPERVISOR_shared_info = &xen_dummy_shared_info;
  100. /*
  101. * Flag to determine whether vcpu info placement is available on all
  102. * VCPUs. We assume it is to start with, and then set it to zero on
  103. * the first failure. This is because it can succeed on some VCPUs
  104. * and not others, since it can involve hypervisor memory allocation,
  105. * or because the guest failed to guarantee all the appropriate
  106. * constraints on all VCPUs (ie buffer can't cross a page boundary).
  107. *
  108. * Note that any particular CPU may be using a placed vcpu structure,
  109. * but we can only optimise if the all are.
  110. *
  111. * 0: not available, 1: available
  112. */
  113. static int have_vcpu_info_placement = 1;
  114. struct tls_descs {
  115. struct desc_struct desc[3];
  116. };
  117. /*
  118. * Updating the 3 TLS descriptors in the GDT on every task switch is
  119. * surprisingly expensive so we avoid updating them if they haven't
  120. * changed. Since Xen writes different descriptors than the one
  121. * passed in the update_descriptor hypercall we keep shadow copies to
  122. * compare against.
  123. */
  124. static DEFINE_PER_CPU(struct tls_descs, shadow_tls_desc);
  125. static void clamp_max_cpus(void)
  126. {
  127. #ifdef CONFIG_SMP
  128. if (setup_max_cpus > MAX_VIRT_CPUS)
  129. setup_max_cpus = MAX_VIRT_CPUS;
  130. #endif
  131. }
  132. static void xen_vcpu_setup(int cpu)
  133. {
  134. struct vcpu_register_vcpu_info info;
  135. int err;
  136. struct vcpu_info *vcpup;
  137. BUG_ON(HYPERVISOR_shared_info == &xen_dummy_shared_info);
  138. if (cpu < MAX_VIRT_CPUS)
  139. per_cpu(xen_vcpu,cpu) = &HYPERVISOR_shared_info->vcpu_info[cpu];
  140. if (!have_vcpu_info_placement) {
  141. if (cpu >= MAX_VIRT_CPUS)
  142. clamp_max_cpus();
  143. return;
  144. }
  145. vcpup = &per_cpu(xen_vcpu_info, cpu);
  146. info.mfn = arbitrary_virt_to_mfn(vcpup);
  147. info.offset = offset_in_page(vcpup);
  148. /* Check to see if the hypervisor will put the vcpu_info
  149. structure where we want it, which allows direct access via
  150. a percpu-variable. */
  151. err = HYPERVISOR_vcpu_op(VCPUOP_register_vcpu_info, cpu, &info);
  152. if (err) {
  153. printk(KERN_DEBUG "register_vcpu_info failed: err=%d\n", err);
  154. have_vcpu_info_placement = 0;
  155. clamp_max_cpus();
  156. } else {
  157. /* This cpu is using the registered vcpu info, even if
  158. later ones fail to. */
  159. per_cpu(xen_vcpu, cpu) = vcpup;
  160. }
  161. }
  162. /*
  163. * On restore, set the vcpu placement up again.
  164. * If it fails, then we're in a bad state, since
  165. * we can't back out from using it...
  166. */
  167. void xen_vcpu_restore(void)
  168. {
  169. int cpu;
  170. for_each_online_cpu(cpu) {
  171. bool other_cpu = (cpu != smp_processor_id());
  172. if (other_cpu &&
  173. HYPERVISOR_vcpu_op(VCPUOP_down, cpu, NULL))
  174. BUG();
  175. xen_setup_runstate_info(cpu);
  176. if (have_vcpu_info_placement)
  177. xen_vcpu_setup(cpu);
  178. if (other_cpu &&
  179. HYPERVISOR_vcpu_op(VCPUOP_up, cpu, NULL))
  180. BUG();
  181. }
  182. }
  183. static void __init xen_banner(void)
  184. {
  185. unsigned version = HYPERVISOR_xen_version(XENVER_version, NULL);
  186. struct xen_extraversion extra;
  187. HYPERVISOR_xen_version(XENVER_extraversion, &extra);
  188. printk(KERN_INFO "Booting paravirtualized kernel on %s\n",
  189. pv_info.name);
  190. printk(KERN_INFO "Xen version: %d.%d%s%s\n",
  191. version >> 16, version & 0xffff, extra.extraversion,
  192. xen_feature(XENFEAT_mmu_pt_update_preserve_ad) ? " (preserve-AD)" : "");
  193. }
  194. #define CPUID_THERM_POWER_LEAF 6
  195. #define APERFMPERF_PRESENT 0
  196. static __read_mostly unsigned int cpuid_leaf1_edx_mask = ~0;
  197. static __read_mostly unsigned int cpuid_leaf1_ecx_mask = ~0;
  198. static __read_mostly unsigned int cpuid_leaf1_ecx_set_mask;
  199. static __read_mostly unsigned int cpuid_leaf5_ecx_val;
  200. static __read_mostly unsigned int cpuid_leaf5_edx_val;
  201. static void xen_cpuid(unsigned int *ax, unsigned int *bx,
  202. unsigned int *cx, unsigned int *dx)
  203. {
  204. unsigned maskebx = ~0;
  205. unsigned maskecx = ~0;
  206. unsigned maskedx = ~0;
  207. unsigned setecx = 0;
  208. /*
  209. * Mask out inconvenient features, to try and disable as many
  210. * unsupported kernel subsystems as possible.
  211. */
  212. switch (*ax) {
  213. case 1:
  214. maskecx = cpuid_leaf1_ecx_mask;
  215. setecx = cpuid_leaf1_ecx_set_mask;
  216. maskedx = cpuid_leaf1_edx_mask;
  217. break;
  218. case CPUID_MWAIT_LEAF:
  219. /* Synthesize the values.. */
  220. *ax = 0;
  221. *bx = 0;
  222. *cx = cpuid_leaf5_ecx_val;
  223. *dx = cpuid_leaf5_edx_val;
  224. return;
  225. case CPUID_THERM_POWER_LEAF:
  226. /* Disabling APERFMPERF for kernel usage */
  227. maskecx = ~(1 << APERFMPERF_PRESENT);
  228. break;
  229. case 0xb:
  230. /* Suppress extended topology stuff */
  231. maskebx = 0;
  232. break;
  233. }
  234. asm(XEN_EMULATE_PREFIX "cpuid"
  235. : "=a" (*ax),
  236. "=b" (*bx),
  237. "=c" (*cx),
  238. "=d" (*dx)
  239. : "0" (*ax), "2" (*cx));
  240. *bx &= maskebx;
  241. *cx &= maskecx;
  242. *cx |= setecx;
  243. *dx &= maskedx;
  244. }
  245. static bool __init xen_check_mwait(void)
  246. {
  247. #if defined(CONFIG_ACPI) && !defined(CONFIG_ACPI_PROCESSOR_AGGREGATOR) && \
  248. !defined(CONFIG_ACPI_PROCESSOR_AGGREGATOR_MODULE)
  249. struct xen_platform_op op = {
  250. .cmd = XENPF_set_processor_pminfo,
  251. .u.set_pminfo.id = -1,
  252. .u.set_pminfo.type = XEN_PM_PDC,
  253. };
  254. uint32_t buf[3];
  255. unsigned int ax, bx, cx, dx;
  256. unsigned int mwait_mask;
  257. /* We need to determine whether it is OK to expose the MWAIT
  258. * capability to the kernel to harvest deeper than C3 states from ACPI
  259. * _CST using the processor_harvest_xen.c module. For this to work, we
  260. * need to gather the MWAIT_LEAF values (which the cstate.c code
  261. * checks against). The hypervisor won't expose the MWAIT flag because
  262. * it would break backwards compatibility; so we will find out directly
  263. * from the hardware and hypercall.
  264. */
  265. if (!xen_initial_domain())
  266. return false;
  267. ax = 1;
  268. cx = 0;
  269. native_cpuid(&ax, &bx, &cx, &dx);
  270. mwait_mask = (1 << (X86_FEATURE_EST % 32)) |
  271. (1 << (X86_FEATURE_MWAIT % 32));
  272. if ((cx & mwait_mask) != mwait_mask)
  273. return false;
  274. /* We need to emulate the MWAIT_LEAF and for that we need both
  275. * ecx and edx. The hypercall provides only partial information.
  276. */
  277. ax = CPUID_MWAIT_LEAF;
  278. bx = 0;
  279. cx = 0;
  280. dx = 0;
  281. native_cpuid(&ax, &bx, &cx, &dx);
  282. /* Ask the Hypervisor whether to clear ACPI_PDC_C_C2C3_FFH. If so,
  283. * don't expose MWAIT_LEAF and let ACPI pick the IOPORT version of C3.
  284. */
  285. buf[0] = ACPI_PDC_REVISION_ID;
  286. buf[1] = 1;
  287. buf[2] = (ACPI_PDC_C_CAPABILITY_SMP | ACPI_PDC_EST_CAPABILITY_SWSMP);
  288. set_xen_guest_handle(op.u.set_pminfo.pdc, buf);
  289. if ((HYPERVISOR_dom0_op(&op) == 0) &&
  290. (buf[2] & (ACPI_PDC_C_C1_FFH | ACPI_PDC_C_C2C3_FFH))) {
  291. cpuid_leaf5_ecx_val = cx;
  292. cpuid_leaf5_edx_val = dx;
  293. }
  294. return true;
  295. #else
  296. return false;
  297. #endif
  298. }
  299. static void __init xen_init_cpuid_mask(void)
  300. {
  301. unsigned int ax, bx, cx, dx;
  302. unsigned int xsave_mask;
  303. cpuid_leaf1_edx_mask =
  304. ~((1 << X86_FEATURE_MTRR) | /* disable MTRR */
  305. (1 << X86_FEATURE_ACC)); /* thermal monitoring */
  306. if (!xen_initial_domain())
  307. cpuid_leaf1_edx_mask &=
  308. ~((1 << X86_FEATURE_APIC) | /* disable local APIC */
  309. (1 << X86_FEATURE_ACPI)); /* disable ACPI */
  310. ax = 1;
  311. cx = 0;
  312. xen_cpuid(&ax, &bx, &cx, &dx);
  313. xsave_mask =
  314. (1 << (X86_FEATURE_XSAVE % 32)) |
  315. (1 << (X86_FEATURE_OSXSAVE % 32));
  316. /* Xen will set CR4.OSXSAVE if supported and not disabled by force */
  317. if ((cx & xsave_mask) != xsave_mask)
  318. cpuid_leaf1_ecx_mask &= ~xsave_mask; /* disable XSAVE & OSXSAVE */
  319. if (xen_check_mwait())
  320. cpuid_leaf1_ecx_set_mask = (1 << (X86_FEATURE_MWAIT % 32));
  321. }
  322. static void xen_set_debugreg(int reg, unsigned long val)
  323. {
  324. HYPERVISOR_set_debugreg(reg, val);
  325. }
  326. static unsigned long xen_get_debugreg(int reg)
  327. {
  328. return HYPERVISOR_get_debugreg(reg);
  329. }
  330. static void xen_end_context_switch(struct task_struct *next)
  331. {
  332. xen_mc_flush();
  333. paravirt_end_context_switch(next);
  334. }
  335. static unsigned long xen_store_tr(void)
  336. {
  337. return 0;
  338. }
  339. /*
  340. * Set the page permissions for a particular virtual address. If the
  341. * address is a vmalloc mapping (or other non-linear mapping), then
  342. * find the linear mapping of the page and also set its protections to
  343. * match.
  344. */
  345. static void set_aliased_prot(void *v, pgprot_t prot)
  346. {
  347. int level;
  348. pte_t *ptep;
  349. pte_t pte;
  350. unsigned long pfn;
  351. struct page *page;
  352. ptep = lookup_address((unsigned long)v, &level);
  353. BUG_ON(ptep == NULL);
  354. pfn = pte_pfn(*ptep);
  355. page = pfn_to_page(pfn);
  356. pte = pfn_pte(pfn, prot);
  357. if (HYPERVISOR_update_va_mapping((unsigned long)v, pte, 0))
  358. BUG();
  359. if (!PageHighMem(page)) {
  360. void *av = __va(PFN_PHYS(pfn));
  361. if (av != v)
  362. if (HYPERVISOR_update_va_mapping((unsigned long)av, pte, 0))
  363. BUG();
  364. } else
  365. kmap_flush_unused();
  366. }
  367. static void xen_alloc_ldt(struct desc_struct *ldt, unsigned entries)
  368. {
  369. const unsigned entries_per_page = PAGE_SIZE / LDT_ENTRY_SIZE;
  370. int i;
  371. for(i = 0; i < entries; i += entries_per_page)
  372. set_aliased_prot(ldt + i, PAGE_KERNEL_RO);
  373. }
  374. static void xen_free_ldt(struct desc_struct *ldt, unsigned entries)
  375. {
  376. const unsigned entries_per_page = PAGE_SIZE / LDT_ENTRY_SIZE;
  377. int i;
  378. for(i = 0; i < entries; i += entries_per_page)
  379. set_aliased_prot(ldt + i, PAGE_KERNEL);
  380. }
  381. static void xen_set_ldt(const void *addr, unsigned entries)
  382. {
  383. struct mmuext_op *op;
  384. struct multicall_space mcs = xen_mc_entry(sizeof(*op));
  385. trace_xen_cpu_set_ldt(addr, entries);
  386. op = mcs.args;
  387. op->cmd = MMUEXT_SET_LDT;
  388. op->arg1.linear_addr = (unsigned long)addr;
  389. op->arg2.nr_ents = entries;
  390. MULTI_mmuext_op(mcs.mc, op, 1, NULL, DOMID_SELF);
  391. xen_mc_issue(PARAVIRT_LAZY_CPU);
  392. }
  393. static void xen_load_gdt(const struct desc_ptr *dtr)
  394. {
  395. unsigned long va = dtr->address;
  396. unsigned int size = dtr->size + 1;
  397. unsigned pages = (size + PAGE_SIZE - 1) / PAGE_SIZE;
  398. unsigned long frames[pages];
  399. int f;
  400. /*
  401. * A GDT can be up to 64k in size, which corresponds to 8192
  402. * 8-byte entries, or 16 4k pages..
  403. */
  404. BUG_ON(size > 65536);
  405. BUG_ON(va & ~PAGE_MASK);
  406. for (f = 0; va < dtr->address + size; va += PAGE_SIZE, f++) {
  407. int level;
  408. pte_t *ptep;
  409. unsigned long pfn, mfn;
  410. void *virt;
  411. /*
  412. * The GDT is per-cpu and is in the percpu data area.
  413. * That can be virtually mapped, so we need to do a
  414. * page-walk to get the underlying MFN for the
  415. * hypercall. The page can also be in the kernel's
  416. * linear range, so we need to RO that mapping too.
  417. */
  418. ptep = lookup_address(va, &level);
  419. BUG_ON(ptep == NULL);
  420. pfn = pte_pfn(*ptep);
  421. mfn = pfn_to_mfn(pfn);
  422. virt = __va(PFN_PHYS(pfn));
  423. frames[f] = mfn;
  424. make_lowmem_page_readonly((void *)va);
  425. make_lowmem_page_readonly(virt);
  426. }
  427. if (HYPERVISOR_set_gdt(frames, size / sizeof(struct desc_struct)))
  428. BUG();
  429. }
  430. /*
  431. * load_gdt for early boot, when the gdt is only mapped once
  432. */
  433. static void __init xen_load_gdt_boot(const struct desc_ptr *dtr)
  434. {
  435. unsigned long va = dtr->address;
  436. unsigned int size = dtr->size + 1;
  437. unsigned pages = (size + PAGE_SIZE - 1) / PAGE_SIZE;
  438. unsigned long frames[pages];
  439. int f;
  440. /*
  441. * A GDT can be up to 64k in size, which corresponds to 8192
  442. * 8-byte entries, or 16 4k pages..
  443. */
  444. BUG_ON(size > 65536);
  445. BUG_ON(va & ~PAGE_MASK);
  446. for (f = 0; va < dtr->address + size; va += PAGE_SIZE, f++) {
  447. pte_t pte;
  448. unsigned long pfn, mfn;
  449. pfn = virt_to_pfn(va);
  450. mfn = pfn_to_mfn(pfn);
  451. pte = pfn_pte(pfn, PAGE_KERNEL_RO);
  452. if (HYPERVISOR_update_va_mapping((unsigned long)va, pte, 0))
  453. BUG();
  454. frames[f] = mfn;
  455. }
  456. if (HYPERVISOR_set_gdt(frames, size / sizeof(struct desc_struct)))
  457. BUG();
  458. }
  459. static inline bool desc_equal(const struct desc_struct *d1,
  460. const struct desc_struct *d2)
  461. {
  462. return d1->a == d2->a && d1->b == d2->b;
  463. }
  464. static void load_TLS_descriptor(struct thread_struct *t,
  465. unsigned int cpu, unsigned int i)
  466. {
  467. struct desc_struct *shadow = &per_cpu(shadow_tls_desc, cpu).desc[i];
  468. struct desc_struct *gdt;
  469. xmaddr_t maddr;
  470. struct multicall_space mc;
  471. if (desc_equal(shadow, &t->tls_array[i]))
  472. return;
  473. *shadow = t->tls_array[i];
  474. gdt = get_cpu_gdt_table(cpu);
  475. maddr = arbitrary_virt_to_machine(&gdt[GDT_ENTRY_TLS_MIN+i]);
  476. mc = __xen_mc_entry(0);
  477. MULTI_update_descriptor(mc.mc, maddr.maddr, t->tls_array[i]);
  478. }
  479. static void xen_load_tls(struct thread_struct *t, unsigned int cpu)
  480. {
  481. /*
  482. * XXX sleazy hack: If we're being called in a lazy-cpu zone
  483. * and lazy gs handling is enabled, it means we're in a
  484. * context switch, and %gs has just been saved. This means we
  485. * can zero it out to prevent faults on exit from the
  486. * hypervisor if the next process has no %gs. Either way, it
  487. * has been saved, and the new value will get loaded properly.
  488. * This will go away as soon as Xen has been modified to not
  489. * save/restore %gs for normal hypercalls.
  490. *
  491. * On x86_64, this hack is not used for %gs, because gs points
  492. * to KERNEL_GS_BASE (and uses it for PDA references), so we
  493. * must not zero %gs on x86_64
  494. *
  495. * For x86_64, we need to zero %fs, otherwise we may get an
  496. * exception between the new %fs descriptor being loaded and
  497. * %fs being effectively cleared at __switch_to().
  498. */
  499. if (paravirt_get_lazy_mode() == PARAVIRT_LAZY_CPU) {
  500. #ifdef CONFIG_X86_32
  501. lazy_load_gs(0);
  502. #else
  503. loadsegment(fs, 0);
  504. #endif
  505. }
  506. xen_mc_batch();
  507. load_TLS_descriptor(t, cpu, 0);
  508. load_TLS_descriptor(t, cpu, 1);
  509. load_TLS_descriptor(t, cpu, 2);
  510. xen_mc_issue(PARAVIRT_LAZY_CPU);
  511. }
  512. #ifdef CONFIG_X86_64
  513. static void xen_load_gs_index(unsigned int idx)
  514. {
  515. if (HYPERVISOR_set_segment_base(SEGBASE_GS_USER_SEL, idx))
  516. BUG();
  517. }
  518. #endif
  519. static void xen_write_ldt_entry(struct desc_struct *dt, int entrynum,
  520. const void *ptr)
  521. {
  522. xmaddr_t mach_lp = arbitrary_virt_to_machine(&dt[entrynum]);
  523. u64 entry = *(u64 *)ptr;
  524. trace_xen_cpu_write_ldt_entry(dt, entrynum, entry);
  525. preempt_disable();
  526. xen_mc_flush();
  527. if (HYPERVISOR_update_descriptor(mach_lp.maddr, entry))
  528. BUG();
  529. preempt_enable();
  530. }
  531. static int cvt_gate_to_trap(int vector, const gate_desc *val,
  532. struct trap_info *info)
  533. {
  534. unsigned long addr;
  535. if (val->type != GATE_TRAP && val->type != GATE_INTERRUPT)
  536. return 0;
  537. info->vector = vector;
  538. addr = gate_offset(*val);
  539. #ifdef CONFIG_X86_64
  540. /*
  541. * Look for known traps using IST, and substitute them
  542. * appropriately. The debugger ones are the only ones we care
  543. * about. Xen will handle faults like double_fault,
  544. * so we should never see them. Warn if
  545. * there's an unexpected IST-using fault handler.
  546. */
  547. if (addr == (unsigned long)debug)
  548. addr = (unsigned long)xen_debug;
  549. else if (addr == (unsigned long)int3)
  550. addr = (unsigned long)xen_int3;
  551. else if (addr == (unsigned long)stack_segment)
  552. addr = (unsigned long)xen_stack_segment;
  553. else if (addr == (unsigned long)double_fault ||
  554. addr == (unsigned long)nmi) {
  555. /* Don't need to handle these */
  556. return 0;
  557. #ifdef CONFIG_X86_MCE
  558. } else if (addr == (unsigned long)machine_check) {
  559. /*
  560. * when xen hypervisor inject vMCE to guest,
  561. * use native mce handler to handle it
  562. */
  563. ;
  564. #endif
  565. } else {
  566. /* Some other trap using IST? */
  567. if (WARN_ON(val->ist != 0))
  568. return 0;
  569. }
  570. #endif /* CONFIG_X86_64 */
  571. info->address = addr;
  572. info->cs = gate_segment(*val);
  573. info->flags = val->dpl;
  574. /* interrupt gates clear IF */
  575. if (val->type == GATE_INTERRUPT)
  576. info->flags |= 1 << 2;
  577. return 1;
  578. }
  579. /* Locations of each CPU's IDT */
  580. static DEFINE_PER_CPU(struct desc_ptr, idt_desc);
  581. /* Set an IDT entry. If the entry is part of the current IDT, then
  582. also update Xen. */
  583. static void xen_write_idt_entry(gate_desc *dt, int entrynum, const gate_desc *g)
  584. {
  585. unsigned long p = (unsigned long)&dt[entrynum];
  586. unsigned long start, end;
  587. trace_xen_cpu_write_idt_entry(dt, entrynum, g);
  588. preempt_disable();
  589. start = __this_cpu_read(idt_desc.address);
  590. end = start + __this_cpu_read(idt_desc.size) + 1;
  591. xen_mc_flush();
  592. native_write_idt_entry(dt, entrynum, g);
  593. if (p >= start && (p + 8) <= end) {
  594. struct trap_info info[2];
  595. info[1].address = 0;
  596. if (cvt_gate_to_trap(entrynum, g, &info[0]))
  597. if (HYPERVISOR_set_trap_table(info))
  598. BUG();
  599. }
  600. preempt_enable();
  601. }
  602. static void xen_convert_trap_info(const struct desc_ptr *desc,
  603. struct trap_info *traps)
  604. {
  605. unsigned in, out, count;
  606. count = (desc->size+1) / sizeof(gate_desc);
  607. BUG_ON(count > 256);
  608. for (in = out = 0; in < count; in++) {
  609. gate_desc *entry = (gate_desc*)(desc->address) + in;
  610. if (cvt_gate_to_trap(in, entry, &traps[out]))
  611. out++;
  612. }
  613. traps[out].address = 0;
  614. }
  615. void xen_copy_trap_info(struct trap_info *traps)
  616. {
  617. const struct desc_ptr *desc = &__get_cpu_var(idt_desc);
  618. xen_convert_trap_info(desc, traps);
  619. }
  620. /* Load a new IDT into Xen. In principle this can be per-CPU, so we
  621. hold a spinlock to protect the static traps[] array (static because
  622. it avoids allocation, and saves stack space). */
  623. static void xen_load_idt(const struct desc_ptr *desc)
  624. {
  625. static DEFINE_SPINLOCK(lock);
  626. static struct trap_info traps[257];
  627. trace_xen_cpu_load_idt(desc);
  628. spin_lock(&lock);
  629. __get_cpu_var(idt_desc) = *desc;
  630. xen_convert_trap_info(desc, traps);
  631. xen_mc_flush();
  632. if (HYPERVISOR_set_trap_table(traps))
  633. BUG();
  634. spin_unlock(&lock);
  635. }
  636. /* Write a GDT descriptor entry. Ignore LDT descriptors, since
  637. they're handled differently. */
  638. static void xen_write_gdt_entry(struct desc_struct *dt, int entry,
  639. const void *desc, int type)
  640. {
  641. trace_xen_cpu_write_gdt_entry(dt, entry, desc, type);
  642. preempt_disable();
  643. switch (type) {
  644. case DESC_LDT:
  645. case DESC_TSS:
  646. /* ignore */
  647. break;
  648. default: {
  649. xmaddr_t maddr = arbitrary_virt_to_machine(&dt[entry]);
  650. xen_mc_flush();
  651. if (HYPERVISOR_update_descriptor(maddr.maddr, *(u64 *)desc))
  652. BUG();
  653. }
  654. }
  655. preempt_enable();
  656. }
  657. /*
  658. * Version of write_gdt_entry for use at early boot-time needed to
  659. * update an entry as simply as possible.
  660. */
  661. static void __init xen_write_gdt_entry_boot(struct desc_struct *dt, int entry,
  662. const void *desc, int type)
  663. {
  664. trace_xen_cpu_write_gdt_entry(dt, entry, desc, type);
  665. switch (type) {
  666. case DESC_LDT:
  667. case DESC_TSS:
  668. /* ignore */
  669. break;
  670. default: {
  671. xmaddr_t maddr = virt_to_machine(&dt[entry]);
  672. if (HYPERVISOR_update_descriptor(maddr.maddr, *(u64 *)desc))
  673. dt[entry] = *(struct desc_struct *)desc;
  674. }
  675. }
  676. }
  677. static void xen_load_sp0(struct tss_struct *tss,
  678. struct thread_struct *thread)
  679. {
  680. struct multicall_space mcs;
  681. mcs = xen_mc_entry(0);
  682. MULTI_stack_switch(mcs.mc, __KERNEL_DS, thread->sp0);
  683. xen_mc_issue(PARAVIRT_LAZY_CPU);
  684. }
  685. static void xen_set_iopl_mask(unsigned mask)
  686. {
  687. struct physdev_set_iopl set_iopl;
  688. /* Force the change at ring 0. */
  689. set_iopl.iopl = (mask == 0) ? 1 : (mask >> 12) & 3;
  690. HYPERVISOR_physdev_op(PHYSDEVOP_set_iopl, &set_iopl);
  691. }
  692. static void xen_io_delay(void)
  693. {
  694. }
  695. #ifdef CONFIG_X86_LOCAL_APIC
  696. static unsigned long xen_set_apic_id(unsigned int x)
  697. {
  698. WARN_ON(1);
  699. return x;
  700. }
  701. static unsigned int xen_get_apic_id(unsigned long x)
  702. {
  703. return ((x)>>24) & 0xFFu;
  704. }
  705. static u32 xen_apic_read(u32 reg)
  706. {
  707. struct xen_platform_op op = {
  708. .cmd = XENPF_get_cpuinfo,
  709. .interface_version = XENPF_INTERFACE_VERSION,
  710. .u.pcpu_info.xen_cpuid = 0,
  711. };
  712. int ret = 0;
  713. /* Shouldn't need this as APIC is turned off for PV, and we only
  714. * get called on the bootup processor. But just in case. */
  715. if (!xen_initial_domain() || smp_processor_id())
  716. return 0;
  717. if (reg == APIC_LVR)
  718. return 0x10;
  719. if (reg != APIC_ID)
  720. return 0;
  721. ret = HYPERVISOR_dom0_op(&op);
  722. if (ret)
  723. return 0;
  724. return op.u.pcpu_info.apic_id << 24;
  725. }
  726. static void xen_apic_write(u32 reg, u32 val)
  727. {
  728. /* Warn to see if there's any stray references */
  729. WARN_ON(1);
  730. }
  731. static u64 xen_apic_icr_read(void)
  732. {
  733. return 0;
  734. }
  735. static void xen_apic_icr_write(u32 low, u32 id)
  736. {
  737. /* Warn to see if there's any stray references */
  738. WARN_ON(1);
  739. }
  740. static void xen_apic_wait_icr_idle(void)
  741. {
  742. return;
  743. }
  744. static u32 xen_safe_apic_wait_icr_idle(void)
  745. {
  746. return 0;
  747. }
  748. static void set_xen_basic_apic_ops(void)
  749. {
  750. apic->read = xen_apic_read;
  751. apic->write = xen_apic_write;
  752. apic->icr_read = xen_apic_icr_read;
  753. apic->icr_write = xen_apic_icr_write;
  754. apic->wait_icr_idle = xen_apic_wait_icr_idle;
  755. apic->safe_wait_icr_idle = xen_safe_apic_wait_icr_idle;
  756. apic->set_apic_id = xen_set_apic_id;
  757. apic->get_apic_id = xen_get_apic_id;
  758. #ifdef CONFIG_SMP
  759. apic->send_IPI_allbutself = xen_send_IPI_allbutself;
  760. apic->send_IPI_mask_allbutself = xen_send_IPI_mask_allbutself;
  761. apic->send_IPI_mask = xen_send_IPI_mask;
  762. apic->send_IPI_all = xen_send_IPI_all;
  763. apic->send_IPI_self = xen_send_IPI_self;
  764. #endif
  765. }
  766. #endif
  767. static void xen_clts(void)
  768. {
  769. struct multicall_space mcs;
  770. mcs = xen_mc_entry(0);
  771. MULTI_fpu_taskswitch(mcs.mc, 0);
  772. xen_mc_issue(PARAVIRT_LAZY_CPU);
  773. }
  774. static DEFINE_PER_CPU(unsigned long, xen_cr0_value);
  775. static unsigned long xen_read_cr0(void)
  776. {
  777. unsigned long cr0 = this_cpu_read(xen_cr0_value);
  778. if (unlikely(cr0 == 0)) {
  779. cr0 = native_read_cr0();
  780. this_cpu_write(xen_cr0_value, cr0);
  781. }
  782. return cr0;
  783. }
  784. static void xen_write_cr0(unsigned long cr0)
  785. {
  786. struct multicall_space mcs;
  787. this_cpu_write(xen_cr0_value, cr0);
  788. /* Only pay attention to cr0.TS; everything else is
  789. ignored. */
  790. mcs = xen_mc_entry(0);
  791. MULTI_fpu_taskswitch(mcs.mc, (cr0 & X86_CR0_TS) != 0);
  792. xen_mc_issue(PARAVIRT_LAZY_CPU);
  793. }
  794. static void xen_write_cr4(unsigned long cr4)
  795. {
  796. cr4 &= ~X86_CR4_PGE;
  797. cr4 &= ~X86_CR4_PSE;
  798. native_write_cr4(cr4);
  799. }
  800. #ifdef CONFIG_X86_64
  801. static inline unsigned long xen_read_cr8(void)
  802. {
  803. return 0;
  804. }
  805. static inline void xen_write_cr8(unsigned long val)
  806. {
  807. BUG_ON(val);
  808. }
  809. #endif
  810. static int xen_write_msr_safe(unsigned int msr, unsigned low, unsigned high)
  811. {
  812. int ret;
  813. ret = 0;
  814. switch (msr) {
  815. #ifdef CONFIG_X86_64
  816. unsigned which;
  817. u64 base;
  818. case MSR_FS_BASE: which = SEGBASE_FS; goto set;
  819. case MSR_KERNEL_GS_BASE: which = SEGBASE_GS_USER; goto set;
  820. case MSR_GS_BASE: which = SEGBASE_GS_KERNEL; goto set;
  821. set:
  822. base = ((u64)high << 32) | low;
  823. if (HYPERVISOR_set_segment_base(which, base) != 0)
  824. ret = -EIO;
  825. break;
  826. #endif
  827. case MSR_STAR:
  828. case MSR_CSTAR:
  829. case MSR_LSTAR:
  830. case MSR_SYSCALL_MASK:
  831. case MSR_IA32_SYSENTER_CS:
  832. case MSR_IA32_SYSENTER_ESP:
  833. case MSR_IA32_SYSENTER_EIP:
  834. /* Fast syscall setup is all done in hypercalls, so
  835. these are all ignored. Stub them out here to stop
  836. Xen console noise. */
  837. break;
  838. case MSR_IA32_CR_PAT:
  839. if (smp_processor_id() == 0)
  840. xen_set_pat(((u64)high << 32) | low);
  841. break;
  842. default:
  843. ret = native_write_msr_safe(msr, low, high);
  844. }
  845. return ret;
  846. }
  847. void xen_setup_shared_info(void)
  848. {
  849. if (!xen_feature(XENFEAT_auto_translated_physmap)) {
  850. set_fixmap(FIX_PARAVIRT_BOOTMAP,
  851. xen_start_info->shared_info);
  852. HYPERVISOR_shared_info =
  853. (struct shared_info *)fix_to_virt(FIX_PARAVIRT_BOOTMAP);
  854. } else
  855. HYPERVISOR_shared_info =
  856. (struct shared_info *)__va(xen_start_info->shared_info);
  857. #ifndef CONFIG_SMP
  858. /* In UP this is as good a place as any to set up shared info */
  859. xen_setup_vcpu_info_placement();
  860. #endif
  861. xen_setup_mfn_list_list();
  862. }
  863. /* This is called once we have the cpu_possible_mask */
  864. void xen_setup_vcpu_info_placement(void)
  865. {
  866. int cpu;
  867. for_each_possible_cpu(cpu)
  868. xen_vcpu_setup(cpu);
  869. /* xen_vcpu_setup managed to place the vcpu_info within the
  870. percpu area for all cpus, so make use of it */
  871. if (have_vcpu_info_placement) {
  872. pv_irq_ops.save_fl = __PV_IS_CALLEE_SAVE(xen_save_fl_direct);
  873. pv_irq_ops.restore_fl = __PV_IS_CALLEE_SAVE(xen_restore_fl_direct);
  874. pv_irq_ops.irq_disable = __PV_IS_CALLEE_SAVE(xen_irq_disable_direct);
  875. pv_irq_ops.irq_enable = __PV_IS_CALLEE_SAVE(xen_irq_enable_direct);
  876. pv_mmu_ops.read_cr2 = xen_read_cr2_direct;
  877. }
  878. }
  879. static unsigned xen_patch(u8 type, u16 clobbers, void *insnbuf,
  880. unsigned long addr, unsigned len)
  881. {
  882. char *start, *end, *reloc;
  883. unsigned ret;
  884. start = end = reloc = NULL;
  885. #define SITE(op, x) \
  886. case PARAVIRT_PATCH(op.x): \
  887. if (have_vcpu_info_placement) { \
  888. start = (char *)xen_##x##_direct; \
  889. end = xen_##x##_direct_end; \
  890. reloc = xen_##x##_direct_reloc; \
  891. } \
  892. goto patch_site
  893. switch (type) {
  894. SITE(pv_irq_ops, irq_enable);
  895. SITE(pv_irq_ops, irq_disable);
  896. SITE(pv_irq_ops, save_fl);
  897. SITE(pv_irq_ops, restore_fl);
  898. #undef SITE
  899. patch_site:
  900. if (start == NULL || (end-start) > len)
  901. goto default_patch;
  902. ret = paravirt_patch_insns(insnbuf, len, start, end);
  903. /* Note: because reloc is assigned from something that
  904. appears to be an array, gcc assumes it's non-null,
  905. but doesn't know its relationship with start and
  906. end. */
  907. if (reloc > start && reloc < end) {
  908. int reloc_off = reloc - start;
  909. long *relocp = (long *)(insnbuf + reloc_off);
  910. long delta = start - (char *)addr;
  911. *relocp += delta;
  912. }
  913. break;
  914. default_patch:
  915. default:
  916. ret = paravirt_patch_default(type, clobbers, insnbuf,
  917. addr, len);
  918. break;
  919. }
  920. return ret;
  921. }
  922. static const struct pv_info xen_info __initconst = {
  923. .paravirt_enabled = 1,
  924. .shared_kernel_pmd = 0,
  925. #ifdef CONFIG_X86_64
  926. .extra_user_64bit_cs = FLAT_USER_CS64,
  927. #endif
  928. .name = "Xen",
  929. };
  930. static const struct pv_init_ops xen_init_ops __initconst = {
  931. .patch = xen_patch,
  932. };
  933. static const struct pv_cpu_ops xen_cpu_ops __initconst = {
  934. .cpuid = xen_cpuid,
  935. .set_debugreg = xen_set_debugreg,
  936. .get_debugreg = xen_get_debugreg,
  937. .clts = xen_clts,
  938. .read_cr0 = xen_read_cr0,
  939. .write_cr0 = xen_write_cr0,
  940. .read_cr4 = native_read_cr4,
  941. .read_cr4_safe = native_read_cr4_safe,
  942. .write_cr4 = xen_write_cr4,
  943. #ifdef CONFIG_X86_64
  944. .read_cr8 = xen_read_cr8,
  945. .write_cr8 = xen_write_cr8,
  946. #endif
  947. .wbinvd = native_wbinvd,
  948. .read_msr = native_read_msr_safe,
  949. .write_msr = xen_write_msr_safe,
  950. .read_tsc = native_read_tsc,
  951. .read_pmc = native_read_pmc,
  952. .read_tscp = native_read_tscp,
  953. .iret = xen_iret,
  954. .irq_enable_sysexit = xen_sysexit,
  955. #ifdef CONFIG_X86_64
  956. .usergs_sysret32 = xen_sysret32,
  957. .usergs_sysret64 = xen_sysret64,
  958. #endif
  959. .load_tr_desc = paravirt_nop,
  960. .set_ldt = xen_set_ldt,
  961. .load_gdt = xen_load_gdt,
  962. .load_idt = xen_load_idt,
  963. .load_tls = xen_load_tls,
  964. #ifdef CONFIG_X86_64
  965. .load_gs_index = xen_load_gs_index,
  966. #endif
  967. .alloc_ldt = xen_alloc_ldt,
  968. .free_ldt = xen_free_ldt,
  969. .store_gdt = native_store_gdt,
  970. .store_idt = native_store_idt,
  971. .store_tr = xen_store_tr,
  972. .write_ldt_entry = xen_write_ldt_entry,
  973. .write_gdt_entry = xen_write_gdt_entry,
  974. .write_idt_entry = xen_write_idt_entry,
  975. .load_sp0 = xen_load_sp0,
  976. .set_iopl_mask = xen_set_iopl_mask,
  977. .io_delay = xen_io_delay,
  978. /* Xen takes care of %gs when switching to usermode for us */
  979. .swapgs = paravirt_nop,
  980. .start_context_switch = paravirt_start_context_switch,
  981. .end_context_switch = xen_end_context_switch,
  982. };
  983. static const struct pv_apic_ops xen_apic_ops __initconst = {
  984. #ifdef CONFIG_X86_LOCAL_APIC
  985. .startup_ipi_hook = paravirt_nop,
  986. #endif
  987. };
  988. static void xen_reboot(int reason)
  989. {
  990. struct sched_shutdown r = { .reason = reason };
  991. if (HYPERVISOR_sched_op(SCHEDOP_shutdown, &r))
  992. BUG();
  993. }
  994. static void xen_restart(char *msg)
  995. {
  996. xen_reboot(SHUTDOWN_reboot);
  997. }
  998. static void xen_emergency_restart(void)
  999. {
  1000. xen_reboot(SHUTDOWN_reboot);
  1001. }
  1002. static void xen_machine_halt(void)
  1003. {
  1004. xen_reboot(SHUTDOWN_poweroff);
  1005. }
  1006. static void xen_machine_power_off(void)
  1007. {
  1008. if (pm_power_off)
  1009. pm_power_off();
  1010. xen_reboot(SHUTDOWN_poweroff);
  1011. }
  1012. static void xen_crash_shutdown(struct pt_regs *regs)
  1013. {
  1014. xen_reboot(SHUTDOWN_crash);
  1015. }
  1016. static int
  1017. xen_panic_event(struct notifier_block *this, unsigned long event, void *ptr)
  1018. {
  1019. xen_reboot(SHUTDOWN_crash);
  1020. return NOTIFY_DONE;
  1021. }
  1022. static struct notifier_block xen_panic_block = {
  1023. .notifier_call= xen_panic_event,
  1024. };
  1025. int xen_panic_handler_init(void)
  1026. {
  1027. atomic_notifier_chain_register(&panic_notifier_list, &xen_panic_block);
  1028. return 0;
  1029. }
  1030. static const struct machine_ops xen_machine_ops __initconst = {
  1031. .restart = xen_restart,
  1032. .halt = xen_machine_halt,
  1033. .power_off = xen_machine_power_off,
  1034. .shutdown = xen_machine_halt,
  1035. .crash_shutdown = xen_crash_shutdown,
  1036. .emergency_restart = xen_emergency_restart,
  1037. };
  1038. /*
  1039. * Set up the GDT and segment registers for -fstack-protector. Until
  1040. * we do this, we have to be careful not to call any stack-protected
  1041. * function, which is most of the kernel.
  1042. */
  1043. static void __init xen_setup_stackprotector(void)
  1044. {
  1045. pv_cpu_ops.write_gdt_entry = xen_write_gdt_entry_boot;
  1046. pv_cpu_ops.load_gdt = xen_load_gdt_boot;
  1047. setup_stack_canary_segment(0);
  1048. switch_to_new_gdt(0);
  1049. pv_cpu_ops.write_gdt_entry = xen_write_gdt_entry;
  1050. pv_cpu_ops.load_gdt = xen_load_gdt;
  1051. }
  1052. /* First C function to be called on Xen boot */
  1053. asmlinkage void __init xen_start_kernel(void)
  1054. {
  1055. struct physdev_set_iopl set_iopl;
  1056. int rc;
  1057. if (!xen_start_info)
  1058. return;
  1059. xen_domain_type = XEN_PV_DOMAIN;
  1060. xen_setup_machphys_mapping();
  1061. /* Install Xen paravirt ops */
  1062. pv_info = xen_info;
  1063. pv_init_ops = xen_init_ops;
  1064. pv_cpu_ops = xen_cpu_ops;
  1065. pv_apic_ops = xen_apic_ops;
  1066. x86_init.resources.memory_setup = xen_memory_setup;
  1067. x86_init.oem.arch_setup = xen_arch_setup;
  1068. x86_init.oem.banner = xen_banner;
  1069. xen_init_time_ops();
  1070. /*
  1071. * Set up some pagetable state before starting to set any ptes.
  1072. */
  1073. xen_init_mmu_ops();
  1074. /* Prevent unwanted bits from being set in PTEs. */
  1075. __supported_pte_mask &= ~_PAGE_GLOBAL;
  1076. #if 0
  1077. if (!xen_initial_domain())
  1078. #endif
  1079. __supported_pte_mask &= ~(_PAGE_PWT | _PAGE_PCD);
  1080. __supported_pte_mask |= _PAGE_IOMAP;
  1081. /*
  1082. * Prevent page tables from being allocated in highmem, even
  1083. * if CONFIG_HIGHPTE is enabled.
  1084. */
  1085. __userpte_alloc_gfp &= ~__GFP_HIGHMEM;
  1086. /* Work out if we support NX */
  1087. x86_configure_nx();
  1088. xen_setup_features();
  1089. /* Get mfn list */
  1090. if (!xen_feature(XENFEAT_auto_translated_physmap))
  1091. xen_build_dynamic_phys_to_machine();
  1092. /*
  1093. * Set up kernel GDT and segment registers, mainly so that
  1094. * -fstack-protector code can be executed.
  1095. */
  1096. xen_setup_stackprotector();
  1097. xen_init_irq_ops();
  1098. xen_init_cpuid_mask();
  1099. #ifdef CONFIG_X86_LOCAL_APIC
  1100. /*
  1101. * set up the basic apic ops.
  1102. */
  1103. set_xen_basic_apic_ops();
  1104. #endif
  1105. if (xen_feature(XENFEAT_mmu_pt_update_preserve_ad)) {
  1106. pv_mmu_ops.ptep_modify_prot_start = xen_ptep_modify_prot_start;
  1107. pv_mmu_ops.ptep_modify_prot_commit = xen_ptep_modify_prot_commit;
  1108. }
  1109. machine_ops = xen_machine_ops;
  1110. /*
  1111. * The only reliable way to retain the initial address of the
  1112. * percpu gdt_page is to remember it here, so we can go and
  1113. * mark it RW later, when the initial percpu area is freed.
  1114. */
  1115. xen_initial_gdt = &per_cpu(gdt_page, 0);
  1116. xen_smp_init();
  1117. #ifdef CONFIG_ACPI_NUMA
  1118. /*
  1119. * The pages we from Xen are not related to machine pages, so
  1120. * any NUMA information the kernel tries to get from ACPI will
  1121. * be meaningless. Prevent it from trying.
  1122. */
  1123. acpi_numa = -1;
  1124. #endif
  1125. /* Don't do the full vcpu_info placement stuff until we have a
  1126. possible map and a non-dummy shared_info. */
  1127. per_cpu(xen_vcpu, 0) = &HYPERVISOR_shared_info->vcpu_info[0];
  1128. local_irq_disable();
  1129. early_boot_irqs_disabled = true;
  1130. xen_raw_console_write("mapping kernel into physical memory\n");
  1131. xen_setup_kernel_pagetable((pgd_t *)xen_start_info->pt_base, xen_start_info->nr_pages);
  1132. /* Allocate and initialize top and mid mfn levels for p2m structure */
  1133. xen_build_mfn_list_list();
  1134. /* keep using Xen gdt for now; no urgent need to change it */
  1135. #ifdef CONFIG_X86_32
  1136. pv_info.kernel_rpl = 1;
  1137. if (xen_feature(XENFEAT_supervisor_mode_kernel))
  1138. pv_info.kernel_rpl = 0;
  1139. #else
  1140. pv_info.kernel_rpl = 0;
  1141. #endif
  1142. /* set the limit of our address space */
  1143. xen_reserve_top();
  1144. /* We used to do this in xen_arch_setup, but that is too late on AMD
  1145. * were early_cpu_init (run before ->arch_setup()) calls early_amd_init
  1146. * which pokes 0xcf8 port.
  1147. */
  1148. set_iopl.iopl = 1;
  1149. rc = HYPERVISOR_physdev_op(PHYSDEVOP_set_iopl, &set_iopl);
  1150. if (rc != 0)
  1151. xen_raw_printk("physdev_op failed %d\n", rc);
  1152. #ifdef CONFIG_X86_32
  1153. /* set up basic CPUID stuff */
  1154. cpu_detect(&new_cpu_data);
  1155. new_cpu_data.hard_math = 1;
  1156. new_cpu_data.wp_works_ok = 1;
  1157. new_cpu_data.x86_capability[0] = cpuid_edx(1);
  1158. #endif
  1159. /* Poke various useful things into boot_params */
  1160. boot_params.hdr.type_of_loader = (9 << 4) | 0;
  1161. boot_params.hdr.ramdisk_image = xen_start_info->mod_start
  1162. ? __pa(xen_start_info->mod_start) : 0;
  1163. boot_params.hdr.ramdisk_size = xen_start_info->mod_len;
  1164. boot_params.hdr.cmd_line_ptr = __pa(xen_start_info->cmd_line);
  1165. if (!xen_initial_domain()) {
  1166. add_preferred_console("xenboot", 0, NULL);
  1167. add_preferred_console("tty", 0, NULL);
  1168. add_preferred_console("hvc", 0, NULL);
  1169. if (pci_xen)
  1170. x86_init.pci.arch_init = pci_xen_init;
  1171. } else {
  1172. const struct dom0_vga_console_info *info =
  1173. (void *)((char *)xen_start_info +
  1174. xen_start_info->console.dom0.info_off);
  1175. struct xen_platform_op op = {
  1176. .cmd = XENPF_firmware_info,
  1177. .interface_version = XENPF_INTERFACE_VERSION,
  1178. .u.firmware_info.type = XEN_FW_KBD_SHIFT_FLAGS,
  1179. };
  1180. xen_init_vga(info, xen_start_info->console.dom0.info_size);
  1181. xen_start_info->console.domU.mfn = 0;
  1182. xen_start_info->console.domU.evtchn = 0;
  1183. if (HYPERVISOR_dom0_op(&op) == 0)
  1184. boot_params.kbd_status = op.u.firmware_info.u.kbd_shift_flags;
  1185. xen_init_apic();
  1186. /* Make sure ACS will be enabled */
  1187. pci_request_acs();
  1188. xen_acpi_sleep_register();
  1189. /* Avoid searching for BIOS MP tables */
  1190. x86_init.mpparse.find_smp_config = x86_init_noop;
  1191. x86_init.mpparse.get_smp_config = x86_init_uint_noop;
  1192. }
  1193. #ifdef CONFIG_PCI
  1194. /* PCI BIOS service won't work from a PV guest. */
  1195. pci_probe &= ~PCI_PROBE_BIOS;
  1196. #endif
  1197. xen_raw_console_write("about to get started...\n");
  1198. xen_setup_runstate_info(0);
  1199. /* Start the world */
  1200. #ifdef CONFIG_X86_32
  1201. i386_start_kernel();
  1202. #else
  1203. x86_64_start_reservations((char *)__pa_symbol(&boot_params));
  1204. #endif
  1205. }
  1206. void __ref xen_hvm_init_shared_info(void)
  1207. {
  1208. int cpu;
  1209. struct xen_add_to_physmap xatp;
  1210. static struct shared_info *shared_info_page = 0;
  1211. if (!shared_info_page)
  1212. shared_info_page = (struct shared_info *)
  1213. extend_brk(PAGE_SIZE, PAGE_SIZE);
  1214. xatp.domid = DOMID_SELF;
  1215. xatp.idx = 0;
  1216. xatp.space = XENMAPSPACE_shared_info;
  1217. xatp.gpfn = __pa(shared_info_page) >> PAGE_SHIFT;
  1218. if (HYPERVISOR_memory_op(XENMEM_add_to_physmap, &xatp))
  1219. BUG();
  1220. HYPERVISOR_shared_info = (struct shared_info *)shared_info_page;
  1221. /* xen_vcpu is a pointer to the vcpu_info struct in the shared_info
  1222. * page, we use it in the event channel upcall and in some pvclock
  1223. * related functions. We don't need the vcpu_info placement
  1224. * optimizations because we don't use any pv_mmu or pv_irq op on
  1225. * HVM.
  1226. * When xen_hvm_init_shared_info is run at boot time only vcpu 0 is
  1227. * online but xen_hvm_init_shared_info is run at resume time too and
  1228. * in that case multiple vcpus might be online. */
  1229. for_each_online_cpu(cpu) {
  1230. per_cpu(xen_vcpu, cpu) = &HYPERVISOR_shared_info->vcpu_info[cpu];
  1231. }
  1232. }
  1233. #ifdef CONFIG_XEN_PVHVM
  1234. static void __init init_hvm_pv_info(void)
  1235. {
  1236. int major, minor;
  1237. uint32_t eax, ebx, ecx, edx, pages, msr, base;
  1238. u64 pfn;
  1239. base = xen_cpuid_base();
  1240. cpuid(base + 1, &eax, &ebx, &ecx, &edx);
  1241. major = eax >> 16;
  1242. minor = eax & 0xffff;
  1243. printk(KERN_INFO "Xen version %d.%d.\n", major, minor);
  1244. cpuid(base + 2, &pages, &msr, &ecx, &edx);
  1245. pfn = __pa(hypercall_page);
  1246. wrmsr_safe(msr, (u32)pfn, (u32)(pfn >> 32));
  1247. xen_setup_features();
  1248. pv_info.name = "Xen HVM";
  1249. xen_domain_type = XEN_HVM_DOMAIN;
  1250. }
  1251. static int __cpuinit xen_hvm_cpu_notify(struct notifier_block *self,
  1252. unsigned long action, void *hcpu)
  1253. {
  1254. int cpu = (long)hcpu;
  1255. switch (action) {
  1256. case CPU_UP_PREPARE:
  1257. xen_vcpu_setup(cpu);
  1258. if (xen_have_vector_callback)
  1259. xen_init_lock_cpu(cpu);
  1260. break;
  1261. default:
  1262. break;
  1263. }
  1264. return NOTIFY_OK;
  1265. }
  1266. static struct notifier_block xen_hvm_cpu_notifier __cpuinitdata = {
  1267. .notifier_call = xen_hvm_cpu_notify,
  1268. };
  1269. static void __init xen_hvm_guest_init(void)
  1270. {
  1271. init_hvm_pv_info();
  1272. xen_hvm_init_shared_info();
  1273. if (xen_feature(XENFEAT_hvm_callback_vector))
  1274. xen_have_vector_callback = 1;
  1275. xen_hvm_smp_init();
  1276. register_cpu_notifier(&xen_hvm_cpu_notifier);
  1277. xen_unplug_emulated_devices();
  1278. x86_init.irqs.intr_init = xen_init_IRQ;
  1279. xen_hvm_init_time_ops();
  1280. xen_hvm_init_mmu_ops();
  1281. }
  1282. static bool __init xen_hvm_platform(void)
  1283. {
  1284. if (xen_pv_domain())
  1285. return false;
  1286. if (!xen_cpuid_base())
  1287. return false;
  1288. return true;
  1289. }
  1290. bool xen_hvm_need_lapic(void)
  1291. {
  1292. if (xen_pv_domain())
  1293. return false;
  1294. if (!xen_hvm_domain())
  1295. return false;
  1296. if (xen_feature(XENFEAT_hvm_pirqs) && xen_have_vector_callback)
  1297. return false;
  1298. return true;
  1299. }
  1300. EXPORT_SYMBOL_GPL(xen_hvm_need_lapic);
  1301. const struct hypervisor_x86 x86_hyper_xen_hvm __refconst = {
  1302. .name = "Xen HVM",
  1303. .detect = xen_hvm_platform,
  1304. .init_platform = xen_hvm_guest_init,
  1305. };
  1306. EXPORT_SYMBOL(x86_hyper_xen_hvm);
  1307. #endif