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
43 struct 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
kvmppc_core_load_host_debugstate(struct kvm_vcpu * vcpu)64 void kvmppc_core_load_host_debugstate(struct kvm_vcpu *vcpu)
65 {
66 }
67
kvmppc_core_load_guest_debugstate(struct kvm_vcpu * vcpu)68 void kvmppc_core_load_guest_debugstate(struct kvm_vcpu *vcpu)
69 {
70 }
71
kvmppc_inject_interrupt(struct kvm_vcpu * vcpu,int vec,u64 flags)72 void 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
kvmppc_book3s_vec2irqprio(unsigned int vec)80 static 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
kvmppc_book3s_dequeue_irqprio(struct kvm_vcpu * vcpu,unsigned int vec)107 static 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
kvmppc_book3s_queue_irqprio(struct kvm_vcpu * vcpu,unsigned int vec)119 void 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
kvmppc_core_queue_program(struct kvm_vcpu * vcpu,ulong flags)131 void 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
kvmppc_core_queue_dec(struct kvm_vcpu * vcpu)137 void kvmppc_core_queue_dec(struct kvm_vcpu *vcpu)
138 {
139 kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
140 }
141
kvmppc_core_pending_dec(struct kvm_vcpu * vcpu)142 int kvmppc_core_pending_dec(struct kvm_vcpu *vcpu)
143 {
144 return test_bit(BOOK3S_IRQPRIO_DECREMENTER, &vcpu->arch.pending_exceptions);
145 }
146
kvmppc_core_dequeue_dec(struct kvm_vcpu * vcpu)147 void kvmppc_core_dequeue_dec(struct kvm_vcpu *vcpu)
148 {
149 kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
150 }
151
kvmppc_core_queue_external(struct kvm_vcpu * vcpu,struct kvm_interrupt * irq)152 void 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
kvmppc_core_dequeue_external(struct kvm_vcpu * vcpu,struct kvm_interrupt * irq)163 void 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
kvmppc_book3s_irqprio_deliver(struct kvm_vcpu * vcpu,unsigned int priority)170 int 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 */
clear_irqprio(struct kvm_vcpu * vcpu,unsigned int priority)247 static 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
kvmppc_core_prepare_to_enter(struct kvm_vcpu * vcpu)261 void 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
kvmppc_gfn_to_pfn(struct kvm_vcpu * vcpu,gfn_t gfn)288 pfn_t kvmppc_gfn_to_pfn(struct kvm_vcpu *vcpu, gfn_t gfn)
289 {
290 ulong mp_pa = vcpu->arch.magic_page_pa;
291
292 /* Magic page override */
293 if (unlikely(mp_pa) &&
294 unlikely(((gfn << PAGE_SHIFT) & KVM_PAM) ==
295 ((mp_pa & PAGE_MASK) & KVM_PAM))) {
296 ulong shared_page = ((ulong)vcpu->arch.shared) & PAGE_MASK;
297 pfn_t pfn;
298
299 pfn = (pfn_t)virt_to_phys((void*)shared_page) >> PAGE_SHIFT;
300 get_page(pfn_to_page(pfn));
301 return pfn;
302 }
303
304 return gfn_to_pfn(vcpu->kvm, gfn);
305 }
306
kvmppc_xlate(struct kvm_vcpu * vcpu,ulong eaddr,bool data,struct kvmppc_pte * pte)307 static int kvmppc_xlate(struct kvm_vcpu *vcpu, ulong eaddr, bool data,
308 struct kvmppc_pte *pte)
309 {
310 int relocated = (vcpu->arch.shared->msr & (data ? MSR_DR : MSR_IR));
311 int r;
312
313 if (relocated) {
314 r = vcpu->arch.mmu.xlate(vcpu, eaddr, pte, data);
315 } else {
316 pte->eaddr = eaddr;
317 pte->raddr = eaddr & KVM_PAM;
318 pte->vpage = VSID_REAL | eaddr >> 12;
319 pte->may_read = true;
320 pte->may_write = true;
321 pte->may_execute = true;
322 r = 0;
323 }
324
325 return r;
326 }
327
kvmppc_bad_hva(void)328 static hva_t kvmppc_bad_hva(void)
329 {
330 return PAGE_OFFSET;
331 }
332
kvmppc_pte_to_hva(struct kvm_vcpu * vcpu,struct kvmppc_pte * pte,bool read)333 static hva_t kvmppc_pte_to_hva(struct kvm_vcpu *vcpu, struct kvmppc_pte *pte,
334 bool read)
335 {
336 hva_t hpage;
337
338 if (read && !pte->may_read)
339 goto err;
340
341 if (!read && !pte->may_write)
342 goto err;
343
344 hpage = gfn_to_hva(vcpu->kvm, pte->raddr >> PAGE_SHIFT);
345 if (kvm_is_error_hva(hpage))
346 goto err;
347
348 return hpage | (pte->raddr & ~PAGE_MASK);
349 err:
350 return kvmppc_bad_hva();
351 }
352
kvmppc_st(struct kvm_vcpu * vcpu,ulong * eaddr,int size,void * ptr,bool data)353 int kvmppc_st(struct kvm_vcpu *vcpu, ulong *eaddr, int size, void *ptr,
354 bool data)
355 {
356 struct kvmppc_pte pte;
357
358 vcpu->stat.st++;
359
360 if (kvmppc_xlate(vcpu, *eaddr, data, &pte))
361 return -ENOENT;
362
363 *eaddr = pte.raddr;
364
365 if (!pte.may_write)
366 return -EPERM;
367
368 if (kvm_write_guest(vcpu->kvm, pte.raddr, ptr, size))
369 return EMULATE_DO_MMIO;
370
371 return EMULATE_DONE;
372 }
373
kvmppc_ld(struct kvm_vcpu * vcpu,ulong * eaddr,int size,void * ptr,bool data)374 int kvmppc_ld(struct kvm_vcpu *vcpu, ulong *eaddr, int size, void *ptr,
375 bool data)
376 {
377 struct kvmppc_pte pte;
378 hva_t hva = *eaddr;
379
380 vcpu->stat.ld++;
381
382 if (kvmppc_xlate(vcpu, *eaddr, data, &pte))
383 goto nopte;
384
385 *eaddr = pte.raddr;
386
387 hva = kvmppc_pte_to_hva(vcpu, &pte, true);
388 if (kvm_is_error_hva(hva))
389 goto mmio;
390
391 if (copy_from_user(ptr, (void __user *)hva, size)) {
392 printk(KERN_INFO "kvmppc_ld at 0x%lx failed\n", hva);
393 goto mmio;
394 }
395
396 return EMULATE_DONE;
397
398 nopte:
399 return -ENOENT;
400 mmio:
401 return EMULATE_DO_MMIO;
402 }
403
kvm_arch_vcpu_setup(struct kvm_vcpu * vcpu)404 int kvm_arch_vcpu_setup(struct kvm_vcpu *vcpu)
405 {
406 return 0;
407 }
408
kvm_arch_vcpu_ioctl_get_regs(struct kvm_vcpu * vcpu,struct kvm_regs * regs)409 int kvm_arch_vcpu_ioctl_get_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
410 {
411 int i;
412
413 regs->pc = kvmppc_get_pc(vcpu);
414 regs->cr = kvmppc_get_cr(vcpu);
415 regs->ctr = kvmppc_get_ctr(vcpu);
416 regs->lr = kvmppc_get_lr(vcpu);
417 regs->xer = kvmppc_get_xer(vcpu);
418 regs->msr = vcpu->arch.shared->msr;
419 regs->srr0 = vcpu->arch.shared->srr0;
420 regs->srr1 = vcpu->arch.shared->srr1;
421 regs->pid = vcpu->arch.pid;
422 regs->sprg0 = vcpu->arch.shared->sprg0;
423 regs->sprg1 = vcpu->arch.shared->sprg1;
424 regs->sprg2 = vcpu->arch.shared->sprg2;
425 regs->sprg3 = vcpu->arch.shared->sprg3;
426 regs->sprg4 = vcpu->arch.shared->sprg4;
427 regs->sprg5 = vcpu->arch.shared->sprg5;
428 regs->sprg6 = vcpu->arch.shared->sprg6;
429 regs->sprg7 = vcpu->arch.shared->sprg7;
430
431 for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
432 regs->gpr[i] = kvmppc_get_gpr(vcpu, i);
433
434 return 0;
435 }
436
kvm_arch_vcpu_ioctl_set_regs(struct kvm_vcpu * vcpu,struct kvm_regs * regs)437 int kvm_arch_vcpu_ioctl_set_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
438 {
439 int i;
440
441 kvmppc_set_pc(vcpu, regs->pc);
442 kvmppc_set_cr(vcpu, regs->cr);
443 kvmppc_set_ctr(vcpu, regs->ctr);
444 kvmppc_set_lr(vcpu, regs->lr);
445 kvmppc_set_xer(vcpu, regs->xer);
446 kvmppc_set_msr(vcpu, regs->msr);
447 vcpu->arch.shared->srr0 = regs->srr0;
448 vcpu->arch.shared->srr1 = regs->srr1;
449 vcpu->arch.shared->sprg0 = regs->sprg0;
450 vcpu->arch.shared->sprg1 = regs->sprg1;
451 vcpu->arch.shared->sprg2 = regs->sprg2;
452 vcpu->arch.shared->sprg3 = regs->sprg3;
453 vcpu->arch.shared->sprg4 = regs->sprg4;
454 vcpu->arch.shared->sprg5 = regs->sprg5;
455 vcpu->arch.shared->sprg6 = regs->sprg6;
456 vcpu->arch.shared->sprg7 = regs->sprg7;
457
458 for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
459 kvmppc_set_gpr(vcpu, i, regs->gpr[i]);
460
461 return 0;
462 }
463
kvm_arch_vcpu_ioctl_get_fpu(struct kvm_vcpu * vcpu,struct kvm_fpu * fpu)464 int kvm_arch_vcpu_ioctl_get_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu)
465 {
466 return -ENOTSUPP;
467 }
468
kvm_arch_vcpu_ioctl_set_fpu(struct kvm_vcpu * vcpu,struct kvm_fpu * fpu)469 int kvm_arch_vcpu_ioctl_set_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu)
470 {
471 return -ENOTSUPP;
472 }
473
kvm_arch_vcpu_ioctl_translate(struct kvm_vcpu * vcpu,struct kvm_translation * tr)474 int kvm_arch_vcpu_ioctl_translate(struct kvm_vcpu *vcpu,
475 struct kvm_translation *tr)
476 {
477 return 0;
478 }
479
kvmppc_decrementer_func(unsigned long data)480 void kvmppc_decrementer_func(unsigned long data)
481 {
482 struct kvm_vcpu *vcpu = (struct kvm_vcpu *)data;
483
484 kvmppc_core_queue_dec(vcpu);
485 kvm_vcpu_kick(vcpu);
486 }
487