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) \
39 START_BTB_FLUSH_SECTION \
40 BTB_FLUSH(reg) \
41 END_BTB_FLUSH_SECTION
42 #else
43 #define BOOKE_CLEAR_BTB(reg)
44 #endif
45
46
47 #define NORMAL_EXCEPTION_PROLOG(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 mr r11, r1; \
57 beq 1f; \
58 BOOKE_CLEAR_BTB(r11) \
59 \
60 lwz r11, TASK_STACK - THREAD(r10); \
61 ALLOC_STACK_FRAME(r11, THREAD_SIZE); \
62 1 : subi r11, r11, INT_FRAME_SIZE; \
63 stw r13, _CCR(r11); \
64 stw r12,GPR12(r11); \
65 stw r9,GPR9(r11); \
66 mfspr r13, SPRN_SPRG_RSCRATCH0; \
67 stw r13, GPR10(r11); \
68 lwz r12, THREAD_NORMSAVE(0)(r10); \
69 stw r12,GPR11(r11); \
70 lwz r13, THREAD_NORMSAVE(2)(r10); \
71 mflr r10; \
72 stw r10,_LINK(r11); \
73 mfspr r12,SPRN_SRR0; \
74 stw r1, GPR1(r11); \
75 mfspr r9,SPRN_SRR1; \
76 stw r1, 0(r11); \
77 mr r1, r11; \
78 rlwinm r9,r9,0,14,12; \
79 stw r0,GPR0(r11); \
80 lis r10, STACK_FRAME_REGS_MARKER@ha; \
81 addi r10, r10, STACK_FRAME_REGS_MARKER@l; \
82 stw r10, 8(r11); \
83 SAVE_4GPRS(3, r11); \
84 SAVE_2GPRS(7, r11)
85
86 .macro SYSCALL_ENTRY trapno intno srr1
87 mfspr r10, SPRN_SPRG_THREAD
88 #ifdef CONFIG_KVM_BOOKE_HV
89 BEGIN_FTR_SECTION
90 mtspr SPRN_SPRG_WSCRATCH0, r10
91 stw r11, THREAD_NORMSAVE(0)(r10)
92 stw r13, THREAD_NORMSAVE(2)(r10)
93 mfcr r13
94 mfspr r11, SPRN_SRR1
95 mtocrf 0x80, r11
96 bf 3, 1975f
97 b kvmppc_handler_\intno\()_\srr1
98 1975:
99 mr r12, r13
100 lwz r13, THREAD_NORMSAVE(2)(r10)
101 FTR_SECTION_ELSE
102 #endif
103 mfcr r12
104 #ifdef CONFIG_KVM_BOOKE_HV
105 ALT_FTR_SECTION_END_IFSET(CPU_FTR_EMB_HV)
106 #endif
107 BOOKE_CLEAR_BTB(r11)
108 lwz r11, TASK_STACK - THREAD(r10)
109 rlwinm r12,r12,0,4,2
110 ALLOC_STACK_FRAME(r11, THREAD_SIZE - INT_FRAME_SIZE)
111 stw r12, _CCR(r11)
112 mflr r12
113 stw r12,_LINK(r11)
114 mfspr r12,SPRN_SRR0
115 stw r1, GPR1(r11)
116 mfspr r9,SPRN_SRR1
117 stw r1, 0(r11)
118 mr r1, r11
119 stw r12,_NIP(r11)
120 rlwinm r9,r9,0,14,12
121 lis r12, STACK_FRAME_REGS_MARKER@ha
122 stw r2,GPR2(r11)
123 addi r12, r12, STACK_FRAME_REGS_MARKER@l
124 stw r9,_MSR(r11)
125 li r2, \trapno + 1
126 stw r12, 8(r11)
127 stw r2,_TRAP(r11)
128 SAVE_GPR(0, r11)
129 SAVE_4GPRS(3, r11)
130 SAVE_2GPRS(7, r11)
131
132 addi r11,r1,STACK_FRAME_OVERHEAD
133 addi r2,r10,-THREAD
134 stw r11,PT_REGS(r10)
135
136
137 lwz r12,THREAD_DBCR0(r10)
138 andis. r12,r12,DBCR0_IDM@h
139 ACCOUNT_CPU_USER_ENTRY(r2, r11, r12)
140 beq+ 3f
141
142 li r12,-1
143 mtspr SPRN_DBSR,r12
144 lis r11,global_dbcr0@ha
145 tophys(r11,r11)
146 addi r11,r11,global_dbcr0@l
147 #ifdef CONFIG_SMP
148 lwz r10, TASK_CPU(r2)
149 slwi r10, r10, 3
150 add r11, r11, r10
151 #endif
152 lwz r12,0(r11)
153 mtspr SPRN_DBCR0,r12
154 lwz r12,4(r11)
155 addi r12,r12,-1
156 stw r12,4(r11)
157
158 3:
159 tovirt(r2, r2)
160 lis r11, transfer_to_syscall@h
161 ori r11, r11, transfer_to_syscall@l
162 #ifdef CONFIG_TRACE_IRQFLAGS
163
164
165
166
167
168 lis r10, MSR_KERNEL@h
169 ori r10, r10, MSR_KERNEL@l
170 rlwimi r10, r9, 0, MSR_EE
171 #else
172 lis r10, (MSR_KERNEL | MSR_EE)@h
173 ori r10, r10, (MSR_KERNEL | MSR_EE)@l
174 #endif
175 mtspr SPRN_SRR1,r10
176 mtspr SPRN_SRR0,r11
177 SYNC
178 RFI
179 .endm
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199 #define MC_STACK_BASE mcheckirq_ctx
200 #define CRIT_STACK_BASE critirq_ctx
201
202
203 #define DBG_STACK_BASE dbgirq_ctx
204
205 #define EXC_LVL_FRAME_OVERHEAD (THREAD_SIZE - INT_FRAME_SIZE - EXC_LVL_SIZE)
206
207 #ifdef CONFIG_SMP
208 #define BOOKE_LOAD_EXC_LEVEL_STACK(level) \
209 mfspr r8,SPRN_PIR; \
210 slwi r8,r8,2; \
211 addis r8,r8,level##_STACK_BASE@ha; \
212 lwz r8,level##_STACK_BASE@l(r8); \
213 addi r8,r8,EXC_LVL_FRAME_OVERHEAD;
214 #else
215 #define BOOKE_LOAD_EXC_LEVEL_STACK(level) \
216 lis r8,level##_STACK_BASE@ha; \
217 lwz r8,level##_STACK_BASE@l(r8); \
218 addi r8,r8,EXC_LVL_FRAME_OVERHEAD;
219 #endif
220
221
222
223
224
225
226
227
228
229 #define EXC_LEVEL_EXCEPTION_PROLOG(exc_level, intno, exc_level_srr0, exc_level_srr1) \
230 mtspr SPRN_SPRG_WSCRATCH_##exc_level,r8; \
231 BOOKE_LOAD_EXC_LEVEL_STACK(exc_level); \
232 stw r9,GPR9(r8); \
233 mfcr r9; \
234 stw r10,GPR10(r8); \
235 stw r11,GPR11(r8); \
236 stw r9,_CCR(r8); \
237 mfspr r11,exc_level_srr1; \
238 DO_KVM BOOKE_INTERRUPT_##intno exc_level_srr1; \
239 BOOKE_CLEAR_BTB(r10) \
240 andi. r11,r11,MSR_PR; \
241 mfspr r11,SPRN_SPRG_THREAD; \
242 lwz r11, TASK_STACK - THREAD(r11); \
243 addi r11,r11,EXC_LVL_FRAME_OVERHEAD; \
244 beq 1f; \
245 \
246 stw r9,_CCR(r11); \
247 lwz r10,GPR10(r8); \
248 lwz r9,GPR9(r8); \
249 stw r10,GPR10(r11); \
250 lwz r10,GPR11(r8); \
251 stw r9,GPR9(r11); \
252 stw r10,GPR11(r11); \
253 b 2f; \
254 \
255 1: mr r11, r8; \
256 2: mfspr r8,SPRN_SPRG_RSCRATCH_##exc_level; \
257 stw r12,GPR12(r11); \
258 mflr r10; \
259 stw r10,_LINK(r11); \
260 mfspr r12,SPRN_DEAR; \
261 stw r12,_DEAR(r11); \
262 mfspr r9,SPRN_ESR; \
263 stw r9,_ESR(r11); \
264 mfspr r12,exc_level_srr0; \
265 stw r1,GPR1(r11); \
266 mfspr r9,exc_level_srr1; \
267 stw r1,0(r11); \
268 mr r1,r11; \
269 rlwinm r9,r9,0,14,12; \
270 stw r0,GPR0(r11); \
271 SAVE_4GPRS(3, r11); \
272 SAVE_2GPRS(7, r11)
273
274 #define CRITICAL_EXCEPTION_PROLOG(intno) \
275 EXC_LEVEL_EXCEPTION_PROLOG(CRIT, intno, SPRN_CSRR0, SPRN_CSRR1)
276 #define DEBUG_EXCEPTION_PROLOG \
277 EXC_LEVEL_EXCEPTION_PROLOG(DBG, DEBUG, SPRN_DSRR0, SPRN_DSRR1)
278 #define MCHECK_EXCEPTION_PROLOG \
279 EXC_LEVEL_EXCEPTION_PROLOG(MC, MACHINE_CHECK, \
280 SPRN_MCSRR0, SPRN_MCSRR1)
281
282
283
284
285
286
287
288 #define GUEST_DOORBELL_EXCEPTION \
289 START_EXCEPTION(GuestDoorbell); \
290 mtspr SPRN_SPRG_WSCRATCH0, r10; \
291 mfspr r10, SPRN_SPRG_THREAD; \
292 stw r11, THREAD_NORMSAVE(0)(r10); \
293 mfspr r11, SPRN_SRR1; \
294 stw r13, THREAD_NORMSAVE(2)(r10); \
295 mfcr r13; \
296 DO_KVM BOOKE_INTERRUPT_GUEST_DBELL SPRN_GSRR1; \
297 trap
298
299
300
301
302 #define START_EXCEPTION(label) \
303 .align 5; \
304 label:
305
306 #define EXCEPTION(n, intno, label, hdlr, xfer) \
307 START_EXCEPTION(label); \
308 NORMAL_EXCEPTION_PROLOG(intno); \
309 addi r3,r1,STACK_FRAME_OVERHEAD; \
310 xfer(n, hdlr)
311
312 #define CRITICAL_EXCEPTION(n, intno, label, hdlr) \
313 START_EXCEPTION(label); \
314 CRITICAL_EXCEPTION_PROLOG(intno); \
315 addi r3,r1,STACK_FRAME_OVERHEAD; \
316 EXC_XFER_TEMPLATE(hdlr, n+2, (MSR_KERNEL & ~(MSR_ME|MSR_DE|MSR_CE)), \
317 crit_transfer_to_handler, ret_from_crit_exc)
318
319 #define MCHECK_EXCEPTION(n, label, hdlr) \
320 START_EXCEPTION(label); \
321 MCHECK_EXCEPTION_PROLOG; \
322 mfspr r5,SPRN_ESR; \
323 stw r5,_ESR(r11); \
324 addi r3,r1,STACK_FRAME_OVERHEAD; \
325 EXC_XFER_TEMPLATE(hdlr, n+4, (MSR_KERNEL & ~(MSR_ME|MSR_DE|MSR_CE)), \
326 mcheck_transfer_to_handler, ret_from_mcheck_exc)
327
328 #define EXC_XFER_TEMPLATE(hdlr, trap, msr, tfer, ret) \
329 li r10,trap; \
330 stw r10,_TRAP(r11); \
331 lis r10,msr@h; \
332 ori r10,r10,msr@l; \
333 bl tfer; \
334 .long hdlr; \
335 .long ret
336
337 #define EXC_XFER_STD(n, hdlr) \
338 EXC_XFER_TEMPLATE(hdlr, n, MSR_KERNEL, transfer_to_handler_full, \
339 ret_from_except_full)
340
341 #define EXC_XFER_LITE(n, hdlr) \
342 EXC_XFER_TEMPLATE(hdlr, n+1, MSR_KERNEL, transfer_to_handler, \
343 ret_from_except)
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358 #define DEBUG_DEBUG_EXCEPTION \
359 START_EXCEPTION(DebugDebug); \
360 DEBUG_EXCEPTION_PROLOG; \
361 \
362
363
364
365
366
367
368
369 \
370 mfspr r10,SPRN_DBSR; \
371 andis. r10,r10,(DBSR_IC|DBSR_BT)@h; \
372 beq+ 2f; \
373 \
374 lis r10,interrupt_base@h; \
375 ori r10,r10,interrupt_base@l; \
376 cmplw r12,r10; \
377 blt+ 2f; \
378 \
379 lis r10,interrupt_end@h; \
380 ori r10,r10,interrupt_end@l; \
381 cmplw r12,r10; \
382 bgt+ 2f; \
383 \
384 \
385 1: rlwinm r9,r9,0,~MSR_DE; \
386 lis r10,(DBSR_IC|DBSR_BT)@h; \
387 mtspr SPRN_DBSR,r10; \
388 \
389 lwz r10,_CCR(r11); \
390 lwz r0,GPR0(r11); \
391 lwz r1,GPR1(r11); \
392 mtcrf 0x80,r10; \
393 mtspr SPRN_DSRR0,r12; \
394 mtspr SPRN_DSRR1,r9; \
395 lwz r9,GPR9(r11); \
396 lwz r12,GPR12(r11); \
397 mtspr SPRN_SPRG_WSCRATCH_DBG,r8; \
398 BOOKE_LOAD_EXC_LEVEL_STACK(DBG); \
399 lwz r10,GPR10(r8); \
400 lwz r11,GPR11(r8); \
401 mfspr r8,SPRN_SPRG_RSCRATCH_DBG; \
402 \
403 PPC_RFDI; \
404 b .; \
405 \
406 \
407 2: mfspr r4,SPRN_DBSR; \
408 addi r3,r1,STACK_FRAME_OVERHEAD; \
409 EXC_XFER_TEMPLATE(DebugException, 0x2008, (MSR_KERNEL & ~(MSR_ME|MSR_DE|MSR_CE)), debug_transfer_to_handler, ret_from_debug_exc)
410
411 #define DEBUG_CRIT_EXCEPTION \
412 START_EXCEPTION(DebugCrit); \
413 CRITICAL_EXCEPTION_PROLOG(DEBUG); \
414 \
415
416
417
418
419
420
421
422 \
423 mfspr r10,SPRN_DBSR; \
424 andis. r10,r10,(DBSR_IC|DBSR_BT)@h; \
425 beq+ 2f; \
426 \
427 lis r10,interrupt_base@h; \
428 ori r10,r10,interrupt_base@l; \
429 cmplw r12,r10; \
430 blt+ 2f; \
431 \
432 lis r10,interrupt_end@h; \
433 ori r10,r10,interrupt_end@l; \
434 cmplw r12,r10; \
435 bgt+ 2f; \
436 \
437 \
438 1: rlwinm r9,r9,0,~MSR_DE; \
439 lis r10,(DBSR_IC|DBSR_BT)@h; \
440 mtspr SPRN_DBSR,r10; \
441 \
442 lwz r10,_CCR(r11); \
443 lwz r0,GPR0(r11); \
444 lwz r1,GPR1(r11); \
445 mtcrf 0x80,r10; \
446 mtspr SPRN_CSRR0,r12; \
447 mtspr SPRN_CSRR1,r9; \
448 lwz r9,GPR9(r11); \
449 lwz r12,GPR12(r11); \
450 mtspr SPRN_SPRG_WSCRATCH_CRIT,r8; \
451 BOOKE_LOAD_EXC_LEVEL_STACK(CRIT); \
452 lwz r10,GPR10(r8); \
453 lwz r11,GPR11(r8); \
454 mfspr r8,SPRN_SPRG_RSCRATCH_CRIT; \
455 \
456 rfci; \
457 b .; \
458 \
459 \
460 2: mfspr r4,SPRN_DBSR; \
461 addi r3,r1,STACK_FRAME_OVERHEAD; \
462 EXC_XFER_TEMPLATE(DebugException, 0x2002, (MSR_KERNEL & ~(MSR_ME|MSR_DE|MSR_CE)), crit_transfer_to_handler, ret_from_crit_exc)
463
464 #define DATA_STORAGE_EXCEPTION \
465 START_EXCEPTION(DataStorage) \
466 NORMAL_EXCEPTION_PROLOG(DATA_STORAGE); \
467 mfspr r5,SPRN_ESR; \
468 stw r5,_ESR(r11); \
469 mfspr r4,SPRN_DEAR; \
470 EXC_XFER_LITE(0x0300, handle_page_fault)
471
472 #define INSTRUCTION_STORAGE_EXCEPTION \
473 START_EXCEPTION(InstructionStorage) \
474 NORMAL_EXCEPTION_PROLOG(INST_STORAGE); \
475 mfspr r5,SPRN_ESR; \
476 stw r5,_ESR(r11); \
477 mr r4,r12; \
478 li r5,0; \
479 EXC_XFER_LITE(0x0400, handle_page_fault)
480
481 #define ALIGNMENT_EXCEPTION \
482 START_EXCEPTION(Alignment) \
483 NORMAL_EXCEPTION_PROLOG(ALIGNMENT); \
484 mfspr r4,SPRN_DEAR; \
485 stw r4,_DEAR(r11); \
486 addi r3,r1,STACK_FRAME_OVERHEAD; \
487 EXC_XFER_STD(0x0600, alignment_exception)
488
489 #define PROGRAM_EXCEPTION \
490 START_EXCEPTION(Program) \
491 NORMAL_EXCEPTION_PROLOG(PROGRAM); \
492 mfspr r4,SPRN_ESR; \
493 stw r4,_ESR(r11); \
494 addi r3,r1,STACK_FRAME_OVERHEAD; \
495 EXC_XFER_STD(0x0700, program_check_exception)
496
497 #define DECREMENTER_EXCEPTION \
498 START_EXCEPTION(Decrementer) \
499 NORMAL_EXCEPTION_PROLOG(DECREMENTER); \
500 lis r0,TSR_DIS@h; \
501 mtspr SPRN_TSR,r0; \
502 addi r3,r1,STACK_FRAME_OVERHEAD; \
503 EXC_XFER_LITE(0x0900, timer_interrupt)
504
505 #define FP_UNAVAILABLE_EXCEPTION \
506 START_EXCEPTION(FloatingPointUnavailable) \
507 NORMAL_EXCEPTION_PROLOG(FP_UNAVAIL); \
508 beq 1f; \
509 bl load_up_fpu; \
510 b fast_exception_return; \
511 1: addi r3,r1,STACK_FRAME_OVERHEAD; \
512 EXC_XFER_STD(0x800, kernel_fp_unavailable_exception)
513
514 #else
515 struct exception_regs {
516 unsigned long mas0;
517 unsigned long mas1;
518 unsigned long mas2;
519 unsigned long mas3;
520 unsigned long mas6;
521 unsigned long mas7;
522 unsigned long srr0;
523 unsigned long srr1;
524 unsigned long csrr0;
525 unsigned long csrr1;
526 unsigned long dsrr0;
527 unsigned long dsrr1;
528 unsigned long saved_ksp_limit;
529 };
530
531
532 #define STACK_EXC_LVL_FRAME_SIZE _ALIGN_UP(sizeof (struct exception_regs), 16)
533
534 #endif
535 #endif