book3s.c 27 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067
  1. /*
  2. * Copyright (C) 2009. SUSE Linux Products GmbH. All rights reserved.
  3. *
  4. * Authors:
  5. * Alexander Graf <agraf@suse.de>
  6. * Kevin Wolf <mail@kevin-wolf.de>
  7. *
  8. * Description:
  9. * This file is derived from arch/powerpc/kvm/44x.c,
  10. * by Hollis Blanchard <hollisb@us.ibm.com>.
  11. *
  12. * This program is free software; you can redistribute it and/or modify
  13. * it under the terms of the GNU General Public License, version 2, as
  14. * published by the Free Software Foundation.
  15. */
  16. #include <linux/kvm_host.h>
  17. #include <linux/err.h>
  18. #include <linux/export.h>
  19. #include <linux/slab.h>
  20. #include <linux/module.h>
  21. #include <linux/miscdevice.h>
  22. #include <linux/gfp.h>
  23. #include <linux/sched.h>
  24. #include <linux/vmalloc.h>
  25. #include <linux/highmem.h>
  26. #include <asm/reg.h>
  27. #include <asm/cputable.h>
  28. #include <asm/cacheflush.h>
  29. #include <linux/uaccess.h>
  30. #include <asm/io.h>
  31. #include <asm/kvm_ppc.h>
  32. #include <asm/kvm_book3s.h>
  33. #include <asm/mmu_context.h>
  34. #include <asm/page.h>
  35. #include <asm/xive.h>
  36. #include "book3s.h"
  37. #include "trace.h"
  38. #define VCPU_STAT(x) offsetof(struct kvm_vcpu, stat.x), KVM_STAT_VCPU
  39. /* #define EXIT_DEBUG */
  40. struct kvm_stats_debugfs_item debugfs_entries[] = {
  41. { "exits", VCPU_STAT(sum_exits) },
  42. { "mmio", VCPU_STAT(mmio_exits) },
  43. { "sig", VCPU_STAT(signal_exits) },
  44. { "sysc", VCPU_STAT(syscall_exits) },
  45. { "inst_emu", VCPU_STAT(emulated_inst_exits) },
  46. { "dec", VCPU_STAT(dec_exits) },
  47. { "ext_intr", VCPU_STAT(ext_intr_exits) },
  48. { "queue_intr", VCPU_STAT(queue_intr) },
  49. { "halt_poll_success_ns", VCPU_STAT(halt_poll_success_ns) },
  50. { "halt_poll_fail_ns", VCPU_STAT(halt_poll_fail_ns) },
  51. { "halt_wait_ns", VCPU_STAT(halt_wait_ns) },
  52. { "halt_successful_poll", VCPU_STAT(halt_successful_poll), },
  53. { "halt_attempted_poll", VCPU_STAT(halt_attempted_poll), },
  54. { "halt_successful_wait", VCPU_STAT(halt_successful_wait) },
  55. { "halt_poll_invalid", VCPU_STAT(halt_poll_invalid) },
  56. { "halt_wakeup", VCPU_STAT(halt_wakeup) },
  57. { "pf_storage", VCPU_STAT(pf_storage) },
  58. { "sp_storage", VCPU_STAT(sp_storage) },
  59. { "pf_instruc", VCPU_STAT(pf_instruc) },
  60. { "sp_instruc", VCPU_STAT(sp_instruc) },
  61. { "ld", VCPU_STAT(ld) },
  62. { "ld_slow", VCPU_STAT(ld_slow) },
  63. { "st", VCPU_STAT(st) },
  64. { "st_slow", VCPU_STAT(st_slow) },
  65. { "pthru_all", VCPU_STAT(pthru_all) },
  66. { "pthru_host", VCPU_STAT(pthru_host) },
  67. { "pthru_bad_aff", VCPU_STAT(pthru_bad_aff) },
  68. { NULL }
  69. };
  70. void kvmppc_unfixup_split_real(struct kvm_vcpu *vcpu)
  71. {
  72. if (vcpu->arch.hflags & BOOK3S_HFLAG_SPLIT_HACK) {
  73. ulong pc = kvmppc_get_pc(vcpu);
  74. ulong lr = kvmppc_get_lr(vcpu);
  75. if ((pc & SPLIT_HACK_MASK) == SPLIT_HACK_OFFS)
  76. kvmppc_set_pc(vcpu, pc & ~SPLIT_HACK_MASK);
  77. if ((lr & SPLIT_HACK_MASK) == SPLIT_HACK_OFFS)
  78. kvmppc_set_lr(vcpu, lr & ~SPLIT_HACK_MASK);
  79. vcpu->arch.hflags &= ~BOOK3S_HFLAG_SPLIT_HACK;
  80. }
  81. }
  82. EXPORT_SYMBOL_GPL(kvmppc_unfixup_split_real);
  83. static inline unsigned long kvmppc_interrupt_offset(struct kvm_vcpu *vcpu)
  84. {
  85. if (!is_kvmppc_hv_enabled(vcpu->kvm))
  86. return to_book3s(vcpu)->hior;
  87. return 0;
  88. }
  89. static inline void kvmppc_update_int_pending(struct kvm_vcpu *vcpu,
  90. unsigned long pending_now, unsigned long old_pending)
  91. {
  92. if (is_kvmppc_hv_enabled(vcpu->kvm))
  93. return;
  94. if (pending_now)
  95. kvmppc_set_int_pending(vcpu, 1);
  96. else if (old_pending)
  97. kvmppc_set_int_pending(vcpu, 0);
  98. }
  99. static inline bool kvmppc_critical_section(struct kvm_vcpu *vcpu)
  100. {
  101. ulong crit_raw;
  102. ulong crit_r1;
  103. bool crit;
  104. if (is_kvmppc_hv_enabled(vcpu->kvm))
  105. return false;
  106. crit_raw = kvmppc_get_critical(vcpu);
  107. crit_r1 = kvmppc_get_gpr(vcpu, 1);
  108. /* Truncate crit indicators in 32 bit mode */
  109. if (!(kvmppc_get_msr(vcpu) & MSR_SF)) {
  110. crit_raw &= 0xffffffff;
  111. crit_r1 &= 0xffffffff;
  112. }
  113. /* Critical section when crit == r1 */
  114. crit = (crit_raw == crit_r1);
  115. /* ... and we're in supervisor mode */
  116. crit = crit && !(kvmppc_get_msr(vcpu) & MSR_PR);
  117. return crit;
  118. }
  119. void kvmppc_inject_interrupt(struct kvm_vcpu *vcpu, int vec, u64 flags)
  120. {
  121. kvmppc_unfixup_split_real(vcpu);
  122. kvmppc_set_srr0(vcpu, kvmppc_get_pc(vcpu));
  123. kvmppc_set_srr1(vcpu, (kvmppc_get_msr(vcpu) & ~0x783f0000ul) | flags);
  124. kvmppc_set_pc(vcpu, kvmppc_interrupt_offset(vcpu) + vec);
  125. vcpu->arch.mmu.reset_msr(vcpu);
  126. }
  127. static int kvmppc_book3s_vec2irqprio(unsigned int vec)
  128. {
  129. unsigned int prio;
  130. switch (vec) {
  131. case 0x100: prio = BOOK3S_IRQPRIO_SYSTEM_RESET; break;
  132. case 0x200: prio = BOOK3S_IRQPRIO_MACHINE_CHECK; break;
  133. case 0x300: prio = BOOK3S_IRQPRIO_DATA_STORAGE; break;
  134. case 0x380: prio = BOOK3S_IRQPRIO_DATA_SEGMENT; break;
  135. case 0x400: prio = BOOK3S_IRQPRIO_INST_STORAGE; break;
  136. case 0x480: prio = BOOK3S_IRQPRIO_INST_SEGMENT; break;
  137. case 0x500: prio = BOOK3S_IRQPRIO_EXTERNAL; break;
  138. case 0x600: prio = BOOK3S_IRQPRIO_ALIGNMENT; break;
  139. case 0x700: prio = BOOK3S_IRQPRIO_PROGRAM; break;
  140. case 0x800: prio = BOOK3S_IRQPRIO_FP_UNAVAIL; break;
  141. case 0x900: prio = BOOK3S_IRQPRIO_DECREMENTER; break;
  142. case 0xc00: prio = BOOK3S_IRQPRIO_SYSCALL; break;
  143. case 0xd00: prio = BOOK3S_IRQPRIO_DEBUG; break;
  144. case 0xf20: prio = BOOK3S_IRQPRIO_ALTIVEC; break;
  145. case 0xf40: prio = BOOK3S_IRQPRIO_VSX; break;
  146. case 0xf60: prio = BOOK3S_IRQPRIO_FAC_UNAVAIL; break;
  147. default: prio = BOOK3S_IRQPRIO_MAX; break;
  148. }
  149. return prio;
  150. }
  151. void kvmppc_book3s_dequeue_irqprio(struct kvm_vcpu *vcpu,
  152. unsigned int vec)
  153. {
  154. unsigned long old_pending = vcpu->arch.pending_exceptions;
  155. clear_bit(kvmppc_book3s_vec2irqprio(vec),
  156. &vcpu->arch.pending_exceptions);
  157. kvmppc_update_int_pending(vcpu, vcpu->arch.pending_exceptions,
  158. old_pending);
  159. }
  160. void kvmppc_book3s_queue_irqprio(struct kvm_vcpu *vcpu, unsigned int vec)
  161. {
  162. vcpu->stat.queue_intr++;
  163. set_bit(kvmppc_book3s_vec2irqprio(vec),
  164. &vcpu->arch.pending_exceptions);
  165. #ifdef EXIT_DEBUG
  166. printk(KERN_INFO "Queueing interrupt %x\n", vec);
  167. #endif
  168. }
  169. EXPORT_SYMBOL_GPL(kvmppc_book3s_queue_irqprio);
  170. void kvmppc_core_queue_program(struct kvm_vcpu *vcpu, ulong flags)
  171. {
  172. /* might as well deliver this straight away */
  173. kvmppc_inject_interrupt(vcpu, BOOK3S_INTERRUPT_PROGRAM, flags);
  174. }
  175. EXPORT_SYMBOL_GPL(kvmppc_core_queue_program);
  176. void kvmppc_core_queue_fpunavail(struct kvm_vcpu *vcpu)
  177. {
  178. /* might as well deliver this straight away */
  179. kvmppc_inject_interrupt(vcpu, BOOK3S_INTERRUPT_FP_UNAVAIL, 0);
  180. }
  181. void kvmppc_core_queue_vec_unavail(struct kvm_vcpu *vcpu)
  182. {
  183. /* might as well deliver this straight away */
  184. kvmppc_inject_interrupt(vcpu, BOOK3S_INTERRUPT_ALTIVEC, 0);
  185. }
  186. void kvmppc_core_queue_vsx_unavail(struct kvm_vcpu *vcpu)
  187. {
  188. /* might as well deliver this straight away */
  189. kvmppc_inject_interrupt(vcpu, BOOK3S_INTERRUPT_VSX, 0);
  190. }
  191. void kvmppc_core_queue_dec(struct kvm_vcpu *vcpu)
  192. {
  193. kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
  194. }
  195. EXPORT_SYMBOL_GPL(kvmppc_core_queue_dec);
  196. int kvmppc_core_pending_dec(struct kvm_vcpu *vcpu)
  197. {
  198. return test_bit(BOOK3S_IRQPRIO_DECREMENTER, &vcpu->arch.pending_exceptions);
  199. }
  200. EXPORT_SYMBOL_GPL(kvmppc_core_pending_dec);
  201. void kvmppc_core_dequeue_dec(struct kvm_vcpu *vcpu)
  202. {
  203. kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
  204. }
  205. EXPORT_SYMBOL_GPL(kvmppc_core_dequeue_dec);
  206. void kvmppc_core_queue_external(struct kvm_vcpu *vcpu,
  207. struct kvm_interrupt *irq)
  208. {
  209. /*
  210. * This case (KVM_INTERRUPT_SET) should never actually arise for
  211. * a pseries guest (because pseries guests expect their interrupt
  212. * controllers to continue asserting an external interrupt request
  213. * until it is acknowledged at the interrupt controller), but is
  214. * included to avoid ABI breakage and potentially for other
  215. * sorts of guest.
  216. *
  217. * There is a subtlety here: HV KVM does not test the
  218. * external_oneshot flag in the code that synthesizes
  219. * external interrupts for the guest just before entering
  220. * the guest. That is OK even if userspace did do a
  221. * KVM_INTERRUPT_SET on a pseries guest vcpu, because the
  222. * caller (kvm_vcpu_ioctl_interrupt) does a kvm_vcpu_kick()
  223. * which ends up doing a smp_send_reschedule(), which will
  224. * pull the guest all the way out to the host, meaning that
  225. * we will call kvmppc_core_prepare_to_enter() before entering
  226. * the guest again, and that will handle the external_oneshot
  227. * flag correctly.
  228. */
  229. if (irq->irq == KVM_INTERRUPT_SET)
  230. vcpu->arch.external_oneshot = 1;
  231. kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL);
  232. }
  233. void kvmppc_core_dequeue_external(struct kvm_vcpu *vcpu)
  234. {
  235. kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL);
  236. }
  237. void kvmppc_core_queue_data_storage(struct kvm_vcpu *vcpu, ulong dar,
  238. ulong flags)
  239. {
  240. kvmppc_set_dar(vcpu, dar);
  241. kvmppc_set_dsisr(vcpu, flags);
  242. kvmppc_inject_interrupt(vcpu, BOOK3S_INTERRUPT_DATA_STORAGE, 0);
  243. }
  244. EXPORT_SYMBOL_GPL(kvmppc_core_queue_data_storage);
  245. void kvmppc_core_queue_inst_storage(struct kvm_vcpu *vcpu, ulong flags)
  246. {
  247. kvmppc_inject_interrupt(vcpu, BOOK3S_INTERRUPT_INST_STORAGE, flags);
  248. }
  249. EXPORT_SYMBOL_GPL(kvmppc_core_queue_inst_storage);
  250. static int kvmppc_book3s_irqprio_deliver(struct kvm_vcpu *vcpu,
  251. unsigned int priority)
  252. {
  253. int deliver = 1;
  254. int vec = 0;
  255. bool crit = kvmppc_critical_section(vcpu);
  256. switch (priority) {
  257. case BOOK3S_IRQPRIO_DECREMENTER:
  258. deliver = (kvmppc_get_msr(vcpu) & MSR_EE) && !crit;
  259. vec = BOOK3S_INTERRUPT_DECREMENTER;
  260. break;
  261. case BOOK3S_IRQPRIO_EXTERNAL:
  262. deliver = (kvmppc_get_msr(vcpu) & MSR_EE) && !crit;
  263. vec = BOOK3S_INTERRUPT_EXTERNAL;
  264. break;
  265. case BOOK3S_IRQPRIO_SYSTEM_RESET:
  266. vec = BOOK3S_INTERRUPT_SYSTEM_RESET;
  267. break;
  268. case BOOK3S_IRQPRIO_MACHINE_CHECK:
  269. vec = BOOK3S_INTERRUPT_MACHINE_CHECK;
  270. break;
  271. case BOOK3S_IRQPRIO_DATA_STORAGE:
  272. vec = BOOK3S_INTERRUPT_DATA_STORAGE;
  273. break;
  274. case BOOK3S_IRQPRIO_INST_STORAGE:
  275. vec = BOOK3S_INTERRUPT_INST_STORAGE;
  276. break;
  277. case BOOK3S_IRQPRIO_DATA_SEGMENT:
  278. vec = BOOK3S_INTERRUPT_DATA_SEGMENT;
  279. break;
  280. case BOOK3S_IRQPRIO_INST_SEGMENT:
  281. vec = BOOK3S_INTERRUPT_INST_SEGMENT;
  282. break;
  283. case BOOK3S_IRQPRIO_ALIGNMENT:
  284. vec = BOOK3S_INTERRUPT_ALIGNMENT;
  285. break;
  286. case BOOK3S_IRQPRIO_PROGRAM:
  287. vec = BOOK3S_INTERRUPT_PROGRAM;
  288. break;
  289. case BOOK3S_IRQPRIO_VSX:
  290. vec = BOOK3S_INTERRUPT_VSX;
  291. break;
  292. case BOOK3S_IRQPRIO_ALTIVEC:
  293. vec = BOOK3S_INTERRUPT_ALTIVEC;
  294. break;
  295. case BOOK3S_IRQPRIO_FP_UNAVAIL:
  296. vec = BOOK3S_INTERRUPT_FP_UNAVAIL;
  297. break;
  298. case BOOK3S_IRQPRIO_SYSCALL:
  299. vec = BOOK3S_INTERRUPT_SYSCALL;
  300. break;
  301. case BOOK3S_IRQPRIO_DEBUG:
  302. vec = BOOK3S_INTERRUPT_TRACE;
  303. break;
  304. case BOOK3S_IRQPRIO_PERFORMANCE_MONITOR:
  305. vec = BOOK3S_INTERRUPT_PERFMON;
  306. break;
  307. case BOOK3S_IRQPRIO_FAC_UNAVAIL:
  308. vec = BOOK3S_INTERRUPT_FAC_UNAVAIL;
  309. break;
  310. default:
  311. deliver = 0;
  312. printk(KERN_ERR "KVM: Unknown interrupt: 0x%x\n", priority);
  313. break;
  314. }
  315. #if 0
  316. printk(KERN_INFO "Deliver interrupt 0x%x? %x\n", vec, deliver);
  317. #endif
  318. if (deliver)
  319. kvmppc_inject_interrupt(vcpu, vec, 0);
  320. return deliver;
  321. }
  322. /*
  323. * This function determines if an irqprio should be cleared once issued.
  324. */
  325. static bool clear_irqprio(struct kvm_vcpu *vcpu, unsigned int priority)
  326. {
  327. switch (priority) {
  328. case BOOK3S_IRQPRIO_DECREMENTER:
  329. /* DEC interrupts get cleared by mtdec */
  330. return false;
  331. case BOOK3S_IRQPRIO_EXTERNAL:
  332. /*
  333. * External interrupts get cleared by userspace
  334. * except when set by the KVM_INTERRUPT ioctl with
  335. * KVM_INTERRUPT_SET (not KVM_INTERRUPT_SET_LEVEL).
  336. */
  337. if (vcpu->arch.external_oneshot) {
  338. vcpu->arch.external_oneshot = 0;
  339. return true;
  340. }
  341. return false;
  342. }
  343. return true;
  344. }
  345. int kvmppc_core_prepare_to_enter(struct kvm_vcpu *vcpu)
  346. {
  347. unsigned long *pending = &vcpu->arch.pending_exceptions;
  348. unsigned long old_pending = vcpu->arch.pending_exceptions;
  349. unsigned int priority;
  350. #ifdef EXIT_DEBUG
  351. if (vcpu->arch.pending_exceptions)
  352. printk(KERN_EMERG "KVM: Check pending: %lx\n", vcpu->arch.pending_exceptions);
  353. #endif
  354. priority = __ffs(*pending);
  355. while (priority < BOOK3S_IRQPRIO_MAX) {
  356. if (kvmppc_book3s_irqprio_deliver(vcpu, priority) &&
  357. clear_irqprio(vcpu, priority)) {
  358. clear_bit(priority, &vcpu->arch.pending_exceptions);
  359. break;
  360. }
  361. priority = find_next_bit(pending,
  362. BITS_PER_BYTE * sizeof(*pending),
  363. priority + 1);
  364. }
  365. /* Tell the guest about our interrupt status */
  366. kvmppc_update_int_pending(vcpu, *pending, old_pending);
  367. return 0;
  368. }
  369. EXPORT_SYMBOL_GPL(kvmppc_core_prepare_to_enter);
  370. kvm_pfn_t kvmppc_gpa_to_pfn(struct kvm_vcpu *vcpu, gpa_t gpa, bool writing,
  371. bool *writable)
  372. {
  373. ulong mp_pa = vcpu->arch.magic_page_pa & KVM_PAM;
  374. gfn_t gfn = gpa >> PAGE_SHIFT;
  375. if (!(kvmppc_get_msr(vcpu) & MSR_SF))
  376. mp_pa = (uint32_t)mp_pa;
  377. /* Magic page override */
  378. gpa &= ~0xFFFULL;
  379. if (unlikely(mp_pa) && unlikely((gpa & KVM_PAM) == mp_pa)) {
  380. ulong shared_page = ((ulong)vcpu->arch.shared) & PAGE_MASK;
  381. kvm_pfn_t pfn;
  382. pfn = (kvm_pfn_t)virt_to_phys((void*)shared_page) >> PAGE_SHIFT;
  383. get_page(pfn_to_page(pfn));
  384. if (writable)
  385. *writable = true;
  386. return pfn;
  387. }
  388. return gfn_to_pfn_prot(vcpu->kvm, gfn, writing, writable);
  389. }
  390. EXPORT_SYMBOL_GPL(kvmppc_gpa_to_pfn);
  391. int kvmppc_xlate(struct kvm_vcpu *vcpu, ulong eaddr, enum xlate_instdata xlid,
  392. enum xlate_readwrite xlrw, struct kvmppc_pte *pte)
  393. {
  394. bool data = (xlid == XLATE_DATA);
  395. bool iswrite = (xlrw == XLATE_WRITE);
  396. int relocated = (kvmppc_get_msr(vcpu) & (data ? MSR_DR : MSR_IR));
  397. int r;
  398. if (relocated) {
  399. r = vcpu->arch.mmu.xlate(vcpu, eaddr, pte, data, iswrite);
  400. } else {
  401. pte->eaddr = eaddr;
  402. pte->raddr = eaddr & KVM_PAM;
  403. pte->vpage = VSID_REAL | eaddr >> 12;
  404. pte->may_read = true;
  405. pte->may_write = true;
  406. pte->may_execute = true;
  407. r = 0;
  408. if ((kvmppc_get_msr(vcpu) & (MSR_IR | MSR_DR)) == MSR_DR &&
  409. !data) {
  410. if ((vcpu->arch.hflags & BOOK3S_HFLAG_SPLIT_HACK) &&
  411. ((eaddr & SPLIT_HACK_MASK) == SPLIT_HACK_OFFS))
  412. pte->raddr &= ~SPLIT_HACK_MASK;
  413. }
  414. }
  415. return r;
  416. }
  417. int kvmppc_load_last_inst(struct kvm_vcpu *vcpu,
  418. enum instruction_fetch_type type, u32 *inst)
  419. {
  420. ulong pc = kvmppc_get_pc(vcpu);
  421. int r;
  422. if (type == INST_SC)
  423. pc -= 4;
  424. r = kvmppc_ld(vcpu, &pc, sizeof(u32), inst, false);
  425. if (r == EMULATE_DONE)
  426. return r;
  427. else
  428. return EMULATE_AGAIN;
  429. }
  430. EXPORT_SYMBOL_GPL(kvmppc_load_last_inst);
  431. int kvm_arch_vcpu_setup(struct kvm_vcpu *vcpu)
  432. {
  433. return 0;
  434. }
  435. int kvmppc_subarch_vcpu_init(struct kvm_vcpu *vcpu)
  436. {
  437. return 0;
  438. }
  439. void kvmppc_subarch_vcpu_uninit(struct kvm_vcpu *vcpu)
  440. {
  441. }
  442. int kvm_arch_vcpu_ioctl_get_sregs(struct kvm_vcpu *vcpu,
  443. struct kvm_sregs *sregs)
  444. {
  445. int ret;
  446. vcpu_load(vcpu);
  447. ret = vcpu->kvm->arch.kvm_ops->get_sregs(vcpu, sregs);
  448. vcpu_put(vcpu);
  449. return ret;
  450. }
  451. int kvm_arch_vcpu_ioctl_set_sregs(struct kvm_vcpu *vcpu,
  452. struct kvm_sregs *sregs)
  453. {
  454. int ret;
  455. vcpu_load(vcpu);
  456. ret = vcpu->kvm->arch.kvm_ops->set_sregs(vcpu, sregs);
  457. vcpu_put(vcpu);
  458. return ret;
  459. }
  460. int kvm_arch_vcpu_ioctl_get_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
  461. {
  462. int i;
  463. regs->pc = kvmppc_get_pc(vcpu);
  464. regs->cr = kvmppc_get_cr(vcpu);
  465. regs->ctr = kvmppc_get_ctr(vcpu);
  466. regs->lr = kvmppc_get_lr(vcpu);
  467. regs->xer = kvmppc_get_xer(vcpu);
  468. regs->msr = kvmppc_get_msr(vcpu);
  469. regs->srr0 = kvmppc_get_srr0(vcpu);
  470. regs->srr1 = kvmppc_get_srr1(vcpu);
  471. regs->pid = vcpu->arch.pid;
  472. regs->sprg0 = kvmppc_get_sprg0(vcpu);
  473. regs->sprg1 = kvmppc_get_sprg1(vcpu);
  474. regs->sprg2 = kvmppc_get_sprg2(vcpu);
  475. regs->sprg3 = kvmppc_get_sprg3(vcpu);
  476. regs->sprg4 = kvmppc_get_sprg4(vcpu);
  477. regs->sprg5 = kvmppc_get_sprg5(vcpu);
  478. regs->sprg6 = kvmppc_get_sprg6(vcpu);
  479. regs->sprg7 = kvmppc_get_sprg7(vcpu);
  480. for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
  481. regs->gpr[i] = kvmppc_get_gpr(vcpu, i);
  482. return 0;
  483. }
  484. int kvm_arch_vcpu_ioctl_set_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
  485. {
  486. int i;
  487. kvmppc_set_pc(vcpu, regs->pc);
  488. kvmppc_set_cr(vcpu, regs->cr);
  489. kvmppc_set_ctr(vcpu, regs->ctr);
  490. kvmppc_set_lr(vcpu, regs->lr);
  491. kvmppc_set_xer(vcpu, regs->xer);
  492. kvmppc_set_msr(vcpu, regs->msr);
  493. kvmppc_set_srr0(vcpu, regs->srr0);
  494. kvmppc_set_srr1(vcpu, regs->srr1);
  495. kvmppc_set_sprg0(vcpu, regs->sprg0);
  496. kvmppc_set_sprg1(vcpu, regs->sprg1);
  497. kvmppc_set_sprg2(vcpu, regs->sprg2);
  498. kvmppc_set_sprg3(vcpu, regs->sprg3);
  499. kvmppc_set_sprg4(vcpu, regs->sprg4);
  500. kvmppc_set_sprg5(vcpu, regs->sprg5);
  501. kvmppc_set_sprg6(vcpu, regs->sprg6);
  502. kvmppc_set_sprg7(vcpu, regs->sprg7);
  503. for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
  504. kvmppc_set_gpr(vcpu, i, regs->gpr[i]);
  505. return 0;
  506. }
  507. int kvm_arch_vcpu_ioctl_get_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu)
  508. {
  509. return -ENOTSUPP;
  510. }
  511. int kvm_arch_vcpu_ioctl_set_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu)
  512. {
  513. return -ENOTSUPP;
  514. }
  515. int kvmppc_get_one_reg(struct kvm_vcpu *vcpu, u64 id,
  516. union kvmppc_one_reg *val)
  517. {
  518. int r = 0;
  519. long int i;
  520. r = vcpu->kvm->arch.kvm_ops->get_one_reg(vcpu, id, val);
  521. if (r == -EINVAL) {
  522. r = 0;
  523. switch (id) {
  524. case KVM_REG_PPC_DAR:
  525. *val = get_reg_val(id, kvmppc_get_dar(vcpu));
  526. break;
  527. case KVM_REG_PPC_DSISR:
  528. *val = get_reg_val(id, kvmppc_get_dsisr(vcpu));
  529. break;
  530. case KVM_REG_PPC_FPR0 ... KVM_REG_PPC_FPR31:
  531. i = id - KVM_REG_PPC_FPR0;
  532. *val = get_reg_val(id, VCPU_FPR(vcpu, i));
  533. break;
  534. case KVM_REG_PPC_FPSCR:
  535. *val = get_reg_val(id, vcpu->arch.fp.fpscr);
  536. break;
  537. #ifdef CONFIG_VSX
  538. case KVM_REG_PPC_VSR0 ... KVM_REG_PPC_VSR31:
  539. if (cpu_has_feature(CPU_FTR_VSX)) {
  540. i = id - KVM_REG_PPC_VSR0;
  541. val->vsxval[0] = vcpu->arch.fp.fpr[i][0];
  542. val->vsxval[1] = vcpu->arch.fp.fpr[i][1];
  543. } else {
  544. r = -ENXIO;
  545. }
  546. break;
  547. #endif /* CONFIG_VSX */
  548. case KVM_REG_PPC_DEBUG_INST:
  549. *val = get_reg_val(id, INS_TW);
  550. break;
  551. #ifdef CONFIG_KVM_XICS
  552. case KVM_REG_PPC_ICP_STATE:
  553. if (!vcpu->arch.icp && !vcpu->arch.xive_vcpu) {
  554. r = -ENXIO;
  555. break;
  556. }
  557. if (xive_enabled())
  558. *val = get_reg_val(id, kvmppc_xive_get_icp(vcpu));
  559. else
  560. *val = get_reg_val(id, kvmppc_xics_get_icp(vcpu));
  561. break;
  562. #endif /* CONFIG_KVM_XICS */
  563. case KVM_REG_PPC_FSCR:
  564. *val = get_reg_val(id, vcpu->arch.fscr);
  565. break;
  566. case KVM_REG_PPC_TAR:
  567. *val = get_reg_val(id, vcpu->arch.tar);
  568. break;
  569. case KVM_REG_PPC_EBBHR:
  570. *val = get_reg_val(id, vcpu->arch.ebbhr);
  571. break;
  572. case KVM_REG_PPC_EBBRR:
  573. *val = get_reg_val(id, vcpu->arch.ebbrr);
  574. break;
  575. case KVM_REG_PPC_BESCR:
  576. *val = get_reg_val(id, vcpu->arch.bescr);
  577. break;
  578. case KVM_REG_PPC_IC:
  579. *val = get_reg_val(id, vcpu->arch.ic);
  580. break;
  581. default:
  582. r = -EINVAL;
  583. break;
  584. }
  585. }
  586. return r;
  587. }
  588. int kvmppc_set_one_reg(struct kvm_vcpu *vcpu, u64 id,
  589. union kvmppc_one_reg *val)
  590. {
  591. int r = 0;
  592. long int i;
  593. r = vcpu->kvm->arch.kvm_ops->set_one_reg(vcpu, id, val);
  594. if (r == -EINVAL) {
  595. r = 0;
  596. switch (id) {
  597. case KVM_REG_PPC_DAR:
  598. kvmppc_set_dar(vcpu, set_reg_val(id, *val));
  599. break;
  600. case KVM_REG_PPC_DSISR:
  601. kvmppc_set_dsisr(vcpu, set_reg_val(id, *val));
  602. break;
  603. case KVM_REG_PPC_FPR0 ... KVM_REG_PPC_FPR31:
  604. i = id - KVM_REG_PPC_FPR0;
  605. VCPU_FPR(vcpu, i) = set_reg_val(id, *val);
  606. break;
  607. case KVM_REG_PPC_FPSCR:
  608. vcpu->arch.fp.fpscr = set_reg_val(id, *val);
  609. break;
  610. #ifdef CONFIG_VSX
  611. case KVM_REG_PPC_VSR0 ... KVM_REG_PPC_VSR31:
  612. if (cpu_has_feature(CPU_FTR_VSX)) {
  613. i = id - KVM_REG_PPC_VSR0;
  614. vcpu->arch.fp.fpr[i][0] = val->vsxval[0];
  615. vcpu->arch.fp.fpr[i][1] = val->vsxval[1];
  616. } else {
  617. r = -ENXIO;
  618. }
  619. break;
  620. #endif /* CONFIG_VSX */
  621. #ifdef CONFIG_KVM_XICS
  622. case KVM_REG_PPC_ICP_STATE:
  623. if (!vcpu->arch.icp && !vcpu->arch.xive_vcpu) {
  624. r = -ENXIO;
  625. break;
  626. }
  627. if (xive_enabled())
  628. r = kvmppc_xive_set_icp(vcpu, set_reg_val(id, *val));
  629. else
  630. r = kvmppc_xics_set_icp(vcpu, set_reg_val(id, *val));
  631. break;
  632. #endif /* CONFIG_KVM_XICS */
  633. case KVM_REG_PPC_FSCR:
  634. vcpu->arch.fscr = set_reg_val(id, *val);
  635. break;
  636. case KVM_REG_PPC_TAR:
  637. vcpu->arch.tar = set_reg_val(id, *val);
  638. break;
  639. case KVM_REG_PPC_EBBHR:
  640. vcpu->arch.ebbhr = set_reg_val(id, *val);
  641. break;
  642. case KVM_REG_PPC_EBBRR:
  643. vcpu->arch.ebbrr = set_reg_val(id, *val);
  644. break;
  645. case KVM_REG_PPC_BESCR:
  646. vcpu->arch.bescr = set_reg_val(id, *val);
  647. break;
  648. case KVM_REG_PPC_IC:
  649. vcpu->arch.ic = set_reg_val(id, *val);
  650. break;
  651. default:
  652. r = -EINVAL;
  653. break;
  654. }
  655. }
  656. return r;
  657. }
  658. void kvmppc_core_vcpu_load(struct kvm_vcpu *vcpu, int cpu)
  659. {
  660. vcpu->kvm->arch.kvm_ops->vcpu_load(vcpu, cpu);
  661. }
  662. void kvmppc_core_vcpu_put(struct kvm_vcpu *vcpu)
  663. {
  664. vcpu->kvm->arch.kvm_ops->vcpu_put(vcpu);
  665. }
  666. void kvmppc_set_msr(struct kvm_vcpu *vcpu, u64 msr)
  667. {
  668. vcpu->kvm->arch.kvm_ops->set_msr(vcpu, msr);
  669. }
  670. EXPORT_SYMBOL_GPL(kvmppc_set_msr);
  671. int kvmppc_vcpu_run(struct kvm_run *kvm_run, struct kvm_vcpu *vcpu)
  672. {
  673. return vcpu->kvm->arch.kvm_ops->vcpu_run(kvm_run, vcpu);
  674. }
  675. int kvm_arch_vcpu_ioctl_translate(struct kvm_vcpu *vcpu,
  676. struct kvm_translation *tr)
  677. {
  678. return 0;
  679. }
  680. int kvm_arch_vcpu_ioctl_set_guest_debug(struct kvm_vcpu *vcpu,
  681. struct kvm_guest_debug *dbg)
  682. {
  683. vcpu_load(vcpu);
  684. vcpu->guest_debug = dbg->control;
  685. vcpu_put(vcpu);
  686. return 0;
  687. }
  688. void kvmppc_decrementer_func(struct kvm_vcpu *vcpu)
  689. {
  690. kvmppc_core_queue_dec(vcpu);
  691. kvm_vcpu_kick(vcpu);
  692. }
  693. struct kvm_vcpu *kvmppc_core_vcpu_create(struct kvm *kvm, unsigned int id)
  694. {
  695. return kvm->arch.kvm_ops->vcpu_create(kvm, id);
  696. }
  697. void kvmppc_core_vcpu_free(struct kvm_vcpu *vcpu)
  698. {
  699. vcpu->kvm->arch.kvm_ops->vcpu_free(vcpu);
  700. }
  701. int kvmppc_core_check_requests(struct kvm_vcpu *vcpu)
  702. {
  703. return vcpu->kvm->arch.kvm_ops->check_requests(vcpu);
  704. }
  705. int kvm_vm_ioctl_get_dirty_log(struct kvm *kvm, struct kvm_dirty_log *log)
  706. {
  707. return kvm->arch.kvm_ops->get_dirty_log(kvm, log);
  708. }
  709. void kvmppc_core_free_memslot(struct kvm *kvm, struct kvm_memory_slot *free,
  710. struct kvm_memory_slot *dont)
  711. {
  712. kvm->arch.kvm_ops->free_memslot(free, dont);
  713. }
  714. int kvmppc_core_create_memslot(struct kvm *kvm, struct kvm_memory_slot *slot,
  715. unsigned long npages)
  716. {
  717. return kvm->arch.kvm_ops->create_memslot(slot, npages);
  718. }
  719. void kvmppc_core_flush_memslot(struct kvm *kvm, struct kvm_memory_slot *memslot)
  720. {
  721. kvm->arch.kvm_ops->flush_memslot(kvm, memslot);
  722. }
  723. int kvmppc_core_prepare_memory_region(struct kvm *kvm,
  724. struct kvm_memory_slot *memslot,
  725. const struct kvm_userspace_memory_region *mem)
  726. {
  727. return kvm->arch.kvm_ops->prepare_memory_region(kvm, memslot, mem);
  728. }
  729. void kvmppc_core_commit_memory_region(struct kvm *kvm,
  730. const struct kvm_userspace_memory_region *mem,
  731. const struct kvm_memory_slot *old,
  732. const struct kvm_memory_slot *new)
  733. {
  734. kvm->arch.kvm_ops->commit_memory_region(kvm, mem, old, new);
  735. }
  736. int kvm_unmap_hva_range(struct kvm *kvm, unsigned long start, unsigned long end)
  737. {
  738. return kvm->arch.kvm_ops->unmap_hva_range(kvm, start, end);
  739. }
  740. int kvm_age_hva(struct kvm *kvm, unsigned long start, unsigned long end)
  741. {
  742. return kvm->arch.kvm_ops->age_hva(kvm, start, end);
  743. }
  744. int kvm_test_age_hva(struct kvm *kvm, unsigned long hva)
  745. {
  746. return kvm->arch.kvm_ops->test_age_hva(kvm, hva);
  747. }
  748. void kvm_set_spte_hva(struct kvm *kvm, unsigned long hva, pte_t pte)
  749. {
  750. kvm->arch.kvm_ops->set_spte_hva(kvm, hva, pte);
  751. }
  752. void kvmppc_mmu_destroy(struct kvm_vcpu *vcpu)
  753. {
  754. vcpu->kvm->arch.kvm_ops->mmu_destroy(vcpu);
  755. }
  756. int kvmppc_core_init_vm(struct kvm *kvm)
  757. {
  758. #ifdef CONFIG_PPC64
  759. INIT_LIST_HEAD_RCU(&kvm->arch.spapr_tce_tables);
  760. INIT_LIST_HEAD(&kvm->arch.rtas_tokens);
  761. #endif
  762. return kvm->arch.kvm_ops->init_vm(kvm);
  763. }
  764. void kvmppc_core_destroy_vm(struct kvm *kvm)
  765. {
  766. kvm->arch.kvm_ops->destroy_vm(kvm);
  767. #ifdef CONFIG_PPC64
  768. kvmppc_rtas_tokens_free(kvm);
  769. WARN_ON(!list_empty(&kvm->arch.spapr_tce_tables));
  770. #endif
  771. }
  772. int kvmppc_h_logical_ci_load(struct kvm_vcpu *vcpu)
  773. {
  774. unsigned long size = kvmppc_get_gpr(vcpu, 4);
  775. unsigned long addr = kvmppc_get_gpr(vcpu, 5);
  776. u64 buf;
  777. int srcu_idx;
  778. int ret;
  779. if (!is_power_of_2(size) || (size > sizeof(buf)))
  780. return H_TOO_HARD;
  781. srcu_idx = srcu_read_lock(&vcpu->kvm->srcu);
  782. ret = kvm_io_bus_read(vcpu, KVM_MMIO_BUS, addr, size, &buf);
  783. srcu_read_unlock(&vcpu->kvm->srcu, srcu_idx);
  784. if (ret != 0)
  785. return H_TOO_HARD;
  786. switch (size) {
  787. case 1:
  788. kvmppc_set_gpr(vcpu, 4, *(u8 *)&buf);
  789. break;
  790. case 2:
  791. kvmppc_set_gpr(vcpu, 4, be16_to_cpu(*(__be16 *)&buf));
  792. break;
  793. case 4:
  794. kvmppc_set_gpr(vcpu, 4, be32_to_cpu(*(__be32 *)&buf));
  795. break;
  796. case 8:
  797. kvmppc_set_gpr(vcpu, 4, be64_to_cpu(*(__be64 *)&buf));
  798. break;
  799. default:
  800. BUG();
  801. }
  802. return H_SUCCESS;
  803. }
  804. EXPORT_SYMBOL_GPL(kvmppc_h_logical_ci_load);
  805. int kvmppc_h_logical_ci_store(struct kvm_vcpu *vcpu)
  806. {
  807. unsigned long size = kvmppc_get_gpr(vcpu, 4);
  808. unsigned long addr = kvmppc_get_gpr(vcpu, 5);
  809. unsigned long val = kvmppc_get_gpr(vcpu, 6);
  810. u64 buf;
  811. int srcu_idx;
  812. int ret;
  813. switch (size) {
  814. case 1:
  815. *(u8 *)&buf = val;
  816. break;
  817. case 2:
  818. *(__be16 *)&buf = cpu_to_be16(val);
  819. break;
  820. case 4:
  821. *(__be32 *)&buf = cpu_to_be32(val);
  822. break;
  823. case 8:
  824. *(__be64 *)&buf = cpu_to_be64(val);
  825. break;
  826. default:
  827. return H_TOO_HARD;
  828. }
  829. srcu_idx = srcu_read_lock(&vcpu->kvm->srcu);
  830. ret = kvm_io_bus_write(vcpu, KVM_MMIO_BUS, addr, size, &buf);
  831. srcu_read_unlock(&vcpu->kvm->srcu, srcu_idx);
  832. if (ret != 0)
  833. return H_TOO_HARD;
  834. return H_SUCCESS;
  835. }
  836. EXPORT_SYMBOL_GPL(kvmppc_h_logical_ci_store);
  837. int kvmppc_core_check_processor_compat(void)
  838. {
  839. /*
  840. * We always return 0 for book3s. We check
  841. * for compatibility while loading the HV
  842. * or PR module
  843. */
  844. return 0;
  845. }
  846. int kvmppc_book3s_hcall_implemented(struct kvm *kvm, unsigned long hcall)
  847. {
  848. return kvm->arch.kvm_ops->hcall_implemented(hcall);
  849. }
  850. #ifdef CONFIG_KVM_XICS
  851. int kvm_set_irq(struct kvm *kvm, int irq_source_id, u32 irq, int level,
  852. bool line_status)
  853. {
  854. if (xive_enabled())
  855. return kvmppc_xive_set_irq(kvm, irq_source_id, irq, level,
  856. line_status);
  857. else
  858. return kvmppc_xics_set_irq(kvm, irq_source_id, irq, level,
  859. line_status);
  860. }
  861. int kvm_arch_set_irq_inatomic(struct kvm_kernel_irq_routing_entry *irq_entry,
  862. struct kvm *kvm, int irq_source_id,
  863. int level, bool line_status)
  864. {
  865. return kvm_set_irq(kvm, irq_source_id, irq_entry->gsi,
  866. level, line_status);
  867. }
  868. static int kvmppc_book3s_set_irq(struct kvm_kernel_irq_routing_entry *e,
  869. struct kvm *kvm, int irq_source_id, int level,
  870. bool line_status)
  871. {
  872. return kvm_set_irq(kvm, irq_source_id, e->gsi, level, line_status);
  873. }
  874. int kvm_irq_map_gsi(struct kvm *kvm,
  875. struct kvm_kernel_irq_routing_entry *entries, int gsi)
  876. {
  877. entries->gsi = gsi;
  878. entries->type = KVM_IRQ_ROUTING_IRQCHIP;
  879. entries->set = kvmppc_book3s_set_irq;
  880. entries->irqchip.irqchip = 0;
  881. entries->irqchip.pin = gsi;
  882. return 1;
  883. }
  884. int kvm_irq_map_chip_pin(struct kvm *kvm, unsigned irqchip, unsigned pin)
  885. {
  886. return pin;
  887. }
  888. #endif /* CONFIG_KVM_XICS */
  889. static int kvmppc_book3s_init(void)
  890. {
  891. int r;
  892. r = kvm_init(NULL, sizeof(struct kvm_vcpu), 0, THIS_MODULE);
  893. if (r)
  894. return r;
  895. #ifdef CONFIG_KVM_BOOK3S_32_HANDLER
  896. r = kvmppc_book3s_init_pr();
  897. #endif
  898. #ifdef CONFIG_KVM_XICS
  899. #ifdef CONFIG_KVM_XIVE
  900. if (xive_enabled()) {
  901. kvmppc_xive_init_module();
  902. kvm_register_device_ops(&kvm_xive_ops, KVM_DEV_TYPE_XICS);
  903. } else
  904. #endif
  905. kvm_register_device_ops(&kvm_xics_ops, KVM_DEV_TYPE_XICS);
  906. #endif
  907. return r;
  908. }
  909. static void kvmppc_book3s_exit(void)
  910. {
  911. #ifdef CONFIG_KVM_XICS
  912. if (xive_enabled())
  913. kvmppc_xive_exit_module();
  914. #endif
  915. #ifdef CONFIG_KVM_BOOK3S_32_HANDLER
  916. kvmppc_book3s_exit_pr();
  917. #endif
  918. kvm_exit();
  919. }
  920. module_init(kvmppc_book3s_init);
  921. module_exit(kvmppc_book3s_exit);
  922. /* On 32bit this is our one and only kernel module */
  923. #ifdef CONFIG_KVM_BOOK3S_32_HANDLER
  924. MODULE_ALIAS_MISCDEV(KVM_MINOR);
  925. MODULE_ALIAS("devname:kvm");
  926. #endif