tjh.dev
Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel
os
linux
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
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
37#include "trace.h"
38
39#define VCPU_STAT(x) offsetof(struct kvm_vcpu, stat.x), KVM_STAT_VCPU
40
41/* #define EXIT_DEBUG */
42
43struct kvm_stats_debugfs_item debugfs_entries[] = {
44 { "exits", VCPU_STAT(sum_exits) },
45 { "mmio", VCPU_STAT(mmio_exits) },
46 { "sig", VCPU_STAT(signal_exits) },
47 { "sysc", VCPU_STAT(syscall_exits) },
48 { "inst_emu", VCPU_STAT(emulated_inst_exits) },
49 { "dec", VCPU_STAT(dec_exits) },
50 { "ext_intr", VCPU_STAT(ext_intr_exits) },
51 { "queue_intr", VCPU_STAT(queue_intr) },
52 { "halt_wakeup", VCPU_STAT(halt_wakeup) },
53 { "pf_storage", VCPU_STAT(pf_storage) },
54 { "sp_storage", VCPU_STAT(sp_storage) },
55 { "pf_instruc", VCPU_STAT(pf_instruc) },
56 { "sp_instruc", VCPU_STAT(sp_instruc) },
57 { "ld", VCPU_STAT(ld) },
58 { "ld_slow", VCPU_STAT(ld_slow) },
59 { "st", VCPU_STAT(st) },
60 { "st_slow", VCPU_STAT(st_slow) },
61 { NULL }
62};
63
64void kvmppc_core_load_host_debugstate(struct kvm_vcpu *vcpu)
65{
66}
67
68void kvmppc_core_load_guest_debugstate(struct kvm_vcpu *vcpu)
69{
70}
71
72void kvmppc_inject_interrupt(struct kvm_vcpu *vcpu, int vec, u64 flags)
73{
74 vcpu->arch.shared->srr0 = kvmppc_get_pc(vcpu);
75 vcpu->arch.shared->srr1 = vcpu->arch.shared->msr | flags;
76 kvmppc_set_pc(vcpu, kvmppc_interrupt_offset(vcpu) + vec);
77 vcpu->arch.mmu.reset_msr(vcpu);
78}
79
80static int kvmppc_book3s_vec2irqprio(unsigned int vec)
81{
82 unsigned int prio;
83
84 switch (vec) {
85 case 0x100: prio = BOOK3S_IRQPRIO_SYSTEM_RESET; break;
86 case 0x200: prio = BOOK3S_IRQPRIO_MACHINE_CHECK; break;
87 case 0x300: prio = BOOK3S_IRQPRIO_DATA_STORAGE; break;
88 case 0x380: prio = BOOK3S_IRQPRIO_DATA_SEGMENT; break;
89 case 0x400: prio = BOOK3S_IRQPRIO_INST_STORAGE; break;
90 case 0x480: prio = BOOK3S_IRQPRIO_INST_SEGMENT; break;
91 case 0x500: prio = BOOK3S_IRQPRIO_EXTERNAL; break;
92 case 0x501: prio = BOOK3S_IRQPRIO_EXTERNAL_LEVEL; break;
93 case 0x600: prio = BOOK3S_IRQPRIO_ALIGNMENT; break;
94 case 0x700: prio = BOOK3S_IRQPRIO_PROGRAM; break;
95 case 0x800: prio = BOOK3S_IRQPRIO_FP_UNAVAIL; break;
96 case 0x900: prio = BOOK3S_IRQPRIO_DECREMENTER; break;
97 case 0xc00: prio = BOOK3S_IRQPRIO_SYSCALL; break;
98 case 0xd00: prio = BOOK3S_IRQPRIO_DEBUG; break;
99 case 0xf20: prio = BOOK3S_IRQPRIO_ALTIVEC; break;
100 case 0xf40: prio = BOOK3S_IRQPRIO_VSX; break;
101 default: prio = BOOK3S_IRQPRIO_MAX; break;
102 }
103
104 return prio;
105}
106
107static void kvmppc_book3s_dequeue_irqprio(struct kvm_vcpu *vcpu,
108 unsigned int vec)
109{
110 unsigned long old_pending = vcpu->arch.pending_exceptions;
111
112 clear_bit(kvmppc_book3s_vec2irqprio(vec),
113 &vcpu->arch.pending_exceptions);
114
115 kvmppc_update_int_pending(vcpu, vcpu->arch.pending_exceptions,
116 old_pending);
117}
118
119void kvmppc_book3s_queue_irqprio(struct kvm_vcpu *vcpu, unsigned int vec)
120{
121 vcpu->stat.queue_intr++;
122
123 set_bit(kvmppc_book3s_vec2irqprio(vec),
124 &vcpu->arch.pending_exceptions);
125#ifdef EXIT_DEBUG
126 printk(KERN_INFO "Queueing interrupt %x\n", vec);
127#endif
128}
129
130
131void kvmppc_core_queue_program(struct kvm_vcpu *vcpu, ulong flags)
132{
133 /* might as well deliver this straight away */
134 kvmppc_inject_interrupt(vcpu, BOOK3S_INTERRUPT_PROGRAM, flags);
135}
136
137void kvmppc_core_queue_dec(struct kvm_vcpu *vcpu)
138{
139 kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
140}
141
142int kvmppc_core_pending_dec(struct kvm_vcpu *vcpu)
143{
144 return test_bit(BOOK3S_IRQPRIO_DECREMENTER, &vcpu->arch.pending_exceptions);
145}
146
147void kvmppc_core_dequeue_dec(struct kvm_vcpu *vcpu)
148{
149 kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
150}
151
152void kvmppc_core_queue_external(struct kvm_vcpu *vcpu,
153 struct kvm_interrupt *irq)
154{
155 unsigned int vec = BOOK3S_INTERRUPT_EXTERNAL;
156
157 if (irq->irq == KVM_INTERRUPT_SET_LEVEL)
158 vec = BOOK3S_INTERRUPT_EXTERNAL_LEVEL;
159
160 kvmppc_book3s_queue_irqprio(vcpu, vec);
161}
162
163void kvmppc_core_dequeue_external(struct kvm_vcpu *vcpu,
164 struct kvm_interrupt *irq)
165{
166 kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL);
167 kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL_LEVEL);
168}
169
170int kvmppc_book3s_irqprio_deliver(struct kvm_vcpu *vcpu, unsigned int priority)
171{
172 int deliver = 1;
173 int vec = 0;
174 bool crit = kvmppc_critical_section(vcpu);
175
176 switch (priority) {
177 case BOOK3S_IRQPRIO_DECREMENTER:
178 deliver = (vcpu->arch.shared->msr & MSR_EE) && !crit;
179 vec = BOOK3S_INTERRUPT_DECREMENTER;
180 break;
181 case BOOK3S_IRQPRIO_EXTERNAL:
182 case BOOK3S_IRQPRIO_EXTERNAL_LEVEL:
183 deliver = (vcpu->arch.shared->msr & MSR_EE) && !crit;
184 vec = BOOK3S_INTERRUPT_EXTERNAL;
185 break;
186 case BOOK3S_IRQPRIO_SYSTEM_RESET:
187 vec = BOOK3S_INTERRUPT_SYSTEM_RESET;
188 break;
189 case BOOK3S_IRQPRIO_MACHINE_CHECK:
190 vec = BOOK3S_INTERRUPT_MACHINE_CHECK;
191 break;
192 case BOOK3S_IRQPRIO_DATA_STORAGE:
193 vec = BOOK3S_INTERRUPT_DATA_STORAGE;
194 break;
195 case BOOK3S_IRQPRIO_INST_STORAGE:
196 vec = BOOK3S_INTERRUPT_INST_STORAGE;
197 break;
198 case BOOK3S_IRQPRIO_DATA_SEGMENT:
199 vec = BOOK3S_INTERRUPT_DATA_SEGMENT;
200 break;
201 case BOOK3S_IRQPRIO_INST_SEGMENT:
202 vec = BOOK3S_INTERRUPT_INST_SEGMENT;
203 break;
204 case BOOK3S_IRQPRIO_ALIGNMENT:
205 vec = BOOK3S_INTERRUPT_ALIGNMENT;
206 break;
207 case BOOK3S_IRQPRIO_PROGRAM:
208 vec = BOOK3S_INTERRUPT_PROGRAM;
209 break;
210 case BOOK3S_IRQPRIO_VSX:
211 vec = BOOK3S_INTERRUPT_VSX;
212 break;
213 case BOOK3S_IRQPRIO_ALTIVEC:
214 vec = BOOK3S_INTERRUPT_ALTIVEC;
215 break;
216 case BOOK3S_IRQPRIO_FP_UNAVAIL:
217 vec = BOOK3S_INTERRUPT_FP_UNAVAIL;
218 break;
219 case BOOK3S_IRQPRIO_SYSCALL:
220 vec = BOOK3S_INTERRUPT_SYSCALL;
221 break;
222 case BOOK3S_IRQPRIO_DEBUG:
223 vec = BOOK3S_INTERRUPT_TRACE;
224 break;
225 case BOOK3S_IRQPRIO_PERFORMANCE_MONITOR:
226 vec = BOOK3S_INTERRUPT_PERFMON;
227 break;
228 default:
229 deliver = 0;
230 printk(KERN_ERR "KVM: Unknown interrupt: 0x%x\n", priority);
231 break;
232 }
233
234#if 0
235 printk(KERN_INFO "Deliver interrupt 0x%x? %x\n", vec, deliver);
236#endif
237
238 if (deliver)
239 kvmppc_inject_interrupt(vcpu, vec, 0);
240
241 return deliver;
242}
243
244/*
245 * This function determines if an irqprio should be cleared once issued.
246 */
247static bool clear_irqprio(struct kvm_vcpu *vcpu, unsigned int priority)
248{
249 switch (priority) {
250 case BOOK3S_IRQPRIO_DECREMENTER:
251 /* DEC interrupts get cleared by mtdec */
252 return false;
253 case BOOK3S_IRQPRIO_EXTERNAL_LEVEL:
254 /* External interrupts get cleared by userspace */
255 return false;
256 }
257
258 return true;
259}
260
261int kvmppc_core_prepare_to_enter(struct kvm_vcpu *vcpu)
262{
263 unsigned long *pending = &vcpu->arch.pending_exceptions;
264 unsigned long old_pending = vcpu->arch.pending_exceptions;
265 unsigned int priority;
266
267#ifdef EXIT_DEBUG
268 if (vcpu->arch.pending_exceptions)
269 printk(KERN_EMERG "KVM: Check pending: %lx\n", vcpu->arch.pending_exceptions);
270#endif
271 priority = __ffs(*pending);
272 while (priority < BOOK3S_IRQPRIO_MAX) {
273 if (kvmppc_book3s_irqprio_deliver(vcpu, priority) &&
274 clear_irqprio(vcpu, priority)) {
275 clear_bit(priority, &vcpu->arch.pending_exceptions);
276 break;
277 }
278
279 priority = find_next_bit(pending,
280 BITS_PER_BYTE * sizeof(*pending),
281 priority + 1);
282 }
283
284 /* Tell the guest about our interrupt status */
285 kvmppc_update_int_pending(vcpu, *pending, old_pending);
286
287 return 0;
288}
289
290pfn_t kvmppc_gfn_to_pfn(struct kvm_vcpu *vcpu, gfn_t gfn)
291{
292 ulong mp_pa = vcpu->arch.magic_page_pa;
293
294 if (!(vcpu->arch.shared->msr & MSR_SF))
295 mp_pa = (uint32_t)mp_pa;
296
297 /* Magic page override */
298 if (unlikely(mp_pa) &&
299 unlikely(((gfn << PAGE_SHIFT) & KVM_PAM) ==
300 ((mp_pa & PAGE_MASK) & KVM_PAM))) {
301 ulong shared_page = ((ulong)vcpu->arch.shared) & PAGE_MASK;
302 pfn_t pfn;
303
304 pfn = (pfn_t)virt_to_phys((void*)shared_page) >> PAGE_SHIFT;
305 get_page(pfn_to_page(pfn));
306 return pfn;
307 }
308
309 return gfn_to_pfn(vcpu->kvm, gfn);
310}
311
312static int kvmppc_xlate(struct kvm_vcpu *vcpu, ulong eaddr, bool data,
313 struct kvmppc_pte *pte)
314{
315 int relocated = (vcpu->arch.shared->msr & (data ? MSR_DR : MSR_IR));
316 int r;
317
318 if (relocated) {
319 r = vcpu->arch.mmu.xlate(vcpu, eaddr, pte, data);
320 } else {
321 pte->eaddr = eaddr;
322 pte->raddr = eaddr & KVM_PAM;
323 pte->vpage = VSID_REAL | eaddr >> 12;
324 pte->may_read = true;
325 pte->may_write = true;
326 pte->may_execute = true;
327 r = 0;
328 }
329
330 return r;
331}
332
333static hva_t kvmppc_bad_hva(void)
334{
335 return PAGE_OFFSET;
336}
337
338static hva_t kvmppc_pte_to_hva(struct kvm_vcpu *vcpu, struct kvmppc_pte *pte,
339 bool read)
340{
341 hva_t hpage;
342
343 if (read && !pte->may_read)
344 goto err;
345
346 if (!read && !pte->may_write)
347 goto err;
348
349 hpage = gfn_to_hva(vcpu->kvm, pte->raddr >> PAGE_SHIFT);
350 if (kvm_is_error_hva(hpage))
351 goto err;
352
353 return hpage | (pte->raddr & ~PAGE_MASK);
354err:
355 return kvmppc_bad_hva();
356}
357
358int kvmppc_st(struct kvm_vcpu *vcpu, ulong *eaddr, int size, void *ptr,
359 bool data)
360{
361 struct kvmppc_pte pte;
362
363 vcpu->stat.st++;
364
365 if (kvmppc_xlate(vcpu, *eaddr, data, &pte))
366 return -ENOENT;
367
368 *eaddr = pte.raddr;
369
370 if (!pte.may_write)
371 return -EPERM;
372
373 if (kvm_write_guest(vcpu->kvm, pte.raddr, ptr, size))
374 return EMULATE_DO_MMIO;
375
376 return EMULATE_DONE;
377}
378
379int kvmppc_ld(struct kvm_vcpu *vcpu, ulong *eaddr, int size, void *ptr,
380 bool data)
381{
382 struct kvmppc_pte pte;
383 hva_t hva = *eaddr;
384
385 vcpu->stat.ld++;
386
387 if (kvmppc_xlate(vcpu, *eaddr, data, &pte))
388 goto nopte;
389
390 *eaddr = pte.raddr;
391
392 hva = kvmppc_pte_to_hva(vcpu, &pte, true);
393 if (kvm_is_error_hva(hva))
394 goto mmio;
395
396 if (copy_from_user(ptr, (void __user *)hva, size)) {
397 printk(KERN_INFO "kvmppc_ld at 0x%lx failed\n", hva);
398 goto mmio;
399 }
400
401 return EMULATE_DONE;
402
403nopte:
404 return -ENOENT;
405mmio:
406 return EMULATE_DO_MMIO;
407}
408
409int kvm_arch_vcpu_setup(struct kvm_vcpu *vcpu)
410{
411 return 0;
412}
413
414int kvmppc_subarch_vcpu_init(struct kvm_vcpu *vcpu)
415{
416 return 0;
417}
418
419void kvmppc_subarch_vcpu_uninit(struct kvm_vcpu *vcpu)
420{
421}
422
423int kvm_arch_vcpu_ioctl_get_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
424{
425 int i;
426
427 regs->pc = kvmppc_get_pc(vcpu);
428 regs->cr = kvmppc_get_cr(vcpu);
429 regs->ctr = kvmppc_get_ctr(vcpu);
430 regs->lr = kvmppc_get_lr(vcpu);
431 regs->xer = kvmppc_get_xer(vcpu);
432 regs->msr = vcpu->arch.shared->msr;
433 regs->srr0 = vcpu->arch.shared->srr0;
434 regs->srr1 = vcpu->arch.shared->srr1;
435 regs->pid = vcpu->arch.pid;
436 regs->sprg0 = vcpu->arch.shared->sprg0;
437 regs->sprg1 = vcpu->arch.shared->sprg1;
438 regs->sprg2 = vcpu->arch.shared->sprg2;
439 regs->sprg3 = vcpu->arch.shared->sprg3;
440 regs->sprg4 = vcpu->arch.shared->sprg4;
441 regs->sprg5 = vcpu->arch.shared->sprg5;
442 regs->sprg6 = vcpu->arch.shared->sprg6;
443 regs->sprg7 = vcpu->arch.shared->sprg7;
444
445 for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
446 regs->gpr[i] = kvmppc_get_gpr(vcpu, i);
447
448 return 0;
449}
450
451int kvm_arch_vcpu_ioctl_set_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
452{
453 int i;
454
455 kvmppc_set_pc(vcpu, regs->pc);
456 kvmppc_set_cr(vcpu, regs->cr);
457 kvmppc_set_ctr(vcpu, regs->ctr);
458 kvmppc_set_lr(vcpu, regs->lr);
459 kvmppc_set_xer(vcpu, regs->xer);
460 kvmppc_set_msr(vcpu, regs->msr);
461 vcpu->arch.shared->srr0 = regs->srr0;
462 vcpu->arch.shared->srr1 = regs->srr1;
463 vcpu->arch.shared->sprg0 = regs->sprg0;
464 vcpu->arch.shared->sprg1 = regs->sprg1;
465 vcpu->arch.shared->sprg2 = regs->sprg2;
466 vcpu->arch.shared->sprg3 = regs->sprg3;
467 vcpu->arch.shared->sprg4 = regs->sprg4;
468 vcpu->arch.shared->sprg5 = regs->sprg5;
469 vcpu->arch.shared->sprg6 = regs->sprg6;
470 vcpu->arch.shared->sprg7 = regs->sprg7;
471
472 for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
473 kvmppc_set_gpr(vcpu, i, regs->gpr[i]);
474
475 return 0;
476}
477
478int kvm_arch_vcpu_ioctl_get_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu)
479{
480 return -ENOTSUPP;
481}
482
483int kvm_arch_vcpu_ioctl_set_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu)
484{
485 return -ENOTSUPP;
486}
487
488int kvm_vcpu_ioctl_get_one_reg(struct kvm_vcpu *vcpu, struct kvm_one_reg *reg)
489{
490 int r;
491 union kvmppc_one_reg val;
492 int size;
493 long int i;
494
495 size = one_reg_size(reg->id);
496 if (size > sizeof(val))
497 return -EINVAL;
498
499 r = kvmppc_get_one_reg(vcpu, reg->id, &val);
500
501 if (r == -EINVAL) {
502 r = 0;
503 switch (reg->id) {
504 case KVM_REG_PPC_DAR:
505 val = get_reg_val(reg->id, vcpu->arch.shared->dar);
506 break;
507 case KVM_REG_PPC_DSISR:
508 val = get_reg_val(reg->id, vcpu->arch.shared->dsisr);
509 break;
510 case KVM_REG_PPC_FPR0 ... KVM_REG_PPC_FPR31:
511 i = reg->id - KVM_REG_PPC_FPR0;
512 val = get_reg_val(reg->id, vcpu->arch.fpr[i]);
513 break;
514 case KVM_REG_PPC_FPSCR:
515 val = get_reg_val(reg->id, vcpu->arch.fpscr);
516 break;
517#ifdef CONFIG_ALTIVEC
518 case KVM_REG_PPC_VR0 ... KVM_REG_PPC_VR31:
519 if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
520 r = -ENXIO;
521 break;
522 }
523 val.vval = vcpu->arch.vr[reg->id - KVM_REG_PPC_VR0];
524 break;
525 case KVM_REG_PPC_VSCR:
526 if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
527 r = -ENXIO;
528 break;
529 }
530 val = get_reg_val(reg->id, vcpu->arch.vscr.u[3]);
531 break;
532#endif /* CONFIG_ALTIVEC */
533 default:
534 r = -EINVAL;
535 break;
536 }
537 }
538 if (r)
539 return r;
540
541 if (copy_to_user((char __user *)(unsigned long)reg->addr, &val, size))
542 r = -EFAULT;
543
544 return r;
545}
546
547int kvm_vcpu_ioctl_set_one_reg(struct kvm_vcpu *vcpu, struct kvm_one_reg *reg)
548{
549 int r;
550 union kvmppc_one_reg val;
551 int size;
552 long int i;
553
554 size = one_reg_size(reg->id);
555 if (size > sizeof(val))
556 return -EINVAL;
557
558 if (copy_from_user(&val, (char __user *)(unsigned long)reg->addr, size))
559 return -EFAULT;
560
561 r = kvmppc_set_one_reg(vcpu, reg->id, &val);
562
563 if (r == -EINVAL) {
564 r = 0;
565 switch (reg->id) {
566 case KVM_REG_PPC_DAR:
567 vcpu->arch.shared->dar = set_reg_val(reg->id, val);
568 break;
569 case KVM_REG_PPC_DSISR:
570 vcpu->arch.shared->dsisr = set_reg_val(reg->id, val);
571 break;
572 case KVM_REG_PPC_FPR0 ... KVM_REG_PPC_FPR31:
573 i = reg->id - KVM_REG_PPC_FPR0;
574 vcpu->arch.fpr[i] = set_reg_val(reg->id, val);
575 break;
576 case KVM_REG_PPC_FPSCR:
577 vcpu->arch.fpscr = set_reg_val(reg->id, val);
578 break;
579#ifdef CONFIG_ALTIVEC
580 case KVM_REG_PPC_VR0 ... KVM_REG_PPC_VR31:
581 if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
582 r = -ENXIO;
583 break;
584 }
585 vcpu->arch.vr[reg->id - KVM_REG_PPC_VR0] = val.vval;
586 break;
587 case KVM_REG_PPC_VSCR:
588 if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
589 r = -ENXIO;
590 break;
591 }
592 vcpu->arch.vscr.u[3] = set_reg_val(reg->id, val);
593 break;
594#endif /* CONFIG_ALTIVEC */
595 default:
596 r = -EINVAL;
597 break;
598 }
599 }
600
601 return r;
602}
603
604int kvm_arch_vcpu_ioctl_translate(struct kvm_vcpu *vcpu,
605 struct kvm_translation *tr)
606{
607 return 0;
608}
609
610void kvmppc_decrementer_func(unsigned long data)
611{
612 struct kvm_vcpu *vcpu = (struct kvm_vcpu *)data;
613
614 kvmppc_core_queue_dec(vcpu);
615 kvm_vcpu_kick(vcpu);
616}