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
10
11
12
13#define SET_IVOR(vector_number, vector_label) \
14 li r26,vector_label@l; \
15 mtspr SPRN_IVOR##vector_number,r26; \
16 sync
17
18#if (THREAD_SHIFT < 15)
19#define ALLOC_STACK_FRAME(reg, val) \
20 addi reg,reg,val
21#else
22#define ALLOC_STACK_FRAME(reg, val) \
23 addis reg,reg,val@ha; \
24 addi reg,reg,val@l
25#endif
26
27
28
29
30
31
32
33#define THREAD_NORMSAVE(offset) (THREAD_NORMSAVES + (offset * 4))
34
35#define NORMAL_EXCEPTION_PROLOG(intno) \
36 mtspr SPRN_SPRG_WSCRATCH0, r10; \
37 mfspr r10, SPRN_SPRG_THREAD; \
38 stw r11, THREAD_NORMSAVE(0)(r10); \
39 stw r13, THREAD_NORMSAVE(2)(r10); \
40 mfcr r13; \
41 mfspr r11, SPRN_SRR1; \
42 DO_KVM BOOKE_INTERRUPT_##intno SPRN_SRR1; \
43 andi. r11, r11, MSR_PR; \
44 mr r11, r1; \
45 beq 1f; \
46 \
47 lwz r11, THREAD_INFO-THREAD(r10); \
48 ALLOC_STACK_FRAME(r11, THREAD_SIZE); \
491 : subi r11, r11, INT_FRAME_SIZE; \
50 stw r13, _CCR(r11); \
51 stw r12,GPR12(r11); \
52 stw r9,GPR9(r11); \
53 mfspr r13, SPRN_SPRG_RSCRATCH0; \
54 stw r13, GPR10(r11); \
55 lwz r12, THREAD_NORMSAVE(0)(r10); \
56 stw r12,GPR11(r11); \
57 lwz r13, THREAD_NORMSAVE(2)(r10); \
58 mflr r10; \
59 stw r10,_LINK(r11); \
60 mfspr r12,SPRN_SRR0; \
61 stw r1, GPR1(r11); \
62 mfspr r9,SPRN_SRR1; \
63 stw r1, 0(r11); \
64 mr r1, r11; \
65 rlwinm r9,r9,0,14,12; \
66 stw r0,GPR0(r11); \
67 lis r10, STACK_FRAME_REGS_MARKER@ha; \
68 addi r10, r10, STACK_FRAME_REGS_MARKER@l; \
69 stw r10, 8(r11); \
70 SAVE_4GPRS(3, r11); \
71 SAVE_2GPRS(7, r11)
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91#define MC_STACK_BASE mcheckirq_ctx
92#define CRIT_STACK_BASE critirq_ctx
93
94
95#define DBG_STACK_BASE dbgirq_ctx
96
97#define EXC_LVL_FRAME_OVERHEAD (THREAD_SIZE - INT_FRAME_SIZE - EXC_LVL_SIZE)
98
99#ifdef CONFIG_SMP
100#define BOOKE_LOAD_EXC_LEVEL_STACK(level) \
101 mfspr r8,SPRN_PIR; \
102 slwi r8,r8,2; \
103 addis r8,r8,level##_STACK_BASE@ha; \
104 lwz r8,level##_STACK_BASE@l(r8); \
105 addi r8,r8,EXC_LVL_FRAME_OVERHEAD;
106#else
107#define BOOKE_LOAD_EXC_LEVEL_STACK(level) \
108 lis r8,level##_STACK_BASE@ha; \
109 lwz r8,level##_STACK_BASE@l(r8); \
110 addi r8,r8,EXC_LVL_FRAME_OVERHEAD;
111#endif
112
113
114
115
116
117
118
119
120
121#define EXC_LEVEL_EXCEPTION_PROLOG(exc_level, intno, exc_level_srr0, exc_level_srr1) \
122 mtspr SPRN_SPRG_WSCRATCH_##exc_level,r8; \
123 BOOKE_LOAD_EXC_LEVEL_STACK(exc_level); \
124 stw r9,GPR9(r8); \
125 mfcr r9; \
126 stw r10,GPR10(r8); \
127 stw r11,GPR11(r8); \
128 stw r9,_CCR(r8); \
129 mfspr r11,exc_level_srr1; \
130 DO_KVM BOOKE_INTERRUPT_##intno exc_level_srr1; \
131 andi. r11,r11,MSR_PR; \
132 mfspr r11,SPRN_SPRG_THREAD; \
133 lwz r11,THREAD_INFO-THREAD(r11); \
134 addi r11,r11,EXC_LVL_FRAME_OVERHEAD; \
135 beq 1f; \
136 \
137 stw r9,_CCR(r11); \
138 lwz r10,GPR10(r8); \
139 lwz r9,GPR9(r8); \
140 stw r10,GPR10(r11); \
141 lwz r10,GPR11(r8); \
142 stw r9,GPR9(r11); \
143 stw r10,GPR11(r11); \
144 b 2f; \
145 \
1461: lwz r9,TI_FLAGS-EXC_LVL_FRAME_OVERHEAD(r11); \
147 lwz r10,TI_PREEMPT-EXC_LVL_FRAME_OVERHEAD(r11); \
148 stw r9,TI_FLAGS-EXC_LVL_FRAME_OVERHEAD(r8); \
149 stw r10,TI_PREEMPT-EXC_LVL_FRAME_OVERHEAD(r8); \
150 lwz r9,TI_TASK-EXC_LVL_FRAME_OVERHEAD(r11); \
151 stw r9,TI_TASK-EXC_LVL_FRAME_OVERHEAD(r8); \
152 mr r11,r8; \
1532: mfspr r8,SPRN_SPRG_RSCRATCH_##exc_level; \
154 stw r12,GPR12(r11); \
155 mflr r10; \
156 stw r10,_LINK(r11); \
157 mfspr r12,SPRN_DEAR; \
158 stw r12,_DEAR(r11); \
159 mfspr r9,SPRN_ESR; \
160 stw r9,_ESR(r11); \
161 mfspr r12,exc_level_srr0; \
162 stw r1,GPR1(r11); \
163 mfspr r9,exc_level_srr1; \
164 stw r1,0(r11); \
165 mr r1,r11; \
166 rlwinm r9,r9,0,14,12; \
167 stw r0,GPR0(r11); \
168 SAVE_4GPRS(3, r11); \
169 SAVE_2GPRS(7, r11)
170
171#define CRITICAL_EXCEPTION_PROLOG(intno) \
172 EXC_LEVEL_EXCEPTION_PROLOG(CRIT, intno, SPRN_CSRR0, SPRN_CSRR1)
173#define DEBUG_EXCEPTION_PROLOG \
174 EXC_LEVEL_EXCEPTION_PROLOG(DBG, DEBUG, SPRN_DSRR0, SPRN_DSRR1)
175#define MCHECK_EXCEPTION_PROLOG \
176 EXC_LEVEL_EXCEPTION_PROLOG(MC, MACHINE_CHECK, \
177 SPRN_MCSRR0, SPRN_MCSRR1)
178
179
180
181
182
183
184
185#define GUEST_DOORBELL_EXCEPTION \
186 START_EXCEPTION(GuestDoorbell); \
187 mtspr SPRN_SPRG_WSCRATCH0, r10; \
188 mfspr r10, SPRN_SPRG_THREAD; \
189 stw r11, THREAD_NORMSAVE(0)(r10); \
190 mfspr r11, SPRN_SRR1; \
191 stw r13, THREAD_NORMSAVE(2)(r10); \
192 mfcr r13; \
193 DO_KVM BOOKE_INTERRUPT_GUEST_DBELL SPRN_GSRR1; \
194 trap
195
196
197
198
199#define START_EXCEPTION(label) \
200 .align 5; \
201label:
202
203#define EXCEPTION(n, intno, label, hdlr, xfer) \
204 START_EXCEPTION(label); \
205 NORMAL_EXCEPTION_PROLOG(intno); \
206 addi r3,r1,STACK_FRAME_OVERHEAD; \
207 xfer(n, hdlr)
208
209#define CRITICAL_EXCEPTION(n, intno, label, hdlr) \
210 START_EXCEPTION(label); \
211 CRITICAL_EXCEPTION_PROLOG(intno); \
212 addi r3,r1,STACK_FRAME_OVERHEAD; \
213 EXC_XFER_TEMPLATE(hdlr, n+2, (MSR_KERNEL & ~(MSR_ME|MSR_DE|MSR_CE)), \
214 NOCOPY, crit_transfer_to_handler, \
215 ret_from_crit_exc)
216
217#define MCHECK_EXCEPTION(n, label, hdlr) \
218 START_EXCEPTION(label); \
219 MCHECK_EXCEPTION_PROLOG; \
220 mfspr r5,SPRN_ESR; \
221 stw r5,_ESR(r11); \
222 addi r3,r1,STACK_FRAME_OVERHEAD; \
223 EXC_XFER_TEMPLATE(hdlr, n+4, (MSR_KERNEL & ~(MSR_ME|MSR_DE|MSR_CE)), \
224 NOCOPY, mcheck_transfer_to_handler, \
225 ret_from_mcheck_exc)
226
227#define EXC_XFER_TEMPLATE(hdlr, trap, msr, copyee, tfer, ret) \
228 li r10,trap; \
229 stw r10,_TRAP(r11); \
230 lis r10,msr@h; \
231 ori r10,r10,msr@l; \
232 copyee(r10, r9); \
233 bl tfer; \
234 .long hdlr; \
235 .long ret
236
237#define COPY_EE(d, s) rlwimi d,s,0,16,16
238#define NOCOPY(d, s)
239
240#define EXC_XFER_STD(n, hdlr) \
241 EXC_XFER_TEMPLATE(hdlr, n, MSR_KERNEL, NOCOPY, transfer_to_handler_full, \
242 ret_from_except_full)
243
244#define EXC_XFER_LITE(n, hdlr) \
245 EXC_XFER_TEMPLATE(hdlr, n+1, MSR_KERNEL, NOCOPY, transfer_to_handler, \
246 ret_from_except)
247
248#define EXC_XFER_EE(n, hdlr) \
249 EXC_XFER_TEMPLATE(hdlr, n, MSR_KERNEL, COPY_EE, transfer_to_handler_full, \
250 ret_from_except_full)
251
252#define EXC_XFER_EE_LITE(n, hdlr) \
253 EXC_XFER_TEMPLATE(hdlr, n+1, MSR_KERNEL, COPY_EE, transfer_to_handler, \
254 ret_from_except)
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269#define DEBUG_DEBUG_EXCEPTION \
270 START_EXCEPTION(DebugDebug); \
271 DEBUG_EXCEPTION_PROLOG; \
272 \
273
274
275
276
277
278
279
280 \
281 mfspr r10,SPRN_DBSR; \
282 andis. r10,r10,(DBSR_IC|DBSR_BT)@h; \
283 beq+ 2f; \
284 \
285 lis r10,interrupt_base@h; \
286 ori r10,r10,interrupt_base@l; \
287 cmplw r12,r10; \
288 blt+ 2f; \
289 \
290 lis r10,interrupt_end@h; \
291 ori r10,r10,interrupt_end@l; \
292 cmplw r12,r10; \
293 bgt+ 2f; \
294 \
295 \
2961: rlwinm r9,r9,0,~MSR_DE; \
297 lis r10,(DBSR_IC|DBSR_BT)@h; \
298 mtspr SPRN_DBSR,r10; \
299 \
300 lwz r10,_CCR(r11); \
301 lwz r0,GPR0(r11); \
302 lwz r1,GPR1(r11); \
303 mtcrf 0x80,r10; \
304 mtspr SPRN_DSRR0,r12; \
305 mtspr SPRN_DSRR1,r9; \
306 lwz r9,GPR9(r11); \
307 lwz r12,GPR12(r11); \
308 mtspr SPRN_SPRG_WSCRATCH_DBG,r8; \
309 BOOKE_LOAD_EXC_LEVEL_STACK(DBG); \
310 lwz r10,GPR10(r8); \
311 lwz r11,GPR11(r8); \
312 mfspr r8,SPRN_SPRG_RSCRATCH_DBG; \
313 \
314 PPC_RFDI; \
315 b .; \
316 \
317 \
3182: mfspr r4,SPRN_DBSR; \
319 addi r3,r1,STACK_FRAME_OVERHEAD; \
320 EXC_XFER_TEMPLATE(DebugException, 0x2008, (MSR_KERNEL & ~(MSR_ME|MSR_DE|MSR_CE)), NOCOPY, debug_transfer_to_handler, ret_from_debug_exc)
321
322#define DEBUG_CRIT_EXCEPTION \
323 START_EXCEPTION(DebugCrit); \
324 CRITICAL_EXCEPTION_PROLOG(DEBUG); \
325 \
326
327
328
329
330
331
332
333 \
334 mfspr r10,SPRN_DBSR; \
335 andis. r10,r10,(DBSR_IC|DBSR_BT)@h; \
336 beq+ 2f; \
337 \
338 lis r10,interrupt_base@h; \
339 ori r10,r10,interrupt_base@l; \
340 cmplw r12,r10; \
341 blt+ 2f; \
342 \
343 lis r10,interrupt_end@h; \
344 ori r10,r10,interrupt_end@l; \
345 cmplw r12,r10; \
346 bgt+ 2f; \
347 \
348 \
3491: rlwinm r9,r9,0,~MSR_DE; \
350 lis r10,(DBSR_IC|DBSR_BT)@h; \
351 mtspr SPRN_DBSR,r10; \
352 \
353 lwz r10,_CCR(r11); \
354 lwz r0,GPR0(r11); \
355 lwz r1,GPR1(r11); \
356 mtcrf 0x80,r10; \
357 mtspr SPRN_CSRR0,r12; \
358 mtspr SPRN_CSRR1,r9; \
359 lwz r9,GPR9(r11); \
360 lwz r12,GPR12(r11); \
361 mtspr SPRN_SPRG_WSCRATCH_CRIT,r8; \
362 BOOKE_LOAD_EXC_LEVEL_STACK(CRIT); \
363 lwz r10,GPR10(r8); \
364 lwz r11,GPR11(r8); \
365 mfspr r8,SPRN_SPRG_RSCRATCH_CRIT; \
366 \
367 rfci; \
368 b .; \
369 \
370 \
3712: mfspr r4,SPRN_DBSR; \
372 addi r3,r1,STACK_FRAME_OVERHEAD; \
373 EXC_XFER_TEMPLATE(DebugException, 0x2002, (MSR_KERNEL & ~(MSR_ME|MSR_DE|MSR_CE)), NOCOPY, crit_transfer_to_handler, ret_from_crit_exc)
374
375#define DATA_STORAGE_EXCEPTION \
376 START_EXCEPTION(DataStorage) \
377 NORMAL_EXCEPTION_PROLOG(DATA_STORAGE); \
378 mfspr r5,SPRN_ESR; \
379 stw r5,_ESR(r11); \
380 mfspr r4,SPRN_DEAR; \
381 EXC_XFER_LITE(0x0300, handle_page_fault)
382
383#define INSTRUCTION_STORAGE_EXCEPTION \
384 START_EXCEPTION(InstructionStorage) \
385 NORMAL_EXCEPTION_PROLOG(INST_STORAGE); \
386 mfspr r5,SPRN_ESR; \
387 stw r5,_ESR(r11); \
388 mr r4,r12; \
389 li r5,0; \
390 EXC_XFER_LITE(0x0400, handle_page_fault)
391
392#define ALIGNMENT_EXCEPTION \
393 START_EXCEPTION(Alignment) \
394 NORMAL_EXCEPTION_PROLOG(ALIGNMENT); \
395 mfspr r4,SPRN_DEAR; \
396 stw r4,_DEAR(r11); \
397 addi r3,r1,STACK_FRAME_OVERHEAD; \
398 EXC_XFER_EE(0x0600, alignment_exception)
399
400#define PROGRAM_EXCEPTION \
401 START_EXCEPTION(Program) \
402 NORMAL_EXCEPTION_PROLOG(PROGRAM); \
403 mfspr r4,SPRN_ESR; \
404 stw r4,_ESR(r11); \
405 addi r3,r1,STACK_FRAME_OVERHEAD; \
406 EXC_XFER_STD(0x0700, program_check_exception)
407
408#define DECREMENTER_EXCEPTION \
409 START_EXCEPTION(Decrementer) \
410 NORMAL_EXCEPTION_PROLOG(DECREMENTER); \
411 lis r0,TSR_DIS@h; \
412 mtspr SPRN_TSR,r0; \
413 addi r3,r1,STACK_FRAME_OVERHEAD; \
414 EXC_XFER_LITE(0x0900, timer_interrupt)
415
416#define FP_UNAVAILABLE_EXCEPTION \
417 START_EXCEPTION(FloatingPointUnavailable) \
418 NORMAL_EXCEPTION_PROLOG(FP_UNAVAIL); \
419 beq 1f; \
420 bl load_up_fpu; \
421 b fast_exception_return; \
4221: addi r3,r1,STACK_FRAME_OVERHEAD; \
423 EXC_XFER_EE_LITE(0x800, kernel_fp_unavailable_exception)
424
425#ifndef __ASSEMBLY__
426struct exception_regs {
427 unsigned long mas0;
428 unsigned long mas1;
429 unsigned long mas2;
430 unsigned long mas3;
431 unsigned long mas6;
432 unsigned long mas7;
433 unsigned long srr0;
434 unsigned long srr1;
435 unsigned long csrr0;
436 unsigned long csrr1;
437 unsigned long dsrr0;
438 unsigned long dsrr1;
439 unsigned long saved_ksp_limit;
440};
441
442
443#define STACK_EXC_LVL_FRAME_SIZE _ALIGN_UP(sizeof (struct exception_regs), 16)
444
445#endif
446#endif
447