1
2#ifndef __HEAD_BOOKE_H__
3#define __HEAD_BOOKE_H__
4
5#include <asm/ptrace.h>
6#include <asm/kvm_asm.h>
7#include <asm/kvm_booke_hv_asm.h>
8
9#ifdef __ASSEMBLY__
10
11
12
13
14
15#define SET_IVOR(vector_number, vector_label) \
16 li r26,vector_label@l; \
17 mtspr SPRN_IVOR##vector_number,r26; \
18 sync
19
20#if (THREAD_SHIFT < 15)
21#define ALLOC_STACK_FRAME(reg, val) \
22 addi reg,reg,val
23#else
24#define ALLOC_STACK_FRAME(reg, val) \
25 addis reg,reg,val@ha; \
26 addi reg,reg,val@l
27#endif
28
29
30
31
32
33
34
35#define THREAD_NORMSAVE(offset) (THREAD_NORMSAVES + (offset * 4))
36
37#ifdef CONFIG_PPC_FSL_BOOK3E
38#define BOOKE_CLEAR_BTB(reg) \
39START_BTB_FLUSH_SECTION \
40 BTB_FLUSH(reg) \
41END_BTB_FLUSH_SECTION
42#else
43#define BOOKE_CLEAR_BTB(reg)
44#endif
45
46
47#define NORMAL_EXCEPTION_PROLOG(trapno, intno) \
48 mtspr SPRN_SPRG_WSCRATCH0, r10; \
49 mfspr r10, SPRN_SPRG_THREAD; \
50 stw r11, THREAD_NORMSAVE(0)(r10); \
51 stw r13, THREAD_NORMSAVE(2)(r10); \
52 mfcr r13; \
53 mfspr r11, SPRN_SRR1; \
54 DO_KVM BOOKE_INTERRUPT_##intno SPRN_SRR1; \
55 andi. r11, r11, MSR_PR; \
56 LOAD_REG_IMMEDIATE(r11, MSR_KERNEL); \
57 mtmsr r11; \
58 mr r11, r1; \
59 beq 1f; \
60 BOOKE_CLEAR_BTB(r11) \
61 \
62 lwz r11, TASK_STACK - THREAD(r10); \
63 ALLOC_STACK_FRAME(r11, THREAD_SIZE); \
641 : subi r11, r11, INT_FRAME_SIZE; \
65 stw r13, _CCR(r11); \
66 stw r12,GPR12(r11); \
67 stw r9,GPR9(r11); \
68 mfspr r13, SPRN_SPRG_RSCRATCH0; \
69 stw r13, GPR10(r11); \
70 lwz r12, THREAD_NORMSAVE(0)(r10); \
71 stw r12,GPR11(r11); \
72 lwz r13, THREAD_NORMSAVE(2)(r10); \
73 mflr r10; \
74 stw r10,_LINK(r11); \
75 mfspr r12,SPRN_SRR0; \
76 stw r1, GPR1(r11); \
77 mfspr r9,SPRN_SRR1; \
78 stw r1, 0(r11); \
79 mr r1, r11; \
80 rlwinm r9,r9,0,14,12; \
81 COMMON_EXCEPTION_PROLOG_END trapno
82
83.macro COMMON_EXCEPTION_PROLOG_END trapno
84 stw r0,GPR0(r1)
85 lis r10, STACK_FRAME_REGS_MARKER@ha
86 addi r10, r10, STACK_FRAME_REGS_MARKER@l
87 stw r10, 8(r1)
88 li r10, \trapno
89 stw r10,_TRAP(r1)
90 SAVE_4GPRS(3, r1)
91 SAVE_2GPRS(7, r1)
92 SAVE_NVGPRS(r1)
93 stw r2,GPR2(r1)
94 stw r12,_NIP(r1)
95 stw r9,_MSR(r1)
96 mfctr r10
97 mfspr r2,SPRN_SPRG_THREAD
98 stw r10,_CTR(r1)
99 tovirt(r2, r2)
100 mfspr r10,SPRN_XER
101 addi r2, r2, -THREAD
102 stw r10,_XER(r1)
103 addi r3,r1,STACK_FRAME_OVERHEAD
104.endm
105
106.macro prepare_transfer_to_handler
107#ifdef CONFIG_E500
108 andi. r12,r9,MSR_PR
109 bne 777f
110 bl prepare_transfer_to_handler
111777:
112#endif
113.endm
114
115.macro SYSCALL_ENTRY trapno intno srr1
116 mfspr r10, SPRN_SPRG_THREAD
117#ifdef CONFIG_KVM_BOOKE_HV
118BEGIN_FTR_SECTION
119 mtspr SPRN_SPRG_WSCRATCH0, r10
120 stw r11, THREAD_NORMSAVE(0)(r10)
121 stw r13, THREAD_NORMSAVE(2)(r10)
122 mfcr r13
123 mfspr r11, SPRN_SRR1
124 mtocrf 0x80, r11
125 bf 3, 1975f
126 b kvmppc_handler_\intno\()_\srr1
1271975:
128 mr r12, r13
129 lwz r13, THREAD_NORMSAVE(2)(r10)
130FTR_SECTION_ELSE
131 mfcr r12
132ALT_FTR_SECTION_END_IFSET(CPU_FTR_EMB_HV)
133#else
134 mfcr r12
135#endif
136 mfspr r9, SPRN_SRR1
137 BOOKE_CLEAR_BTB(r11)
138 mr r11, r1
139 lwz r1, TASK_STACK - THREAD(r10)
140 rlwinm r12,r12,0,4,2
141 ALLOC_STACK_FRAME(r1, THREAD_SIZE - INT_FRAME_SIZE)
142 stw r12, _CCR(r1)
143 mfspr r12,SPRN_SRR0
144 stw r12,_NIP(r1)
145 b transfer_to_syscall
146.endm
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165#define MC_STACK_BASE mcheckirq_ctx
166#define CRIT_STACK_BASE critirq_ctx
167
168
169#define DBG_STACK_BASE dbgirq_ctx
170
171#ifdef CONFIG_SMP
172#define BOOKE_LOAD_EXC_LEVEL_STACK(level) \
173 mfspr r8,SPRN_PIR; \
174 slwi r8,r8,2; \
175 addis r8,r8,level##_STACK_BASE@ha; \
176 lwz r8,level##_STACK_BASE@l(r8); \
177 addi r8,r8,THREAD_SIZE - INT_FRAME_SIZE;
178#else
179#define BOOKE_LOAD_EXC_LEVEL_STACK(level) \
180 lis r8,level##_STACK_BASE@ha; \
181 lwz r8,level##_STACK_BASE@l(r8); \
182 addi r8,r8,THREAD_SIZE - INT_FRAME_SIZE;
183#endif
184
185
186
187
188
189
190
191
192
193#define EXC_LEVEL_EXCEPTION_PROLOG(exc_level, trapno, intno, exc_level_srr0, exc_level_srr1) \
194 mtspr SPRN_SPRG_WSCRATCH_##exc_level,r8; \
195 BOOKE_LOAD_EXC_LEVEL_STACK(exc_level); \
196 stw r9,GPR9(r8); \
197 mfcr r9; \
198 stw r10,GPR10(r8); \
199 stw r11,GPR11(r8); \
200 stw r9,_CCR(r8); \
201 mfspr r11,exc_level_srr1; \
202 DO_KVM BOOKE_INTERRUPT_##intno exc_level_srr1; \
203 BOOKE_CLEAR_BTB(r10) \
204 andi. r11,r11,MSR_PR; \
205 LOAD_REG_IMMEDIATE(r11, MSR_KERNEL & ~(MSR_ME|MSR_DE|MSR_CE)); \
206 mtmsr r11; \
207 mfspr r11,SPRN_SPRG_THREAD; \
208 lwz r11, TASK_STACK - THREAD(r11); \
209 addi r11,r11,THREAD_SIZE - INT_FRAME_SIZE; \
210 beq 1f; \
211 \
212 stw r9,_CCR(r11); \
213 lwz r10,GPR10(r8); \
214 lwz r9,GPR9(r8); \
215 stw r10,GPR10(r11); \
216 lwz r10,GPR11(r8); \
217 stw r9,GPR9(r11); \
218 stw r10,GPR11(r11); \
219 b 2f; \
220 \
2211: mr r11, r8; \
2222: mfspr r8,SPRN_SPRG_RSCRATCH_##exc_level; \
223 stw r12,GPR12(r11); \
224 mflr r10; \
225 stw r10,_LINK(r11); \
226 mfspr r12,SPRN_DEAR; \
227 stw r12,_DEAR(r11); \
228 mfspr r9,SPRN_ESR; \
229 stw r9,_ESR(r11); \
230 mfspr r12,exc_level_srr0; \
231 stw r1,GPR1(r11); \
232 mfspr r9,exc_level_srr1; \
233 stw r1,0(r11); \
234 mr r1,r11; \
235 rlwinm r9,r9,0,14,12; \
236 COMMON_EXCEPTION_PROLOG_END trapno
237
238#define SAVE_xSRR(xSRR) \
239 mfspr r0,SPRN_##xSRR##0; \
240 stw r0,_##xSRR##0(r1); \
241 mfspr r0,SPRN_##xSRR##1; \
242 stw r0,_##xSRR##1(r1)
243
244
245.macro SAVE_MMU_REGS
246#ifdef CONFIG_PPC_BOOK3E_MMU
247 mfspr r0,SPRN_MAS0
248 stw r0,MAS0(r1)
249 mfspr r0,SPRN_MAS1
250 stw r0,MAS1(r1)
251 mfspr r0,SPRN_MAS2
252 stw r0,MAS2(r1)
253 mfspr r0,SPRN_MAS3
254 stw r0,MAS3(r1)
255 mfspr r0,SPRN_MAS6
256 stw r0,MAS6(r1)
257#ifdef CONFIG_PHYS_64BIT
258 mfspr r0,SPRN_MAS7
259 stw r0,MAS7(r1)
260#endif
261#endif
262#ifdef CONFIG_44x
263 mfspr r0,SPRN_MMUCR
264 stw r0,MMUCR(r1)
265#endif
266.endm
267
268#define CRITICAL_EXCEPTION_PROLOG(trapno, intno) \
269 EXC_LEVEL_EXCEPTION_PROLOG(CRIT, trapno+2, intno, SPRN_CSRR0, SPRN_CSRR1)
270#define DEBUG_EXCEPTION_PROLOG(trapno) \
271 EXC_LEVEL_EXCEPTION_PROLOG(DBG, trapno+8, DEBUG, SPRN_DSRR0, SPRN_DSRR1)
272#define MCHECK_EXCEPTION_PROLOG(trapno) \
273 EXC_LEVEL_EXCEPTION_PROLOG(MC, trapno+4, MACHINE_CHECK, \
274 SPRN_MCSRR0, SPRN_MCSRR1)
275
276
277
278
279
280
281
282#define GUEST_DOORBELL_EXCEPTION \
283 START_EXCEPTION(GuestDoorbell); \
284 mtspr SPRN_SPRG_WSCRATCH0, r10; \
285 mfspr r10, SPRN_SPRG_THREAD; \
286 stw r11, THREAD_NORMSAVE(0)(r10); \
287 mfspr r11, SPRN_SRR1; \
288 stw r13, THREAD_NORMSAVE(2)(r10); \
289 mfcr r13; \
290 DO_KVM BOOKE_INTERRUPT_GUEST_DBELL SPRN_GSRR1; \
291 trap
292
293
294
295
296#define START_EXCEPTION(label) \
297 .align 5; \
298label:
299
300#define EXCEPTION(n, intno, label, hdlr) \
301 START_EXCEPTION(label); \
302 NORMAL_EXCEPTION_PROLOG(n, intno); \
303 prepare_transfer_to_handler; \
304 bl hdlr; \
305 b interrupt_return
306
307#define CRITICAL_EXCEPTION(n, intno, label, hdlr) \
308 START_EXCEPTION(label); \
309 CRITICAL_EXCEPTION_PROLOG(n, intno); \
310 SAVE_MMU_REGS; \
311 SAVE_xSRR(SRR); \
312 prepare_transfer_to_handler; \
313 bl hdlr; \
314 b ret_from_crit_exc
315
316#define MCHECK_EXCEPTION(n, label, hdlr) \
317 START_EXCEPTION(label); \
318 MCHECK_EXCEPTION_PROLOG(n); \
319 mfspr r5,SPRN_ESR; \
320 stw r5,_ESR(r11); \
321 SAVE_xSRR(DSRR); \
322 SAVE_xSRR(CSRR); \
323 SAVE_MMU_REGS; \
324 SAVE_xSRR(SRR); \
325 prepare_transfer_to_handler; \
326 bl hdlr; \
327 b ret_from_mcheck_exc
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342#define DEBUG_DEBUG_EXCEPTION \
343 START_EXCEPTION(DebugDebug); \
344 DEBUG_EXCEPTION_PROLOG(2000); \
345 \
346
347
348
349
350
351
352
353 \
354 mfspr r10,SPRN_DBSR; \
355 andis. r10,r10,(DBSR_IC|DBSR_BT)@h; \
356 beq+ 2f; \
357 \
358 lis r10,interrupt_base@h; \
359 ori r10,r10,interrupt_base@l; \
360 cmplw r12,r10; \
361 blt+ 2f; \
362 \
363 lis r10,interrupt_end@h; \
364 ori r10,r10,interrupt_end@l; \
365 cmplw r12,r10; \
366 bgt+ 2f; \
367 \
368 \
3691: rlwinm r9,r9,0,~MSR_DE; \
370 lis r10,(DBSR_IC|DBSR_BT)@h; \
371 mtspr SPRN_DBSR,r10; \
372 \
373 lwz r10,_CCR(r11); \
374 lwz r0,GPR0(r11); \
375 lwz r1,GPR1(r11); \
376 mtcrf 0x80,r10; \
377 mtspr SPRN_DSRR0,r12; \
378 mtspr SPRN_DSRR1,r9; \
379 lwz r9,GPR9(r11); \
380 lwz r12,GPR12(r11); \
381 mtspr SPRN_SPRG_WSCRATCH_DBG,r8; \
382 BOOKE_LOAD_EXC_LEVEL_STACK(DBG); \
383 lwz r10,GPR10(r8); \
384 lwz r11,GPR11(r8); \
385 mfspr r8,SPRN_SPRG_RSCRATCH_DBG; \
386 \
387 PPC_RFDI; \
388 b .; \
389 \
390 \
3912: mfspr r4,SPRN_DBSR; \
392 stw r4,_ESR(r11); \
393 SAVE_xSRR(CSRR); \
394 SAVE_MMU_REGS; \
395 SAVE_xSRR(SRR); \
396 prepare_transfer_to_handler; \
397 bl DebugException; \
398 b ret_from_debug_exc
399
400#define DEBUG_CRIT_EXCEPTION \
401 START_EXCEPTION(DebugCrit); \
402 CRITICAL_EXCEPTION_PROLOG(2000,DEBUG); \
403 \
404
405
406
407
408
409
410
411 \
412 mfspr r10,SPRN_DBSR; \
413 andis. r10,r10,(DBSR_IC|DBSR_BT)@h; \
414 beq+ 2f; \
415 \
416 lis r10,interrupt_base@h; \
417 ori r10,r10,interrupt_base@l; \
418 cmplw r12,r10; \
419 blt+ 2f; \
420 \
421 lis r10,interrupt_end@h; \
422 ori r10,r10,interrupt_end@l; \
423 cmplw r12,r10; \
424 bgt+ 2f; \
425 \
426 \
4271: rlwinm r9,r9,0,~MSR_DE; \
428 lis r10,(DBSR_IC|DBSR_BT)@h; \
429 mtspr SPRN_DBSR,r10; \
430 \
431 lwz r10,_CCR(r11); \
432 lwz r0,GPR0(r11); \
433 lwz r1,GPR1(r11); \
434 mtcrf 0x80,r10; \
435 mtspr SPRN_CSRR0,r12; \
436 mtspr SPRN_CSRR1,r9; \
437 lwz r9,GPR9(r11); \
438 lwz r12,GPR12(r11); \
439 mtspr SPRN_SPRG_WSCRATCH_CRIT,r8; \
440 BOOKE_LOAD_EXC_LEVEL_STACK(CRIT); \
441 lwz r10,GPR10(r8); \
442 lwz r11,GPR11(r8); \
443 mfspr r8,SPRN_SPRG_RSCRATCH_CRIT; \
444 \
445 rfci; \
446 b .; \
447 \
448 \
4492: mfspr r4,SPRN_DBSR; \
450 stw r4,_ESR(r11); \
451 SAVE_MMU_REGS; \
452 SAVE_xSRR(SRR); \
453 prepare_transfer_to_handler; \
454 bl DebugException; \
455 b ret_from_crit_exc
456
457#define DATA_STORAGE_EXCEPTION \
458 START_EXCEPTION(DataStorage) \
459 NORMAL_EXCEPTION_PROLOG(0x300, DATA_STORAGE); \
460 mfspr r5,SPRN_ESR; \
461 stw r5,_ESR(r11); \
462 mfspr r4,SPRN_DEAR; \
463 stw r4, _DEAR(r11); \
464 prepare_transfer_to_handler; \
465 bl do_page_fault; \
466 b interrupt_return
467
468#define INSTRUCTION_STORAGE_EXCEPTION \
469 START_EXCEPTION(InstructionStorage) \
470 NORMAL_EXCEPTION_PROLOG(0x400, INST_STORAGE); \
471 mfspr r5,SPRN_ESR; \
472 stw r5,_ESR(r11); \
473 stw r12, _DEAR(r11); \
474 prepare_transfer_to_handler; \
475 bl do_page_fault; \
476 b interrupt_return
477
478#define ALIGNMENT_EXCEPTION \
479 START_EXCEPTION(Alignment) \
480 NORMAL_EXCEPTION_PROLOG(0x600, ALIGNMENT); \
481 mfspr r4,SPRN_DEAR; \
482 stw r4,_DEAR(r11); \
483 prepare_transfer_to_handler; \
484 bl alignment_exception; \
485 REST_NVGPRS(r1); \
486 b interrupt_return
487
488#define PROGRAM_EXCEPTION \
489 START_EXCEPTION(Program) \
490 NORMAL_EXCEPTION_PROLOG(0x700, PROGRAM); \
491 mfspr r4,SPRN_ESR; \
492 stw r4,_ESR(r11); \
493 prepare_transfer_to_handler; \
494 bl program_check_exception; \
495 REST_NVGPRS(r1); \
496 b interrupt_return
497
498#define DECREMENTER_EXCEPTION \
499 START_EXCEPTION(Decrementer) \
500 NORMAL_EXCEPTION_PROLOG(0x900, DECREMENTER); \
501 lis r0,TSR_DIS@h; \
502 mtspr SPRN_TSR,r0; \
503 prepare_transfer_to_handler; \
504 bl timer_interrupt; \
505 b interrupt_return
506
507#define FP_UNAVAILABLE_EXCEPTION \
508 START_EXCEPTION(FloatingPointUnavailable) \
509 NORMAL_EXCEPTION_PROLOG(0x800, FP_UNAVAIL); \
510 beq 1f; \
511 bl load_up_fpu; \
512 b fast_exception_return; \
5131: prepare_transfer_to_handler; \
514 bl kernel_fp_unavailable_exception; \
515 b interrupt_return
516
517#endif
518#endif
519