Commit | Line | Data |
---|---|---|
2f4cf5e4 AG |
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> | |
329d20ba | 19 | #include <linux/slab.h> |
bed1ed98 | 20 | #include "trace.h" |
2f4cf5e4 AG |
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> | |
149dbdb1 | 31 | #include <asm/page.h> |
5a0e3ad6 | 32 | #include <linux/gfp.h> |
2f4cf5e4 AG |
33 | #include <linux/sched.h> |
34 | #include <linux/vmalloc.h> | |
9fb244a2 | 35 | #include <linux/highmem.h> |
2f4cf5e4 AG |
36 | |
37 | #define VCPU_STAT(x) offsetof(struct kvm_vcpu, stat.x), KVM_STAT_VCPU | |
38 | ||
39 | /* #define EXIT_DEBUG */ | |
180a34d2 AG |
40 | /* #define DEBUG_EXT */ |
41 | ||
c8c0b6f2 AG |
42 | static int kvmppc_handle_ext(struct kvm_vcpu *vcpu, unsigned int exit_nr, |
43 | ulong msr); | |
2f4cf5e4 | 44 | |
07b0907d AG |
45 | /* Some compatibility defines */ |
46 | #ifdef CONFIG_PPC_BOOK3S_32 | |
47 | #define MSR_USER32 MSR_USER | |
48 | #define MSR_USER64 MSR_USER | |
49 | #define HW_PAGE_SIZE PAGE_SIZE | |
50 | #endif | |
51 | ||
2f4cf5e4 AG |
52 | struct kvm_stats_debugfs_item debugfs_entries[] = { |
53 | { "exits", VCPU_STAT(sum_exits) }, | |
54 | { "mmio", VCPU_STAT(mmio_exits) }, | |
55 | { "sig", VCPU_STAT(signal_exits) }, | |
56 | { "sysc", VCPU_STAT(syscall_exits) }, | |
57 | { "inst_emu", VCPU_STAT(emulated_inst_exits) }, | |
58 | { "dec", VCPU_STAT(dec_exits) }, | |
59 | { "ext_intr", VCPU_STAT(ext_intr_exits) }, | |
60 | { "queue_intr", VCPU_STAT(queue_intr) }, | |
61 | { "halt_wakeup", VCPU_STAT(halt_wakeup) }, | |
62 | { "pf_storage", VCPU_STAT(pf_storage) }, | |
63 | { "sp_storage", VCPU_STAT(sp_storage) }, | |
64 | { "pf_instruc", VCPU_STAT(pf_instruc) }, | |
65 | { "sp_instruc", VCPU_STAT(sp_instruc) }, | |
66 | { "ld", VCPU_STAT(ld) }, | |
67 | { "ld_slow", VCPU_STAT(ld_slow) }, | |
68 | { "st", VCPU_STAT(st) }, | |
69 | { "st_slow", VCPU_STAT(st_slow) }, | |
70 | { NULL } | |
71 | }; | |
72 | ||
73 | void kvmppc_core_load_host_debugstate(struct kvm_vcpu *vcpu) | |
74 | { | |
75 | } | |
76 | ||
77 | void kvmppc_core_load_guest_debugstate(struct kvm_vcpu *vcpu) | |
78 | { | |
79 | } | |
80 | ||
81 | void kvmppc_core_vcpu_load(struct kvm_vcpu *vcpu, int cpu) | |
82 | { | |
c7f38f46 AG |
83 | #ifdef CONFIG_PPC_BOOK3S_64 |
84 | memcpy(to_svcpu(vcpu)->slb, to_book3s(vcpu)->slb_shadow, sizeof(to_svcpu(vcpu)->slb)); | |
85 | memcpy(&get_paca()->shadow_vcpu, to_book3s(vcpu)->shadow_vcpu, | |
7e57cba0 | 86 | sizeof(get_paca()->shadow_vcpu)); |
c7f38f46 AG |
87 | to_svcpu(vcpu)->slb_max = to_book3s(vcpu)->slb_shadow_max; |
88 | #endif | |
89 | ||
90 | #ifdef CONFIG_PPC_BOOK3S_32 | |
91 | current->thread.kvm_shadow_vcpu = to_book3s(vcpu)->shadow_vcpu; | |
92 | #endif | |
2f4cf5e4 AG |
93 | } |
94 | ||
95 | void kvmppc_core_vcpu_put(struct kvm_vcpu *vcpu) | |
96 | { | |
c7f38f46 AG |
97 | #ifdef CONFIG_PPC_BOOK3S_64 |
98 | memcpy(to_book3s(vcpu)->slb_shadow, to_svcpu(vcpu)->slb, sizeof(to_svcpu(vcpu)->slb)); | |
99 | memcpy(to_book3s(vcpu)->shadow_vcpu, &get_paca()->shadow_vcpu, | |
7e57cba0 | 100 | sizeof(get_paca()->shadow_vcpu)); |
c7f38f46 AG |
101 | to_book3s(vcpu)->slb_shadow_max = to_svcpu(vcpu)->slb_max; |
102 | #endif | |
180a34d2 AG |
103 | |
104 | kvmppc_giveup_ext(vcpu, MSR_FP); | |
105 | kvmppc_giveup_ext(vcpu, MSR_VEC); | |
106 | kvmppc_giveup_ext(vcpu, MSR_VSX); | |
2f4cf5e4 AG |
107 | } |
108 | ||
a76f8497 AG |
109 | static void kvmppc_recalc_shadow_msr(struct kvm_vcpu *vcpu) |
110 | { | |
666e7252 AG |
111 | ulong smsr = vcpu->arch.shared->msr; |
112 | ||
a76f8497 | 113 | /* Guest MSR values */ |
666e7252 | 114 | smsr &= MSR_FE0 | MSR_FE1 | MSR_SF | MSR_SE | MSR_BE | MSR_DE; |
a76f8497 | 115 | /* Process MSR values */ |
666e7252 | 116 | smsr |= MSR_ME | MSR_RI | MSR_IR | MSR_DR | MSR_PR | MSR_EE; |
a76f8497 | 117 | /* External providers the guest reserved */ |
666e7252 | 118 | smsr |= (vcpu->arch.shared->msr & vcpu->arch.guest_owned_ext); |
a76f8497 AG |
119 | /* 64-bit Process MSR values */ |
120 | #ifdef CONFIG_PPC_BOOK3S_64 | |
666e7252 | 121 | smsr |= MSR_ISF | MSR_HV; |
a76f8497 | 122 | #endif |
666e7252 | 123 | vcpu->arch.shadow_msr = smsr; |
a76f8497 AG |
124 | } |
125 | ||
2f4cf5e4 AG |
126 | void kvmppc_set_msr(struct kvm_vcpu *vcpu, u64 msr) |
127 | { | |
666e7252 | 128 | ulong old_msr = vcpu->arch.shared->msr; |
2f4cf5e4 AG |
129 | |
130 | #ifdef EXIT_DEBUG | |
131 | printk(KERN_INFO "KVM: Set MSR to 0x%llx\n", msr); | |
132 | #endif | |
a76f8497 | 133 | |
2f4cf5e4 | 134 | msr &= to_book3s(vcpu)->msr_mask; |
666e7252 | 135 | vcpu->arch.shared->msr = msr; |
a76f8497 | 136 | kvmppc_recalc_shadow_msr(vcpu); |
2f4cf5e4 | 137 | |
296c19d0 | 138 | if (msr & MSR_POW) { |
2f4cf5e4 AG |
139 | if (!vcpu->arch.pending_exceptions) { |
140 | kvm_vcpu_block(vcpu); | |
141 | vcpu->stat.halt_wakeup++; | |
296c19d0 AG |
142 | |
143 | /* Unset POW bit after we woke up */ | |
144 | msr &= ~MSR_POW; | |
145 | vcpu->arch.shared->msr = msr; | |
2f4cf5e4 AG |
146 | } |
147 | } | |
148 | ||
666e7252 | 149 | if ((vcpu->arch.shared->msr & (MSR_PR|MSR_IR|MSR_DR)) != |
f7bc74e1 | 150 | (old_msr & (MSR_PR|MSR_IR|MSR_DR))) { |
2f4cf5e4 | 151 | kvmppc_mmu_flush_segments(vcpu); |
c7f38f46 | 152 | kvmppc_mmu_map_segment(vcpu, kvmppc_get_pc(vcpu)); |
4cb6b7ea AG |
153 | |
154 | /* Preload magic page segment when in kernel mode */ | |
155 | if (!(msr & MSR_PR) && vcpu->arch.magic_page_pa) { | |
156 | struct kvm_vcpu_arch *a = &vcpu->arch; | |
157 | ||
158 | if (msr & MSR_DR) | |
159 | kvmppc_mmu_map_segment(vcpu, a->magic_page_ea); | |
160 | else | |
161 | kvmppc_mmu_map_segment(vcpu, a->magic_page_pa); | |
162 | } | |
2f4cf5e4 | 163 | } |
d1bab74c AG |
164 | |
165 | /* Preload FPU if it's enabled */ | |
666e7252 | 166 | if (vcpu->arch.shared->msr & MSR_FP) |
d1bab74c | 167 | kvmppc_handle_ext(vcpu, BOOK3S_INTERRUPT_FP_UNAVAIL, MSR_FP); |
2f4cf5e4 AG |
168 | } |
169 | ||
170 | void kvmppc_inject_interrupt(struct kvm_vcpu *vcpu, int vec, u64 flags) | |
171 | { | |
de7906c3 AG |
172 | vcpu->arch.shared->srr0 = kvmppc_get_pc(vcpu); |
173 | vcpu->arch.shared->srr1 = vcpu->arch.shared->msr | flags; | |
c7f38f46 | 174 | kvmppc_set_pc(vcpu, to_book3s(vcpu)->hior + vec); |
2f4cf5e4 AG |
175 | vcpu->arch.mmu.reset_msr(vcpu); |
176 | } | |
177 | ||
583617b7 | 178 | static int kvmppc_book3s_vec2irqprio(unsigned int vec) |
2f4cf5e4 AG |
179 | { |
180 | unsigned int prio; | |
181 | ||
2f4cf5e4 AG |
182 | switch (vec) { |
183 | case 0x100: prio = BOOK3S_IRQPRIO_SYSTEM_RESET; break; | |
184 | case 0x200: prio = BOOK3S_IRQPRIO_MACHINE_CHECK; break; | |
185 | case 0x300: prio = BOOK3S_IRQPRIO_DATA_STORAGE; break; | |
186 | case 0x380: prio = BOOK3S_IRQPRIO_DATA_SEGMENT; break; | |
187 | case 0x400: prio = BOOK3S_IRQPRIO_INST_STORAGE; break; | |
188 | case 0x480: prio = BOOK3S_IRQPRIO_INST_SEGMENT; break; | |
189 | case 0x500: prio = BOOK3S_IRQPRIO_EXTERNAL; break; | |
17bd1580 | 190 | case 0x501: prio = BOOK3S_IRQPRIO_EXTERNAL_LEVEL; break; |
2f4cf5e4 AG |
191 | case 0x600: prio = BOOK3S_IRQPRIO_ALIGNMENT; break; |
192 | case 0x700: prio = BOOK3S_IRQPRIO_PROGRAM; break; | |
193 | case 0x800: prio = BOOK3S_IRQPRIO_FP_UNAVAIL; break; | |
194 | case 0x900: prio = BOOK3S_IRQPRIO_DECREMENTER; break; | |
195 | case 0xc00: prio = BOOK3S_IRQPRIO_SYSCALL; break; | |
196 | case 0xd00: prio = BOOK3S_IRQPRIO_DEBUG; break; | |
197 | case 0xf20: prio = BOOK3S_IRQPRIO_ALTIVEC; break; | |
198 | case 0xf40: prio = BOOK3S_IRQPRIO_VSX; break; | |
199 | default: prio = BOOK3S_IRQPRIO_MAX; break; | |
200 | } | |
201 | ||
583617b7 AG |
202 | return prio; |
203 | } | |
204 | ||
7706664d AG |
205 | static void kvmppc_book3s_dequeue_irqprio(struct kvm_vcpu *vcpu, |
206 | unsigned int vec) | |
207 | { | |
208 | clear_bit(kvmppc_book3s_vec2irqprio(vec), | |
209 | &vcpu->arch.pending_exceptions); | |
9ee18b1e AG |
210 | |
211 | if (!vcpu->arch.pending_exceptions) | |
212 | vcpu->arch.shared->int_pending = 0; | |
7706664d AG |
213 | } |
214 | ||
583617b7 AG |
215 | void kvmppc_book3s_queue_irqprio(struct kvm_vcpu *vcpu, unsigned int vec) |
216 | { | |
217 | vcpu->stat.queue_intr++; | |
218 | ||
219 | set_bit(kvmppc_book3s_vec2irqprio(vec), | |
220 | &vcpu->arch.pending_exceptions); | |
2f4cf5e4 AG |
221 | #ifdef EXIT_DEBUG |
222 | printk(KERN_INFO "Queueing interrupt %x\n", vec); | |
223 | #endif | |
224 | } | |
225 | ||
226 | ||
25a8a02d | 227 | void kvmppc_core_queue_program(struct kvm_vcpu *vcpu, ulong flags) |
2f4cf5e4 | 228 | { |
25a8a02d | 229 | to_book3s(vcpu)->prog_flags = flags; |
2f4cf5e4 AG |
230 | kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_PROGRAM); |
231 | } | |
232 | ||
233 | void kvmppc_core_queue_dec(struct kvm_vcpu *vcpu) | |
234 | { | |
235 | kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER); | |
236 | } | |
237 | ||
238 | int kvmppc_core_pending_dec(struct kvm_vcpu *vcpu) | |
239 | { | |
44075d95 | 240 | return test_bit(BOOK3S_IRQPRIO_DECREMENTER, &vcpu->arch.pending_exceptions); |
2f4cf5e4 AG |
241 | } |
242 | ||
7706664d AG |
243 | void kvmppc_core_dequeue_dec(struct kvm_vcpu *vcpu) |
244 | { | |
245 | kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER); | |
246 | } | |
247 | ||
2f4cf5e4 AG |
248 | void kvmppc_core_queue_external(struct kvm_vcpu *vcpu, |
249 | struct kvm_interrupt *irq) | |
250 | { | |
17bd1580 AG |
251 | unsigned int vec = BOOK3S_INTERRUPT_EXTERNAL; |
252 | ||
253 | if (irq->irq == KVM_INTERRUPT_SET_LEVEL) | |
254 | vec = BOOK3S_INTERRUPT_EXTERNAL_LEVEL; | |
255 | ||
256 | kvmppc_book3s_queue_irqprio(vcpu, vec); | |
2f4cf5e4 AG |
257 | } |
258 | ||
18978768 AG |
259 | void kvmppc_core_dequeue_external(struct kvm_vcpu *vcpu, |
260 | struct kvm_interrupt *irq) | |
261 | { | |
262 | kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL); | |
17bd1580 | 263 | kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL_LEVEL); |
18978768 AG |
264 | } |
265 | ||
2f4cf5e4 AG |
266 | int kvmppc_book3s_irqprio_deliver(struct kvm_vcpu *vcpu, unsigned int priority) |
267 | { | |
268 | int deliver = 1; | |
269 | int vec = 0; | |
25a8a02d | 270 | ulong flags = 0ULL; |
5c6cedf4 AG |
271 | ulong crit_raw = vcpu->arch.shared->critical; |
272 | ulong crit_r1 = kvmppc_get_gpr(vcpu, 1); | |
273 | bool crit; | |
274 | ||
275 | /* Truncate crit indicators in 32 bit mode */ | |
276 | if (!(vcpu->arch.shared->msr & MSR_SF)) { | |
277 | crit_raw &= 0xffffffff; | |
278 | crit_r1 &= 0xffffffff; | |
279 | } | |
280 | ||
281 | /* Critical section when crit == r1 */ | |
282 | crit = (crit_raw == crit_r1); | |
283 | /* ... and we're in supervisor mode */ | |
284 | crit = crit && !(vcpu->arch.shared->msr & MSR_PR); | |
2f4cf5e4 AG |
285 | |
286 | switch (priority) { | |
287 | case BOOK3S_IRQPRIO_DECREMENTER: | |
5c6cedf4 | 288 | deliver = (vcpu->arch.shared->msr & MSR_EE) && !crit; |
2f4cf5e4 AG |
289 | vec = BOOK3S_INTERRUPT_DECREMENTER; |
290 | break; | |
291 | case BOOK3S_IRQPRIO_EXTERNAL: | |
17bd1580 | 292 | case BOOK3S_IRQPRIO_EXTERNAL_LEVEL: |
5c6cedf4 | 293 | deliver = (vcpu->arch.shared->msr & MSR_EE) && !crit; |
2f4cf5e4 AG |
294 | vec = BOOK3S_INTERRUPT_EXTERNAL; |
295 | break; | |
296 | case BOOK3S_IRQPRIO_SYSTEM_RESET: | |
297 | vec = BOOK3S_INTERRUPT_SYSTEM_RESET; | |
298 | break; | |
299 | case BOOK3S_IRQPRIO_MACHINE_CHECK: | |
300 | vec = BOOK3S_INTERRUPT_MACHINE_CHECK; | |
301 | break; | |
302 | case BOOK3S_IRQPRIO_DATA_STORAGE: | |
303 | vec = BOOK3S_INTERRUPT_DATA_STORAGE; | |
304 | break; | |
305 | case BOOK3S_IRQPRIO_INST_STORAGE: | |
306 | vec = BOOK3S_INTERRUPT_INST_STORAGE; | |
307 | break; | |
308 | case BOOK3S_IRQPRIO_DATA_SEGMENT: | |
309 | vec = BOOK3S_INTERRUPT_DATA_SEGMENT; | |
310 | break; | |
311 | case BOOK3S_IRQPRIO_INST_SEGMENT: | |
312 | vec = BOOK3S_INTERRUPT_INST_SEGMENT; | |
313 | break; | |
314 | case BOOK3S_IRQPRIO_ALIGNMENT: | |
315 | vec = BOOK3S_INTERRUPT_ALIGNMENT; | |
316 | break; | |
317 | case BOOK3S_IRQPRIO_PROGRAM: | |
318 | vec = BOOK3S_INTERRUPT_PROGRAM; | |
25a8a02d | 319 | flags = to_book3s(vcpu)->prog_flags; |
2f4cf5e4 AG |
320 | break; |
321 | case BOOK3S_IRQPRIO_VSX: | |
322 | vec = BOOK3S_INTERRUPT_VSX; | |
323 | break; | |
324 | case BOOK3S_IRQPRIO_ALTIVEC: | |
325 | vec = BOOK3S_INTERRUPT_ALTIVEC; | |
326 | break; | |
327 | case BOOK3S_IRQPRIO_FP_UNAVAIL: | |
328 | vec = BOOK3S_INTERRUPT_FP_UNAVAIL; | |
329 | break; | |
330 | case BOOK3S_IRQPRIO_SYSCALL: | |
331 | vec = BOOK3S_INTERRUPT_SYSCALL; | |
332 | break; | |
333 | case BOOK3S_IRQPRIO_DEBUG: | |
334 | vec = BOOK3S_INTERRUPT_TRACE; | |
335 | break; | |
336 | case BOOK3S_IRQPRIO_PERFORMANCE_MONITOR: | |
337 | vec = BOOK3S_INTERRUPT_PERFMON; | |
338 | break; | |
339 | default: | |
340 | deliver = 0; | |
341 | printk(KERN_ERR "KVM: Unknown interrupt: 0x%x\n", priority); | |
342 | break; | |
343 | } | |
344 | ||
345 | #if 0 | |
346 | printk(KERN_INFO "Deliver interrupt 0x%x? %x\n", vec, deliver); | |
347 | #endif | |
348 | ||
349 | if (deliver) | |
25a8a02d | 350 | kvmppc_inject_interrupt(vcpu, vec, flags); |
2f4cf5e4 AG |
351 | |
352 | return deliver; | |
353 | } | |
354 | ||
17bd1580 AG |
355 | /* |
356 | * This function determines if an irqprio should be cleared once issued. | |
357 | */ | |
358 | static bool clear_irqprio(struct kvm_vcpu *vcpu, unsigned int priority) | |
359 | { | |
360 | switch (priority) { | |
361 | case BOOK3S_IRQPRIO_DECREMENTER: | |
362 | /* DEC interrupts get cleared by mtdec */ | |
363 | return false; | |
364 | case BOOK3S_IRQPRIO_EXTERNAL_LEVEL: | |
365 | /* External interrupts get cleared by userspace */ | |
366 | return false; | |
367 | } | |
368 | ||
369 | return true; | |
370 | } | |
371 | ||
2f4cf5e4 AG |
372 | void kvmppc_core_deliver_interrupts(struct kvm_vcpu *vcpu) |
373 | { | |
374 | unsigned long *pending = &vcpu->arch.pending_exceptions; | |
90bba358 | 375 | unsigned long old_pending = vcpu->arch.pending_exceptions; |
2f4cf5e4 AG |
376 | unsigned int priority; |
377 | ||
2f4cf5e4 AG |
378 | #ifdef EXIT_DEBUG |
379 | if (vcpu->arch.pending_exceptions) | |
380 | printk(KERN_EMERG "KVM: Check pending: %lx\n", vcpu->arch.pending_exceptions); | |
381 | #endif | |
382 | priority = __ffs(*pending); | |
ada7ba17 | 383 | while (priority < BOOK3S_IRQPRIO_MAX) { |
7706664d | 384 | if (kvmppc_book3s_irqprio_deliver(vcpu, priority) && |
17bd1580 | 385 | clear_irqprio(vcpu, priority)) { |
2f4cf5e4 AG |
386 | clear_bit(priority, &vcpu->arch.pending_exceptions); |
387 | break; | |
388 | } | |
389 | ||
390 | priority = find_next_bit(pending, | |
391 | BITS_PER_BYTE * sizeof(*pending), | |
392 | priority + 1); | |
393 | } | |
90bba358 AG |
394 | |
395 | /* Tell the guest about our interrupt status */ | |
396 | if (*pending) | |
397 | vcpu->arch.shared->int_pending = 1; | |
398 | else if (old_pending) | |
399 | vcpu->arch.shared->int_pending = 0; | |
2f4cf5e4 AG |
400 | } |
401 | ||
402 | void kvmppc_set_pvr(struct kvm_vcpu *vcpu, u32 pvr) | |
403 | { | |
b83d4a9c AG |
404 | u32 host_pvr; |
405 | ||
e15a1137 | 406 | vcpu->arch.hflags &= ~BOOK3S_HFLAG_SLB; |
2f4cf5e4 | 407 | vcpu->arch.pvr = pvr; |
07b0907d | 408 | #ifdef CONFIG_PPC_BOOK3S_64 |
2f4cf5e4 AG |
409 | if ((pvr >= 0x330000) && (pvr < 0x70330000)) { |
410 | kvmppc_mmu_book3s_64_init(vcpu); | |
411 | to_book3s(vcpu)->hior = 0xfff00000; | |
412 | to_book3s(vcpu)->msr_mask = 0xffffffffffffffffULL; | |
07b0907d AG |
413 | } else |
414 | #endif | |
415 | { | |
2f4cf5e4 AG |
416 | kvmppc_mmu_book3s_32_init(vcpu); |
417 | to_book3s(vcpu)->hior = 0; | |
418 | to_book3s(vcpu)->msr_mask = 0xffffffffULL; | |
419 | } | |
420 | ||
421 | /* If we are in hypervisor level on 970, we can tell the CPU to | |
422 | * treat DCBZ as 32 bytes store */ | |
423 | vcpu->arch.hflags &= ~BOOK3S_HFLAG_DCBZ32; | |
424 | if (vcpu->arch.mmu.is_dcbz32(vcpu) && (mfmsr() & MSR_HV) && | |
425 | !strcmp(cur_cpu_spec->platform, "ppc970")) | |
426 | vcpu->arch.hflags |= BOOK3S_HFLAG_DCBZ32; | |
427 | ||
05b0ab1c AG |
428 | /* Cell performs badly if MSR_FEx are set. So let's hope nobody |
429 | really needs them in a VM on Cell and force disable them. */ | |
430 | if (!strcmp(cur_cpu_spec->platform, "ppc-cell-be")) | |
431 | to_book3s(vcpu)->msr_mask &= ~(MSR_FE0 | MSR_FE1); | |
07b0907d AG |
432 | |
433 | #ifdef CONFIG_PPC_BOOK3S_32 | |
434 | /* 32 bit Book3S always has 32 byte dcbz */ | |
435 | vcpu->arch.hflags |= BOOK3S_HFLAG_DCBZ32; | |
436 | #endif | |
b83d4a9c AG |
437 | |
438 | /* On some CPUs we can execute paired single operations natively */ | |
439 | asm ( "mfpvr %0" : "=r"(host_pvr)); | |
440 | switch (host_pvr) { | |
441 | case 0x00080200: /* lonestar 2.0 */ | |
442 | case 0x00088202: /* lonestar 2.2 */ | |
443 | case 0x70000100: /* gekko 1.0 */ | |
444 | case 0x00080100: /* gekko 2.0 */ | |
445 | case 0x00083203: /* gekko 2.3a */ | |
446 | case 0x00083213: /* gekko 2.3b */ | |
447 | case 0x00083204: /* gekko 2.4 */ | |
448 | case 0x00083214: /* gekko 2.4e (8SE) - retail HW2 */ | |
449 | case 0x00087200: /* broadway */ | |
450 | vcpu->arch.hflags |= BOOK3S_HFLAG_NATIVE_PS; | |
451 | /* Enable HID2.PSE - in case we need it later */ | |
452 | mtspr(SPRN_HID2_GEKKO, mfspr(SPRN_HID2_GEKKO) | (1 << 29)); | |
453 | } | |
2f4cf5e4 AG |
454 | } |
455 | ||
e8508940 AG |
456 | pfn_t kvmppc_gfn_to_pfn(struct kvm_vcpu *vcpu, gfn_t gfn) |
457 | { | |
458 | ulong mp_pa = vcpu->arch.magic_page_pa; | |
459 | ||
460 | /* Magic page override */ | |
461 | if (unlikely(mp_pa) && | |
462 | unlikely(((gfn << PAGE_SHIFT) & KVM_PAM) == | |
463 | ((mp_pa & PAGE_MASK) & KVM_PAM))) { | |
464 | ulong shared_page = ((ulong)vcpu->arch.shared) & PAGE_MASK; | |
465 | pfn_t pfn; | |
466 | ||
467 | pfn = (pfn_t)virt_to_phys((void*)shared_page) >> PAGE_SHIFT; | |
468 | get_page(pfn_to_page(pfn)); | |
469 | return pfn; | |
470 | } | |
471 | ||
472 | return gfn_to_pfn(vcpu->kvm, gfn); | |
473 | } | |
474 | ||
2f4cf5e4 AG |
475 | /* Book3s_32 CPUs always have 32 bytes cache line size, which Linux assumes. To |
476 | * make Book3s_32 Linux work on Book3s_64, we have to make sure we trap dcbz to | |
477 | * emulate 32 bytes dcbz length. | |
478 | * | |
479 | * The Book3s_64 inventors also realized this case and implemented a special bit | |
480 | * in the HID5 register, which is a hypervisor ressource. Thus we can't use it. | |
481 | * | |
482 | * My approach here is to patch the dcbz instruction on executing pages. | |
483 | */ | |
484 | static void kvmppc_patch_dcbz(struct kvm_vcpu *vcpu, struct kvmppc_pte *pte) | |
485 | { | |
9fb244a2 AG |
486 | struct page *hpage; |
487 | u64 hpage_offset; | |
2f4cf5e4 AG |
488 | u32 *page; |
489 | int i; | |
490 | ||
9fb244a2 | 491 | hpage = gfn_to_page(vcpu->kvm, pte->raddr >> PAGE_SHIFT); |
646bab55 WY |
492 | if (is_error_page(hpage)) { |
493 | kvm_release_page_clean(hpage); | |
2f4cf5e4 | 494 | return; |
646bab55 | 495 | } |
2f4cf5e4 | 496 | |
9fb244a2 AG |
497 | hpage_offset = pte->raddr & ~PAGE_MASK; |
498 | hpage_offset &= ~0xFFFULL; | |
499 | hpage_offset /= 4; | |
2f4cf5e4 | 500 | |
9fb244a2 AG |
501 | get_page(hpage); |
502 | page = kmap_atomic(hpage, KM_USER0); | |
2f4cf5e4 | 503 | |
9fb244a2 AG |
504 | /* patch dcbz into reserved instruction, so we trap */ |
505 | for (i=hpage_offset; i < hpage_offset + (HW_PAGE_SIZE / 4); i++) | |
506 | if ((page[i] & 0xff0007ff) == INS_DCBZ) | |
507 | page[i] &= 0xfffffff7; | |
2f4cf5e4 | 508 | |
9fb244a2 AG |
509 | kunmap_atomic(page, KM_USER0); |
510 | put_page(hpage); | |
2f4cf5e4 AG |
511 | } |
512 | ||
513 | static int kvmppc_xlate(struct kvm_vcpu *vcpu, ulong eaddr, bool data, | |
514 | struct kvmppc_pte *pte) | |
515 | { | |
666e7252 | 516 | int relocated = (vcpu->arch.shared->msr & (data ? MSR_DR : MSR_IR)); |
2f4cf5e4 AG |
517 | int r; |
518 | ||
519 | if (relocated) { | |
520 | r = vcpu->arch.mmu.xlate(vcpu, eaddr, pte, data); | |
521 | } else { | |
522 | pte->eaddr = eaddr; | |
28e83b4f | 523 | pte->raddr = eaddr & KVM_PAM; |
3eeafd7d | 524 | pte->vpage = VSID_REAL | eaddr >> 12; |
2f4cf5e4 AG |
525 | pte->may_read = true; |
526 | pte->may_write = true; | |
527 | pte->may_execute = true; | |
528 | r = 0; | |
529 | } | |
530 | ||
531 | return r; | |
532 | } | |
533 | ||
534 | static hva_t kvmppc_bad_hva(void) | |
535 | { | |
536 | return PAGE_OFFSET; | |
537 | } | |
538 | ||
539 | static hva_t kvmppc_pte_to_hva(struct kvm_vcpu *vcpu, struct kvmppc_pte *pte, | |
540 | bool read) | |
541 | { | |
542 | hva_t hpage; | |
543 | ||
544 | if (read && !pte->may_read) | |
545 | goto err; | |
546 | ||
547 | if (!read && !pte->may_write) | |
548 | goto err; | |
549 | ||
550 | hpage = gfn_to_hva(vcpu->kvm, pte->raddr >> PAGE_SHIFT); | |
551 | if (kvm_is_error_hva(hpage)) | |
552 | goto err; | |
553 | ||
554 | return hpage | (pte->raddr & ~PAGE_MASK); | |
555 | err: | |
556 | return kvmppc_bad_hva(); | |
557 | } | |
558 | ||
5467a97d AG |
559 | int kvmppc_st(struct kvm_vcpu *vcpu, ulong *eaddr, int size, void *ptr, |
560 | bool data) | |
2f4cf5e4 AG |
561 | { |
562 | struct kvmppc_pte pte; | |
2f4cf5e4 AG |
563 | |
564 | vcpu->stat.st++; | |
565 | ||
5467a97d | 566 | if (kvmppc_xlate(vcpu, *eaddr, data, &pte)) |
9fb244a2 | 567 | return -ENOENT; |
5467a97d AG |
568 | |
569 | *eaddr = pte.raddr; | |
2f4cf5e4 | 570 | |
9fb244a2 AG |
571 | if (!pte.may_write) |
572 | return -EPERM; | |
2f4cf5e4 | 573 | |
9fb244a2 AG |
574 | if (kvm_write_guest(vcpu->kvm, pte.raddr, ptr, size)) |
575 | return EMULATE_DO_MMIO; | |
2f4cf5e4 | 576 | |
5467a97d | 577 | return EMULATE_DONE; |
2f4cf5e4 AG |
578 | } |
579 | ||
5467a97d | 580 | int kvmppc_ld(struct kvm_vcpu *vcpu, ulong *eaddr, int size, void *ptr, |
2f4cf5e4 AG |
581 | bool data) |
582 | { | |
583 | struct kvmppc_pte pte; | |
5467a97d | 584 | hva_t hva = *eaddr; |
2f4cf5e4 AG |
585 | |
586 | vcpu->stat.ld++; | |
587 | ||
5467a97d AG |
588 | if (kvmppc_xlate(vcpu, *eaddr, data, &pte)) |
589 | goto nopte; | |
590 | ||
591 | *eaddr = pte.raddr; | |
2f4cf5e4 AG |
592 | |
593 | hva = kvmppc_pte_to_hva(vcpu, &pte, true); | |
594 | if (kvm_is_error_hva(hva)) | |
5467a97d | 595 | goto mmio; |
2f4cf5e4 AG |
596 | |
597 | if (copy_from_user(ptr, (void __user *)hva, size)) { | |
598 | printk(KERN_INFO "kvmppc_ld at 0x%lx failed\n", hva); | |
5467a97d | 599 | goto mmio; |
2f4cf5e4 AG |
600 | } |
601 | ||
5467a97d | 602 | return EMULATE_DONE; |
2f4cf5e4 | 603 | |
5467a97d | 604 | nopte: |
2f4cf5e4 | 605 | return -ENOENT; |
5467a97d AG |
606 | mmio: |
607 | return EMULATE_DO_MMIO; | |
2f4cf5e4 AG |
608 | } |
609 | ||
610 | static int kvmppc_visible_gfn(struct kvm_vcpu *vcpu, gfn_t gfn) | |
611 | { | |
e8508940 AG |
612 | ulong mp_pa = vcpu->arch.magic_page_pa; |
613 | ||
614 | if (unlikely(mp_pa) && | |
615 | unlikely((mp_pa & KVM_PAM) >> PAGE_SHIFT == gfn)) { | |
616 | return 1; | |
617 | } | |
618 | ||
2f4cf5e4 AG |
619 | return kvm_is_visible_gfn(vcpu->kvm, gfn); |
620 | } | |
621 | ||
622 | int kvmppc_handle_pagefault(struct kvm_run *run, struct kvm_vcpu *vcpu, | |
623 | ulong eaddr, int vec) | |
624 | { | |
625 | bool data = (vec == BOOK3S_INTERRUPT_DATA_STORAGE); | |
626 | int r = RESUME_GUEST; | |
627 | int relocated; | |
628 | int page_found = 0; | |
629 | struct kvmppc_pte pte; | |
630 | bool is_mmio = false; | |
666e7252 AG |
631 | bool dr = (vcpu->arch.shared->msr & MSR_DR) ? true : false; |
632 | bool ir = (vcpu->arch.shared->msr & MSR_IR) ? true : false; | |
f7bc74e1 | 633 | u64 vsid; |
2f4cf5e4 | 634 | |
3eeafd7d | 635 | relocated = data ? dr : ir; |
2f4cf5e4 AG |
636 | |
637 | /* Resolve real address if translation turned on */ | |
638 | if (relocated) { | |
639 | page_found = vcpu->arch.mmu.xlate(vcpu, eaddr, &pte, data); | |
640 | } else { | |
641 | pte.may_execute = true; | |
642 | pte.may_read = true; | |
643 | pte.may_write = true; | |
28e83b4f | 644 | pte.raddr = eaddr & KVM_PAM; |
2f4cf5e4 AG |
645 | pte.eaddr = eaddr; |
646 | pte.vpage = eaddr >> 12; | |
3eeafd7d AG |
647 | } |
648 | ||
666e7252 | 649 | switch (vcpu->arch.shared->msr & (MSR_DR|MSR_IR)) { |
3eeafd7d | 650 | case 0: |
f7bc74e1 | 651 | pte.vpage |= ((u64)VSID_REAL << (SID_SHIFT - 12)); |
3eeafd7d AG |
652 | break; |
653 | case MSR_DR: | |
3eeafd7d | 654 | case MSR_IR: |
f7bc74e1 AG |
655 | vcpu->arch.mmu.esid_to_vsid(vcpu, eaddr >> SID_SHIFT, &vsid); |
656 | ||
666e7252 | 657 | if ((vcpu->arch.shared->msr & (MSR_DR|MSR_IR)) == MSR_DR) |
f7bc74e1 AG |
658 | pte.vpage |= ((u64)VSID_REAL_DR << (SID_SHIFT - 12)); |
659 | else | |
660 | pte.vpage |= ((u64)VSID_REAL_IR << (SID_SHIFT - 12)); | |
661 | pte.vpage |= vsid; | |
662 | ||
663 | if (vsid == -1) | |
664 | page_found = -EINVAL; | |
3eeafd7d | 665 | break; |
2f4cf5e4 AG |
666 | } |
667 | ||
668 | if (vcpu->arch.mmu.is_dcbz32(vcpu) && | |
669 | (!(vcpu->arch.hflags & BOOK3S_HFLAG_DCBZ32))) { | |
670 | /* | |
671 | * If we do the dcbz hack, we have to NX on every execution, | |
672 | * so we can patch the executing code. This renders our guest | |
673 | * NX-less. | |
674 | */ | |
675 | pte.may_execute = !data; | |
676 | } | |
677 | ||
678 | if (page_found == -ENOENT) { | |
679 | /* Page not found in guest PTE entries */ | |
5e030186 | 680 | vcpu->arch.shared->dar = kvmppc_get_fault_dar(vcpu); |
d562de48 | 681 | vcpu->arch.shared->dsisr = to_svcpu(vcpu)->fault_dsisr; |
666e7252 AG |
682 | vcpu->arch.shared->msr |= |
683 | (to_svcpu(vcpu)->shadow_srr1 & 0x00000000f8000000ULL); | |
2f4cf5e4 AG |
684 | kvmppc_book3s_queue_irqprio(vcpu, vec); |
685 | } else if (page_found == -EPERM) { | |
686 | /* Storage protection */ | |
5e030186 | 687 | vcpu->arch.shared->dar = kvmppc_get_fault_dar(vcpu); |
d562de48 AG |
688 | vcpu->arch.shared->dsisr = |
689 | to_svcpu(vcpu)->fault_dsisr & ~DSISR_NOHPTE; | |
690 | vcpu->arch.shared->dsisr |= DSISR_PROTFAULT; | |
666e7252 AG |
691 | vcpu->arch.shared->msr |= |
692 | (to_svcpu(vcpu)->shadow_srr1 & 0x00000000f8000000ULL); | |
2f4cf5e4 AG |
693 | kvmppc_book3s_queue_irqprio(vcpu, vec); |
694 | } else if (page_found == -EINVAL) { | |
695 | /* Page not found in guest SLB */ | |
5e030186 | 696 | vcpu->arch.shared->dar = kvmppc_get_fault_dar(vcpu); |
2f4cf5e4 AG |
697 | kvmppc_book3s_queue_irqprio(vcpu, vec + 0x80); |
698 | } else if (!is_mmio && | |
699 | kvmppc_visible_gfn(vcpu, pte.raddr >> PAGE_SHIFT)) { | |
700 | /* The guest's PTE is not mapped yet. Map on the host */ | |
701 | kvmppc_mmu_map_page(vcpu, &pte); | |
702 | if (data) | |
703 | vcpu->stat.sp_storage++; | |
704 | else if (vcpu->arch.mmu.is_dcbz32(vcpu) && | |
705 | (!(vcpu->arch.hflags & BOOK3S_HFLAG_DCBZ32))) | |
706 | kvmppc_patch_dcbz(vcpu, &pte); | |
707 | } else { | |
708 | /* MMIO */ | |
709 | vcpu->stat.mmio_exits++; | |
710 | vcpu->arch.paddr_accessed = pte.raddr; | |
711 | r = kvmppc_emulate_mmio(run, vcpu); | |
712 | if ( r == RESUME_HOST_NV ) | |
713 | r = RESUME_HOST; | |
2f4cf5e4 AG |
714 | } |
715 | ||
716 | return r; | |
717 | } | |
718 | ||
180a34d2 AG |
719 | static inline int get_fpr_index(int i) |
720 | { | |
721 | #ifdef CONFIG_VSX | |
722 | i *= 2; | |
723 | #endif | |
724 | return i; | |
725 | } | |
726 | ||
727 | /* Give up external provider (FPU, Altivec, VSX) */ | |
aba3bd7f | 728 | void kvmppc_giveup_ext(struct kvm_vcpu *vcpu, ulong msr) |
180a34d2 AG |
729 | { |
730 | struct thread_struct *t = ¤t->thread; | |
731 | u64 *vcpu_fpr = vcpu->arch.fpr; | |
a2b07664 | 732 | #ifdef CONFIG_VSX |
180a34d2 | 733 | u64 *vcpu_vsx = vcpu->arch.vsr; |
a2b07664 | 734 | #endif |
180a34d2 AG |
735 | u64 *thread_fpr = (u64*)t->fpr; |
736 | int i; | |
737 | ||
738 | if (!(vcpu->arch.guest_owned_ext & msr)) | |
739 | return; | |
740 | ||
741 | #ifdef DEBUG_EXT | |
742 | printk(KERN_INFO "Giving up ext 0x%lx\n", msr); | |
743 | #endif | |
744 | ||
745 | switch (msr) { | |
746 | case MSR_FP: | |
747 | giveup_fpu(current); | |
748 | for (i = 0; i < ARRAY_SIZE(vcpu->arch.fpr); i++) | |
749 | vcpu_fpr[i] = thread_fpr[get_fpr_index(i)]; | |
750 | ||
751 | vcpu->arch.fpscr = t->fpscr.val; | |
752 | break; | |
753 | case MSR_VEC: | |
754 | #ifdef CONFIG_ALTIVEC | |
755 | giveup_altivec(current); | |
756 | memcpy(vcpu->arch.vr, t->vr, sizeof(vcpu->arch.vr)); | |
757 | vcpu->arch.vscr = t->vscr; | |
758 | #endif | |
759 | break; | |
760 | case MSR_VSX: | |
761 | #ifdef CONFIG_VSX | |
762 | __giveup_vsx(current); | |
763 | for (i = 0; i < ARRAY_SIZE(vcpu->arch.vsr); i++) | |
764 | vcpu_vsx[i] = thread_fpr[get_fpr_index(i) + 1]; | |
765 | #endif | |
766 | break; | |
767 | default: | |
768 | BUG(); | |
769 | } | |
770 | ||
771 | vcpu->arch.guest_owned_ext &= ~msr; | |
772 | current->thread.regs->msr &= ~msr; | |
a76f8497 | 773 | kvmppc_recalc_shadow_msr(vcpu); |
180a34d2 AG |
774 | } |
775 | ||
8963221d | 776 | static int kvmppc_read_inst(struct kvm_vcpu *vcpu) |
c8c0b6f2 | 777 | { |
c7f38f46 AG |
778 | ulong srr0 = kvmppc_get_pc(vcpu); |
779 | u32 last_inst = kvmppc_get_last_inst(vcpu); | |
c8c0b6f2 AG |
780 | int ret; |
781 | ||
c7f38f46 | 782 | ret = kvmppc_ld(vcpu, &srr0, sizeof(u32), &last_inst, false); |
c8c0b6f2 | 783 | if (ret == -ENOENT) { |
666e7252 AG |
784 | ulong msr = vcpu->arch.shared->msr; |
785 | ||
786 | msr = kvmppc_set_field(msr, 33, 33, 1); | |
787 | msr = kvmppc_set_field(msr, 34, 36, 0); | |
788 | vcpu->arch.shared->msr = kvmppc_set_field(msr, 42, 47, 0); | |
c8c0b6f2 | 789 | kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_INST_STORAGE); |
8963221d AG |
790 | return EMULATE_AGAIN; |
791 | } | |
792 | ||
793 | return EMULATE_DONE; | |
794 | } | |
795 | ||
796 | static int kvmppc_check_ext(struct kvm_vcpu *vcpu, unsigned int exit_nr) | |
797 | { | |
798 | ||
799 | /* Need to do paired single emulation? */ | |
800 | if (!(vcpu->arch.hflags & BOOK3S_HFLAG_PAIRED_SINGLE)) | |
801 | return EMULATE_DONE; | |
802 | ||
803 | /* Read out the instruction */ | |
804 | if (kvmppc_read_inst(vcpu) == EMULATE_DONE) | |
c8c0b6f2 AG |
805 | /* Need to emulate */ |
806 | return EMULATE_FAIL; | |
c8c0b6f2 AG |
807 | |
808 | return EMULATE_AGAIN; | |
809 | } | |
810 | ||
180a34d2 AG |
811 | /* Handle external providers (FPU, Altivec, VSX) */ |
812 | static int kvmppc_handle_ext(struct kvm_vcpu *vcpu, unsigned int exit_nr, | |
813 | ulong msr) | |
814 | { | |
815 | struct thread_struct *t = ¤t->thread; | |
816 | u64 *vcpu_fpr = vcpu->arch.fpr; | |
a2b07664 | 817 | #ifdef CONFIG_VSX |
180a34d2 | 818 | u64 *vcpu_vsx = vcpu->arch.vsr; |
a2b07664 | 819 | #endif |
180a34d2 AG |
820 | u64 *thread_fpr = (u64*)t->fpr; |
821 | int i; | |
822 | ||
3c402a75 AG |
823 | /* When we have paired singles, we emulate in software */ |
824 | if (vcpu->arch.hflags & BOOK3S_HFLAG_PAIRED_SINGLE) | |
825 | return RESUME_GUEST; | |
826 | ||
666e7252 | 827 | if (!(vcpu->arch.shared->msr & msr)) { |
180a34d2 AG |
828 | kvmppc_book3s_queue_irqprio(vcpu, exit_nr); |
829 | return RESUME_GUEST; | |
830 | } | |
831 | ||
c2453693 AG |
832 | /* We already own the ext */ |
833 | if (vcpu->arch.guest_owned_ext & msr) { | |
834 | return RESUME_GUEST; | |
835 | } | |
836 | ||
180a34d2 AG |
837 | #ifdef DEBUG_EXT |
838 | printk(KERN_INFO "Loading up ext 0x%lx\n", msr); | |
839 | #endif | |
840 | ||
841 | current->thread.regs->msr |= msr; | |
842 | ||
843 | switch (msr) { | |
844 | case MSR_FP: | |
845 | for (i = 0; i < ARRAY_SIZE(vcpu->arch.fpr); i++) | |
846 | thread_fpr[get_fpr_index(i)] = vcpu_fpr[i]; | |
847 | ||
848 | t->fpscr.val = vcpu->arch.fpscr; | |
849 | t->fpexc_mode = 0; | |
850 | kvmppc_load_up_fpu(); | |
851 | break; | |
852 | case MSR_VEC: | |
853 | #ifdef CONFIG_ALTIVEC | |
854 | memcpy(t->vr, vcpu->arch.vr, sizeof(vcpu->arch.vr)); | |
855 | t->vscr = vcpu->arch.vscr; | |
856 | t->vrsave = -1; | |
857 | kvmppc_load_up_altivec(); | |
858 | #endif | |
859 | break; | |
860 | case MSR_VSX: | |
861 | #ifdef CONFIG_VSX | |
862 | for (i = 0; i < ARRAY_SIZE(vcpu->arch.vsr); i++) | |
863 | thread_fpr[get_fpr_index(i) + 1] = vcpu_vsx[i]; | |
864 | kvmppc_load_up_vsx(); | |
865 | #endif | |
866 | break; | |
867 | default: | |
868 | BUG(); | |
869 | } | |
870 | ||
871 | vcpu->arch.guest_owned_ext |= msr; | |
872 | ||
a76f8497 | 873 | kvmppc_recalc_shadow_msr(vcpu); |
180a34d2 AG |
874 | |
875 | return RESUME_GUEST; | |
876 | } | |
877 | ||
2f4cf5e4 AG |
878 | int kvmppc_handle_exit(struct kvm_run *run, struct kvm_vcpu *vcpu, |
879 | unsigned int exit_nr) | |
880 | { | |
881 | int r = RESUME_HOST; | |
882 | ||
883 | vcpu->stat.sum_exits++; | |
884 | ||
885 | run->exit_reason = KVM_EXIT_UNKNOWN; | |
886 | run->ready_for_interrupt_injection = 1; | |
bed1ed98 AG |
887 | |
888 | trace_kvm_book3s_exit(exit_nr, vcpu); | |
2f4cf5e4 AG |
889 | kvm_resched(vcpu); |
890 | switch (exit_nr) { | |
891 | case BOOK3S_INTERRUPT_INST_STORAGE: | |
892 | vcpu->stat.pf_instruc++; | |
61db97cc AG |
893 | |
894 | #ifdef CONFIG_PPC_BOOK3S_32 | |
895 | /* We set segments as unused segments when invalidating them. So | |
896 | * treat the respective fault as segment fault. */ | |
897 | if (to_svcpu(vcpu)->sr[kvmppc_get_pc(vcpu) >> SID_SHIFT] | |
898 | == SR_INVALID) { | |
899 | kvmppc_mmu_map_segment(vcpu, kvmppc_get_pc(vcpu)); | |
900 | r = RESUME_GUEST; | |
901 | break; | |
902 | } | |
903 | #endif | |
904 | ||
2f4cf5e4 | 905 | /* only care about PTEG not found errors, but leave NX alone */ |
c7f38f46 AG |
906 | if (to_svcpu(vcpu)->shadow_srr1 & 0x40000000) { |
907 | r = kvmppc_handle_pagefault(run, vcpu, kvmppc_get_pc(vcpu), exit_nr); | |
2f4cf5e4 AG |
908 | vcpu->stat.sp_instruc++; |
909 | } else if (vcpu->arch.mmu.is_dcbz32(vcpu) && | |
910 | (!(vcpu->arch.hflags & BOOK3S_HFLAG_DCBZ32))) { | |
911 | /* | |
912 | * XXX If we do the dcbz hack we use the NX bit to flush&patch the page, | |
913 | * so we can't use the NX bit inside the guest. Let's cross our fingers, | |
914 | * that no guest that needs the dcbz hack does NX. | |
915 | */ | |
af7b4d10 | 916 | kvmppc_mmu_pte_flush(vcpu, kvmppc_get_pc(vcpu), ~0xFFFUL); |
9fb244a2 | 917 | r = RESUME_GUEST; |
2f4cf5e4 | 918 | } else { |
666e7252 AG |
919 | vcpu->arch.shared->msr |= |
920 | to_svcpu(vcpu)->shadow_srr1 & 0x58000000; | |
2f4cf5e4 | 921 | kvmppc_book3s_queue_irqprio(vcpu, exit_nr); |
2f4cf5e4 AG |
922 | r = RESUME_GUEST; |
923 | } | |
924 | break; | |
925 | case BOOK3S_INTERRUPT_DATA_STORAGE: | |
c7f38f46 AG |
926 | { |
927 | ulong dar = kvmppc_get_fault_dar(vcpu); | |
2f4cf5e4 | 928 | vcpu->stat.pf_storage++; |
61db97cc AG |
929 | |
930 | #ifdef CONFIG_PPC_BOOK3S_32 | |
931 | /* We set segments as unused segments when invalidating them. So | |
932 | * treat the respective fault as segment fault. */ | |
933 | if ((to_svcpu(vcpu)->sr[dar >> SID_SHIFT]) == SR_INVALID) { | |
934 | kvmppc_mmu_map_segment(vcpu, dar); | |
935 | r = RESUME_GUEST; | |
936 | break; | |
937 | } | |
938 | #endif | |
939 | ||
2f4cf5e4 | 940 | /* The only case we need to handle is missing shadow PTEs */ |
c7f38f46 AG |
941 | if (to_svcpu(vcpu)->fault_dsisr & DSISR_NOHPTE) { |
942 | r = kvmppc_handle_pagefault(run, vcpu, dar, exit_nr); | |
2f4cf5e4 | 943 | } else { |
5e030186 | 944 | vcpu->arch.shared->dar = dar; |
d562de48 | 945 | vcpu->arch.shared->dsisr = to_svcpu(vcpu)->fault_dsisr; |
2f4cf5e4 | 946 | kvmppc_book3s_queue_irqprio(vcpu, exit_nr); |
2f4cf5e4 AG |
947 | r = RESUME_GUEST; |
948 | } | |
949 | break; | |
c7f38f46 | 950 | } |
2f4cf5e4 | 951 | case BOOK3S_INTERRUPT_DATA_SEGMENT: |
c7f38f46 | 952 | if (kvmppc_mmu_map_segment(vcpu, kvmppc_get_fault_dar(vcpu)) < 0) { |
5e030186 | 953 | vcpu->arch.shared->dar = kvmppc_get_fault_dar(vcpu); |
2f4cf5e4 AG |
954 | kvmppc_book3s_queue_irqprio(vcpu, |
955 | BOOK3S_INTERRUPT_DATA_SEGMENT); | |
956 | } | |
957 | r = RESUME_GUEST; | |
958 | break; | |
959 | case BOOK3S_INTERRUPT_INST_SEGMENT: | |
c7f38f46 | 960 | if (kvmppc_mmu_map_segment(vcpu, kvmppc_get_pc(vcpu)) < 0) { |
2f4cf5e4 AG |
961 | kvmppc_book3s_queue_irqprio(vcpu, |
962 | BOOK3S_INTERRUPT_INST_SEGMENT); | |
963 | } | |
964 | r = RESUME_GUEST; | |
965 | break; | |
966 | /* We're good on these - the host merely wanted to get our attention */ | |
967 | case BOOK3S_INTERRUPT_DECREMENTER: | |
968 | vcpu->stat.dec_exits++; | |
969 | r = RESUME_GUEST; | |
970 | break; | |
971 | case BOOK3S_INTERRUPT_EXTERNAL: | |
972 | vcpu->stat.ext_intr_exits++; | |
973 | r = RESUME_GUEST; | |
974 | break; | |
7fdaec99 AG |
975 | case BOOK3S_INTERRUPT_PERFMON: |
976 | r = RESUME_GUEST; | |
977 | break; | |
2f4cf5e4 AG |
978 | case BOOK3S_INTERRUPT_PROGRAM: |
979 | { | |
980 | enum emulation_result er; | |
ff1ca3f9 AG |
981 | ulong flags; |
982 | ||
c8c0b6f2 | 983 | program_interrupt: |
c7f38f46 | 984 | flags = to_svcpu(vcpu)->shadow_srr1 & 0x1f0000ull; |
2f4cf5e4 | 985 | |
666e7252 | 986 | if (vcpu->arch.shared->msr & MSR_PR) { |
2f4cf5e4 | 987 | #ifdef EXIT_DEBUG |
c7f38f46 | 988 | printk(KERN_INFO "Userspace triggered 0x700 exception at 0x%lx (0x%x)\n", kvmppc_get_pc(vcpu), kvmppc_get_last_inst(vcpu)); |
2f4cf5e4 | 989 | #endif |
c7f38f46 | 990 | if ((kvmppc_get_last_inst(vcpu) & 0xff0007ff) != |
2f4cf5e4 | 991 | (INS_DCBZ & 0xfffffff7)) { |
ff1ca3f9 | 992 | kvmppc_core_queue_program(vcpu, flags); |
2f4cf5e4 AG |
993 | r = RESUME_GUEST; |
994 | break; | |
995 | } | |
996 | } | |
997 | ||
998 | vcpu->stat.emulated_inst_exits++; | |
999 | er = kvmppc_emulate_instruction(run, vcpu); | |
1000 | switch (er) { | |
1001 | case EMULATE_DONE: | |
97c4cfbe | 1002 | r = RESUME_GUEST_NV; |
2f4cf5e4 | 1003 | break; |
37f5bca6 AG |
1004 | case EMULATE_AGAIN: |
1005 | r = RESUME_GUEST; | |
1006 | break; | |
2f4cf5e4 AG |
1007 | case EMULATE_FAIL: |
1008 | printk(KERN_CRIT "%s: emulation at %lx failed (%08x)\n", | |
c7f38f46 | 1009 | __func__, kvmppc_get_pc(vcpu), kvmppc_get_last_inst(vcpu)); |
ff1ca3f9 | 1010 | kvmppc_core_queue_program(vcpu, flags); |
2f4cf5e4 AG |
1011 | r = RESUME_GUEST; |
1012 | break; | |
e5c29e92 AG |
1013 | case EMULATE_DO_MMIO: |
1014 | run->exit_reason = KVM_EXIT_MMIO; | |
1015 | r = RESUME_HOST_NV; | |
1016 | break; | |
2f4cf5e4 AG |
1017 | default: |
1018 | BUG(); | |
1019 | } | |
1020 | break; | |
1021 | } | |
1022 | case BOOK3S_INTERRUPT_SYSCALL: | |
ad0a048b AG |
1023 | if (vcpu->arch.osi_enabled && |
1024 | (((u32)kvmppc_get_gpr(vcpu, 3)) == OSI_SC_MAGIC_R3) && | |
1025 | (((u32)kvmppc_get_gpr(vcpu, 4)) == OSI_SC_MAGIC_R4)) { | |
2a342ed5 | 1026 | /* MOL hypercalls */ |
ad0a048b AG |
1027 | u64 *gprs = run->osi.gprs; |
1028 | int i; | |
1029 | ||
1030 | run->exit_reason = KVM_EXIT_OSI; | |
1031 | for (i = 0; i < 32; i++) | |
1032 | gprs[i] = kvmppc_get_gpr(vcpu, i); | |
1033 | vcpu->arch.osi_needed = 1; | |
1034 | r = RESUME_HOST_NV; | |
2a342ed5 AG |
1035 | } else if (!(vcpu->arch.shared->msr & MSR_PR) && |
1036 | (((u32)kvmppc_get_gpr(vcpu, 0)) == KVM_SC_MAGIC_R0)) { | |
1037 | /* KVM PV hypercalls */ | |
1038 | kvmppc_set_gpr(vcpu, 3, kvmppc_kvm_pv(vcpu)); | |
1039 | r = RESUME_GUEST; | |
ad0a048b | 1040 | } else { |
2a342ed5 | 1041 | /* Guest syscalls */ |
ad0a048b AG |
1042 | vcpu->stat.syscall_exits++; |
1043 | kvmppc_book3s_queue_irqprio(vcpu, exit_nr); | |
1044 | r = RESUME_GUEST; | |
1045 | } | |
2f4cf5e4 | 1046 | break; |
2f4cf5e4 | 1047 | case BOOK3S_INTERRUPT_FP_UNAVAIL: |
2f4cf5e4 AG |
1048 | case BOOK3S_INTERRUPT_ALTIVEC: |
1049 | case BOOK3S_INTERRUPT_VSX: | |
c8c0b6f2 AG |
1050 | { |
1051 | int ext_msr = 0; | |
1052 | ||
1053 | switch (exit_nr) { | |
1054 | case BOOK3S_INTERRUPT_FP_UNAVAIL: ext_msr = MSR_FP; break; | |
1055 | case BOOK3S_INTERRUPT_ALTIVEC: ext_msr = MSR_VEC; break; | |
1056 | case BOOK3S_INTERRUPT_VSX: ext_msr = MSR_VSX; break; | |
1057 | } | |
1058 | ||
1059 | switch (kvmppc_check_ext(vcpu, exit_nr)) { | |
1060 | case EMULATE_DONE: | |
1061 | /* everything ok - let's enable the ext */ | |
1062 | r = kvmppc_handle_ext(vcpu, exit_nr, ext_msr); | |
1063 | break; | |
1064 | case EMULATE_FAIL: | |
1065 | /* we need to emulate this instruction */ | |
1066 | goto program_interrupt; | |
1067 | break; | |
1068 | default: | |
1069 | /* nothing to worry about - go again */ | |
1070 | break; | |
1071 | } | |
180a34d2 | 1072 | break; |
c8c0b6f2 | 1073 | } |
ca7f4203 AG |
1074 | case BOOK3S_INTERRUPT_ALIGNMENT: |
1075 | if (kvmppc_read_inst(vcpu) == EMULATE_DONE) { | |
d562de48 | 1076 | vcpu->arch.shared->dsisr = kvmppc_alignment_dsisr(vcpu, |
c7f38f46 | 1077 | kvmppc_get_last_inst(vcpu)); |
5e030186 | 1078 | vcpu->arch.shared->dar = kvmppc_alignment_dar(vcpu, |
c7f38f46 | 1079 | kvmppc_get_last_inst(vcpu)); |
ca7f4203 AG |
1080 | kvmppc_book3s_queue_irqprio(vcpu, exit_nr); |
1081 | } | |
1082 | r = RESUME_GUEST; | |
1083 | break; | |
180a34d2 AG |
1084 | case BOOK3S_INTERRUPT_MACHINE_CHECK: |
1085 | case BOOK3S_INTERRUPT_TRACE: | |
2f4cf5e4 AG |
1086 | kvmppc_book3s_queue_irqprio(vcpu, exit_nr); |
1087 | r = RESUME_GUEST; | |
1088 | break; | |
1089 | default: | |
1090 | /* Ugh - bork here! What did we get? */ | |
f7adbba1 | 1091 | printk(KERN_EMERG "exit_nr=0x%x | pc=0x%lx | msr=0x%lx\n", |
c7f38f46 | 1092 | exit_nr, kvmppc_get_pc(vcpu), to_svcpu(vcpu)->shadow_srr1); |
2f4cf5e4 AG |
1093 | r = RESUME_HOST; |
1094 | BUG(); | |
1095 | break; | |
1096 | } | |
1097 | ||
1098 | ||
1099 | if (!(r & RESUME_HOST)) { | |
1100 | /* To avoid clobbering exit_reason, only check for signals if | |
1101 | * we aren't already exiting to userspace for some other | |
1102 | * reason. */ | |
1103 | if (signal_pending(current)) { | |
1104 | #ifdef EXIT_DEBUG | |
1105 | printk(KERN_EMERG "KVM: Going back to host\n"); | |
1106 | #endif | |
1107 | vcpu->stat.signal_exits++; | |
1108 | run->exit_reason = KVM_EXIT_INTR; | |
1109 | r = -EINTR; | |
1110 | } else { | |
1111 | /* In case an interrupt came in that was triggered | |
1112 | * from userspace (like DEC), we need to check what | |
1113 | * to inject now! */ | |
1114 | kvmppc_core_deliver_interrupts(vcpu); | |
1115 | } | |
1116 | } | |
1117 | ||
bed1ed98 | 1118 | trace_kvm_book3s_reenter(r, vcpu); |
2f4cf5e4 AG |
1119 | |
1120 | return r; | |
1121 | } | |
1122 | ||
1123 | int kvm_arch_vcpu_setup(struct kvm_vcpu *vcpu) | |
1124 | { | |
1125 | return 0; | |
1126 | } | |
1127 | ||
1128 | int kvm_arch_vcpu_ioctl_get_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs) | |
1129 | { | |
1130 | int i; | |
1131 | ||
c7f38f46 | 1132 | regs->pc = kvmppc_get_pc(vcpu); |
992b5b29 | 1133 | regs->cr = kvmppc_get_cr(vcpu); |
c7f38f46 AG |
1134 | regs->ctr = kvmppc_get_ctr(vcpu); |
1135 | regs->lr = kvmppc_get_lr(vcpu); | |
992b5b29 | 1136 | regs->xer = kvmppc_get_xer(vcpu); |
666e7252 | 1137 | regs->msr = vcpu->arch.shared->msr; |
de7906c3 AG |
1138 | regs->srr0 = vcpu->arch.shared->srr0; |
1139 | regs->srr1 = vcpu->arch.shared->srr1; | |
2f4cf5e4 | 1140 | regs->pid = vcpu->arch.pid; |
a73a9599 AG |
1141 | regs->sprg0 = vcpu->arch.shared->sprg0; |
1142 | regs->sprg1 = vcpu->arch.shared->sprg1; | |
1143 | regs->sprg2 = vcpu->arch.shared->sprg2; | |
1144 | regs->sprg3 = vcpu->arch.shared->sprg3; | |
bc9c1933 PT |
1145 | regs->sprg4 = vcpu->arch.sprg4; |
1146 | regs->sprg5 = vcpu->arch.sprg5; | |
1147 | regs->sprg6 = vcpu->arch.sprg6; | |
1148 | regs->sprg7 = vcpu->arch.sprg7; | |
2f4cf5e4 AG |
1149 | |
1150 | for (i = 0; i < ARRAY_SIZE(regs->gpr); i++) | |
8e5b26b5 | 1151 | regs->gpr[i] = kvmppc_get_gpr(vcpu, i); |
2f4cf5e4 AG |
1152 | |
1153 | return 0; | |
1154 | } | |
1155 | ||
1156 | int kvm_arch_vcpu_ioctl_set_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs) | |
1157 | { | |
1158 | int i; | |
1159 | ||
c7f38f46 | 1160 | kvmppc_set_pc(vcpu, regs->pc); |
992b5b29 | 1161 | kvmppc_set_cr(vcpu, regs->cr); |
c7f38f46 AG |
1162 | kvmppc_set_ctr(vcpu, regs->ctr); |
1163 | kvmppc_set_lr(vcpu, regs->lr); | |
992b5b29 | 1164 | kvmppc_set_xer(vcpu, regs->xer); |
2f4cf5e4 | 1165 | kvmppc_set_msr(vcpu, regs->msr); |
de7906c3 AG |
1166 | vcpu->arch.shared->srr0 = regs->srr0; |
1167 | vcpu->arch.shared->srr1 = regs->srr1; | |
a73a9599 AG |
1168 | vcpu->arch.shared->sprg0 = regs->sprg0; |
1169 | vcpu->arch.shared->sprg1 = regs->sprg1; | |
1170 | vcpu->arch.shared->sprg2 = regs->sprg2; | |
1171 | vcpu->arch.shared->sprg3 = regs->sprg3; | |
bc9c1933 PT |
1172 | vcpu->arch.sprg4 = regs->sprg4; |
1173 | vcpu->arch.sprg5 = regs->sprg5; | |
1174 | vcpu->arch.sprg6 = regs->sprg6; | |
1175 | vcpu->arch.sprg7 = regs->sprg7; | |
2f4cf5e4 | 1176 | |
8e5b26b5 AG |
1177 | for (i = 0; i < ARRAY_SIZE(regs->gpr); i++) |
1178 | kvmppc_set_gpr(vcpu, i, regs->gpr[i]); | |
2f4cf5e4 AG |
1179 | |
1180 | return 0; | |
1181 | } | |
1182 | ||
1183 | int kvm_arch_vcpu_ioctl_get_sregs(struct kvm_vcpu *vcpu, | |
1184 | struct kvm_sregs *sregs) | |
1185 | { | |
e15a1137 AG |
1186 | struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu); |
1187 | int i; | |
1188 | ||
2f4cf5e4 | 1189 | sregs->pvr = vcpu->arch.pvr; |
e15a1137 AG |
1190 | |
1191 | sregs->u.s.sdr1 = to_book3s(vcpu)->sdr1; | |
1192 | if (vcpu->arch.hflags & BOOK3S_HFLAG_SLB) { | |
1193 | for (i = 0; i < 64; i++) { | |
1194 | sregs->u.s.ppc64.slb[i].slbe = vcpu3s->slb[i].orige | i; | |
1195 | sregs->u.s.ppc64.slb[i].slbv = vcpu3s->slb[i].origv; | |
1196 | } | |
1197 | } else { | |
df1bfa25 AG |
1198 | for (i = 0; i < 16; i++) |
1199 | sregs->u.s.ppc32.sr[i] = vcpu->arch.shared->sr[i]; | |
1200 | ||
e15a1137 AG |
1201 | for (i = 0; i < 8; i++) { |
1202 | sregs->u.s.ppc32.ibat[i] = vcpu3s->ibat[i].raw; | |
1203 | sregs->u.s.ppc32.dbat[i] = vcpu3s->dbat[i].raw; | |
1204 | } | |
1205 | } | |
98001d8d | 1206 | |
2f4cf5e4 AG |
1207 | return 0; |
1208 | } | |
1209 | ||
1210 | int kvm_arch_vcpu_ioctl_set_sregs(struct kvm_vcpu *vcpu, | |
1211 | struct kvm_sregs *sregs) | |
1212 | { | |
e15a1137 AG |
1213 | struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu); |
1214 | int i; | |
1215 | ||
2f4cf5e4 | 1216 | kvmppc_set_pvr(vcpu, sregs->pvr); |
e15a1137 AG |
1217 | |
1218 | vcpu3s->sdr1 = sregs->u.s.sdr1; | |
1219 | if (vcpu->arch.hflags & BOOK3S_HFLAG_SLB) { | |
1220 | for (i = 0; i < 64; i++) { | |
1221 | vcpu->arch.mmu.slbmte(vcpu, sregs->u.s.ppc64.slb[i].slbv, | |
1222 | sregs->u.s.ppc64.slb[i].slbe); | |
1223 | } | |
1224 | } else { | |
1225 | for (i = 0; i < 16; i++) { | |
1226 | vcpu->arch.mmu.mtsrin(vcpu, i, sregs->u.s.ppc32.sr[i]); | |
1227 | } | |
1228 | for (i = 0; i < 8; i++) { | |
1229 | kvmppc_set_bat(vcpu, &(vcpu3s->ibat[i]), false, | |
1230 | (u32)sregs->u.s.ppc32.ibat[i]); | |
1231 | kvmppc_set_bat(vcpu, &(vcpu3s->ibat[i]), true, | |
1232 | (u32)(sregs->u.s.ppc32.ibat[i] >> 32)); | |
1233 | kvmppc_set_bat(vcpu, &(vcpu3s->dbat[i]), false, | |
1234 | (u32)sregs->u.s.ppc32.dbat[i]); | |
1235 | kvmppc_set_bat(vcpu, &(vcpu3s->dbat[i]), true, | |
1236 | (u32)(sregs->u.s.ppc32.dbat[i] >> 32)); | |
1237 | } | |
1238 | } | |
1239 | ||
1240 | /* Flush the MMU after messing with the segments */ | |
1241 | kvmppc_mmu_pte_flush(vcpu, 0, 0); | |
98001d8d | 1242 | |
2f4cf5e4 AG |
1243 | return 0; |
1244 | } | |
1245 | ||
1246 | int kvm_arch_vcpu_ioctl_get_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu) | |
1247 | { | |
1248 | return -ENOTSUPP; | |
1249 | } | |
1250 | ||
1251 | int kvm_arch_vcpu_ioctl_set_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu) | |
1252 | { | |
1253 | return -ENOTSUPP; | |
1254 | } | |
1255 | ||
1256 | int kvm_arch_vcpu_ioctl_translate(struct kvm_vcpu *vcpu, | |
1257 | struct kvm_translation *tr) | |
1258 | { | |
1259 | return 0; | |
1260 | } | |
1261 | ||
1262 | /* | |
1263 | * Get (and clear) the dirty memory log for a memory slot. | |
1264 | */ | |
1265 | int kvm_vm_ioctl_get_dirty_log(struct kvm *kvm, | |
1266 | struct kvm_dirty_log *log) | |
1267 | { | |
1268 | struct kvm_memory_slot *memslot; | |
1269 | struct kvm_vcpu *vcpu; | |
1270 | ulong ga, ga_end; | |
1271 | int is_dirty = 0; | |
87bf6e7d TY |
1272 | int r; |
1273 | unsigned long n; | |
2f4cf5e4 | 1274 | |
79fac95e | 1275 | mutex_lock(&kvm->slots_lock); |
2f4cf5e4 AG |
1276 | |
1277 | r = kvm_get_dirty_log(kvm, log, &is_dirty); | |
1278 | if (r) | |
1279 | goto out; | |
1280 | ||
1281 | /* If nothing is dirty, don't bother messing with page tables. */ | |
1282 | if (is_dirty) { | |
46a26bf5 | 1283 | memslot = &kvm->memslots->memslots[log->slot]; |
2f4cf5e4 AG |
1284 | |
1285 | ga = memslot->base_gfn << PAGE_SHIFT; | |
1286 | ga_end = ga + (memslot->npages << PAGE_SHIFT); | |
1287 | ||
1288 | kvm_for_each_vcpu(n, vcpu, kvm) | |
1289 | kvmppc_mmu_pte_pflush(vcpu, ga, ga_end); | |
1290 | ||
87bf6e7d | 1291 | n = kvm_dirty_bitmap_bytes(memslot); |
2f4cf5e4 AG |
1292 | memset(memslot->dirty_bitmap, 0, n); |
1293 | } | |
1294 | ||
1295 | r = 0; | |
1296 | out: | |
79fac95e | 1297 | mutex_unlock(&kvm->slots_lock); |
2f4cf5e4 AG |
1298 | return r; |
1299 | } | |
1300 | ||
1301 | int kvmppc_core_check_processor_compat(void) | |
1302 | { | |
1303 | return 0; | |
1304 | } | |
1305 | ||
1306 | struct kvm_vcpu *kvmppc_core_vcpu_create(struct kvm *kvm, unsigned int id) | |
1307 | { | |
1308 | struct kvmppc_vcpu_book3s *vcpu_book3s; | |
1309 | struct kvm_vcpu *vcpu; | |
c7f38f46 | 1310 | int err = -ENOMEM; |
e8508940 | 1311 | unsigned long p; |
2f4cf5e4 | 1312 | |
26535037 | 1313 | vcpu_book3s = vzalloc(sizeof(struct kvmppc_vcpu_book3s)); |
c7f38f46 | 1314 | if (!vcpu_book3s) |
2f4cf5e4 | 1315 | goto out; |
c7f38f46 | 1316 | |
c7f38f46 AG |
1317 | vcpu_book3s->shadow_vcpu = (struct kvmppc_book3s_shadow_vcpu *) |
1318 | kzalloc(sizeof(*vcpu_book3s->shadow_vcpu), GFP_KERNEL); | |
1319 | if (!vcpu_book3s->shadow_vcpu) | |
1320 | goto free_vcpu; | |
1321 | ||
2f4cf5e4 AG |
1322 | vcpu = &vcpu_book3s->vcpu; |
1323 | err = kvm_vcpu_init(vcpu, kvm, id); | |
1324 | if (err) | |
c7f38f46 | 1325 | goto free_shadow_vcpu; |
2f4cf5e4 | 1326 | |
e8508940 AG |
1327 | p = __get_free_page(GFP_KERNEL|__GFP_ZERO); |
1328 | /* the real shared page fills the last 4k of our page */ | |
1329 | vcpu->arch.shared = (void*)(p + PAGE_SIZE - 4096); | |
1330 | if (!p) | |
96bc451a AG |
1331 | goto uninit_vcpu; |
1332 | ||
2f4cf5e4 AG |
1333 | vcpu->arch.host_retip = kvm_return_point; |
1334 | vcpu->arch.host_msr = mfmsr(); | |
07b0907d | 1335 | #ifdef CONFIG_PPC_BOOK3S_64 |
2f4cf5e4 AG |
1336 | /* default to book3s_64 (970fx) */ |
1337 | vcpu->arch.pvr = 0x3C0301; | |
07b0907d AG |
1338 | #else |
1339 | /* default to book3s_32 (750) */ | |
1340 | vcpu->arch.pvr = 0x84202; | |
1341 | #endif | |
2f4cf5e4 AG |
1342 | kvmppc_set_pvr(vcpu, vcpu->arch.pvr); |
1343 | vcpu_book3s->slb_nr = 64; | |
1344 | ||
1345 | /* remember where some real-mode handlers are */ | |
149dbdb1 PM |
1346 | vcpu->arch.trampoline_lowmem = __pa(kvmppc_handler_lowmem_trampoline); |
1347 | vcpu->arch.trampoline_enter = __pa(kvmppc_handler_trampoline_enter); | |
2f4cf5e4 | 1348 | vcpu->arch.highmem_handler = (ulong)kvmppc_handler_highmem; |
07b0907d | 1349 | #ifdef CONFIG_PPC_BOOK3S_64 |
021ec9c6 | 1350 | vcpu->arch.rmcall = *(ulong*)kvmppc_rmcall; |
07b0907d AG |
1351 | #else |
1352 | vcpu->arch.rmcall = (ulong)kvmppc_rmcall; | |
1353 | #endif | |
2f4cf5e4 AG |
1354 | |
1355 | vcpu->arch.shadow_msr = MSR_USER64; | |
1356 | ||
9cc5e953 | 1357 | err = kvmppc_mmu_init(vcpu); |
2f4cf5e4 | 1358 | if (err < 0) |
96bc451a | 1359 | goto uninit_vcpu; |
2f4cf5e4 AG |
1360 | |
1361 | return vcpu; | |
1362 | ||
96bc451a AG |
1363 | uninit_vcpu: |
1364 | kvm_vcpu_uninit(vcpu); | |
c7f38f46 AG |
1365 | free_shadow_vcpu: |
1366 | kfree(vcpu_book3s->shadow_vcpu); | |
2f4cf5e4 | 1367 | free_vcpu: |
032c3407 | 1368 | vfree(vcpu_book3s); |
2f4cf5e4 AG |
1369 | out: |
1370 | return ERR_PTR(err); | |
1371 | } | |
1372 | ||
1373 | void kvmppc_core_vcpu_free(struct kvm_vcpu *vcpu) | |
1374 | { | |
1375 | struct kvmppc_vcpu_book3s *vcpu_book3s = to_book3s(vcpu); | |
1376 | ||
e8508940 | 1377 | free_page((unsigned long)vcpu->arch.shared & PAGE_MASK); |
2f4cf5e4 | 1378 | kvm_vcpu_uninit(vcpu); |
c7f38f46 | 1379 | kfree(vcpu_book3s->shadow_vcpu); |
032c3407 | 1380 | vfree(vcpu_book3s); |
2f4cf5e4 AG |
1381 | } |
1382 | ||
1383 | extern int __kvmppc_vcpu_entry(struct kvm_run *kvm_run, struct kvm_vcpu *vcpu); | |
1384 | int __kvmppc_vcpu_run(struct kvm_run *kvm_run, struct kvm_vcpu *vcpu) | |
1385 | { | |
1386 | int ret; | |
49f6be8e AS |
1387 | double fpr[32][TS_FPRWIDTH]; |
1388 | unsigned int fpscr; | |
1389 | int fpexc_mode; | |
a2b07664 | 1390 | #ifdef CONFIG_ALTIVEC |
49f6be8e AS |
1391 | vector128 vr[32]; |
1392 | vector128 vscr; | |
1393 | unsigned long uninitialized_var(vrsave); | |
1394 | int used_vr; | |
a2b07664 AG |
1395 | #endif |
1396 | #ifdef CONFIG_VSX | |
49f6be8e | 1397 | int used_vsr; |
a2b07664 | 1398 | #endif |
180a34d2 | 1399 | ulong ext_msr; |
2f4cf5e4 AG |
1400 | |
1401 | /* No need to go into the guest when all we do is going out */ | |
1402 | if (signal_pending(current)) { | |
1403 | kvm_run->exit_reason = KVM_EXIT_INTR; | |
1404 | return -EINTR; | |
1405 | } | |
1406 | ||
180a34d2 AG |
1407 | /* Save FPU state in stack */ |
1408 | if (current->thread.regs->msr & MSR_FP) | |
1409 | giveup_fpu(current); | |
49f6be8e AS |
1410 | memcpy(fpr, current->thread.fpr, sizeof(current->thread.fpr)); |
1411 | fpscr = current->thread.fpscr.val; | |
1412 | fpexc_mode = current->thread.fpexc_mode; | |
180a34d2 AG |
1413 | |
1414 | #ifdef CONFIG_ALTIVEC | |
1415 | /* Save Altivec state in stack */ | |
49f6be8e AS |
1416 | used_vr = current->thread.used_vr; |
1417 | if (used_vr) { | |
180a34d2 AG |
1418 | if (current->thread.regs->msr & MSR_VEC) |
1419 | giveup_altivec(current); | |
49f6be8e AS |
1420 | memcpy(vr, current->thread.vr, sizeof(current->thread.vr)); |
1421 | vscr = current->thread.vscr; | |
1422 | vrsave = current->thread.vrsave; | |
180a34d2 | 1423 | } |
180a34d2 AG |
1424 | #endif |
1425 | ||
1426 | #ifdef CONFIG_VSX | |
1427 | /* Save VSX state in stack */ | |
49f6be8e AS |
1428 | used_vsr = current->thread.used_vsr; |
1429 | if (used_vsr && (current->thread.regs->msr & MSR_VSX)) | |
180a34d2 | 1430 | __giveup_vsx(current); |
180a34d2 AG |
1431 | #endif |
1432 | ||
1433 | /* Remember the MSR with disabled extensions */ | |
1434 | ext_msr = current->thread.regs->msr; | |
1435 | ||
2f4cf5e4 AG |
1436 | /* XXX we get called with irq disabled - change that! */ |
1437 | local_irq_enable(); | |
1438 | ||
d1bab74c | 1439 | /* Preload FPU if it's enabled */ |
666e7252 | 1440 | if (vcpu->arch.shared->msr & MSR_FP) |
d1bab74c AG |
1441 | kvmppc_handle_ext(vcpu, BOOK3S_INTERRUPT_FP_UNAVAIL, MSR_FP); |
1442 | ||
2f4cf5e4 AG |
1443 | ret = __kvmppc_vcpu_entry(kvm_run, vcpu); |
1444 | ||
1445 | local_irq_disable(); | |
1446 | ||
180a34d2 AG |
1447 | current->thread.regs->msr = ext_msr; |
1448 | ||
1449 | /* Make sure we save the guest FPU/Altivec/VSX state */ | |
1450 | kvmppc_giveup_ext(vcpu, MSR_FP); | |
1451 | kvmppc_giveup_ext(vcpu, MSR_VEC); | |
1452 | kvmppc_giveup_ext(vcpu, MSR_VSX); | |
1453 | ||
1454 | /* Restore FPU state from stack */ | |
49f6be8e AS |
1455 | memcpy(current->thread.fpr, fpr, sizeof(current->thread.fpr)); |
1456 | current->thread.fpscr.val = fpscr; | |
1457 | current->thread.fpexc_mode = fpexc_mode; | |
180a34d2 AG |
1458 | |
1459 | #ifdef CONFIG_ALTIVEC | |
1460 | /* Restore Altivec state from stack */ | |
49f6be8e AS |
1461 | if (used_vr && current->thread.used_vr) { |
1462 | memcpy(current->thread.vr, vr, sizeof(current->thread.vr)); | |
1463 | current->thread.vscr = vscr; | |
1464 | current->thread.vrsave = vrsave; | |
180a34d2 | 1465 | } |
49f6be8e | 1466 | current->thread.used_vr = used_vr; |
180a34d2 AG |
1467 | #endif |
1468 | ||
1469 | #ifdef CONFIG_VSX | |
49f6be8e | 1470 | current->thread.used_vsr = used_vsr; |
180a34d2 AG |
1471 | #endif |
1472 | ||
2f4cf5e4 AG |
1473 | return ret; |
1474 | } | |
1475 | ||
1476 | static int kvmppc_book3s_init(void) | |
1477 | { | |
fef093be AG |
1478 | int r; |
1479 | ||
1480 | r = kvm_init(NULL, sizeof(struct kvmppc_vcpu_book3s), 0, | |
1481 | THIS_MODULE); | |
1482 | ||
1483 | if (r) | |
1484 | return r; | |
1485 | ||
1486 | r = kvmppc_mmu_hpte_sysinit(); | |
1487 | ||
1488 | return r; | |
2f4cf5e4 AG |
1489 | } |
1490 | ||
1491 | static void kvmppc_book3s_exit(void) | |
1492 | { | |
fef093be | 1493 | kvmppc_mmu_hpte_sysexit(); |
2f4cf5e4 AG |
1494 | kvm_exit(); |
1495 | } | |
1496 | ||
1497 | module_init(kvmppc_book3s_init); | |
1498 | module_exit(kvmppc_book3s_exit); |