enlighten.c 39 KB

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