1
2
3
4
5
6
7
8
9
10
11#include <asm/asm-compat.h>
12#include <asm/feature-fixups.h>
13
14
15
16#define GET_SHADOW_VCPU(reg) \
17 mr reg, r13
18
19
20
21#define GET_SHADOW_VCPU(reg) \
22 tophys(reg, r2); \
23 lwz reg, (THREAD + THREAD_KVM_SVCPU)(reg); \
24 tophys(reg, reg)
25
26#endif
27
28
29#define USE_QUICK_LAST_INST
30
31
32
33
34
35#include "book3s_64_slb.S"
36
37#include "book3s_32_sr.S"
38#endif
39
40
41
42
43
44
45
46.global kvmppc_handler_trampoline_enter
47kvmppc_handler_trampoline_enter:
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66 GET_SHADOW_VCPU(r3)
67
68
69 mflr r0
70 PPC_STL r0, HSTATE_VMHANDLER(r3)
71 PPC_STL r5, HSTATE_HOST_MSR(r3)
72
73
74 PPC_STL r1, HSTATE_HOST_R1(r3)
75 PPC_STL r2, HSTATE_HOST_R2(r3)
76
77
78 li r11, KVM_GUEST_MODE_GUEST
79 stb r11, HSTATE_IN_GUEST(r3)
80
81
82 LOAD_GUEST_SEGMENTS
83
84#ifdef CONFIG_PPC_BOOK3S_64
85BEGIN_FTR_SECTION
86
87 mfspr r8, SPRN_FSCR
88 std r8, HSTATE_HOST_FSCR(r13)
89
90 ld r9, SVCPU_SHADOW_FSCR(r13)
91 mtspr SPRN_FSCR, r9
92END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S)
93
94
95
96
97
98
99
100
101
102 lbz r0, HSTATE_RESTORE_HID5(r3)
103 cmpwi r0, 0
104 beq no_dcbz32_on
105
106 mfspr r0,SPRN_HID5
107 ori r0, r0, 0x80
108 mtspr SPRN_HID5,r0
109no_dcbz32_on:
110
111#endif
112
113
114
115 PPC_LL r8, SVCPU_CTR(r3)
116 PPC_LL r9, SVCPU_LR(r3)
117 lwz r10, SVCPU_CR(r3)
118 PPC_LL r11, SVCPU_XER(r3)
119
120 mtctr r8
121 mtlr r9
122 mtcr r10
123 mtxer r11
124
125
126 PPC_LL r9, SVCPU_PC(r3)
127
128 li r0, MSR_RI
129 andc r6, r6, r0
130
131 PPC_LL r0, SVCPU_R0(r3)
132 PPC_LL r1, SVCPU_R1(r3)
133 PPC_LL r2, SVCPU_R2(r3)
134 PPC_LL r5, SVCPU_R5(r3)
135 PPC_LL r7, SVCPU_R7(r3)
136 PPC_LL r8, SVCPU_R8(r3)
137 PPC_LL r10, SVCPU_R10(r3)
138 PPC_LL r11, SVCPU_R11(r3)
139 PPC_LL r12, SVCPU_R12(r3)
140 PPC_LL r13, SVCPU_R13(r3)
141
142 MTMSR_EERI(r6)
143 mtsrr0 r9
144 mtsrr1 r4
145
146 PPC_LL r4, SVCPU_R4(r3)
147 PPC_LL r6, SVCPU_R6(r3)
148 PPC_LL r9, SVCPU_R9(r3)
149 PPC_LL r3, (SVCPU_R3)(r3)
150
151 RFI_TO_GUEST
152kvmppc_handler_trampoline_enter_end:
153
154
155
156
157
158
159
160
161
162.global kvmppc_interrupt_pr
163kvmppc_interrupt_pr:
164
165
166
167
168
169
170
171
172
173#ifdef CONFIG_PPC64
174
175 ld r9,HSTATE_SCRATCH2(r13)
176 rotldi r12, r12, 32
177 stw r12, HSTATE_SCRATCH1(r13)
178 srdi r12, r12, 32
179#endif
180
181.global kvmppc_handler_trampoline_exit
182kvmppc_handler_trampoline_exit:
183
184
185
186
187
188
189
190
191
192
193
194 PPC_STL r0, SVCPU_R0(r13)
195 PPC_STL r1, SVCPU_R1(r13)
196 PPC_STL r2, SVCPU_R2(r13)
197 PPC_STL r3, SVCPU_R3(r13)
198 PPC_STL r4, SVCPU_R4(r13)
199 PPC_STL r5, SVCPU_R5(r13)
200 PPC_STL r6, SVCPU_R6(r13)
201 PPC_STL r7, SVCPU_R7(r13)
202 PPC_STL r8, SVCPU_R8(r13)
203 PPC_STL r9, SVCPU_R9(r13)
204 PPC_STL r10, SVCPU_R10(r13)
205 PPC_STL r11, SVCPU_R11(r13)
206
207
208 PPC_LL r1, HSTATE_HOST_R1(r13)
209 PPC_LL r2, HSTATE_HOST_R2(r13)
210
211
212#ifdef CONFIG_PPC64
213BEGIN_FTR_SECTION
214 andi. r0, r12, 0x2
215 cmpwi cr1, r0, 0
216 beq 1f
217 mfspr r3,SPRN_HSRR0
218 mfspr r4,SPRN_HSRR1
219 andi. r12,r12,0x3ffd
220 b 2f
221END_FTR_SECTION_IFSET(CPU_FTR_HVMODE)
222#endif
2231: mfsrr0 r3
224 mfsrr1 r4
2252:
226 PPC_STL r3, SVCPU_PC(r13)
227 PPC_STL r4, SVCPU_SHADOW_SRR1(r13)
228
229
230 GET_SCRATCH0(r9)
231 PPC_LL r8, HSTATE_SCRATCH0(r13)
232 lwz r7, HSTATE_SCRATCH1(r13)
233
234 PPC_STL r9, SVCPU_R13(r13)
235 PPC_STL r8, SVCPU_R12(r13)
236 stw r7, SVCPU_CR(r13)
237
238
239
240 mfxer r5
241 mfdar r6
242 mfdsisr r7
243 mfctr r8
244 mflr r9
245
246 PPC_STL r5, SVCPU_XER(r13)
247 PPC_STL r6, SVCPU_FAULT_DAR(r13)
248 stw r7, SVCPU_FAULT_DSISR(r13)
249 PPC_STL r8, SVCPU_CTR(r13)
250 PPC_STL r9, SVCPU_LR(r13)
251
252
253
254
255
256
257
258
259
260 cmpwi r12, BOOK3S_INTERRUPT_DATA_STORAGE
261 beq ld_last_inst
262 cmpwi r12, BOOK3S_INTERRUPT_PROGRAM
263 beq ld_last_inst
264 cmpwi r12, BOOK3S_INTERRUPT_SYSCALL
265 beq ld_last_prev_inst
266 cmpwi r12, BOOK3S_INTERRUPT_ALIGNMENT
267 beq- ld_last_inst
268#ifdef CONFIG_PPC64
269BEGIN_FTR_SECTION
270 cmpwi r12, BOOK3S_INTERRUPT_H_EMUL_ASSIST
271 beq- ld_last_inst
272END_FTR_SECTION_IFSET(CPU_FTR_HVMODE)
273BEGIN_FTR_SECTION
274 cmpwi r12, BOOK3S_INTERRUPT_FAC_UNAVAIL
275 beq- ld_last_inst
276END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S)
277#endif
278
279 b no_ld_last_inst
280
281ld_last_prev_inst:
282 addi r3, r3, -4
283
284ld_last_inst:
285
286
287
288 li r0, KVM_INST_FETCH_FAILED
289
290#ifdef USE_QUICK_LAST_INST
291
292
293
294 li r9, KVM_GUEST_MODE_SKIP
295 stb r9, HSTATE_IN_GUEST(r13)
296
297
298 mfmsr r9
299 ori r11, r9, MSR_DR
300 mtmsr r11
301 sync
302
303 lwz r0, 0(r3)
304
305 mtmsr r9
306 sync
307
308#endif
309 stw r0, SVCPU_LAST_INST(r13)
310
311no_ld_last_inst:
312
313
314 li r9, KVM_GUEST_MODE_NONE
315 stb r9, HSTATE_IN_GUEST(r13)
316
317
318 LOAD_HOST_SEGMENTS
319
320#ifdef CONFIG_PPC_BOOK3S_64
321
322 lbz r5, HSTATE_RESTORE_HID5(r13)
323 cmpwi r5, 0
324 beq no_dcbz32_off
325
326 li r4, 0
327 mfspr r5,SPRN_HID5
328 rldimi r5,r4,6,56
329 mtspr SPRN_HID5,r5
330
331no_dcbz32_off:
332
333BEGIN_FTR_SECTION
334
335 cmpwi r12, BOOK3S_INTERRUPT_FAC_UNAVAIL
336 bne+ no_fscr_save
337 mfspr r7, SPRN_FSCR
338 std r7, SVCPU_SHADOW_FSCR(r13)
339no_fscr_save:
340
341 ld r8, HSTATE_HOST_FSCR(r13)
342 mtspr SPRN_FSCR, r8
343END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S)
344
345#endif
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373 PPC_LL r6, HSTATE_HOST_MSR(r13)
374#ifdef CONFIG_PPC_TRANSACTIONAL_MEM
375
376
377
378
379
380
381
382
383 mfmsr r7
384 rldicl r7, r7, 64 - MSR_TS_S_LG, 62
385 rldimi r6, r7, MSR_TS_S_LG, 63 - MSR_TS_T_LG
386#endif
387 PPC_LL r8, HSTATE_VMHANDLER(r13)
388
389#ifdef CONFIG_PPC64
390BEGIN_FTR_SECTION
391 beq cr1, 1f
392 mtspr SPRN_HSRR1, r6
393 mtspr SPRN_HSRR0, r8
394END_FTR_SECTION_IFSET(CPU_FTR_HVMODE)
395#endif
3961:
397 mtsrr1 r6
398
399 mtsrr0 r8
400
401
402 cmpwi r12, BOOK3S_INTERRUPT_EXTERNAL
403 beqa BOOK3S_INTERRUPT_EXTERNAL
404 cmpwi r12, BOOK3S_INTERRUPT_DECREMENTER
405 beqa BOOK3S_INTERRUPT_DECREMENTER
406 cmpwi r12, BOOK3S_INTERRUPT_PERFMON
407 beqa BOOK3S_INTERRUPT_PERFMON
408 cmpwi r12, BOOK3S_INTERRUPT_DOORBELL
409 beqa BOOK3S_INTERRUPT_DOORBELL
410
411 RFI_TO_KERNEL
412kvmppc_handler_trampoline_exit_end:
413