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#ifdef CONFIG_PPC64
172
173 rotldi r12, r12, 32
174 stw r12, HSTATE_SCRATCH1(r13)
175 srdi r12, r12, 32
176#endif
177
178.global kvmppc_handler_trampoline_exit
179kvmppc_handler_trampoline_exit:
180
181
182
183
184
185
186
187
188
189
190
191 PPC_STL r0, SVCPU_R0(r13)
192 PPC_STL r1, SVCPU_R1(r13)
193 PPC_STL r2, SVCPU_R2(r13)
194 PPC_STL r3, SVCPU_R3(r13)
195 PPC_STL r4, SVCPU_R4(r13)
196 PPC_STL r5, SVCPU_R5(r13)
197 PPC_STL r6, SVCPU_R6(r13)
198 PPC_STL r7, SVCPU_R7(r13)
199 PPC_STL r8, SVCPU_R8(r13)
200 PPC_STL r9, SVCPU_R9(r13)
201 PPC_STL r10, SVCPU_R10(r13)
202 PPC_STL r11, SVCPU_R11(r13)
203
204
205 PPC_LL r1, HSTATE_HOST_R1(r13)
206 PPC_LL r2, HSTATE_HOST_R2(r13)
207
208
209#ifdef CONFIG_PPC64
210BEGIN_FTR_SECTION
211 andi. r0, r12, 0x2
212 cmpwi cr1, r0, 0
213 beq 1f
214 mfspr r3,SPRN_HSRR0
215 mfspr r4,SPRN_HSRR1
216 andi. r12,r12,0x3ffd
217 b 2f
218END_FTR_SECTION_IFSET(CPU_FTR_HVMODE)
219#endif
2201: mfsrr0 r3
221 mfsrr1 r4
2222:
223 PPC_STL r3, SVCPU_PC(r13)
224 PPC_STL r4, SVCPU_SHADOW_SRR1(r13)
225
226
227 GET_SCRATCH0(r9)
228 PPC_LL r8, HSTATE_SCRATCH0(r13)
229 lwz r7, HSTATE_SCRATCH1(r13)
230
231 PPC_STL r9, SVCPU_R13(r13)
232 PPC_STL r8, SVCPU_R12(r13)
233 stw r7, SVCPU_CR(r13)
234
235
236
237 mfxer r5
238 mfdar r6
239 mfdsisr r7
240 mfctr r8
241 mflr r9
242
243 PPC_STL r5, SVCPU_XER(r13)
244 PPC_STL r6, SVCPU_FAULT_DAR(r13)
245 stw r7, SVCPU_FAULT_DSISR(r13)
246 PPC_STL r8, SVCPU_CTR(r13)
247 PPC_STL r9, SVCPU_LR(r13)
248
249
250
251
252
253
254
255
256
257 cmpwi r12, BOOK3S_INTERRUPT_DATA_STORAGE
258 beq ld_last_inst
259 cmpwi r12, BOOK3S_INTERRUPT_PROGRAM
260 beq ld_last_inst
261 cmpwi r12, BOOK3S_INTERRUPT_SYSCALL
262 beq ld_last_prev_inst
263 cmpwi r12, BOOK3S_INTERRUPT_ALIGNMENT
264 beq- ld_last_inst
265#ifdef CONFIG_PPC64
266BEGIN_FTR_SECTION
267 cmpwi r12, BOOK3S_INTERRUPT_H_EMUL_ASSIST
268 beq- ld_last_inst
269END_FTR_SECTION_IFSET(CPU_FTR_HVMODE)
270BEGIN_FTR_SECTION
271 cmpwi r12, BOOK3S_INTERRUPT_FAC_UNAVAIL
272 beq- ld_last_inst
273END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S)
274#endif
275
276 b no_ld_last_inst
277
278ld_last_prev_inst:
279 addi r3, r3, -4
280
281ld_last_inst:
282
283
284
285 li r0, KVM_INST_FETCH_FAILED
286
287#ifdef USE_QUICK_LAST_INST
288
289
290
291 li r9, KVM_GUEST_MODE_SKIP
292 stb r9, HSTATE_IN_GUEST(r13)
293
294
295 mfmsr r9
296 ori r11, r9, MSR_DR
297 mtmsr r11
298 sync
299
300 lwz r0, 0(r3)
301
302 mtmsr r9
303 sync
304
305#endif
306 stw r0, SVCPU_LAST_INST(r13)
307
308no_ld_last_inst:
309
310
311 li r9, KVM_GUEST_MODE_NONE
312 stb r9, HSTATE_IN_GUEST(r13)
313
314
315 LOAD_HOST_SEGMENTS
316
317#ifdef CONFIG_PPC_BOOK3S_64
318
319 lbz r5, HSTATE_RESTORE_HID5(r13)
320 cmpwi r5, 0
321 beq no_dcbz32_off
322
323 li r4, 0
324 mfspr r5,SPRN_HID5
325 rldimi r5,r4,6,56
326 mtspr SPRN_HID5,r5
327
328no_dcbz32_off:
329
330BEGIN_FTR_SECTION
331
332 cmpwi r12, BOOK3S_INTERRUPT_FAC_UNAVAIL
333 bne+ no_fscr_save
334 mfspr r7, SPRN_FSCR
335 std r7, SVCPU_SHADOW_FSCR(r13)
336no_fscr_save:
337
338 ld r8, HSTATE_HOST_FSCR(r13)
339 mtspr SPRN_FSCR, r8
340END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S)
341
342#endif
343
344
345
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 PPC_LL r6, HSTATE_HOST_MSR(r13)
371#ifdef CONFIG_PPC_TRANSACTIONAL_MEM
372
373
374
375
376
377
378
379
380 mfmsr r7
381 rldicl r7, r7, 64 - MSR_TS_S_LG, 62
382 rldimi r6, r7, MSR_TS_S_LG, 63 - MSR_TS_T_LG
383#endif
384 PPC_LL r8, HSTATE_VMHANDLER(r13)
385
386#ifdef CONFIG_PPC64
387BEGIN_FTR_SECTION
388 beq cr1, 1f
389 mtspr SPRN_HSRR1, r6
390 mtspr SPRN_HSRR0, r8
391END_FTR_SECTION_IFSET(CPU_FTR_HVMODE)
392#endif
3931:
394 mtsrr1 r6
395
396 mtsrr0 r8
397
398
399 cmpwi r12, BOOK3S_INTERRUPT_EXTERNAL
400 beqa BOOK3S_INTERRUPT_EXTERNAL
401 cmpwi r12, BOOK3S_INTERRUPT_DECREMENTER
402 beqa BOOK3S_INTERRUPT_DECREMENTER
403 cmpwi r12, BOOK3S_INTERRUPT_PERFMON
404 beqa BOOK3S_INTERRUPT_PERFMON
405 cmpwi r12, BOOK3S_INTERRUPT_DOORBELL
406 beqa BOOK3S_INTERRUPT_DOORBELL
407
408 RFI_TO_KERNEL
409kvmppc_handler_trampoline_exit_end:
410