blob: b998abf1a63d13f8f05132037560b8e466d3b955 [file] [log] [blame]
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001/*
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>
Stephen Rothwell329d20b2010-04-27 15:49:17 +100019#include <linux/slab.h>
Alexander Graf2f4cf5e2009-10-30 05:47:10 +000020
21#include <asm/reg.h>
22#include <asm/cputable.h>
23#include <asm/cacheflush.h>
24#include <asm/tlbflush.h>
25#include <asm/uaccess.h>
26#include <asm/io.h>
27#include <asm/kvm_ppc.h>
28#include <asm/kvm_book3s.h>
29#include <asm/mmu_context.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090030#include <linux/gfp.h>
Alexander Graf2f4cf5e2009-10-30 05:47:10 +000031#include <linux/sched.h>
32#include <linux/vmalloc.h>
Alexander Graf9fb244a2010-03-24 21:48:32 +010033#include <linux/highmem.h>
Alexander Graf2f4cf5e2009-10-30 05:47:10 +000034
35#define VCPU_STAT(x) offsetof(struct kvm_vcpu, stat.x), KVM_STAT_VCPU
36
37/* #define EXIT_DEBUG */
38/* #define EXIT_DEBUG_SIMPLE */
Alexander Graf180a34d2010-01-15 14:49:11 +010039/* #define DEBUG_EXT */
40
Alexander Grafc8c0b6f2010-02-19 11:00:34 +010041static int kvmppc_handle_ext(struct kvm_vcpu *vcpu, unsigned int exit_nr,
42 ulong msr);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +000043
Alexander Graf07b09072010-04-16 00:11:53 +020044/* Some compatibility defines */
45#ifdef CONFIG_PPC_BOOK3S_32
46#define MSR_USER32 MSR_USER
47#define MSR_USER64 MSR_USER
48#define HW_PAGE_SIZE PAGE_SIZE
49#endif
50
Alexander Graf2f4cf5e2009-10-30 05:47:10 +000051struct kvm_stats_debugfs_item debugfs_entries[] = {
52 { "exits", VCPU_STAT(sum_exits) },
53 { "mmio", VCPU_STAT(mmio_exits) },
54 { "sig", VCPU_STAT(signal_exits) },
55 { "sysc", VCPU_STAT(syscall_exits) },
56 { "inst_emu", VCPU_STAT(emulated_inst_exits) },
57 { "dec", VCPU_STAT(dec_exits) },
58 { "ext_intr", VCPU_STAT(ext_intr_exits) },
59 { "queue_intr", VCPU_STAT(queue_intr) },
60 { "halt_wakeup", VCPU_STAT(halt_wakeup) },
61 { "pf_storage", VCPU_STAT(pf_storage) },
62 { "sp_storage", VCPU_STAT(sp_storage) },
63 { "pf_instruc", VCPU_STAT(pf_instruc) },
64 { "sp_instruc", VCPU_STAT(sp_instruc) },
65 { "ld", VCPU_STAT(ld) },
66 { "ld_slow", VCPU_STAT(ld_slow) },
67 { "st", VCPU_STAT(st) },
68 { "st_slow", VCPU_STAT(st_slow) },
69 { NULL }
70};
71
72void kvmppc_core_load_host_debugstate(struct kvm_vcpu *vcpu)
73{
74}
75
76void kvmppc_core_load_guest_debugstate(struct kvm_vcpu *vcpu)
77{
78}
79
80void kvmppc_core_vcpu_load(struct kvm_vcpu *vcpu, int cpu)
81{
Alexander Grafc7f38f42010-04-16 00:11:40 +020082#ifdef CONFIG_PPC_BOOK3S_64
83 memcpy(to_svcpu(vcpu)->slb, to_book3s(vcpu)->slb_shadow, sizeof(to_svcpu(vcpu)->slb));
84 memcpy(&get_paca()->shadow_vcpu, to_book3s(vcpu)->shadow_vcpu,
Alexander Graf7e57cba2010-01-08 02:58:03 +010085 sizeof(get_paca()->shadow_vcpu));
Alexander Grafc7f38f42010-04-16 00:11:40 +020086 to_svcpu(vcpu)->slb_max = to_book3s(vcpu)->slb_shadow_max;
87#endif
88
89#ifdef CONFIG_PPC_BOOK3S_32
90 current->thread.kvm_shadow_vcpu = to_book3s(vcpu)->shadow_vcpu;
91#endif
Alexander Graf2f4cf5e2009-10-30 05:47:10 +000092}
93
94void kvmppc_core_vcpu_put(struct kvm_vcpu *vcpu)
95{
Alexander Grafc7f38f42010-04-16 00:11:40 +020096#ifdef CONFIG_PPC_BOOK3S_64
97 memcpy(to_book3s(vcpu)->slb_shadow, to_svcpu(vcpu)->slb, sizeof(to_svcpu(vcpu)->slb));
98 memcpy(to_book3s(vcpu)->shadow_vcpu, &get_paca()->shadow_vcpu,
Alexander Graf7e57cba2010-01-08 02:58:03 +010099 sizeof(get_paca()->shadow_vcpu));
Alexander Grafc7f38f42010-04-16 00:11:40 +0200100 to_book3s(vcpu)->slb_shadow_max = to_svcpu(vcpu)->slb_max;
101#endif
Alexander Graf180a34d2010-01-15 14:49:11 +0100102
103 kvmppc_giveup_ext(vcpu, MSR_FP);
104 kvmppc_giveup_ext(vcpu, MSR_VEC);
105 kvmppc_giveup_ext(vcpu, MSR_VSX);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000106}
107
Alexander Graf0bb1fb72009-12-21 20:21:25 +0100108#if defined(EXIT_DEBUG)
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000109static u32 kvmppc_get_dec(struct kvm_vcpu *vcpu)
110{
111 u64 jd = mftb() - vcpu->arch.dec_jiffies;
112 return vcpu->arch.dec - jd;
113}
114#endif
115
Alexander Grafa76f8492010-01-15 14:49:14 +0100116static void kvmppc_recalc_shadow_msr(struct kvm_vcpu *vcpu)
117{
118 vcpu->arch.shadow_msr = vcpu->arch.msr;
119 /* Guest MSR values */
120 vcpu->arch.shadow_msr &= MSR_FE0 | MSR_FE1 | MSR_SF | MSR_SE |
121 MSR_BE | MSR_DE;
122 /* Process MSR values */
123 vcpu->arch.shadow_msr |= MSR_ME | MSR_RI | MSR_IR | MSR_DR | MSR_PR |
124 MSR_EE;
125 /* External providers the guest reserved */
126 vcpu->arch.shadow_msr |= (vcpu->arch.msr & vcpu->arch.guest_owned_ext);
127 /* 64-bit Process MSR values */
128#ifdef CONFIG_PPC_BOOK3S_64
129 vcpu->arch.shadow_msr |= MSR_ISF | MSR_HV;
130#endif
131}
132
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000133void kvmppc_set_msr(struct kvm_vcpu *vcpu, u64 msr)
134{
135 ulong old_msr = vcpu->arch.msr;
136
137#ifdef EXIT_DEBUG
138 printk(KERN_INFO "KVM: Set MSR to 0x%llx\n", msr);
139#endif
Alexander Grafa76f8492010-01-15 14:49:14 +0100140
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000141 msr &= to_book3s(vcpu)->msr_mask;
142 vcpu->arch.msr = msr;
Alexander Grafa76f8492010-01-15 14:49:14 +0100143 kvmppc_recalc_shadow_msr(vcpu);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000144
145 if (msr & (MSR_WE|MSR_POW)) {
146 if (!vcpu->arch.pending_exceptions) {
147 kvm_vcpu_block(vcpu);
148 vcpu->stat.halt_wakeup++;
149 }
150 }
151
Alexander Graff7bc74e2010-04-20 02:49:48 +0200152 if ((vcpu->arch.msr & (MSR_PR|MSR_IR|MSR_DR)) !=
153 (old_msr & (MSR_PR|MSR_IR|MSR_DR))) {
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000154 kvmppc_mmu_flush_segments(vcpu);
Alexander Grafc7f38f42010-04-16 00:11:40 +0200155 kvmppc_mmu_map_segment(vcpu, kvmppc_get_pc(vcpu));
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000156 }
Alexander Grafd1bab742010-02-19 11:00:35 +0100157
158 /* Preload FPU if it's enabled */
159 if (vcpu->arch.msr & MSR_FP)
160 kvmppc_handle_ext(vcpu, BOOK3S_INTERRUPT_FP_UNAVAIL, MSR_FP);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000161}
162
163void kvmppc_inject_interrupt(struct kvm_vcpu *vcpu, int vec, u64 flags)
164{
Alexander Grafc7f38f42010-04-16 00:11:40 +0200165 vcpu->arch.srr0 = kvmppc_get_pc(vcpu);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000166 vcpu->arch.srr1 = vcpu->arch.msr | flags;
Alexander Grafc7f38f42010-04-16 00:11:40 +0200167 kvmppc_set_pc(vcpu, to_book3s(vcpu)->hior + vec);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000168 vcpu->arch.mmu.reset_msr(vcpu);
169}
170
Alexander Graf583617b2009-12-21 20:21:23 +0100171static int kvmppc_book3s_vec2irqprio(unsigned int vec)
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000172{
173 unsigned int prio;
174
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000175 switch (vec) {
176 case 0x100: prio = BOOK3S_IRQPRIO_SYSTEM_RESET; break;
177 case 0x200: prio = BOOK3S_IRQPRIO_MACHINE_CHECK; break;
178 case 0x300: prio = BOOK3S_IRQPRIO_DATA_STORAGE; break;
179 case 0x380: prio = BOOK3S_IRQPRIO_DATA_SEGMENT; break;
180 case 0x400: prio = BOOK3S_IRQPRIO_INST_STORAGE; break;
181 case 0x480: prio = BOOK3S_IRQPRIO_INST_SEGMENT; break;
182 case 0x500: prio = BOOK3S_IRQPRIO_EXTERNAL; break;
183 case 0x600: prio = BOOK3S_IRQPRIO_ALIGNMENT; break;
184 case 0x700: prio = BOOK3S_IRQPRIO_PROGRAM; break;
185 case 0x800: prio = BOOK3S_IRQPRIO_FP_UNAVAIL; break;
186 case 0x900: prio = BOOK3S_IRQPRIO_DECREMENTER; break;
187 case 0xc00: prio = BOOK3S_IRQPRIO_SYSCALL; break;
188 case 0xd00: prio = BOOK3S_IRQPRIO_DEBUG; break;
189 case 0xf20: prio = BOOK3S_IRQPRIO_ALTIVEC; break;
190 case 0xf40: prio = BOOK3S_IRQPRIO_VSX; break;
191 default: prio = BOOK3S_IRQPRIO_MAX; break;
192 }
193
Alexander Graf583617b2009-12-21 20:21:23 +0100194 return prio;
195}
196
Alexander Graf7706664d2009-12-21 20:21:24 +0100197static void kvmppc_book3s_dequeue_irqprio(struct kvm_vcpu *vcpu,
198 unsigned int vec)
199{
200 clear_bit(kvmppc_book3s_vec2irqprio(vec),
201 &vcpu->arch.pending_exceptions);
202}
203
Alexander Graf583617b2009-12-21 20:21:23 +0100204void kvmppc_book3s_queue_irqprio(struct kvm_vcpu *vcpu, unsigned int vec)
205{
206 vcpu->stat.queue_intr++;
207
208 set_bit(kvmppc_book3s_vec2irqprio(vec),
209 &vcpu->arch.pending_exceptions);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000210#ifdef EXIT_DEBUG
211 printk(KERN_INFO "Queueing interrupt %x\n", vec);
212#endif
213}
214
215
Alexander Graf25a8a022010-01-08 02:58:07 +0100216void kvmppc_core_queue_program(struct kvm_vcpu *vcpu, ulong flags)
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000217{
Alexander Graf25a8a022010-01-08 02:58:07 +0100218 to_book3s(vcpu)->prog_flags = flags;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000219 kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_PROGRAM);
220}
221
222void kvmppc_core_queue_dec(struct kvm_vcpu *vcpu)
223{
224 kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
225}
226
227int kvmppc_core_pending_dec(struct kvm_vcpu *vcpu)
228{
229 return test_bit(BOOK3S_INTERRUPT_DECREMENTER >> 7, &vcpu->arch.pending_exceptions);
230}
231
Alexander Graf7706664d2009-12-21 20:21:24 +0100232void kvmppc_core_dequeue_dec(struct kvm_vcpu *vcpu)
233{
234 kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
235}
236
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000237void kvmppc_core_queue_external(struct kvm_vcpu *vcpu,
238 struct kvm_interrupt *irq)
239{
240 kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL);
241}
242
Alexander Graf18978762010-03-24 21:48:18 +0100243void kvmppc_core_dequeue_external(struct kvm_vcpu *vcpu,
244 struct kvm_interrupt *irq)
245{
246 kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL);
247}
248
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000249int kvmppc_book3s_irqprio_deliver(struct kvm_vcpu *vcpu, unsigned int priority)
250{
251 int deliver = 1;
252 int vec = 0;
Alexander Graf25a8a022010-01-08 02:58:07 +0100253 ulong flags = 0ULL;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000254
255 switch (priority) {
256 case BOOK3S_IRQPRIO_DECREMENTER:
257 deliver = vcpu->arch.msr & MSR_EE;
258 vec = BOOK3S_INTERRUPT_DECREMENTER;
259 break;
260 case BOOK3S_IRQPRIO_EXTERNAL:
261 deliver = vcpu->arch.msr & MSR_EE;
262 vec = BOOK3S_INTERRUPT_EXTERNAL;
263 break;
264 case BOOK3S_IRQPRIO_SYSTEM_RESET:
265 vec = BOOK3S_INTERRUPT_SYSTEM_RESET;
266 break;
267 case BOOK3S_IRQPRIO_MACHINE_CHECK:
268 vec = BOOK3S_INTERRUPT_MACHINE_CHECK;
269 break;
270 case BOOK3S_IRQPRIO_DATA_STORAGE:
271 vec = BOOK3S_INTERRUPT_DATA_STORAGE;
272 break;
273 case BOOK3S_IRQPRIO_INST_STORAGE:
274 vec = BOOK3S_INTERRUPT_INST_STORAGE;
275 break;
276 case BOOK3S_IRQPRIO_DATA_SEGMENT:
277 vec = BOOK3S_INTERRUPT_DATA_SEGMENT;
278 break;
279 case BOOK3S_IRQPRIO_INST_SEGMENT:
280 vec = BOOK3S_INTERRUPT_INST_SEGMENT;
281 break;
282 case BOOK3S_IRQPRIO_ALIGNMENT:
283 vec = BOOK3S_INTERRUPT_ALIGNMENT;
284 break;
285 case BOOK3S_IRQPRIO_PROGRAM:
286 vec = BOOK3S_INTERRUPT_PROGRAM;
Alexander Graf25a8a022010-01-08 02:58:07 +0100287 flags = to_book3s(vcpu)->prog_flags;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000288 break;
289 case BOOK3S_IRQPRIO_VSX:
290 vec = BOOK3S_INTERRUPT_VSX;
291 break;
292 case BOOK3S_IRQPRIO_ALTIVEC:
293 vec = BOOK3S_INTERRUPT_ALTIVEC;
294 break;
295 case BOOK3S_IRQPRIO_FP_UNAVAIL:
296 vec = BOOK3S_INTERRUPT_FP_UNAVAIL;
297 break;
298 case BOOK3S_IRQPRIO_SYSCALL:
299 vec = BOOK3S_INTERRUPT_SYSCALL;
300 break;
301 case BOOK3S_IRQPRIO_DEBUG:
302 vec = BOOK3S_INTERRUPT_TRACE;
303 break;
304 case BOOK3S_IRQPRIO_PERFORMANCE_MONITOR:
305 vec = BOOK3S_INTERRUPT_PERFMON;
306 break;
307 default:
308 deliver = 0;
309 printk(KERN_ERR "KVM: Unknown interrupt: 0x%x\n", priority);
310 break;
311 }
312
313#if 0
314 printk(KERN_INFO "Deliver interrupt 0x%x? %x\n", vec, deliver);
315#endif
316
317 if (deliver)
Alexander Graf25a8a022010-01-08 02:58:07 +0100318 kvmppc_inject_interrupt(vcpu, vec, flags);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000319
320 return deliver;
321}
322
323void kvmppc_core_deliver_interrupts(struct kvm_vcpu *vcpu)
324{
325 unsigned long *pending = &vcpu->arch.pending_exceptions;
326 unsigned int priority;
327
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000328#ifdef EXIT_DEBUG
329 if (vcpu->arch.pending_exceptions)
330 printk(KERN_EMERG "KVM: Check pending: %lx\n", vcpu->arch.pending_exceptions);
331#endif
332 priority = __ffs(*pending);
Alexander Grafada7ba12010-04-16 00:11:56 +0200333 while (priority < BOOK3S_IRQPRIO_MAX) {
Alexander Graf7706664d2009-12-21 20:21:24 +0100334 if (kvmppc_book3s_irqprio_deliver(vcpu, priority) &&
335 (priority != BOOK3S_IRQPRIO_DECREMENTER)) {
336 /* DEC interrupts get cleared by mtdec */
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000337 clear_bit(priority, &vcpu->arch.pending_exceptions);
338 break;
339 }
340
341 priority = find_next_bit(pending,
342 BITS_PER_BYTE * sizeof(*pending),
343 priority + 1);
344 }
345}
346
347void kvmppc_set_pvr(struct kvm_vcpu *vcpu, u32 pvr)
348{
Alexander Grafb83d4a92010-04-20 02:49:54 +0200349 u32 host_pvr;
350
Alexander Grafe15a1132009-11-30 03:02:02 +0000351 vcpu->arch.hflags &= ~BOOK3S_HFLAG_SLB;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000352 vcpu->arch.pvr = pvr;
Alexander Graf07b09072010-04-16 00:11:53 +0200353#ifdef CONFIG_PPC_BOOK3S_64
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000354 if ((pvr >= 0x330000) && (pvr < 0x70330000)) {
355 kvmppc_mmu_book3s_64_init(vcpu);
356 to_book3s(vcpu)->hior = 0xfff00000;
357 to_book3s(vcpu)->msr_mask = 0xffffffffffffffffULL;
Alexander Graf07b09072010-04-16 00:11:53 +0200358 } else
359#endif
360 {
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000361 kvmppc_mmu_book3s_32_init(vcpu);
362 to_book3s(vcpu)->hior = 0;
363 to_book3s(vcpu)->msr_mask = 0xffffffffULL;
364 }
365
366 /* If we are in hypervisor level on 970, we can tell the CPU to
367 * treat DCBZ as 32 bytes store */
368 vcpu->arch.hflags &= ~BOOK3S_HFLAG_DCBZ32;
369 if (vcpu->arch.mmu.is_dcbz32(vcpu) && (mfmsr() & MSR_HV) &&
370 !strcmp(cur_cpu_spec->platform, "ppc970"))
371 vcpu->arch.hflags |= BOOK3S_HFLAG_DCBZ32;
372
Alexander Graf05b0ab12010-03-24 21:48:37 +0100373 /* Cell performs badly if MSR_FEx are set. So let's hope nobody
374 really needs them in a VM on Cell and force disable them. */
375 if (!strcmp(cur_cpu_spec->platform, "ppc-cell-be"))
376 to_book3s(vcpu)->msr_mask &= ~(MSR_FE0 | MSR_FE1);
Alexander Graf07b09072010-04-16 00:11:53 +0200377
378#ifdef CONFIG_PPC_BOOK3S_32
379 /* 32 bit Book3S always has 32 byte dcbz */
380 vcpu->arch.hflags |= BOOK3S_HFLAG_DCBZ32;
381#endif
Alexander Grafb83d4a92010-04-20 02:49:54 +0200382
383 /* On some CPUs we can execute paired single operations natively */
384 asm ( "mfpvr %0" : "=r"(host_pvr));
385 switch (host_pvr) {
386 case 0x00080200: /* lonestar 2.0 */
387 case 0x00088202: /* lonestar 2.2 */
388 case 0x70000100: /* gekko 1.0 */
389 case 0x00080100: /* gekko 2.0 */
390 case 0x00083203: /* gekko 2.3a */
391 case 0x00083213: /* gekko 2.3b */
392 case 0x00083204: /* gekko 2.4 */
393 case 0x00083214: /* gekko 2.4e (8SE) - retail HW2 */
394 case 0x00087200: /* broadway */
395 vcpu->arch.hflags |= BOOK3S_HFLAG_NATIVE_PS;
396 /* Enable HID2.PSE - in case we need it later */
397 mtspr(SPRN_HID2_GEKKO, mfspr(SPRN_HID2_GEKKO) | (1 << 29));
398 }
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000399}
400
401/* Book3s_32 CPUs always have 32 bytes cache line size, which Linux assumes. To
402 * make Book3s_32 Linux work on Book3s_64, we have to make sure we trap dcbz to
403 * emulate 32 bytes dcbz length.
404 *
405 * The Book3s_64 inventors also realized this case and implemented a special bit
406 * in the HID5 register, which is a hypervisor ressource. Thus we can't use it.
407 *
408 * My approach here is to patch the dcbz instruction on executing pages.
409 */
410static void kvmppc_patch_dcbz(struct kvm_vcpu *vcpu, struct kvmppc_pte *pte)
411{
Alexander Graf9fb244a2010-03-24 21:48:32 +0100412 struct page *hpage;
413 u64 hpage_offset;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000414 u32 *page;
415 int i;
416
Alexander Graf9fb244a2010-03-24 21:48:32 +0100417 hpage = gfn_to_page(vcpu->kvm, pte->raddr >> PAGE_SHIFT);
418 if (is_error_page(hpage))
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000419 return;
420
Alexander Graf9fb244a2010-03-24 21:48:32 +0100421 hpage_offset = pte->raddr & ~PAGE_MASK;
422 hpage_offset &= ~0xFFFULL;
423 hpage_offset /= 4;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000424
Alexander Graf9fb244a2010-03-24 21:48:32 +0100425 get_page(hpage);
426 page = kmap_atomic(hpage, KM_USER0);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000427
Alexander Graf9fb244a2010-03-24 21:48:32 +0100428 /* patch dcbz into reserved instruction, so we trap */
429 for (i=hpage_offset; i < hpage_offset + (HW_PAGE_SIZE / 4); i++)
430 if ((page[i] & 0xff0007ff) == INS_DCBZ)
431 page[i] &= 0xfffffff7;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000432
Alexander Graf9fb244a2010-03-24 21:48:32 +0100433 kunmap_atomic(page, KM_USER0);
434 put_page(hpage);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000435}
436
437static int kvmppc_xlate(struct kvm_vcpu *vcpu, ulong eaddr, bool data,
438 struct kvmppc_pte *pte)
439{
440 int relocated = (vcpu->arch.msr & (data ? MSR_DR : MSR_IR));
441 int r;
442
443 if (relocated) {
444 r = vcpu->arch.mmu.xlate(vcpu, eaddr, pte, data);
445 } else {
446 pte->eaddr = eaddr;
447 pte->raddr = eaddr & 0xffffffff;
Alexander Graf3eeafd72010-03-24 21:48:17 +0100448 pte->vpage = VSID_REAL | eaddr >> 12;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000449 pte->may_read = true;
450 pte->may_write = true;
451 pte->may_execute = true;
452 r = 0;
453 }
454
455 return r;
456}
457
458static hva_t kvmppc_bad_hva(void)
459{
460 return PAGE_OFFSET;
461}
462
463static hva_t kvmppc_pte_to_hva(struct kvm_vcpu *vcpu, struct kvmppc_pte *pte,
464 bool read)
465{
466 hva_t hpage;
467
468 if (read && !pte->may_read)
469 goto err;
470
471 if (!read && !pte->may_write)
472 goto err;
473
474 hpage = gfn_to_hva(vcpu->kvm, pte->raddr >> PAGE_SHIFT);
475 if (kvm_is_error_hva(hpage))
476 goto err;
477
478 return hpage | (pte->raddr & ~PAGE_MASK);
479err:
480 return kvmppc_bad_hva();
481}
482
Alexander Graf5467a972010-02-19 11:00:38 +0100483int kvmppc_st(struct kvm_vcpu *vcpu, ulong *eaddr, int size, void *ptr,
484 bool data)
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000485{
486 struct kvmppc_pte pte;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000487
488 vcpu->stat.st++;
489
Alexander Graf5467a972010-02-19 11:00:38 +0100490 if (kvmppc_xlate(vcpu, *eaddr, data, &pte))
Alexander Graf9fb244a2010-03-24 21:48:32 +0100491 return -ENOENT;
Alexander Graf5467a972010-02-19 11:00:38 +0100492
493 *eaddr = pte.raddr;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000494
Alexander Graf9fb244a2010-03-24 21:48:32 +0100495 if (!pte.may_write)
496 return -EPERM;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000497
Alexander Graf9fb244a2010-03-24 21:48:32 +0100498 if (kvm_write_guest(vcpu->kvm, pte.raddr, ptr, size))
499 return EMULATE_DO_MMIO;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000500
Alexander Graf5467a972010-02-19 11:00:38 +0100501 return EMULATE_DONE;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000502}
503
Alexander Graf5467a972010-02-19 11:00:38 +0100504int kvmppc_ld(struct kvm_vcpu *vcpu, ulong *eaddr, int size, void *ptr,
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000505 bool data)
506{
507 struct kvmppc_pte pte;
Alexander Graf5467a972010-02-19 11:00:38 +0100508 hva_t hva = *eaddr;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000509
510 vcpu->stat.ld++;
511
Alexander Graf5467a972010-02-19 11:00:38 +0100512 if (kvmppc_xlate(vcpu, *eaddr, data, &pte))
513 goto nopte;
514
515 *eaddr = pte.raddr;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000516
517 hva = kvmppc_pte_to_hva(vcpu, &pte, true);
518 if (kvm_is_error_hva(hva))
Alexander Graf5467a972010-02-19 11:00:38 +0100519 goto mmio;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000520
521 if (copy_from_user(ptr, (void __user *)hva, size)) {
522 printk(KERN_INFO "kvmppc_ld at 0x%lx failed\n", hva);
Alexander Graf5467a972010-02-19 11:00:38 +0100523 goto mmio;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000524 }
525
Alexander Graf5467a972010-02-19 11:00:38 +0100526 return EMULATE_DONE;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000527
Alexander Graf5467a972010-02-19 11:00:38 +0100528nopte:
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000529 return -ENOENT;
Alexander Graf5467a972010-02-19 11:00:38 +0100530mmio:
531 return EMULATE_DO_MMIO;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000532}
533
534static int kvmppc_visible_gfn(struct kvm_vcpu *vcpu, gfn_t gfn)
535{
536 return kvm_is_visible_gfn(vcpu->kvm, gfn);
537}
538
539int kvmppc_handle_pagefault(struct kvm_run *run, struct kvm_vcpu *vcpu,
540 ulong eaddr, int vec)
541{
542 bool data = (vec == BOOK3S_INTERRUPT_DATA_STORAGE);
543 int r = RESUME_GUEST;
544 int relocated;
545 int page_found = 0;
546 struct kvmppc_pte pte;
547 bool is_mmio = false;
Alexander Graf3eeafd72010-03-24 21:48:17 +0100548 bool dr = (vcpu->arch.msr & MSR_DR) ? true : false;
549 bool ir = (vcpu->arch.msr & MSR_IR) ? true : false;
Alexander Graff7bc74e2010-04-20 02:49:48 +0200550 u64 vsid;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000551
Alexander Graf3eeafd72010-03-24 21:48:17 +0100552 relocated = data ? dr : ir;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000553
554 /* Resolve real address if translation turned on */
555 if (relocated) {
556 page_found = vcpu->arch.mmu.xlate(vcpu, eaddr, &pte, data);
557 } else {
558 pte.may_execute = true;
559 pte.may_read = true;
560 pte.may_write = true;
561 pte.raddr = eaddr & 0xffffffff;
562 pte.eaddr = eaddr;
563 pte.vpage = eaddr >> 12;
Alexander Graf3eeafd72010-03-24 21:48:17 +0100564 }
565
566 switch (vcpu->arch.msr & (MSR_DR|MSR_IR)) {
567 case 0:
Alexander Graff7bc74e2010-04-20 02:49:48 +0200568 pte.vpage |= ((u64)VSID_REAL << (SID_SHIFT - 12));
Alexander Graf3eeafd72010-03-24 21:48:17 +0100569 break;
570 case MSR_DR:
Alexander Graf3eeafd72010-03-24 21:48:17 +0100571 case MSR_IR:
Alexander Graff7bc74e2010-04-20 02:49:48 +0200572 vcpu->arch.mmu.esid_to_vsid(vcpu, eaddr >> SID_SHIFT, &vsid);
573
574 if ((vcpu->arch.msr & (MSR_DR|MSR_IR)) == MSR_DR)
575 pte.vpage |= ((u64)VSID_REAL_DR << (SID_SHIFT - 12));
576 else
577 pte.vpage |= ((u64)VSID_REAL_IR << (SID_SHIFT - 12));
578 pte.vpage |= vsid;
579
580 if (vsid == -1)
581 page_found = -EINVAL;
Alexander Graf3eeafd72010-03-24 21:48:17 +0100582 break;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000583 }
584
585 if (vcpu->arch.mmu.is_dcbz32(vcpu) &&
586 (!(vcpu->arch.hflags & BOOK3S_HFLAG_DCBZ32))) {
587 /*
588 * If we do the dcbz hack, we have to NX on every execution,
589 * so we can patch the executing code. This renders our guest
590 * NX-less.
591 */
592 pte.may_execute = !data;
593 }
594
595 if (page_found == -ENOENT) {
596 /* Page not found in guest PTE entries */
Alexander Grafc7f38f42010-04-16 00:11:40 +0200597 vcpu->arch.dear = kvmppc_get_fault_dar(vcpu);
598 to_book3s(vcpu)->dsisr = to_svcpu(vcpu)->fault_dsisr;
599 vcpu->arch.msr |= (to_svcpu(vcpu)->shadow_srr1 & 0x00000000f8000000ULL);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000600 kvmppc_book3s_queue_irqprio(vcpu, vec);
601 } else if (page_found == -EPERM) {
602 /* Storage protection */
Alexander Grafc7f38f42010-04-16 00:11:40 +0200603 vcpu->arch.dear = kvmppc_get_fault_dar(vcpu);
604 to_book3s(vcpu)->dsisr = to_svcpu(vcpu)->fault_dsisr & ~DSISR_NOHPTE;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000605 to_book3s(vcpu)->dsisr |= DSISR_PROTFAULT;
Alexander Grafc7f38f42010-04-16 00:11:40 +0200606 vcpu->arch.msr |= (to_svcpu(vcpu)->shadow_srr1 & 0x00000000f8000000ULL);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000607 kvmppc_book3s_queue_irqprio(vcpu, vec);
608 } else if (page_found == -EINVAL) {
609 /* Page not found in guest SLB */
Alexander Grafc7f38f42010-04-16 00:11:40 +0200610 vcpu->arch.dear = kvmppc_get_fault_dar(vcpu);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000611 kvmppc_book3s_queue_irqprio(vcpu, vec + 0x80);
612 } else if (!is_mmio &&
613 kvmppc_visible_gfn(vcpu, pte.raddr >> PAGE_SHIFT)) {
614 /* The guest's PTE is not mapped yet. Map on the host */
615 kvmppc_mmu_map_page(vcpu, &pte);
616 if (data)
617 vcpu->stat.sp_storage++;
618 else if (vcpu->arch.mmu.is_dcbz32(vcpu) &&
619 (!(vcpu->arch.hflags & BOOK3S_HFLAG_DCBZ32)))
620 kvmppc_patch_dcbz(vcpu, &pte);
621 } else {
622 /* MMIO */
623 vcpu->stat.mmio_exits++;
624 vcpu->arch.paddr_accessed = pte.raddr;
625 r = kvmppc_emulate_mmio(run, vcpu);
626 if ( r == RESUME_HOST_NV )
627 r = RESUME_HOST;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000628 }
629
630 return r;
631}
632
Alexander Graf180a34d2010-01-15 14:49:11 +0100633static inline int get_fpr_index(int i)
634{
635#ifdef CONFIG_VSX
636 i *= 2;
637#endif
638 return i;
639}
640
641/* Give up external provider (FPU, Altivec, VSX) */
Alexander Grafaba3bd72010-02-19 11:00:39 +0100642void kvmppc_giveup_ext(struct kvm_vcpu *vcpu, ulong msr)
Alexander Graf180a34d2010-01-15 14:49:11 +0100643{
644 struct thread_struct *t = &current->thread;
645 u64 *vcpu_fpr = vcpu->arch.fpr;
Alexander Grafa2b07662010-03-24 21:48:31 +0100646#ifdef CONFIG_VSX
Alexander Graf180a34d2010-01-15 14:49:11 +0100647 u64 *vcpu_vsx = vcpu->arch.vsr;
Alexander Grafa2b07662010-03-24 21:48:31 +0100648#endif
Alexander Graf180a34d2010-01-15 14:49:11 +0100649 u64 *thread_fpr = (u64*)t->fpr;
650 int i;
651
652 if (!(vcpu->arch.guest_owned_ext & msr))
653 return;
654
655#ifdef DEBUG_EXT
656 printk(KERN_INFO "Giving up ext 0x%lx\n", msr);
657#endif
658
659 switch (msr) {
660 case MSR_FP:
661 giveup_fpu(current);
662 for (i = 0; i < ARRAY_SIZE(vcpu->arch.fpr); i++)
663 vcpu_fpr[i] = thread_fpr[get_fpr_index(i)];
664
665 vcpu->arch.fpscr = t->fpscr.val;
666 break;
667 case MSR_VEC:
668#ifdef CONFIG_ALTIVEC
669 giveup_altivec(current);
670 memcpy(vcpu->arch.vr, t->vr, sizeof(vcpu->arch.vr));
671 vcpu->arch.vscr = t->vscr;
672#endif
673 break;
674 case MSR_VSX:
675#ifdef CONFIG_VSX
676 __giveup_vsx(current);
677 for (i = 0; i < ARRAY_SIZE(vcpu->arch.vsr); i++)
678 vcpu_vsx[i] = thread_fpr[get_fpr_index(i) + 1];
679#endif
680 break;
681 default:
682 BUG();
683 }
684
685 vcpu->arch.guest_owned_ext &= ~msr;
686 current->thread.regs->msr &= ~msr;
Alexander Grafa76f8492010-01-15 14:49:14 +0100687 kvmppc_recalc_shadow_msr(vcpu);
Alexander Graf180a34d2010-01-15 14:49:11 +0100688}
689
Alexander Graf89632212010-03-24 21:48:21 +0100690static int kvmppc_read_inst(struct kvm_vcpu *vcpu)
Alexander Grafc8c0b6f2010-02-19 11:00:34 +0100691{
Alexander Grafc7f38f42010-04-16 00:11:40 +0200692 ulong srr0 = kvmppc_get_pc(vcpu);
693 u32 last_inst = kvmppc_get_last_inst(vcpu);
Alexander Grafc8c0b6f2010-02-19 11:00:34 +0100694 int ret;
695
Alexander Grafc7f38f42010-04-16 00:11:40 +0200696 ret = kvmppc_ld(vcpu, &srr0, sizeof(u32), &last_inst, false);
Alexander Grafc8c0b6f2010-02-19 11:00:34 +0100697 if (ret == -ENOENT) {
698 vcpu->arch.msr = kvmppc_set_field(vcpu->arch.msr, 33, 33, 1);
699 vcpu->arch.msr = kvmppc_set_field(vcpu->arch.msr, 34, 36, 0);
700 vcpu->arch.msr = kvmppc_set_field(vcpu->arch.msr, 42, 47, 0);
701 kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_INST_STORAGE);
Alexander Graf89632212010-03-24 21:48:21 +0100702 return EMULATE_AGAIN;
703 }
704
705 return EMULATE_DONE;
706}
707
708static int kvmppc_check_ext(struct kvm_vcpu *vcpu, unsigned int exit_nr)
709{
710
711 /* Need to do paired single emulation? */
712 if (!(vcpu->arch.hflags & BOOK3S_HFLAG_PAIRED_SINGLE))
713 return EMULATE_DONE;
714
715 /* Read out the instruction */
716 if (kvmppc_read_inst(vcpu) == EMULATE_DONE)
Alexander Grafc8c0b6f2010-02-19 11:00:34 +0100717 /* Need to emulate */
718 return EMULATE_FAIL;
Alexander Grafc8c0b6f2010-02-19 11:00:34 +0100719
720 return EMULATE_AGAIN;
721}
722
Alexander Graf180a34d2010-01-15 14:49:11 +0100723/* Handle external providers (FPU, Altivec, VSX) */
724static int kvmppc_handle_ext(struct kvm_vcpu *vcpu, unsigned int exit_nr,
725 ulong msr)
726{
727 struct thread_struct *t = &current->thread;
728 u64 *vcpu_fpr = vcpu->arch.fpr;
Alexander Grafa2b07662010-03-24 21:48:31 +0100729#ifdef CONFIG_VSX
Alexander Graf180a34d2010-01-15 14:49:11 +0100730 u64 *vcpu_vsx = vcpu->arch.vsr;
Alexander Grafa2b07662010-03-24 21:48:31 +0100731#endif
Alexander Graf180a34d2010-01-15 14:49:11 +0100732 u64 *thread_fpr = (u64*)t->fpr;
733 int i;
734
Alexander Graf3c402a72010-02-19 11:00:32 +0100735 /* When we have paired singles, we emulate in software */
736 if (vcpu->arch.hflags & BOOK3S_HFLAG_PAIRED_SINGLE)
737 return RESUME_GUEST;
738
Alexander Graf180a34d2010-01-15 14:49:11 +0100739 if (!(vcpu->arch.msr & msr)) {
740 kvmppc_book3s_queue_irqprio(vcpu, exit_nr);
741 return RESUME_GUEST;
742 }
743
Alexander Grafc2453692010-03-24 21:48:22 +0100744 /* We already own the ext */
745 if (vcpu->arch.guest_owned_ext & msr) {
746 return RESUME_GUEST;
747 }
748
Alexander Graf180a34d2010-01-15 14:49:11 +0100749#ifdef DEBUG_EXT
750 printk(KERN_INFO "Loading up ext 0x%lx\n", msr);
751#endif
752
753 current->thread.regs->msr |= msr;
754
755 switch (msr) {
756 case MSR_FP:
757 for (i = 0; i < ARRAY_SIZE(vcpu->arch.fpr); i++)
758 thread_fpr[get_fpr_index(i)] = vcpu_fpr[i];
759
760 t->fpscr.val = vcpu->arch.fpscr;
761 t->fpexc_mode = 0;
762 kvmppc_load_up_fpu();
763 break;
764 case MSR_VEC:
765#ifdef CONFIG_ALTIVEC
766 memcpy(t->vr, vcpu->arch.vr, sizeof(vcpu->arch.vr));
767 t->vscr = vcpu->arch.vscr;
768 t->vrsave = -1;
769 kvmppc_load_up_altivec();
770#endif
771 break;
772 case MSR_VSX:
773#ifdef CONFIG_VSX
774 for (i = 0; i < ARRAY_SIZE(vcpu->arch.vsr); i++)
775 thread_fpr[get_fpr_index(i) + 1] = vcpu_vsx[i];
776 kvmppc_load_up_vsx();
777#endif
778 break;
779 default:
780 BUG();
781 }
782
783 vcpu->arch.guest_owned_ext |= msr;
784
Alexander Grafa76f8492010-01-15 14:49:14 +0100785 kvmppc_recalc_shadow_msr(vcpu);
Alexander Graf180a34d2010-01-15 14:49:11 +0100786
787 return RESUME_GUEST;
788}
789
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000790int kvmppc_handle_exit(struct kvm_run *run, struct kvm_vcpu *vcpu,
791 unsigned int exit_nr)
792{
793 int r = RESUME_HOST;
794
795 vcpu->stat.sum_exits++;
796
797 run->exit_reason = KVM_EXIT_UNKNOWN;
798 run->ready_for_interrupt_injection = 1;
799#ifdef EXIT_DEBUG
800 printk(KERN_EMERG "exit_nr=0x%x | pc=0x%lx | dar=0x%lx | dec=0x%x | msr=0x%lx\n",
Alexander Grafc7f38f42010-04-16 00:11:40 +0200801 exit_nr, kvmppc_get_pc(vcpu), kvmppc_get_fault_dar(vcpu),
802 kvmppc_get_dec(vcpu), to_svcpu(vcpu)->shadow_srr1);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000803#elif defined (EXIT_DEBUG_SIMPLE)
804 if ((exit_nr != 0x900) && (exit_nr != 0x500))
805 printk(KERN_EMERG "exit_nr=0x%x | pc=0x%lx | dar=0x%lx | msr=0x%lx\n",
Alexander Grafc7f38f42010-04-16 00:11:40 +0200806 exit_nr, kvmppc_get_pc(vcpu), kvmppc_get_fault_dar(vcpu),
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000807 vcpu->arch.msr);
808#endif
809 kvm_resched(vcpu);
810 switch (exit_nr) {
811 case BOOK3S_INTERRUPT_INST_STORAGE:
812 vcpu->stat.pf_instruc++;
Alexander Graf61db97c2010-04-16 00:11:52 +0200813
814#ifdef CONFIG_PPC_BOOK3S_32
815 /* We set segments as unused segments when invalidating them. So
816 * treat the respective fault as segment fault. */
817 if (to_svcpu(vcpu)->sr[kvmppc_get_pc(vcpu) >> SID_SHIFT]
818 == SR_INVALID) {
819 kvmppc_mmu_map_segment(vcpu, kvmppc_get_pc(vcpu));
820 r = RESUME_GUEST;
821 break;
822 }
823#endif
824
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000825 /* only care about PTEG not found errors, but leave NX alone */
Alexander Grafc7f38f42010-04-16 00:11:40 +0200826 if (to_svcpu(vcpu)->shadow_srr1 & 0x40000000) {
827 r = kvmppc_handle_pagefault(run, vcpu, kvmppc_get_pc(vcpu), exit_nr);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000828 vcpu->stat.sp_instruc++;
829 } else if (vcpu->arch.mmu.is_dcbz32(vcpu) &&
830 (!(vcpu->arch.hflags & BOOK3S_HFLAG_DCBZ32))) {
831 /*
832 * XXX If we do the dcbz hack we use the NX bit to flush&patch the page,
833 * so we can't use the NX bit inside the guest. Let's cross our fingers,
834 * that no guest that needs the dcbz hack does NX.
835 */
Alexander Grafaf7b4d12010-04-20 02:49:46 +0200836 kvmppc_mmu_pte_flush(vcpu, kvmppc_get_pc(vcpu), ~0xFFFUL);
Alexander Graf9fb244a2010-03-24 21:48:32 +0100837 r = RESUME_GUEST;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000838 } else {
Alexander Grafc7f38f42010-04-16 00:11:40 +0200839 vcpu->arch.msr |= to_svcpu(vcpu)->shadow_srr1 & 0x58000000;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000840 kvmppc_book3s_queue_irqprio(vcpu, exit_nr);
Alexander Grafaf7b4d12010-04-20 02:49:46 +0200841 kvmppc_mmu_pte_flush(vcpu, kvmppc_get_pc(vcpu), ~0xFFFUL);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000842 r = RESUME_GUEST;
843 }
844 break;
845 case BOOK3S_INTERRUPT_DATA_STORAGE:
Alexander Grafc7f38f42010-04-16 00:11:40 +0200846 {
847 ulong dar = kvmppc_get_fault_dar(vcpu);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000848 vcpu->stat.pf_storage++;
Alexander Graf61db97c2010-04-16 00:11:52 +0200849
850#ifdef CONFIG_PPC_BOOK3S_32
851 /* We set segments as unused segments when invalidating them. So
852 * treat the respective fault as segment fault. */
853 if ((to_svcpu(vcpu)->sr[dar >> SID_SHIFT]) == SR_INVALID) {
854 kvmppc_mmu_map_segment(vcpu, dar);
855 r = RESUME_GUEST;
856 break;
857 }
858#endif
859
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000860 /* The only case we need to handle is missing shadow PTEs */
Alexander Grafc7f38f42010-04-16 00:11:40 +0200861 if (to_svcpu(vcpu)->fault_dsisr & DSISR_NOHPTE) {
862 r = kvmppc_handle_pagefault(run, vcpu, dar, exit_nr);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000863 } else {
Alexander Grafc7f38f42010-04-16 00:11:40 +0200864 vcpu->arch.dear = dar;
865 to_book3s(vcpu)->dsisr = to_svcpu(vcpu)->fault_dsisr;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000866 kvmppc_book3s_queue_irqprio(vcpu, exit_nr);
Alexander Grafaf7b4d12010-04-20 02:49:46 +0200867 kvmppc_mmu_pte_flush(vcpu, vcpu->arch.dear, ~0xFFFUL);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000868 r = RESUME_GUEST;
869 }
870 break;
Alexander Grafc7f38f42010-04-16 00:11:40 +0200871 }
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000872 case BOOK3S_INTERRUPT_DATA_SEGMENT:
Alexander Grafc7f38f42010-04-16 00:11:40 +0200873 if (kvmppc_mmu_map_segment(vcpu, kvmppc_get_fault_dar(vcpu)) < 0) {
874 vcpu->arch.dear = kvmppc_get_fault_dar(vcpu);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000875 kvmppc_book3s_queue_irqprio(vcpu,
876 BOOK3S_INTERRUPT_DATA_SEGMENT);
877 }
878 r = RESUME_GUEST;
879 break;
880 case BOOK3S_INTERRUPT_INST_SEGMENT:
Alexander Grafc7f38f42010-04-16 00:11:40 +0200881 if (kvmppc_mmu_map_segment(vcpu, kvmppc_get_pc(vcpu)) < 0) {
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000882 kvmppc_book3s_queue_irqprio(vcpu,
883 BOOK3S_INTERRUPT_INST_SEGMENT);
884 }
885 r = RESUME_GUEST;
886 break;
887 /* We're good on these - the host merely wanted to get our attention */
888 case BOOK3S_INTERRUPT_DECREMENTER:
889 vcpu->stat.dec_exits++;
890 r = RESUME_GUEST;
891 break;
892 case BOOK3S_INTERRUPT_EXTERNAL:
893 vcpu->stat.ext_intr_exits++;
894 r = RESUME_GUEST;
895 break;
Alexander Graf7fdaec92010-04-20 02:49:47 +0200896 case BOOK3S_INTERRUPT_PERFMON:
897 r = RESUME_GUEST;
898 break;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000899 case BOOK3S_INTERRUPT_PROGRAM:
900 {
901 enum emulation_result er;
Alexander Grafff1ca3f2010-01-08 02:58:09 +0100902 ulong flags;
903
Alexander Grafc8c0b6f2010-02-19 11:00:34 +0100904program_interrupt:
Alexander Grafc7f38f42010-04-16 00:11:40 +0200905 flags = to_svcpu(vcpu)->shadow_srr1 & 0x1f0000ull;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000906
907 if (vcpu->arch.msr & MSR_PR) {
908#ifdef EXIT_DEBUG
Alexander Grafc7f38f42010-04-16 00:11:40 +0200909 printk(KERN_INFO "Userspace triggered 0x700 exception at 0x%lx (0x%x)\n", kvmppc_get_pc(vcpu), kvmppc_get_last_inst(vcpu));
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000910#endif
Alexander Grafc7f38f42010-04-16 00:11:40 +0200911 if ((kvmppc_get_last_inst(vcpu) & 0xff0007ff) !=
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000912 (INS_DCBZ & 0xfffffff7)) {
Alexander Grafff1ca3f2010-01-08 02:58:09 +0100913 kvmppc_core_queue_program(vcpu, flags);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000914 r = RESUME_GUEST;
915 break;
916 }
917 }
918
919 vcpu->stat.emulated_inst_exits++;
920 er = kvmppc_emulate_instruction(run, vcpu);
921 switch (er) {
922 case EMULATE_DONE:
Alexander Graf97c4cfb2010-01-04 22:19:25 +0100923 r = RESUME_GUEST_NV;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000924 break;
Alexander Graf37f5bca2010-02-19 11:00:31 +0100925 case EMULATE_AGAIN:
926 r = RESUME_GUEST;
927 break;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000928 case EMULATE_FAIL:
929 printk(KERN_CRIT "%s: emulation at %lx failed (%08x)\n",
Alexander Grafc7f38f42010-04-16 00:11:40 +0200930 __func__, kvmppc_get_pc(vcpu), kvmppc_get_last_inst(vcpu));
Alexander Grafff1ca3f2010-01-08 02:58:09 +0100931 kvmppc_core_queue_program(vcpu, flags);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000932 r = RESUME_GUEST;
933 break;
Alexander Grafe5c29e92010-02-19 11:00:43 +0100934 case EMULATE_DO_MMIO:
935 run->exit_reason = KVM_EXIT_MMIO;
936 r = RESUME_HOST_NV;
937 break;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000938 default:
939 BUG();
940 }
941 break;
942 }
943 case BOOK3S_INTERRUPT_SYSCALL:
Alexander Grafad0a0482010-03-24 21:48:30 +0100944 // XXX make user settable
945 if (vcpu->arch.osi_enabled &&
946 (((u32)kvmppc_get_gpr(vcpu, 3)) == OSI_SC_MAGIC_R3) &&
947 (((u32)kvmppc_get_gpr(vcpu, 4)) == OSI_SC_MAGIC_R4)) {
948 u64 *gprs = run->osi.gprs;
949 int i;
950
951 run->exit_reason = KVM_EXIT_OSI;
952 for (i = 0; i < 32; i++)
953 gprs[i] = kvmppc_get_gpr(vcpu, i);
954 vcpu->arch.osi_needed = 1;
955 r = RESUME_HOST_NV;
956
957 } else {
958 vcpu->stat.syscall_exits++;
959 kvmppc_book3s_queue_irqprio(vcpu, exit_nr);
960 r = RESUME_GUEST;
961 }
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000962 break;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000963 case BOOK3S_INTERRUPT_FP_UNAVAIL:
Alexander Graf2f4cf5e2009-10-30 05:47:10 +0000964 case BOOK3S_INTERRUPT_ALTIVEC:
965 case BOOK3S_INTERRUPT_VSX:
Alexander Grafc8c0b6f2010-02-19 11:00:34 +0100966 {
967 int ext_msr = 0;
968
969 switch (exit_nr) {
970 case BOOK3S_INTERRUPT_FP_UNAVAIL: ext_msr = MSR_FP; break;
971 case BOOK3S_INTERRUPT_ALTIVEC: ext_msr = MSR_VEC; break;
972 case BOOK3S_INTERRUPT_VSX: ext_msr = MSR_VSX; break;
973 }
974
975 switch (kvmppc_check_ext(vcpu, exit_nr)) {
976 case EMULATE_DONE:
977 /* everything ok - let's enable the ext */
978 r = kvmppc_handle_ext(vcpu, exit_nr, ext_msr);
979 break;
980 case EMULATE_FAIL:
981 /* we need to emulate this instruction */
982 goto program_interrupt;
983 break;
984 default:
985 /* nothing to worry about - go again */
986 break;
987 }
Alexander Graf180a34d2010-01-15 14:49:11 +0100988 break;
Alexander Grafc8c0b6f2010-02-19 11:00:34 +0100989 }
Alexander Grafca7f4202010-03-24 21:48:28 +0100990 case BOOK3S_INTERRUPT_ALIGNMENT:
991 if (kvmppc_read_inst(vcpu) == EMULATE_DONE) {
992 to_book3s(vcpu)->dsisr = kvmppc_alignment_dsisr(vcpu,
Alexander Grafc7f38f42010-04-16 00:11:40 +0200993 kvmppc_get_last_inst(vcpu));
Alexander Grafca7f4202010-03-24 21:48:28 +0100994 vcpu->arch.dear = kvmppc_alignment_dar(vcpu,
Alexander Grafc7f38f42010-04-16 00:11:40 +0200995 kvmppc_get_last_inst(vcpu));
Alexander Grafca7f4202010-03-24 21:48:28 +0100996 kvmppc_book3s_queue_irqprio(vcpu, exit_nr);
997 }
998 r = RESUME_GUEST;
999 break;
Alexander Graf180a34d2010-01-15 14:49:11 +01001000 case BOOK3S_INTERRUPT_MACHINE_CHECK:
1001 case BOOK3S_INTERRUPT_TRACE:
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001002 kvmppc_book3s_queue_irqprio(vcpu, exit_nr);
1003 r = RESUME_GUEST;
1004 break;
1005 default:
1006 /* Ugh - bork here! What did we get? */
Alexander Graff7adbba2010-01-15 14:49:13 +01001007 printk(KERN_EMERG "exit_nr=0x%x | pc=0x%lx | msr=0x%lx\n",
Alexander Grafc7f38f42010-04-16 00:11:40 +02001008 exit_nr, kvmppc_get_pc(vcpu), to_svcpu(vcpu)->shadow_srr1);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001009 r = RESUME_HOST;
1010 BUG();
1011 break;
1012 }
1013
1014
1015 if (!(r & RESUME_HOST)) {
1016 /* To avoid clobbering exit_reason, only check for signals if
1017 * we aren't already exiting to userspace for some other
1018 * reason. */
1019 if (signal_pending(current)) {
1020#ifdef EXIT_DEBUG
1021 printk(KERN_EMERG "KVM: Going back to host\n");
1022#endif
1023 vcpu->stat.signal_exits++;
1024 run->exit_reason = KVM_EXIT_INTR;
1025 r = -EINTR;
1026 } else {
1027 /* In case an interrupt came in that was triggered
1028 * from userspace (like DEC), we need to check what
1029 * to inject now! */
1030 kvmppc_core_deliver_interrupts(vcpu);
1031 }
1032 }
1033
1034#ifdef EXIT_DEBUG
Alexander Grafc7f38f42010-04-16 00:11:40 +02001035 printk(KERN_EMERG "KVM exit: vcpu=0x%p pc=0x%lx r=0x%x\n", vcpu, kvmppc_get_pc(vcpu), r);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001036#endif
1037
1038 return r;
1039}
1040
1041int kvm_arch_vcpu_setup(struct kvm_vcpu *vcpu)
1042{
1043 return 0;
1044}
1045
1046int kvm_arch_vcpu_ioctl_get_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
1047{
1048 int i;
1049
Alexander Grafa56cf342010-03-24 21:48:23 +01001050 vcpu_load(vcpu);
1051
Alexander Grafc7f38f42010-04-16 00:11:40 +02001052 regs->pc = kvmppc_get_pc(vcpu);
Alexander Graf992b5b22010-01-08 02:58:02 +01001053 regs->cr = kvmppc_get_cr(vcpu);
Alexander Grafc7f38f42010-04-16 00:11:40 +02001054 regs->ctr = kvmppc_get_ctr(vcpu);
1055 regs->lr = kvmppc_get_lr(vcpu);
Alexander Graf992b5b22010-01-08 02:58:02 +01001056 regs->xer = kvmppc_get_xer(vcpu);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001057 regs->msr = vcpu->arch.msr;
1058 regs->srr0 = vcpu->arch.srr0;
1059 regs->srr1 = vcpu->arch.srr1;
1060 regs->pid = vcpu->arch.pid;
1061 regs->sprg0 = vcpu->arch.sprg0;
1062 regs->sprg1 = vcpu->arch.sprg1;
1063 regs->sprg2 = vcpu->arch.sprg2;
1064 regs->sprg3 = vcpu->arch.sprg3;
1065 regs->sprg5 = vcpu->arch.sprg4;
1066 regs->sprg6 = vcpu->arch.sprg5;
1067 regs->sprg7 = vcpu->arch.sprg6;
1068
1069 for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
Alexander Graf8e5b26b2010-01-08 02:58:01 +01001070 regs->gpr[i] = kvmppc_get_gpr(vcpu, i);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001071
Alexander Grafa56cf342010-03-24 21:48:23 +01001072 vcpu_put(vcpu);
1073
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001074 return 0;
1075}
1076
1077int kvm_arch_vcpu_ioctl_set_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
1078{
1079 int i;
1080
Alexander Grafa56cf342010-03-24 21:48:23 +01001081 vcpu_load(vcpu);
1082
Alexander Grafc7f38f42010-04-16 00:11:40 +02001083 kvmppc_set_pc(vcpu, regs->pc);
Alexander Graf992b5b22010-01-08 02:58:02 +01001084 kvmppc_set_cr(vcpu, regs->cr);
Alexander Grafc7f38f42010-04-16 00:11:40 +02001085 kvmppc_set_ctr(vcpu, regs->ctr);
1086 kvmppc_set_lr(vcpu, regs->lr);
Alexander Graf992b5b22010-01-08 02:58:02 +01001087 kvmppc_set_xer(vcpu, regs->xer);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001088 kvmppc_set_msr(vcpu, regs->msr);
1089 vcpu->arch.srr0 = regs->srr0;
1090 vcpu->arch.srr1 = regs->srr1;
1091 vcpu->arch.sprg0 = regs->sprg0;
1092 vcpu->arch.sprg1 = regs->sprg1;
1093 vcpu->arch.sprg2 = regs->sprg2;
1094 vcpu->arch.sprg3 = regs->sprg3;
1095 vcpu->arch.sprg5 = regs->sprg4;
1096 vcpu->arch.sprg6 = regs->sprg5;
1097 vcpu->arch.sprg7 = regs->sprg6;
1098
Alexander Graf8e5b26b2010-01-08 02:58:01 +01001099 for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
1100 kvmppc_set_gpr(vcpu, i, regs->gpr[i]);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001101
Alexander Grafa56cf342010-03-24 21:48:23 +01001102 vcpu_put(vcpu);
1103
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001104 return 0;
1105}
1106
1107int kvm_arch_vcpu_ioctl_get_sregs(struct kvm_vcpu *vcpu,
1108 struct kvm_sregs *sregs)
1109{
Alexander Grafe15a1132009-11-30 03:02:02 +00001110 struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
1111 int i;
1112
Avi Kivity98001d82010-05-13 11:05:49 +03001113 vcpu_load(vcpu);
1114
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001115 sregs->pvr = vcpu->arch.pvr;
Alexander Grafe15a1132009-11-30 03:02:02 +00001116
1117 sregs->u.s.sdr1 = to_book3s(vcpu)->sdr1;
1118 if (vcpu->arch.hflags & BOOK3S_HFLAG_SLB) {
1119 for (i = 0; i < 64; i++) {
1120 sregs->u.s.ppc64.slb[i].slbe = vcpu3s->slb[i].orige | i;
1121 sregs->u.s.ppc64.slb[i].slbv = vcpu3s->slb[i].origv;
1122 }
1123 } else {
1124 for (i = 0; i < 16; i++) {
1125 sregs->u.s.ppc32.sr[i] = vcpu3s->sr[i].raw;
1126 sregs->u.s.ppc32.sr[i] = vcpu3s->sr[i].raw;
1127 }
1128 for (i = 0; i < 8; i++) {
1129 sregs->u.s.ppc32.ibat[i] = vcpu3s->ibat[i].raw;
1130 sregs->u.s.ppc32.dbat[i] = vcpu3s->dbat[i].raw;
1131 }
1132 }
Avi Kivity98001d82010-05-13 11:05:49 +03001133
1134 vcpu_put(vcpu);
1135
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001136 return 0;
1137}
1138
1139int kvm_arch_vcpu_ioctl_set_sregs(struct kvm_vcpu *vcpu,
1140 struct kvm_sregs *sregs)
1141{
Alexander Grafe15a1132009-11-30 03:02:02 +00001142 struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
1143 int i;
1144
Avi Kivity98001d82010-05-13 11:05:49 +03001145 vcpu_load(vcpu);
1146
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001147 kvmppc_set_pvr(vcpu, sregs->pvr);
Alexander Grafe15a1132009-11-30 03:02:02 +00001148
1149 vcpu3s->sdr1 = sregs->u.s.sdr1;
1150 if (vcpu->arch.hflags & BOOK3S_HFLAG_SLB) {
1151 for (i = 0; i < 64; i++) {
1152 vcpu->arch.mmu.slbmte(vcpu, sregs->u.s.ppc64.slb[i].slbv,
1153 sregs->u.s.ppc64.slb[i].slbe);
1154 }
1155 } else {
1156 for (i = 0; i < 16; i++) {
1157 vcpu->arch.mmu.mtsrin(vcpu, i, sregs->u.s.ppc32.sr[i]);
1158 }
1159 for (i = 0; i < 8; i++) {
1160 kvmppc_set_bat(vcpu, &(vcpu3s->ibat[i]), false,
1161 (u32)sregs->u.s.ppc32.ibat[i]);
1162 kvmppc_set_bat(vcpu, &(vcpu3s->ibat[i]), true,
1163 (u32)(sregs->u.s.ppc32.ibat[i] >> 32));
1164 kvmppc_set_bat(vcpu, &(vcpu3s->dbat[i]), false,
1165 (u32)sregs->u.s.ppc32.dbat[i]);
1166 kvmppc_set_bat(vcpu, &(vcpu3s->dbat[i]), true,
1167 (u32)(sregs->u.s.ppc32.dbat[i] >> 32));
1168 }
1169 }
1170
1171 /* Flush the MMU after messing with the segments */
1172 kvmppc_mmu_pte_flush(vcpu, 0, 0);
Avi Kivity98001d82010-05-13 11:05:49 +03001173
1174 vcpu_put(vcpu);
1175
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001176 return 0;
1177}
1178
1179int kvm_arch_vcpu_ioctl_get_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu)
1180{
1181 return -ENOTSUPP;
1182}
1183
1184int kvm_arch_vcpu_ioctl_set_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu)
1185{
1186 return -ENOTSUPP;
1187}
1188
1189int kvm_arch_vcpu_ioctl_translate(struct kvm_vcpu *vcpu,
1190 struct kvm_translation *tr)
1191{
1192 return 0;
1193}
1194
1195/*
1196 * Get (and clear) the dirty memory log for a memory slot.
1197 */
1198int kvm_vm_ioctl_get_dirty_log(struct kvm *kvm,
1199 struct kvm_dirty_log *log)
1200{
1201 struct kvm_memory_slot *memslot;
1202 struct kvm_vcpu *vcpu;
1203 ulong ga, ga_end;
1204 int is_dirty = 0;
Takuya Yoshikawa87bf6e72010-04-12 19:35:35 +09001205 int r;
1206 unsigned long n;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001207
Marcelo Tosatti79fac952009-12-23 14:35:26 -02001208 mutex_lock(&kvm->slots_lock);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001209
1210 r = kvm_get_dirty_log(kvm, log, &is_dirty);
1211 if (r)
1212 goto out;
1213
1214 /* If nothing is dirty, don't bother messing with page tables. */
1215 if (is_dirty) {
Marcelo Tosatti46a26bf2009-12-23 14:35:16 -02001216 memslot = &kvm->memslots->memslots[log->slot];
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001217
1218 ga = memslot->base_gfn << PAGE_SHIFT;
1219 ga_end = ga + (memslot->npages << PAGE_SHIFT);
1220
1221 kvm_for_each_vcpu(n, vcpu, kvm)
1222 kvmppc_mmu_pte_pflush(vcpu, ga, ga_end);
1223
Takuya Yoshikawa87bf6e72010-04-12 19:35:35 +09001224 n = kvm_dirty_bitmap_bytes(memslot);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001225 memset(memslot->dirty_bitmap, 0, n);
1226 }
1227
1228 r = 0;
1229out:
Marcelo Tosatti79fac952009-12-23 14:35:26 -02001230 mutex_unlock(&kvm->slots_lock);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001231 return r;
1232}
1233
1234int kvmppc_core_check_processor_compat(void)
1235{
1236 return 0;
1237}
1238
1239struct kvm_vcpu *kvmppc_core_vcpu_create(struct kvm *kvm, unsigned int id)
1240{
1241 struct kvmppc_vcpu_book3s *vcpu_book3s;
1242 struct kvm_vcpu *vcpu;
Alexander Grafc7f38f42010-04-16 00:11:40 +02001243 int err = -ENOMEM;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001244
Alexander Graf032c3402010-02-19 12:24:33 +01001245 vcpu_book3s = vmalloc(sizeof(struct kvmppc_vcpu_book3s));
Alexander Grafc7f38f42010-04-16 00:11:40 +02001246 if (!vcpu_book3s)
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001247 goto out;
Alexander Grafc7f38f42010-04-16 00:11:40 +02001248
Alexander Graf7e821d32010-02-22 16:52:08 +01001249 memset(vcpu_book3s, 0, sizeof(struct kvmppc_vcpu_book3s));
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001250
Alexander Grafc7f38f42010-04-16 00:11:40 +02001251 vcpu_book3s->shadow_vcpu = (struct kvmppc_book3s_shadow_vcpu *)
1252 kzalloc(sizeof(*vcpu_book3s->shadow_vcpu), GFP_KERNEL);
1253 if (!vcpu_book3s->shadow_vcpu)
1254 goto free_vcpu;
1255
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001256 vcpu = &vcpu_book3s->vcpu;
1257 err = kvm_vcpu_init(vcpu, kvm, id);
1258 if (err)
Alexander Grafc7f38f42010-04-16 00:11:40 +02001259 goto free_shadow_vcpu;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001260
1261 vcpu->arch.host_retip = kvm_return_point;
1262 vcpu->arch.host_msr = mfmsr();
Alexander Graf07b09072010-04-16 00:11:53 +02001263#ifdef CONFIG_PPC_BOOK3S_64
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001264 /* default to book3s_64 (970fx) */
1265 vcpu->arch.pvr = 0x3C0301;
Alexander Graf07b09072010-04-16 00:11:53 +02001266#else
1267 /* default to book3s_32 (750) */
1268 vcpu->arch.pvr = 0x84202;
1269#endif
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001270 kvmppc_set_pvr(vcpu, vcpu->arch.pvr);
1271 vcpu_book3s->slb_nr = 64;
1272
1273 /* remember where some real-mode handlers are */
1274 vcpu->arch.trampoline_lowmem = kvmppc_trampoline_lowmem;
1275 vcpu->arch.trampoline_enter = kvmppc_trampoline_enter;
1276 vcpu->arch.highmem_handler = (ulong)kvmppc_handler_highmem;
Alexander Graf07b09072010-04-16 00:11:53 +02001277#ifdef CONFIG_PPC_BOOK3S_64
Alexander Graf021ec9c2010-01-08 02:58:06 +01001278 vcpu->arch.rmcall = *(ulong*)kvmppc_rmcall;
Alexander Graf07b09072010-04-16 00:11:53 +02001279#else
1280 vcpu->arch.rmcall = (ulong)kvmppc_rmcall;
1281#endif
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001282
1283 vcpu->arch.shadow_msr = MSR_USER64;
1284
Alexander Graf9cc5e952010-04-16 00:11:45 +02001285 err = kvmppc_mmu_init(vcpu);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001286 if (err < 0)
Alexander Grafc7f38f42010-04-16 00:11:40 +02001287 goto free_shadow_vcpu;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001288
1289 return vcpu;
1290
Alexander Grafc7f38f42010-04-16 00:11:40 +02001291free_shadow_vcpu:
1292 kfree(vcpu_book3s->shadow_vcpu);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001293free_vcpu:
Alexander Graf032c3402010-02-19 12:24:33 +01001294 vfree(vcpu_book3s);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001295out:
1296 return ERR_PTR(err);
1297}
1298
1299void kvmppc_core_vcpu_free(struct kvm_vcpu *vcpu)
1300{
1301 struct kvmppc_vcpu_book3s *vcpu_book3s = to_book3s(vcpu);
1302
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001303 kvm_vcpu_uninit(vcpu);
Alexander Grafc7f38f42010-04-16 00:11:40 +02001304 kfree(vcpu_book3s->shadow_vcpu);
Alexander Graf032c3402010-02-19 12:24:33 +01001305 vfree(vcpu_book3s);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001306}
1307
1308extern int __kvmppc_vcpu_entry(struct kvm_run *kvm_run, struct kvm_vcpu *vcpu);
1309int __kvmppc_vcpu_run(struct kvm_run *kvm_run, struct kvm_vcpu *vcpu)
1310{
1311 int ret;
Alexander Graf180a34d2010-01-15 14:49:11 +01001312 struct thread_struct ext_bkp;
Alexander Grafa2b07662010-03-24 21:48:31 +01001313#ifdef CONFIG_ALTIVEC
Alexander Graf180a34d2010-01-15 14:49:11 +01001314 bool save_vec = current->thread.used_vr;
Alexander Grafa2b07662010-03-24 21:48:31 +01001315#endif
1316#ifdef CONFIG_VSX
Alexander Graf180a34d2010-01-15 14:49:11 +01001317 bool save_vsx = current->thread.used_vsr;
Alexander Grafa2b07662010-03-24 21:48:31 +01001318#endif
Alexander Graf180a34d2010-01-15 14:49:11 +01001319 ulong ext_msr;
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001320
1321 /* No need to go into the guest when all we do is going out */
1322 if (signal_pending(current)) {
1323 kvm_run->exit_reason = KVM_EXIT_INTR;
1324 return -EINTR;
1325 }
1326
Alexander Graf180a34d2010-01-15 14:49:11 +01001327 /* Save FPU state in stack */
1328 if (current->thread.regs->msr & MSR_FP)
1329 giveup_fpu(current);
1330 memcpy(ext_bkp.fpr, current->thread.fpr, sizeof(current->thread.fpr));
1331 ext_bkp.fpscr = current->thread.fpscr;
1332 ext_bkp.fpexc_mode = current->thread.fpexc_mode;
1333
1334#ifdef CONFIG_ALTIVEC
1335 /* Save Altivec state in stack */
1336 if (save_vec) {
1337 if (current->thread.regs->msr & MSR_VEC)
1338 giveup_altivec(current);
1339 memcpy(ext_bkp.vr, current->thread.vr, sizeof(ext_bkp.vr));
1340 ext_bkp.vscr = current->thread.vscr;
1341 ext_bkp.vrsave = current->thread.vrsave;
1342 }
1343 ext_bkp.used_vr = current->thread.used_vr;
1344#endif
1345
1346#ifdef CONFIG_VSX
1347 /* Save VSX state in stack */
1348 if (save_vsx && (current->thread.regs->msr & MSR_VSX))
1349 __giveup_vsx(current);
1350 ext_bkp.used_vsr = current->thread.used_vsr;
1351#endif
1352
1353 /* Remember the MSR with disabled extensions */
1354 ext_msr = current->thread.regs->msr;
1355
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001356 /* XXX we get called with irq disabled - change that! */
1357 local_irq_enable();
1358
Alexander Grafd1bab742010-02-19 11:00:35 +01001359 /* Preload FPU if it's enabled */
1360 if (vcpu->arch.msr & MSR_FP)
1361 kvmppc_handle_ext(vcpu, BOOK3S_INTERRUPT_FP_UNAVAIL, MSR_FP);
1362
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001363 ret = __kvmppc_vcpu_entry(kvm_run, vcpu);
1364
1365 local_irq_disable();
1366
Alexander Graf180a34d2010-01-15 14:49:11 +01001367 current->thread.regs->msr = ext_msr;
1368
1369 /* Make sure we save the guest FPU/Altivec/VSX state */
1370 kvmppc_giveup_ext(vcpu, MSR_FP);
1371 kvmppc_giveup_ext(vcpu, MSR_VEC);
1372 kvmppc_giveup_ext(vcpu, MSR_VSX);
1373
1374 /* Restore FPU state from stack */
1375 memcpy(current->thread.fpr, ext_bkp.fpr, sizeof(ext_bkp.fpr));
1376 current->thread.fpscr = ext_bkp.fpscr;
1377 current->thread.fpexc_mode = ext_bkp.fpexc_mode;
1378
1379#ifdef CONFIG_ALTIVEC
1380 /* Restore Altivec state from stack */
1381 if (save_vec && current->thread.used_vr) {
1382 memcpy(current->thread.vr, ext_bkp.vr, sizeof(ext_bkp.vr));
1383 current->thread.vscr = ext_bkp.vscr;
1384 current->thread.vrsave= ext_bkp.vrsave;
1385 }
1386 current->thread.used_vr = ext_bkp.used_vr;
1387#endif
1388
1389#ifdef CONFIG_VSX
1390 current->thread.used_vsr = ext_bkp.used_vsr;
1391#endif
1392
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001393 return ret;
1394}
1395
1396static int kvmppc_book3s_init(void)
1397{
Avi Kivity0ee75be2010-04-28 15:39:01 +03001398 return kvm_init(NULL, sizeof(struct kvmppc_vcpu_book3s), 0,
1399 THIS_MODULE);
Alexander Graf2f4cf5e2009-10-30 05:47:10 +00001400}
1401
1402static void kvmppc_book3s_exit(void)
1403{
1404 kvm_exit();
1405}
1406
1407module_init(kvmppc_book3s_init);
1408module_exit(kvmppc_book3s_exit);