1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include <linux/kvm_host.h>
23#include <linux/export.h>
24#include <linux/err.h>
25#include <linux/slab.h>
26
27#include <asm/reg.h>
28#include <asm/cputable.h>
29#include <asm/cacheflush.h>
30#include <asm/tlbflush.h>
31#include <linux/uaccess.h>
32#include <asm/io.h>
33#include <asm/kvm_ppc.h>
34#include <asm/kvm_book3s.h>
35#include <asm/mmu_context.h>
36#include <asm/switch_to.h>
37#include <asm/firmware.h>
38#include <asm/setup.h>
39#include <linux/gfp.h>
40#include <linux/sched.h>
41#include <linux/vmalloc.h>
42#include <linux/highmem.h>
43#include <linux/module.h>
44#include <linux/miscdevice.h>
45
46#include "book3s.h"
47
48#define CREATE_TRACE_POINTS
49#include "trace_pr.h"
50
51
52
53
54static int kvmppc_handle_ext(struct kvm_vcpu *vcpu, unsigned int exit_nr,
55 ulong msr);
56static void kvmppc_giveup_fac(struct kvm_vcpu *vcpu, ulong fac);
57
58
59#ifdef CONFIG_PPC_BOOK3S_32
60#define MSR_USER32 MSR_USER
61#define MSR_USER64 MSR_USER
62#define HW_PAGE_SIZE PAGE_SIZE
63#define HPTE_R_M _PAGE_COHERENT
64#endif
65
66static bool kvmppc_is_split_real(struct kvm_vcpu *vcpu)
67{
68 ulong msr = kvmppc_get_msr(vcpu);
69 return (msr & (MSR_IR|MSR_DR)) == MSR_DR;
70}
71
72static void kvmppc_fixup_split_real(struct kvm_vcpu *vcpu)
73{
74 ulong msr = kvmppc_get_msr(vcpu);
75 ulong pc = kvmppc_get_pc(vcpu);
76
77
78 if ((msr & (MSR_IR|MSR_DR)) != MSR_DR)
79 return;
80
81
82 if (vcpu->arch.hflags & BOOK3S_HFLAG_SPLIT_HACK)
83 return;
84
85
86 if (pc & SPLIT_HACK_MASK)
87 return;
88
89 vcpu->arch.hflags |= BOOK3S_HFLAG_SPLIT_HACK;
90 kvmppc_set_pc(vcpu, pc | SPLIT_HACK_OFFS);
91}
92
93void kvmppc_unfixup_split_real(struct kvm_vcpu *vcpu);
94
95static void kvmppc_core_vcpu_load_pr(struct kvm_vcpu *vcpu, int cpu)
96{
97#ifdef CONFIG_PPC_BOOK3S_64
98 struct kvmppc_book3s_shadow_vcpu *svcpu = svcpu_get(vcpu);
99 memcpy(svcpu->slb, to_book3s(vcpu)->slb_shadow, sizeof(svcpu->slb));
100 svcpu->slb_max = to_book3s(vcpu)->slb_shadow_max;
101 svcpu->in_use = 0;
102 svcpu_put(svcpu);
103#endif
104
105
106 if (cpu_has_feature(CPU_FTR_HVMODE) &&
107 cpu_has_feature(CPU_FTR_ARCH_207S))
108 mtspr(SPRN_LPCR, mfspr(SPRN_LPCR) & ~LPCR_AIL);
109
110 vcpu->cpu = smp_processor_id();
111#ifdef CONFIG_PPC_BOOK3S_32
112 current->thread.kvm_shadow_vcpu = vcpu->arch.shadow_vcpu;
113#endif
114
115 if (kvmppc_is_split_real(vcpu))
116 kvmppc_fixup_split_real(vcpu);
117}
118
119static void kvmppc_core_vcpu_put_pr(struct kvm_vcpu *vcpu)
120{
121#ifdef CONFIG_PPC_BOOK3S_64
122 struct kvmppc_book3s_shadow_vcpu *svcpu = svcpu_get(vcpu);
123 if (svcpu->in_use) {
124 kvmppc_copy_from_svcpu(vcpu, svcpu);
125 }
126 memcpy(to_book3s(vcpu)->slb_shadow, svcpu->slb, sizeof(svcpu->slb));
127 to_book3s(vcpu)->slb_shadow_max = svcpu->slb_max;
128 svcpu_put(svcpu);
129#endif
130
131 if (kvmppc_is_split_real(vcpu))
132 kvmppc_unfixup_split_real(vcpu);
133
134 kvmppc_giveup_ext(vcpu, MSR_FP | MSR_VEC | MSR_VSX);
135 kvmppc_giveup_fac(vcpu, FSCR_TAR_LG);
136
137
138 if (cpu_has_feature(CPU_FTR_HVMODE) &&
139 cpu_has_feature(CPU_FTR_ARCH_207S))
140 mtspr(SPRN_LPCR, mfspr(SPRN_LPCR) | LPCR_AIL_3);
141
142 vcpu->cpu = -1;
143}
144
145
146void kvmppc_copy_to_svcpu(struct kvmppc_book3s_shadow_vcpu *svcpu,
147 struct kvm_vcpu *vcpu)
148{
149 svcpu->gpr[0] = vcpu->arch.gpr[0];
150 svcpu->gpr[1] = vcpu->arch.gpr[1];
151 svcpu->gpr[2] = vcpu->arch.gpr[2];
152 svcpu->gpr[3] = vcpu->arch.gpr[3];
153 svcpu->gpr[4] = vcpu->arch.gpr[4];
154 svcpu->gpr[5] = vcpu->arch.gpr[5];
155 svcpu->gpr[6] = vcpu->arch.gpr[6];
156 svcpu->gpr[7] = vcpu->arch.gpr[7];
157 svcpu->gpr[8] = vcpu->arch.gpr[8];
158 svcpu->gpr[9] = vcpu->arch.gpr[9];
159 svcpu->gpr[10] = vcpu->arch.gpr[10];
160 svcpu->gpr[11] = vcpu->arch.gpr[11];
161 svcpu->gpr[12] = vcpu->arch.gpr[12];
162 svcpu->gpr[13] = vcpu->arch.gpr[13];
163 svcpu->cr = vcpu->arch.cr;
164 svcpu->xer = vcpu->arch.xer;
165 svcpu->ctr = vcpu->arch.ctr;
166 svcpu->lr = vcpu->arch.lr;
167 svcpu->pc = vcpu->arch.pc;
168#ifdef CONFIG_PPC_BOOK3S_64
169 svcpu->shadow_fscr = vcpu->arch.shadow_fscr;
170#endif
171
172
173
174
175 vcpu->arch.entry_tb = get_tb();
176 vcpu->arch.entry_vtb = get_vtb();
177 if (cpu_has_feature(CPU_FTR_ARCH_207S))
178 vcpu->arch.entry_ic = mfspr(SPRN_IC);
179 svcpu->in_use = true;
180}
181
182
183void kvmppc_copy_from_svcpu(struct kvm_vcpu *vcpu,
184 struct kvmppc_book3s_shadow_vcpu *svcpu)
185{
186
187
188
189
190 preempt_disable();
191
192
193
194
195
196 if (!svcpu->in_use)
197 goto out;
198
199 vcpu->arch.gpr[0] = svcpu->gpr[0];
200 vcpu->arch.gpr[1] = svcpu->gpr[1];
201 vcpu->arch.gpr[2] = svcpu->gpr[2];
202 vcpu->arch.gpr[3] = svcpu->gpr[3];
203 vcpu->arch.gpr[4] = svcpu->gpr[4];
204 vcpu->arch.gpr[5] = svcpu->gpr[5];
205 vcpu->arch.gpr[6] = svcpu->gpr[6];
206 vcpu->arch.gpr[7] = svcpu->gpr[7];
207 vcpu->arch.gpr[8] = svcpu->gpr[8];
208 vcpu->arch.gpr[9] = svcpu->gpr[9];
209 vcpu->arch.gpr[10] = svcpu->gpr[10];
210 vcpu->arch.gpr[11] = svcpu->gpr[11];
211 vcpu->arch.gpr[12] = svcpu->gpr[12];
212 vcpu->arch.gpr[13] = svcpu->gpr[13];
213 vcpu->arch.cr = svcpu->cr;
214 vcpu->arch.xer = svcpu->xer;
215 vcpu->arch.ctr = svcpu->ctr;
216 vcpu->arch.lr = svcpu->lr;
217 vcpu->arch.pc = svcpu->pc;
218 vcpu->arch.shadow_srr1 = svcpu->shadow_srr1;
219 vcpu->arch.fault_dar = svcpu->fault_dar;
220 vcpu->arch.fault_dsisr = svcpu->fault_dsisr;
221 vcpu->arch.last_inst = svcpu->last_inst;
222#ifdef CONFIG_PPC_BOOK3S_64
223 vcpu->arch.shadow_fscr = svcpu->shadow_fscr;
224#endif
225
226
227
228 vcpu->arch.purr += get_tb() - vcpu->arch.entry_tb;
229 vcpu->arch.spurr += get_tb() - vcpu->arch.entry_tb;
230 to_book3s(vcpu)->vtb += get_vtb() - vcpu->arch.entry_vtb;
231 if (cpu_has_feature(CPU_FTR_ARCH_207S))
232 vcpu->arch.ic += mfspr(SPRN_IC) - vcpu->arch.entry_ic;
233 svcpu->in_use = false;
234
235out:
236 preempt_enable();
237}
238
239static int kvmppc_core_check_requests_pr(struct kvm_vcpu *vcpu)
240{
241 int r = 1;
242
243
244
245 if (kvm_check_request(KVM_REQ_TLB_FLUSH, vcpu))
246 kvmppc_mmu_pte_flush(vcpu, 0, 0);
247
248 return r;
249}
250
251
252static void do_kvm_unmap_hva(struct kvm *kvm, unsigned long start,
253 unsigned long end)
254{
255 long i;
256 struct kvm_vcpu *vcpu;
257 struct kvm_memslots *slots;
258 struct kvm_memory_slot *memslot;
259
260 slots = kvm_memslots(kvm);
261 kvm_for_each_memslot(memslot, slots) {
262 unsigned long hva_start, hva_end;
263 gfn_t gfn, gfn_end;
264
265 hva_start = max(start, memslot->userspace_addr);
266 hva_end = min(end, memslot->userspace_addr +
267 (memslot->npages << PAGE_SHIFT));
268 if (hva_start >= hva_end)
269 continue;
270
271
272
273
274 gfn = hva_to_gfn_memslot(hva_start, memslot);
275 gfn_end = hva_to_gfn_memslot(hva_end + PAGE_SIZE - 1, memslot);
276 kvm_for_each_vcpu(i, vcpu, kvm)
277 kvmppc_mmu_pte_pflush(vcpu, gfn << PAGE_SHIFT,
278 gfn_end << PAGE_SHIFT);
279 }
280}
281
282static int kvm_unmap_hva_pr(struct kvm *kvm, unsigned long hva)
283{
284 trace_kvm_unmap_hva(hva);
285
286 do_kvm_unmap_hva(kvm, hva, hva + PAGE_SIZE);
287
288 return 0;
289}
290
291static int kvm_unmap_hva_range_pr(struct kvm *kvm, unsigned long start,
292 unsigned long end)
293{
294 do_kvm_unmap_hva(kvm, start, end);
295
296 return 0;
297}
298
299static int kvm_age_hva_pr(struct kvm *kvm, unsigned long start,
300 unsigned long end)
301{
302
303 return 0;
304}
305
306static int kvm_test_age_hva_pr(struct kvm *kvm, unsigned long hva)
307{
308
309 return 0;
310}
311
312static void kvm_set_spte_hva_pr(struct kvm *kvm, unsigned long hva, pte_t pte)
313{
314
315 do_kvm_unmap_hva(kvm, hva, hva + PAGE_SIZE);
316}
317
318
319
320static void kvmppc_recalc_shadow_msr(struct kvm_vcpu *vcpu)
321{
322 ulong guest_msr = kvmppc_get_msr(vcpu);
323 ulong smsr = guest_msr;
324
325
326 smsr &= MSR_FE0 | MSR_FE1 | MSR_SF | MSR_SE | MSR_BE | MSR_LE;
327
328 smsr |= MSR_ME | MSR_RI | MSR_IR | MSR_DR | MSR_PR | MSR_EE;
329
330 smsr |= (guest_msr & vcpu->arch.guest_owned_ext);
331
332#ifdef CONFIG_PPC_BOOK3S_64
333 smsr |= MSR_ISF | MSR_HV;
334#endif
335 vcpu->arch.shadow_msr = smsr;
336}
337
338static void kvmppc_set_msr_pr(struct kvm_vcpu *vcpu, u64 msr)
339{
340 ulong old_msr = kvmppc_get_msr(vcpu);
341
342#ifdef EXIT_DEBUG
343 printk(KERN_INFO "KVM: Set MSR to 0x%llx\n", msr);
344#endif
345
346 msr &= to_book3s(vcpu)->msr_mask;
347 kvmppc_set_msr_fast(vcpu, msr);
348 kvmppc_recalc_shadow_msr(vcpu);
349
350 if (msr & MSR_POW) {
351 if (!vcpu->arch.pending_exceptions) {
352 kvm_vcpu_block(vcpu);
353 kvm_clear_request(KVM_REQ_UNHALT, vcpu);
354 vcpu->stat.halt_wakeup++;
355
356
357 msr &= ~MSR_POW;
358 kvmppc_set_msr_fast(vcpu, msr);
359 }
360 }
361
362 if (kvmppc_is_split_real(vcpu))
363 kvmppc_fixup_split_real(vcpu);
364 else
365 kvmppc_unfixup_split_real(vcpu);
366
367 if ((kvmppc_get_msr(vcpu) & (MSR_PR|MSR_IR|MSR_DR)) !=
368 (old_msr & (MSR_PR|MSR_IR|MSR_DR))) {
369 kvmppc_mmu_flush_segments(vcpu);
370 kvmppc_mmu_map_segment(vcpu, kvmppc_get_pc(vcpu));
371
372
373 if (!(msr & MSR_PR) && vcpu->arch.magic_page_pa) {
374 struct kvm_vcpu_arch *a = &vcpu->arch;
375
376 if (msr & MSR_DR)
377 kvmppc_mmu_map_segment(vcpu, a->magic_page_ea);
378 else
379 kvmppc_mmu_map_segment(vcpu, a->magic_page_pa);
380 }
381 }
382
383
384
385
386
387
388
389
390
391 if (vcpu->arch.magic_page_pa &&
392 !(old_msr & MSR_PR) && !(old_msr & MSR_SF) && (msr & MSR_SF)) {
393
394 kvmppc_mmu_pte_flush(vcpu, (uint32_t)vcpu->arch.magic_page_pa,
395 ~0xFFFUL);
396 }
397
398
399 if (kvmppc_get_msr(vcpu) & MSR_FP)
400 kvmppc_handle_ext(vcpu, BOOK3S_INTERRUPT_FP_UNAVAIL, MSR_FP);
401}
402
403void kvmppc_set_pvr_pr(struct kvm_vcpu *vcpu, u32 pvr)
404{
405 u32 host_pvr;
406
407 vcpu->arch.hflags &= ~BOOK3S_HFLAG_SLB;
408 vcpu->arch.pvr = pvr;
409#ifdef CONFIG_PPC_BOOK3S_64
410 if ((pvr >= 0x330000) && (pvr < 0x70330000)) {
411 kvmppc_mmu_book3s_64_init(vcpu);
412 if (!to_book3s(vcpu)->hior_explicit)
413 to_book3s(vcpu)->hior = 0xfff00000;
414 to_book3s(vcpu)->msr_mask = 0xffffffffffffffffULL;
415 vcpu->arch.cpu_type = KVM_CPU_3S_64;
416 } else
417#endif
418 {
419 kvmppc_mmu_book3s_32_init(vcpu);
420 if (!to_book3s(vcpu)->hior_explicit)
421 to_book3s(vcpu)->hior = 0;
422 to_book3s(vcpu)->msr_mask = 0xffffffffULL;
423 vcpu->arch.cpu_type = KVM_CPU_3S_32;
424 }
425
426 kvmppc_sanity_check(vcpu);
427
428
429
430 vcpu->arch.hflags &= ~BOOK3S_HFLAG_DCBZ32;
431 if (vcpu->arch.mmu.is_dcbz32(vcpu) && (mfmsr() & MSR_HV) &&
432 !strcmp(cur_cpu_spec->platform, "ppc970"))
433 vcpu->arch.hflags |= BOOK3S_HFLAG_DCBZ32;
434
435
436
437 if (!strcmp(cur_cpu_spec->platform, "ppc-cell-be"))
438 to_book3s(vcpu)->msr_mask &= ~(MSR_FE0 | MSR_FE1);
439
440
441
442
443
444
445
446
447 switch (PVR_VER(pvr)) {
448 case PVR_POWER6:
449 case PVR_POWER7:
450 case PVR_POWER7p:
451 case PVR_POWER8:
452 case PVR_POWER8E:
453 case PVR_POWER8NVL:
454 vcpu->arch.hflags |= BOOK3S_HFLAG_MULTI_PGSIZE |
455 BOOK3S_HFLAG_NEW_TLBIE;
456 break;
457 }
458
459#ifdef CONFIG_PPC_BOOK3S_32
460
461 vcpu->arch.hflags |= BOOK3S_HFLAG_DCBZ32;
462#endif
463
464
465 asm ( "mfpvr %0" : "=r"(host_pvr));
466 switch (host_pvr) {
467 case 0x00080200:
468 case 0x00088202:
469 case 0x70000100:
470 case 0x00080100:
471 case 0x00083203:
472 case 0x00083213:
473 case 0x00083204:
474 case 0x00083214:
475 case 0x00087200:
476 vcpu->arch.hflags |= BOOK3S_HFLAG_NATIVE_PS;
477
478 mtspr(SPRN_HID2_GEKKO, mfspr(SPRN_HID2_GEKKO) | (1 << 29));
479 }
480}
481
482
483
484
485
486
487
488
489
490
491static void kvmppc_patch_dcbz(struct kvm_vcpu *vcpu, struct kvmppc_pte *pte)
492{
493 struct page *hpage;
494 u64 hpage_offset;
495 u32 *page;
496 int i;
497
498 hpage = gfn_to_page(vcpu->kvm, pte->raddr >> PAGE_SHIFT);
499 if (is_error_page(hpage))
500 return;
501
502 hpage_offset = pte->raddr & ~PAGE_MASK;
503 hpage_offset &= ~0xFFFULL;
504 hpage_offset /= 4;
505
506 get_page(hpage);
507 page = kmap_atomic(hpage);
508
509
510 for (i=hpage_offset; i < hpage_offset + (HW_PAGE_SIZE / 4); i++)
511 if ((be32_to_cpu(page[i]) & 0xff0007ff) == INS_DCBZ)
512 page[i] &= cpu_to_be32(0xfffffff7);
513
514 kunmap_atomic(page);
515 put_page(hpage);
516}
517
518static bool kvmppc_visible_gpa(struct kvm_vcpu *vcpu, gpa_t gpa)
519{
520 ulong mp_pa = vcpu->arch.magic_page_pa;
521
522 if (!(kvmppc_get_msr(vcpu) & MSR_SF))
523 mp_pa = (uint32_t)mp_pa;
524
525 gpa &= ~0xFFFULL;
526 if (unlikely(mp_pa) && unlikely((mp_pa & KVM_PAM) == (gpa & KVM_PAM))) {
527 return true;
528 }
529
530 return kvm_is_visible_gfn(vcpu->kvm, gpa >> PAGE_SHIFT);
531}
532
533int kvmppc_handle_pagefault(struct kvm_run *run, struct kvm_vcpu *vcpu,
534 ulong eaddr, int vec)
535{
536 bool data = (vec == BOOK3S_INTERRUPT_DATA_STORAGE);
537 bool iswrite = false;
538 int r = RESUME_GUEST;
539 int relocated;
540 int page_found = 0;
541 struct kvmppc_pte pte = { 0 };
542 bool dr = (kvmppc_get_msr(vcpu) & MSR_DR) ? true : false;
543 bool ir = (kvmppc_get_msr(vcpu) & MSR_IR) ? true : false;
544 u64 vsid;
545
546 relocated = data ? dr : ir;
547 if (data && (vcpu->arch.fault_dsisr & DSISR_ISSTORE))
548 iswrite = true;
549
550
551 if (relocated) {
552 page_found = vcpu->arch.mmu.xlate(vcpu, eaddr, &pte, data, iswrite);
553 } else {
554 pte.may_execute = true;
555 pte.may_read = true;
556 pte.may_write = true;
557 pte.raddr = eaddr & KVM_PAM;
558 pte.eaddr = eaddr;
559 pte.vpage = eaddr >> 12;
560 pte.page_size = MMU_PAGE_64K;
561 pte.wimg = HPTE_R_M;
562 }
563
564 switch (kvmppc_get_msr(vcpu) & (MSR_DR|MSR_IR)) {
565 case 0:
566 pte.vpage |= ((u64)VSID_REAL << (SID_SHIFT - 12));
567 break;
568 case MSR_DR:
569 if (!data &&
570 (vcpu->arch.hflags & BOOK3S_HFLAG_SPLIT_HACK) &&
571 ((pte.raddr & SPLIT_HACK_MASK) == SPLIT_HACK_OFFS))
572 pte.raddr &= ~SPLIT_HACK_MASK;
573
574 case MSR_IR:
575 vcpu->arch.mmu.esid_to_vsid(vcpu, eaddr >> SID_SHIFT, &vsid);
576
577 if ((kvmppc_get_msr(vcpu) & (MSR_DR|MSR_IR)) == MSR_DR)
578 pte.vpage |= ((u64)VSID_REAL_DR << (SID_SHIFT - 12));
579 else
580 pte.vpage |= ((u64)VSID_REAL_IR << (SID_SHIFT - 12));
581 pte.vpage |= vsid;
582
583 if (vsid == -1)
584 page_found = -EINVAL;
585 break;
586 }
587
588 if (vcpu->arch.mmu.is_dcbz32(vcpu) &&
589 (!(vcpu->arch.hflags & BOOK3S_HFLAG_DCBZ32))) {
590
591
592
593
594
595 pte.may_execute = !data;
596 }
597
598 if (page_found == -ENOENT) {
599
600 u64 ssrr1 = vcpu->arch.shadow_srr1;
601 u64 msr = kvmppc_get_msr(vcpu);
602 kvmppc_set_dar(vcpu, kvmppc_get_fault_dar(vcpu));
603 kvmppc_set_dsisr(vcpu, vcpu->arch.fault_dsisr);
604 kvmppc_set_msr_fast(vcpu, msr | (ssrr1 & 0xf8000000ULL));
605 kvmppc_book3s_queue_irqprio(vcpu, vec);
606 } else if (page_found == -EPERM) {
607
608 u32 dsisr = vcpu->arch.fault_dsisr;
609 u64 ssrr1 = vcpu->arch.shadow_srr1;
610 u64 msr = kvmppc_get_msr(vcpu);
611 kvmppc_set_dar(vcpu, kvmppc_get_fault_dar(vcpu));
612 dsisr = (dsisr & ~DSISR_NOHPTE) | DSISR_PROTFAULT;
613 kvmppc_set_dsisr(vcpu, dsisr);
614 kvmppc_set_msr_fast(vcpu, msr | (ssrr1 & 0xf8000000ULL));
615 kvmppc_book3s_queue_irqprio(vcpu, vec);
616 } else if (page_found == -EINVAL) {
617
618 kvmppc_set_dar(vcpu, kvmppc_get_fault_dar(vcpu));
619 kvmppc_book3s_queue_irqprio(vcpu, vec + 0x80);
620 } else if (kvmppc_visible_gpa(vcpu, pte.raddr)) {
621 if (data && !(vcpu->arch.fault_dsisr & DSISR_NOHPTE)) {
622
623
624
625
626
627 kvmppc_mmu_unmap_page(vcpu, &pte);
628 }
629
630 if (kvmppc_mmu_map_page(vcpu, &pte, iswrite) == -EIO) {
631
632 run->exit_reason = KVM_EXIT_INTERNAL_ERROR;
633 return RESUME_HOST;
634 }
635 if (data)
636 vcpu->stat.sp_storage++;
637 else if (vcpu->arch.mmu.is_dcbz32(vcpu) &&
638 (!(vcpu->arch.hflags & BOOK3S_HFLAG_DCBZ32)))
639 kvmppc_patch_dcbz(vcpu, &pte);
640 } else {
641
642 vcpu->stat.mmio_exits++;
643 vcpu->arch.paddr_accessed = pte.raddr;
644 vcpu->arch.vaddr_accessed = pte.eaddr;
645 r = kvmppc_emulate_mmio(run, vcpu);
646 if ( r == RESUME_HOST_NV )
647 r = RESUME_HOST;
648 }
649
650 return r;
651}
652
653
654void kvmppc_giveup_ext(struct kvm_vcpu *vcpu, ulong msr)
655{
656 struct thread_struct *t = ¤t->thread;
657
658
659
660
661
662 if (msr & MSR_VSX)
663 msr |= MSR_FP | MSR_VEC;
664
665 msr &= vcpu->arch.guest_owned_ext;
666 if (!msr)
667 return;
668
669#ifdef DEBUG_EXT
670 printk(KERN_INFO "Giving up ext 0x%lx\n", msr);
671#endif
672
673 if (msr & MSR_FP) {
674
675
676
677
678
679 if (t->regs->msr & MSR_FP)
680 giveup_fpu(current);
681 t->fp_save_area = NULL;
682 }
683
684#ifdef CONFIG_ALTIVEC
685 if (msr & MSR_VEC) {
686 if (current->thread.regs->msr & MSR_VEC)
687 giveup_altivec(current);
688 t->vr_save_area = NULL;
689 }
690#endif
691
692 vcpu->arch.guest_owned_ext &= ~(msr | MSR_VSX);
693 kvmppc_recalc_shadow_msr(vcpu);
694}
695
696
697static void kvmppc_giveup_fac(struct kvm_vcpu *vcpu, ulong fac)
698{
699#ifdef CONFIG_PPC_BOOK3S_64
700 if (!(vcpu->arch.shadow_fscr & (1ULL << fac))) {
701
702 return;
703 }
704
705 switch (fac) {
706 case FSCR_TAR_LG:
707 vcpu->arch.tar = mfspr(SPRN_TAR);
708 mtspr(SPRN_TAR, current->thread.tar);
709 vcpu->arch.shadow_fscr &= ~FSCR_TAR;
710 break;
711 }
712#endif
713}
714
715
716static int kvmppc_handle_ext(struct kvm_vcpu *vcpu, unsigned int exit_nr,
717 ulong msr)
718{
719 struct thread_struct *t = ¤t->thread;
720
721
722 if (vcpu->arch.hflags & BOOK3S_HFLAG_PAIRED_SINGLE)
723 return RESUME_GUEST;
724
725 if (!(kvmppc_get_msr(vcpu) & msr)) {
726 kvmppc_book3s_queue_irqprio(vcpu, exit_nr);
727 return RESUME_GUEST;
728 }
729
730 if (msr == MSR_VSX) {
731
732#ifdef CONFIG_VSX
733 if (!cpu_has_feature(CPU_FTR_VSX))
734#endif
735 {
736 kvmppc_core_queue_program(vcpu, SRR1_PROGILL);
737 return RESUME_GUEST;
738 }
739
740
741
742
743
744 msr = MSR_FP | MSR_VEC | MSR_VSX;
745 }
746
747
748 msr &= ~vcpu->arch.guest_owned_ext;
749 if (!msr)
750 return RESUME_GUEST;
751
752#ifdef DEBUG_EXT
753 printk(KERN_INFO "Loading up ext 0x%lx\n", msr);
754#endif
755
756 if (msr & MSR_FP) {
757 preempt_disable();
758 enable_kernel_fp();
759 load_fp_state(&vcpu->arch.fp);
760 disable_kernel_fp();
761 t->fp_save_area = &vcpu->arch.fp;
762 preempt_enable();
763 }
764
765 if (msr & MSR_VEC) {
766#ifdef CONFIG_ALTIVEC
767 preempt_disable();
768 enable_kernel_altivec();
769 load_vr_state(&vcpu->arch.vr);
770 disable_kernel_altivec();
771 t->vr_save_area = &vcpu->arch.vr;
772 preempt_enable();
773#endif
774 }
775
776 t->regs->msr |= msr;
777 vcpu->arch.guest_owned_ext |= msr;
778 kvmppc_recalc_shadow_msr(vcpu);
779
780 return RESUME_GUEST;
781}
782
783
784
785
786
787static void kvmppc_handle_lost_ext(struct kvm_vcpu *vcpu)
788{
789 unsigned long lost_ext;
790
791 lost_ext = vcpu->arch.guest_owned_ext & ~current->thread.regs->msr;
792 if (!lost_ext)
793 return;
794
795 if (lost_ext & MSR_FP) {
796 preempt_disable();
797 enable_kernel_fp();
798 load_fp_state(&vcpu->arch.fp);
799 disable_kernel_fp();
800 preempt_enable();
801 }
802#ifdef CONFIG_ALTIVEC
803 if (lost_ext & MSR_VEC) {
804 preempt_disable();
805 enable_kernel_altivec();
806 load_vr_state(&vcpu->arch.vr);
807 disable_kernel_altivec();
808 preempt_enable();
809 }
810#endif
811 current->thread.regs->msr |= lost_ext;
812}
813
814#ifdef CONFIG_PPC_BOOK3S_64
815
816static void kvmppc_trigger_fac_interrupt(struct kvm_vcpu *vcpu, ulong fac)
817{
818
819 vcpu->arch.fscr &= ~(0xffULL << 56);
820 vcpu->arch.fscr |= (fac << 56);
821 kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_FAC_UNAVAIL);
822}
823
824static void kvmppc_emulate_fac(struct kvm_vcpu *vcpu, ulong fac)
825{
826 enum emulation_result er = EMULATE_FAIL;
827
828 if (!(kvmppc_get_msr(vcpu) & MSR_PR))
829 er = kvmppc_emulate_instruction(vcpu->run, vcpu);
830
831 if ((er != EMULATE_DONE) && (er != EMULATE_AGAIN)) {
832
833 kvmppc_trigger_fac_interrupt(vcpu, fac);
834 }
835}
836
837
838static int kvmppc_handle_fac(struct kvm_vcpu *vcpu, ulong fac)
839{
840 bool guest_fac_enabled;
841 BUG_ON(!cpu_has_feature(CPU_FTR_ARCH_207S));
842
843
844
845
846
847 switch (fac) {
848 case FSCR_TAR_LG:
849 case FSCR_EBB_LG:
850 guest_fac_enabled = (vcpu->arch.fscr & (1ULL << fac));
851 break;
852 case FSCR_TM_LG:
853 guest_fac_enabled = kvmppc_get_msr(vcpu) & MSR_TM;
854 break;
855 default:
856 guest_fac_enabled = false;
857 break;
858 }
859
860 if (!guest_fac_enabled) {
861
862 kvmppc_trigger_fac_interrupt(vcpu, fac);
863 return RESUME_GUEST;
864 }
865
866 switch (fac) {
867 case FSCR_TAR_LG:
868
869 current->thread.tar = mfspr(SPRN_TAR);
870 mtspr(SPRN_TAR, vcpu->arch.tar);
871 vcpu->arch.shadow_fscr |= FSCR_TAR;
872 break;
873 default:
874 kvmppc_emulate_fac(vcpu, fac);
875 break;
876 }
877
878 return RESUME_GUEST;
879}
880
881void kvmppc_set_fscr(struct kvm_vcpu *vcpu, u64 fscr)
882{
883 if ((vcpu->arch.fscr & FSCR_TAR) && !(fscr & FSCR_TAR)) {
884
885 kvmppc_giveup_fac(vcpu, FSCR_TAR_LG);
886 }
887 vcpu->arch.fscr = fscr;
888}
889#endif
890
891static void kvmppc_setup_debug(struct kvm_vcpu *vcpu)
892{
893 if (vcpu->guest_debug & KVM_GUESTDBG_SINGLESTEP) {
894 u64 msr = kvmppc_get_msr(vcpu);
895
896 kvmppc_set_msr(vcpu, msr | MSR_SE);
897 }
898}
899
900static void kvmppc_clear_debug(struct kvm_vcpu *vcpu)
901{
902 if (vcpu->guest_debug & KVM_GUESTDBG_SINGLESTEP) {
903 u64 msr = kvmppc_get_msr(vcpu);
904
905 kvmppc_set_msr(vcpu, msr & ~MSR_SE);
906 }
907}
908
909static int kvmppc_exit_pr_progint(struct kvm_run *run, struct kvm_vcpu *vcpu,
910 unsigned int exit_nr)
911{
912 enum emulation_result er;
913 ulong flags;
914 u32 last_inst;
915 int emul, r;
916
917
918
919
920
921
922
923 if (exit_nr == BOOK3S_INTERRUPT_PROGRAM)
924 flags = vcpu->arch.shadow_srr1 & 0x1f0000ull;
925 else
926 flags = SRR1_PROGILL;
927
928 emul = kvmppc_get_last_inst(vcpu, INST_GENERIC, &last_inst);
929 if (emul != EMULATE_DONE)
930 return RESUME_GUEST;
931
932 if (kvmppc_get_msr(vcpu) & MSR_PR) {
933#ifdef EXIT_DEBUG
934 pr_info("Userspace triggered 0x700 exception at\n 0x%lx (0x%x)\n",
935 kvmppc_get_pc(vcpu), last_inst);
936#endif
937 if ((last_inst & 0xff0007ff) != (INS_DCBZ & 0xfffffff7)) {
938 kvmppc_core_queue_program(vcpu, flags);
939 return RESUME_GUEST;
940 }
941 }
942
943 vcpu->stat.emulated_inst_exits++;
944 er = kvmppc_emulate_instruction(run, vcpu);
945 switch (er) {
946 case EMULATE_DONE:
947 r = RESUME_GUEST_NV;
948 break;
949 case EMULATE_AGAIN:
950 r = RESUME_GUEST;
951 break;
952 case EMULATE_FAIL:
953 pr_crit("%s: emulation at %lx failed (%08x)\n",
954 __func__, kvmppc_get_pc(vcpu), last_inst);
955 kvmppc_core_queue_program(vcpu, flags);
956 r = RESUME_GUEST;
957 break;
958 case EMULATE_DO_MMIO:
959 run->exit_reason = KVM_EXIT_MMIO;
960 r = RESUME_HOST_NV;
961 break;
962 case EMULATE_EXIT_USER:
963 r = RESUME_HOST_NV;
964 break;
965 default:
966 BUG();
967 }
968
969 return r;
970}
971
972int kvmppc_handle_exit_pr(struct kvm_run *run, struct kvm_vcpu *vcpu,
973 unsigned int exit_nr)
974{
975 int r = RESUME_HOST;
976 int s;
977
978 vcpu->stat.sum_exits++;
979
980 run->exit_reason = KVM_EXIT_UNKNOWN;
981 run->ready_for_interrupt_injection = 1;
982
983
984
985 trace_kvm_exit(exit_nr, vcpu);
986 guest_exit();
987
988 switch (exit_nr) {
989 case BOOK3S_INTERRUPT_INST_STORAGE:
990 {
991 ulong shadow_srr1 = vcpu->arch.shadow_srr1;
992 vcpu->stat.pf_instruc++;
993
994 if (kvmppc_is_split_real(vcpu))
995 kvmppc_fixup_split_real(vcpu);
996
997#ifdef CONFIG_PPC_BOOK3S_32
998
999
1000 {
1001 struct kvmppc_book3s_shadow_vcpu *svcpu;
1002 u32 sr;
1003
1004 svcpu = svcpu_get(vcpu);
1005 sr = svcpu->sr[kvmppc_get_pc(vcpu) >> SID_SHIFT];
1006 svcpu_put(svcpu);
1007 if (sr == SR_INVALID) {
1008 kvmppc_mmu_map_segment(vcpu, kvmppc_get_pc(vcpu));
1009 r = RESUME_GUEST;
1010 break;
1011 }
1012 }
1013#endif
1014
1015
1016 if (shadow_srr1 & 0x40000000) {
1017 int idx = srcu_read_lock(&vcpu->kvm->srcu);
1018 r = kvmppc_handle_pagefault(run, vcpu, kvmppc_get_pc(vcpu), exit_nr);
1019 srcu_read_unlock(&vcpu->kvm->srcu, idx);
1020 vcpu->stat.sp_instruc++;
1021 } else if (vcpu->arch.mmu.is_dcbz32(vcpu) &&
1022 (!(vcpu->arch.hflags & BOOK3S_HFLAG_DCBZ32))) {
1023
1024
1025
1026
1027
1028 kvmppc_mmu_pte_flush(vcpu, kvmppc_get_pc(vcpu), ~0xFFFUL);
1029 r = RESUME_GUEST;
1030 } else {
1031 u64 msr = kvmppc_get_msr(vcpu);
1032 msr |= shadow_srr1 & 0x58000000;
1033 kvmppc_set_msr_fast(vcpu, msr);
1034 kvmppc_book3s_queue_irqprio(vcpu, exit_nr);
1035 r = RESUME_GUEST;
1036 }
1037 break;
1038 }
1039 case BOOK3S_INTERRUPT_DATA_STORAGE:
1040 {
1041 ulong dar = kvmppc_get_fault_dar(vcpu);
1042 u32 fault_dsisr = vcpu->arch.fault_dsisr;
1043 vcpu->stat.pf_storage++;
1044
1045#ifdef CONFIG_PPC_BOOK3S_32
1046
1047
1048 {
1049 struct kvmppc_book3s_shadow_vcpu *svcpu;
1050 u32 sr;
1051
1052 svcpu = svcpu_get(vcpu);
1053 sr = svcpu->sr[dar >> SID_SHIFT];
1054 svcpu_put(svcpu);
1055 if (sr == SR_INVALID) {
1056 kvmppc_mmu_map_segment(vcpu, dar);
1057 r = RESUME_GUEST;
1058 break;
1059 }
1060 }
1061#endif
1062
1063
1064
1065
1066
1067
1068 if (fault_dsisr & (DSISR_NOHPTE | DSISR_PROTFAULT)) {
1069 int idx = srcu_read_lock(&vcpu->kvm->srcu);
1070 r = kvmppc_handle_pagefault(run, vcpu, dar, exit_nr);
1071 srcu_read_unlock(&vcpu->kvm->srcu, idx);
1072 } else {
1073 kvmppc_set_dar(vcpu, dar);
1074 kvmppc_set_dsisr(vcpu, fault_dsisr);
1075 kvmppc_book3s_queue_irqprio(vcpu, exit_nr);
1076 r = RESUME_GUEST;
1077 }
1078 break;
1079 }
1080 case BOOK3S_INTERRUPT_DATA_SEGMENT:
1081 if (kvmppc_mmu_map_segment(vcpu, kvmppc_get_fault_dar(vcpu)) < 0) {
1082 kvmppc_set_dar(vcpu, kvmppc_get_fault_dar(vcpu));
1083 kvmppc_book3s_queue_irqprio(vcpu,
1084 BOOK3S_INTERRUPT_DATA_SEGMENT);
1085 }
1086 r = RESUME_GUEST;
1087 break;
1088 case BOOK3S_INTERRUPT_INST_SEGMENT:
1089 if (kvmppc_mmu_map_segment(vcpu, kvmppc_get_pc(vcpu)) < 0) {
1090 kvmppc_book3s_queue_irqprio(vcpu,
1091 BOOK3S_INTERRUPT_INST_SEGMENT);
1092 }
1093 r = RESUME_GUEST;
1094 break;
1095
1096 case BOOK3S_INTERRUPT_DECREMENTER:
1097 case BOOK3S_INTERRUPT_HV_DECREMENTER:
1098 case BOOK3S_INTERRUPT_DOORBELL:
1099 case BOOK3S_INTERRUPT_H_DOORBELL:
1100 vcpu->stat.dec_exits++;
1101 r = RESUME_GUEST;
1102 break;
1103 case BOOK3S_INTERRUPT_EXTERNAL:
1104 case BOOK3S_INTERRUPT_EXTERNAL_LEVEL:
1105 case BOOK3S_INTERRUPT_EXTERNAL_HV:
1106 vcpu->stat.ext_intr_exits++;
1107 r = RESUME_GUEST;
1108 break;
1109 case BOOK3S_INTERRUPT_PERFMON:
1110 r = RESUME_GUEST;
1111 break;
1112 case BOOK3S_INTERRUPT_PROGRAM:
1113 case BOOK3S_INTERRUPT_H_EMUL_ASSIST:
1114 r = kvmppc_exit_pr_progint(run, vcpu, exit_nr);
1115 break;
1116 case BOOK3S_INTERRUPT_SYSCALL:
1117 {
1118 u32 last_sc;
1119 int emul;
1120
1121
1122 if (vcpu->arch.papr_enabled) {
1123
1124 emul = kvmppc_get_last_inst(vcpu, INST_SC, &last_sc);
1125 if (emul != EMULATE_DONE) {
1126 kvmppc_set_pc(vcpu, kvmppc_get_pc(vcpu) - 4);
1127 r = RESUME_GUEST;
1128 break;
1129 }
1130 }
1131
1132 if (vcpu->arch.papr_enabled &&
1133 (last_sc == 0x44000022) &&
1134 !(kvmppc_get_msr(vcpu) & MSR_PR)) {
1135
1136 ulong cmd = kvmppc_get_gpr(vcpu, 3);
1137 int i;
1138
1139#ifdef CONFIG_PPC_BOOK3S_64
1140 if (kvmppc_h_pr(vcpu, cmd) == EMULATE_DONE) {
1141 r = RESUME_GUEST;
1142 break;
1143 }
1144#endif
1145
1146 run->papr_hcall.nr = cmd;
1147 for (i = 0; i < 9; ++i) {
1148 ulong gpr = kvmppc_get_gpr(vcpu, 4 + i);
1149 run->papr_hcall.args[i] = gpr;
1150 }
1151 run->exit_reason = KVM_EXIT_PAPR_HCALL;
1152 vcpu->arch.hcall_needed = 1;
1153 r = RESUME_HOST;
1154 } else if (vcpu->arch.osi_enabled &&
1155 (((u32)kvmppc_get_gpr(vcpu, 3)) == OSI_SC_MAGIC_R3) &&
1156 (((u32)kvmppc_get_gpr(vcpu, 4)) == OSI_SC_MAGIC_R4)) {
1157
1158 u64 *gprs = run->osi.gprs;
1159 int i;
1160
1161 run->exit_reason = KVM_EXIT_OSI;
1162 for (i = 0; i < 32; i++)
1163 gprs[i] = kvmppc_get_gpr(vcpu, i);
1164 vcpu->arch.osi_needed = 1;
1165 r = RESUME_HOST_NV;
1166 } else if (!(kvmppc_get_msr(vcpu) & MSR_PR) &&
1167 (((u32)kvmppc_get_gpr(vcpu, 0)) == KVM_SC_MAGIC_R0)) {
1168
1169 kvmppc_set_gpr(vcpu, 3, kvmppc_kvm_pv(vcpu));
1170 r = RESUME_GUEST;
1171 } else {
1172
1173 vcpu->stat.syscall_exits++;
1174 kvmppc_book3s_queue_irqprio(vcpu, exit_nr);
1175 r = RESUME_GUEST;
1176 }
1177 break;
1178 }
1179 case BOOK3S_INTERRUPT_FP_UNAVAIL:
1180 case BOOK3S_INTERRUPT_ALTIVEC:
1181 case BOOK3S_INTERRUPT_VSX:
1182 {
1183 int ext_msr = 0;
1184 int emul;
1185 u32 last_inst;
1186
1187 if (vcpu->arch.hflags & BOOK3S_HFLAG_PAIRED_SINGLE) {
1188
1189 emul = kvmppc_get_last_inst(vcpu, INST_GENERIC,
1190 &last_inst);
1191 if (emul == EMULATE_DONE)
1192 r = kvmppc_exit_pr_progint(run, vcpu, exit_nr);
1193 else
1194 r = RESUME_GUEST;
1195
1196 break;
1197 }
1198
1199
1200 switch (exit_nr) {
1201 case BOOK3S_INTERRUPT_FP_UNAVAIL:
1202 ext_msr = MSR_FP;
1203 break;
1204
1205 case BOOK3S_INTERRUPT_ALTIVEC:
1206 ext_msr = MSR_VEC;
1207 break;
1208
1209 case BOOK3S_INTERRUPT_VSX:
1210 ext_msr = MSR_VSX;
1211 break;
1212 }
1213
1214 r = kvmppc_handle_ext(vcpu, exit_nr, ext_msr);
1215 break;
1216 }
1217 case BOOK3S_INTERRUPT_ALIGNMENT:
1218 {
1219 u32 last_inst;
1220 int emul = kvmppc_get_last_inst(vcpu, INST_GENERIC, &last_inst);
1221
1222 if (emul == EMULATE_DONE) {
1223 u32 dsisr;
1224 u64 dar;
1225
1226 dsisr = kvmppc_alignment_dsisr(vcpu, last_inst);
1227 dar = kvmppc_alignment_dar(vcpu, last_inst);
1228
1229 kvmppc_set_dsisr(vcpu, dsisr);
1230 kvmppc_set_dar(vcpu, dar);
1231
1232 kvmppc_book3s_queue_irqprio(vcpu, exit_nr);
1233 }
1234 r = RESUME_GUEST;
1235 break;
1236 }
1237#ifdef CONFIG_PPC_BOOK3S_64
1238 case BOOK3S_INTERRUPT_FAC_UNAVAIL:
1239 kvmppc_handle_fac(vcpu, vcpu->arch.shadow_fscr >> 56);
1240 r = RESUME_GUEST;
1241 break;
1242#endif
1243 case BOOK3S_INTERRUPT_MACHINE_CHECK:
1244 kvmppc_book3s_queue_irqprio(vcpu, exit_nr);
1245 r = RESUME_GUEST;
1246 break;
1247 case BOOK3S_INTERRUPT_TRACE:
1248 if (vcpu->guest_debug & KVM_GUESTDBG_SINGLESTEP) {
1249 run->exit_reason = KVM_EXIT_DEBUG;
1250 r = RESUME_HOST;
1251 } else {
1252 kvmppc_book3s_queue_irqprio(vcpu, exit_nr);
1253 r = RESUME_GUEST;
1254 }
1255 break;
1256 default:
1257 {
1258 ulong shadow_srr1 = vcpu->arch.shadow_srr1;
1259
1260 printk(KERN_EMERG "exit_nr=0x%x | pc=0x%lx | msr=0x%lx\n",
1261 exit_nr, kvmppc_get_pc(vcpu), shadow_srr1);
1262 r = RESUME_HOST;
1263 BUG();
1264 break;
1265 }
1266 }
1267
1268 if (!(r & RESUME_HOST)) {
1269
1270
1271
1272
1273
1274
1275
1276
1277
1278
1279 s = kvmppc_prepare_to_enter(vcpu);
1280 if (s <= 0)
1281 r = s;
1282 else {
1283
1284 kvmppc_fix_ee_before_entry();
1285 }
1286
1287 kvmppc_handle_lost_ext(vcpu);
1288 }
1289
1290 trace_kvm_book3s_reenter(r, vcpu);
1291
1292 return r;
1293}
1294
1295static int kvm_arch_vcpu_ioctl_get_sregs_pr(struct kvm_vcpu *vcpu,
1296 struct kvm_sregs *sregs)
1297{
1298 struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
1299 int i;
1300
1301 sregs->pvr = vcpu->arch.pvr;
1302
1303 sregs->u.s.sdr1 = to_book3s(vcpu)->sdr1;
1304 if (vcpu->arch.hflags & BOOK3S_HFLAG_SLB) {
1305 for (i = 0; i < 64; i++) {
1306 sregs->u.s.ppc64.slb[i].slbe = vcpu->arch.slb[i].orige | i;
1307 sregs->u.s.ppc64.slb[i].slbv = vcpu->arch.slb[i].origv;
1308 }
1309 } else {
1310 for (i = 0; i < 16; i++)
1311 sregs->u.s.ppc32.sr[i] = kvmppc_get_sr(vcpu, i);
1312
1313 for (i = 0; i < 8; i++) {
1314 sregs->u.s.ppc32.ibat[i] = vcpu3s->ibat[i].raw;
1315 sregs->u.s.ppc32.dbat[i] = vcpu3s->dbat[i].raw;
1316 }
1317 }
1318
1319 return 0;
1320}
1321
1322static int kvm_arch_vcpu_ioctl_set_sregs_pr(struct kvm_vcpu *vcpu,
1323 struct kvm_sregs *sregs)
1324{
1325 struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
1326 int i;
1327
1328 kvmppc_set_pvr_pr(vcpu, sregs->pvr);
1329
1330 vcpu3s->sdr1 = sregs->u.s.sdr1;
1331#ifdef CONFIG_PPC_BOOK3S_64
1332 if (vcpu->arch.hflags & BOOK3S_HFLAG_SLB) {
1333
1334 vcpu->arch.mmu.slbmte(vcpu, 0, 0);
1335 vcpu->arch.mmu.slbia(vcpu);
1336
1337 for (i = 0; i < 64; i++) {
1338 u64 rb = sregs->u.s.ppc64.slb[i].slbe;
1339 u64 rs = sregs->u.s.ppc64.slb[i].slbv;
1340
1341 if (rb & SLB_ESID_V)
1342 vcpu->arch.mmu.slbmte(vcpu, rs, rb);
1343 }
1344 } else
1345#endif
1346 {
1347 for (i = 0; i < 16; i++) {
1348 vcpu->arch.mmu.mtsrin(vcpu, i, sregs->u.s.ppc32.sr[i]);
1349 }
1350 for (i = 0; i < 8; i++) {
1351 kvmppc_set_bat(vcpu, &(vcpu3s->ibat[i]), false,
1352 (u32)sregs->u.s.ppc32.ibat[i]);
1353 kvmppc_set_bat(vcpu, &(vcpu3s->ibat[i]), true,
1354 (u32)(sregs->u.s.ppc32.ibat[i] >> 32));
1355 kvmppc_set_bat(vcpu, &(vcpu3s->dbat[i]), false,
1356 (u32)sregs->u.s.ppc32.dbat[i]);
1357 kvmppc_set_bat(vcpu, &(vcpu3s->dbat[i]), true,
1358 (u32)(sregs->u.s.ppc32.dbat[i] >> 32));
1359 }
1360 }
1361
1362
1363 kvmppc_mmu_pte_flush(vcpu, 0, 0);
1364
1365 return 0;
1366}
1367
1368static int kvmppc_get_one_reg_pr(struct kvm_vcpu *vcpu, u64 id,
1369 union kvmppc_one_reg *val)
1370{
1371 int r = 0;
1372
1373 switch (id) {
1374 case KVM_REG_PPC_DEBUG_INST:
1375 *val = get_reg_val(id, KVMPPC_INST_SW_BREAKPOINT);
1376 break;
1377 case KVM_REG_PPC_HIOR:
1378 *val = get_reg_val(id, to_book3s(vcpu)->hior);
1379 break;
1380 case KVM_REG_PPC_VTB:
1381 *val = get_reg_val(id, to_book3s(vcpu)->vtb);
1382 break;
1383 case KVM_REG_PPC_LPCR:
1384 case KVM_REG_PPC_LPCR_64:
1385
1386
1387
1388 if (vcpu->arch.intr_msr & MSR_LE)
1389 *val = get_reg_val(id, LPCR_ILE);
1390 else
1391 *val = get_reg_val(id, 0);
1392 break;
1393 default:
1394 r = -EINVAL;
1395 break;
1396 }
1397
1398 return r;
1399}
1400
1401static void kvmppc_set_lpcr_pr(struct kvm_vcpu *vcpu, u64 new_lpcr)
1402{
1403 if (new_lpcr & LPCR_ILE)
1404 vcpu->arch.intr_msr |= MSR_LE;
1405 else
1406 vcpu->arch.intr_msr &= ~MSR_LE;
1407}
1408
1409static int kvmppc_set_one_reg_pr(struct kvm_vcpu *vcpu, u64 id,
1410 union kvmppc_one_reg *val)
1411{
1412 int r = 0;
1413
1414 switch (id) {
1415 case KVM_REG_PPC_HIOR:
1416 to_book3s(vcpu)->hior = set_reg_val(id, *val);
1417 to_book3s(vcpu)->hior_explicit = true;
1418 break;
1419 case KVM_REG_PPC_VTB:
1420 to_book3s(vcpu)->vtb = set_reg_val(id, *val);
1421 break;
1422 case KVM_REG_PPC_LPCR:
1423 case KVM_REG_PPC_LPCR_64:
1424 kvmppc_set_lpcr_pr(vcpu, set_reg_val(id, *val));
1425 break;
1426 default:
1427 r = -EINVAL;
1428 break;
1429 }
1430
1431 return r;
1432}
1433
1434static struct kvm_vcpu *kvmppc_core_vcpu_create_pr(struct kvm *kvm,
1435 unsigned int id)
1436{
1437 struct kvmppc_vcpu_book3s *vcpu_book3s;
1438 struct kvm_vcpu *vcpu;
1439 int err = -ENOMEM;
1440 unsigned long p;
1441
1442 vcpu = kmem_cache_zalloc(kvm_vcpu_cache, GFP_KERNEL);
1443 if (!vcpu)
1444 goto out;
1445
1446 vcpu_book3s = vzalloc(sizeof(struct kvmppc_vcpu_book3s));
1447 if (!vcpu_book3s)
1448 goto free_vcpu;
1449 vcpu->arch.book3s = vcpu_book3s;
1450
1451#ifdef CONFIG_KVM_BOOK3S_32_HANDLER
1452 vcpu->arch.shadow_vcpu =
1453 kzalloc(sizeof(*vcpu->arch.shadow_vcpu), GFP_KERNEL);
1454 if (!vcpu->arch.shadow_vcpu)
1455 goto free_vcpu3s;
1456#endif
1457
1458 err = kvm_vcpu_init(vcpu, kvm, id);
1459 if (err)
1460 goto free_shadow_vcpu;
1461
1462 err = -ENOMEM;
1463 p = __get_free_page(GFP_KERNEL|__GFP_ZERO);
1464 if (!p)
1465 goto uninit_vcpu;
1466 vcpu->arch.shared = (void *)p;
1467#ifdef CONFIG_PPC_BOOK3S_64
1468
1469#ifdef __BIG_ENDIAN__
1470 vcpu->arch.shared_big_endian = true;
1471#else
1472 vcpu->arch.shared_big_endian = false;
1473#endif
1474
1475
1476
1477
1478
1479
1480 vcpu->arch.pvr = 0x3C0301;
1481 if (mmu_has_feature(MMU_FTR_1T_SEGMENT))
1482 vcpu->arch.pvr = mfspr(SPRN_PVR);
1483 vcpu->arch.intr_msr = MSR_SF;
1484#else
1485
1486 vcpu->arch.pvr = 0x84202;
1487#endif
1488 kvmppc_set_pvr_pr(vcpu, vcpu->arch.pvr);
1489 vcpu->arch.slb_nr = 64;
1490
1491 vcpu->arch.shadow_msr = MSR_USER64 & ~MSR_LE;
1492
1493 err = kvmppc_mmu_init(vcpu);
1494 if (err < 0)
1495 goto uninit_vcpu;
1496
1497 return vcpu;
1498
1499uninit_vcpu:
1500 kvm_vcpu_uninit(vcpu);
1501free_shadow_vcpu:
1502#ifdef CONFIG_KVM_BOOK3S_32_HANDLER
1503 kfree(vcpu->arch.shadow_vcpu);
1504free_vcpu3s:
1505#endif
1506 vfree(vcpu_book3s);
1507free_vcpu:
1508 kmem_cache_free(kvm_vcpu_cache, vcpu);
1509out:
1510 return ERR_PTR(err);
1511}
1512
1513static void kvmppc_core_vcpu_free_pr(struct kvm_vcpu *vcpu)
1514{
1515 struct kvmppc_vcpu_book3s *vcpu_book3s = to_book3s(vcpu);
1516
1517 free_page((unsigned long)vcpu->arch.shared & PAGE_MASK);
1518 kvm_vcpu_uninit(vcpu);
1519#ifdef CONFIG_KVM_BOOK3S_32_HANDLER
1520 kfree(vcpu->arch.shadow_vcpu);
1521#endif
1522 vfree(vcpu_book3s);
1523 kmem_cache_free(kvm_vcpu_cache, vcpu);
1524}
1525
1526static int kvmppc_vcpu_run_pr(struct kvm_run *kvm_run, struct kvm_vcpu *vcpu)
1527{
1528 int ret;
1529#ifdef CONFIG_ALTIVEC
1530 unsigned long uninitialized_var(vrsave);
1531#endif
1532
1533
1534 if (!vcpu->arch.sane) {
1535 kvm_run->exit_reason = KVM_EXIT_INTERNAL_ERROR;
1536 ret = -EINVAL;
1537 goto out;
1538 }
1539
1540 kvmppc_setup_debug(vcpu);
1541
1542
1543
1544
1545
1546
1547
1548 ret = kvmppc_prepare_to_enter(vcpu);
1549 if (ret <= 0)
1550 goto out;
1551
1552
1553
1554 giveup_all(current);
1555
1556
1557 if (kvmppc_get_msr(vcpu) & MSR_FP)
1558 kvmppc_handle_ext(vcpu, BOOK3S_INTERRUPT_FP_UNAVAIL, MSR_FP);
1559
1560 kvmppc_fix_ee_before_entry();
1561
1562 ret = __kvmppc_vcpu_run(kvm_run, vcpu);
1563
1564 kvmppc_clear_debug(vcpu);
1565
1566
1567
1568
1569
1570 kvmppc_giveup_ext(vcpu, MSR_FP | MSR_VEC | MSR_VSX);
1571
1572
1573 kvmppc_giveup_fac(vcpu, FSCR_TAR_LG);
1574
1575out:
1576 vcpu->mode = OUTSIDE_GUEST_MODE;
1577 return ret;
1578}
1579
1580
1581
1582
1583static int kvm_vm_ioctl_get_dirty_log_pr(struct kvm *kvm,
1584 struct kvm_dirty_log *log)
1585{
1586 struct kvm_memslots *slots;
1587 struct kvm_memory_slot *memslot;
1588 struct kvm_vcpu *vcpu;
1589 ulong ga, ga_end;
1590 int is_dirty = 0;
1591 int r;
1592 unsigned long n;
1593
1594 mutex_lock(&kvm->slots_lock);
1595
1596 r = kvm_get_dirty_log(kvm, log, &is_dirty);
1597 if (r)
1598 goto out;
1599
1600
1601 if (is_dirty) {
1602 slots = kvm_memslots(kvm);
1603 memslot = id_to_memslot(slots, log->slot);
1604
1605 ga = memslot->base_gfn << PAGE_SHIFT;
1606 ga_end = ga + (memslot->npages << PAGE_SHIFT);
1607
1608 kvm_for_each_vcpu(n, vcpu, kvm)
1609 kvmppc_mmu_pte_pflush(vcpu, ga, ga_end);
1610
1611 n = kvm_dirty_bitmap_bytes(memslot);
1612 memset(memslot->dirty_bitmap, 0, n);
1613 }
1614
1615 r = 0;
1616out:
1617 mutex_unlock(&kvm->slots_lock);
1618 return r;
1619}
1620
1621static void kvmppc_core_flush_memslot_pr(struct kvm *kvm,
1622 struct kvm_memory_slot *memslot)
1623{
1624 return;
1625}
1626
1627static int kvmppc_core_prepare_memory_region_pr(struct kvm *kvm,
1628 struct kvm_memory_slot *memslot,
1629 const struct kvm_userspace_memory_region *mem)
1630{
1631 return 0;
1632}
1633
1634static void kvmppc_core_commit_memory_region_pr(struct kvm *kvm,
1635 const struct kvm_userspace_memory_region *mem,
1636 const struct kvm_memory_slot *old,
1637 const struct kvm_memory_slot *new)
1638{
1639 return;
1640}
1641
1642static void kvmppc_core_free_memslot_pr(struct kvm_memory_slot *free,
1643 struct kvm_memory_slot *dont)
1644{
1645 return;
1646}
1647
1648static int kvmppc_core_create_memslot_pr(struct kvm_memory_slot *slot,
1649 unsigned long npages)
1650{
1651 return 0;
1652}
1653
1654
1655#ifdef CONFIG_PPC64
1656static int kvm_vm_ioctl_get_smmu_info_pr(struct kvm *kvm,
1657 struct kvm_ppc_smmu_info *info)
1658{
1659 long int i;
1660 struct kvm_vcpu *vcpu;
1661
1662 info->flags = 0;
1663
1664
1665 info->slb_size = 64;
1666
1667
1668 info->sps[0].page_shift = 12;
1669 info->sps[0].slb_enc = 0;
1670 info->sps[0].enc[0].page_shift = 12;
1671 info->sps[0].enc[0].pte_enc = 0;
1672
1673
1674
1675
1676
1677
1678
1679
1680
1681
1682 i = 1;
1683 vcpu = kvm_get_vcpu(kvm, 0);
1684 if (vcpu && (vcpu->arch.hflags & BOOK3S_HFLAG_MULTI_PGSIZE)) {
1685 info->flags = KVM_PPC_1T_SEGMENTS;
1686 info->sps[i].page_shift = 16;
1687 info->sps[i].slb_enc = SLB_VSID_L | SLB_VSID_LP_01;
1688 info->sps[i].enc[0].page_shift = 16;
1689 info->sps[i].enc[0].pte_enc = 1;
1690 ++i;
1691 }
1692
1693
1694 info->sps[i].page_shift = 24;
1695 info->sps[i].slb_enc = SLB_VSID_L;
1696 info->sps[i].enc[0].page_shift = 24;
1697 info->sps[i].enc[0].pte_enc = 0;
1698
1699 return 0;
1700}
1701#else
1702static int kvm_vm_ioctl_get_smmu_info_pr(struct kvm *kvm,
1703 struct kvm_ppc_smmu_info *info)
1704{
1705
1706 BUG();
1707}
1708#endif
1709
1710static unsigned int kvm_global_user_count = 0;
1711static DEFINE_SPINLOCK(kvm_global_user_count_lock);
1712
1713static int kvmppc_core_init_vm_pr(struct kvm *kvm)
1714{
1715 mutex_init(&kvm->arch.hpt_mutex);
1716
1717#ifdef CONFIG_PPC_BOOK3S_64
1718
1719 kvmppc_pr_init_default_hcalls(kvm);
1720#endif
1721
1722 if (firmware_has_feature(FW_FEATURE_SET_MODE)) {
1723 spin_lock(&kvm_global_user_count_lock);
1724 if (++kvm_global_user_count == 1)
1725 pseries_disable_reloc_on_exc();
1726 spin_unlock(&kvm_global_user_count_lock);
1727 }
1728 return 0;
1729}
1730
1731static void kvmppc_core_destroy_vm_pr(struct kvm *kvm)
1732{
1733#ifdef CONFIG_PPC64
1734 WARN_ON(!list_empty(&kvm->arch.spapr_tce_tables));
1735#endif
1736
1737 if (firmware_has_feature(FW_FEATURE_SET_MODE)) {
1738 spin_lock(&kvm_global_user_count_lock);
1739 BUG_ON(kvm_global_user_count == 0);
1740 if (--kvm_global_user_count == 0)
1741 pseries_enable_reloc_on_exc();
1742 spin_unlock(&kvm_global_user_count_lock);
1743 }
1744}
1745
1746static int kvmppc_core_check_processor_compat_pr(void)
1747{
1748
1749
1750
1751 if (cpu_has_feature(CPU_FTR_ARCH_300))
1752 return -EIO;
1753 return 0;
1754}
1755
1756static long kvm_arch_vm_ioctl_pr(struct file *filp,
1757 unsigned int ioctl, unsigned long arg)
1758{
1759 return -ENOTTY;
1760}
1761
1762static struct kvmppc_ops kvm_ops_pr = {
1763 .get_sregs = kvm_arch_vcpu_ioctl_get_sregs_pr,
1764 .set_sregs = kvm_arch_vcpu_ioctl_set_sregs_pr,
1765 .get_one_reg = kvmppc_get_one_reg_pr,
1766 .set_one_reg = kvmppc_set_one_reg_pr,
1767 .vcpu_load = kvmppc_core_vcpu_load_pr,
1768 .vcpu_put = kvmppc_core_vcpu_put_pr,
1769 .set_msr = kvmppc_set_msr_pr,
1770 .vcpu_run = kvmppc_vcpu_run_pr,
1771 .vcpu_create = kvmppc_core_vcpu_create_pr,
1772 .vcpu_free = kvmppc_core_vcpu_free_pr,
1773 .check_requests = kvmppc_core_check_requests_pr,
1774 .get_dirty_log = kvm_vm_ioctl_get_dirty_log_pr,
1775 .flush_memslot = kvmppc_core_flush_memslot_pr,
1776 .prepare_memory_region = kvmppc_core_prepare_memory_region_pr,
1777 .commit_memory_region = kvmppc_core_commit_memory_region_pr,
1778 .unmap_hva = kvm_unmap_hva_pr,
1779 .unmap_hva_range = kvm_unmap_hva_range_pr,
1780 .age_hva = kvm_age_hva_pr,
1781 .test_age_hva = kvm_test_age_hva_pr,
1782 .set_spte_hva = kvm_set_spte_hva_pr,
1783 .mmu_destroy = kvmppc_mmu_destroy_pr,
1784 .free_memslot = kvmppc_core_free_memslot_pr,
1785 .create_memslot = kvmppc_core_create_memslot_pr,
1786 .init_vm = kvmppc_core_init_vm_pr,
1787 .destroy_vm = kvmppc_core_destroy_vm_pr,
1788 .get_smmu_info = kvm_vm_ioctl_get_smmu_info_pr,
1789 .emulate_op = kvmppc_core_emulate_op_pr,
1790 .emulate_mtspr = kvmppc_core_emulate_mtspr_pr,
1791 .emulate_mfspr = kvmppc_core_emulate_mfspr_pr,
1792 .fast_vcpu_kick = kvm_vcpu_kick,
1793 .arch_vm_ioctl = kvm_arch_vm_ioctl_pr,
1794#ifdef CONFIG_PPC_BOOK3S_64
1795 .hcall_implemented = kvmppc_hcall_impl_pr,
1796#endif
1797};
1798
1799
1800int kvmppc_book3s_init_pr(void)
1801{
1802 int r;
1803
1804 r = kvmppc_core_check_processor_compat_pr();
1805 if (r < 0)
1806 return r;
1807
1808 kvm_ops_pr.owner = THIS_MODULE;
1809 kvmppc_pr_ops = &kvm_ops_pr;
1810
1811 r = kvmppc_mmu_hpte_sysinit();
1812 return r;
1813}
1814
1815void kvmppc_book3s_exit_pr(void)
1816{
1817 kvmppc_pr_ops = NULL;
1818 kvmppc_mmu_hpte_sysexit();
1819}
1820
1821
1822
1823
1824#ifdef CONFIG_PPC_BOOK3S_64
1825
1826module_init(kvmppc_book3s_init_pr);
1827module_exit(kvmppc_book3s_exit_pr);
1828
1829MODULE_LICENSE("GPL");
1830MODULE_ALIAS_MISCDEV(KVM_MINOR);
1831MODULE_ALIAS("devname:kvm");
1832#endif
1833