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