book3s.c 23 KB

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