book3s.c 22 KB

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