1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
|
/*
**************************************************************************
*
* Component =
*
* Synopsis = rdbg/powerpc/excep_f.c
*
* $Id$
*
**************************************************************************
*/
#include <rtems.h>
#include <rtems/error.h>
#include <assert.h>
#include <errno.h>
#include <rdbg/rdbg.h>
#include <rdbg/servrpc.h>
int
ExcepToSig (Exception_context * ctx)
{
int excep = getExcNum (ctx);
switch (excep) {
case ASM_FLOAT_VECTOR:
return SIGFPE;
case ASM_TRACE_VECTOR:
case ASM_PROG_VECTOR:
case ASM_SYS_VECTOR:
return SIGTRAP;
case ASM_ISI_VECTOR:
return SIGSEGV;
case ASM_RESET_VECTOR:
case ASM_MACH_VECTOR:
case ASM_EXT_VECTOR:
case ASM_ALIGN_VECTOR:
return SIGILL;
default:
break;
}
return SIGKILL;
}
/*----- Breakpoint Exception management -----*/
/*
* Handler for Breakpoint Exceptions :
* software breakpoints.
*/
void
BreakPointExcHdl (CPU_Exception_frame * ctx)
{
rtems_status_code status;
rtems_id continueSemId;
/*
* we must re-enable the floating point engine
* if the interrupted thread is FP. Otherwise,
* the semaphore primitives may crash when they
* try to save FP context while switching this
* thread... NB : deferred fp context switching
* would 1) avoid to have to save FP, make this code
* obsolete.
*/
if (ctx->EXC_SRR1 & MSR_FP) {
register unsigned long msr;
__asm__ __volatile__ ("mfmsr %0":"=r" (msr));
__asm__ __volatile__ ("mtmsr %0"::"r" (msr | MSR_FP));
}
if ((justSaveContext) && (ctx->_EXC_number == ASM_SYS_VECTOR)) {
PushSavedExceptCtx (_Thread_Executing->Object.id, ctx);
justSaveContext = 0;
} else {
if (ctx->_EXC_number != ASM_TRACE_VECTOR) {
NbSerializedCtx++;
rtems_semaphore_obtain (serializeSemId, RTEMS_WAIT, RTEMS_NO_TIMEOUT);
NbSerializedCtx--;
}
currentTargetThread = _Thread_Executing->Object.id;
#ifdef DDEBUG
printk ("----------------------------------------------------------\n");
printk ("Exception %d caught at PC %x by thread %d\n",
ctx->_EXC_number, ctx->EXC_SRR0, _Thread_Executing->Object.id);
printk ("----------------------------------------------------------\n");
printk ("Processor execution context at time of the fault was :\n");
printk ("----------------------------------------------------------\n");
printk ("\t R0 = %x\n", ctx->GPR0);
printk ("\t R1 = %x\n", ctx->GPR1);
printk ("\t R2 = %x\n", ctx->GPR2);
printk ("\t R3 = %x\n", ctx->GPR3);
printk ("\t R4 = %x\n", ctx->GPR4);
printk ("\t R5 = %x\n", ctx->GPR5);
printk ("\t R6 = %x\n", ctx->GPR6);
printk ("\t R7 = %x\n", ctx->GPR7);
printk ("\t R8 = %x\n", ctx->GPR8);
printk ("\t R9 = %x\n", ctx->GPR9);
printk ("\t R10 = %x\n", ctx->GPR10);
printk ("\t R11 = %x\n", ctx->GPR11);
printk ("\t R12 = %x\n", ctx->GPR12);
printk ("\t R13 = %x\n", ctx->GPR13);
printk ("\t R14 = %x\n", ctx->GPR14);
printk ("\t R15 = %x\n", ctx->GPR15);
printk ("\t R16 = %x\n", ctx->GPR16);
printk ("\t R17 = %x\n", ctx->GPR17);
printk ("\t R18 = %x\n", ctx->GPR18);
printk ("\t R19 = %x\n", ctx->GPR19);
printk ("\t R20 = %x\n", ctx->GPR20);
printk ("\t R21 = %x\n", ctx->GPR21);
printk ("\t R22 = %x\n", ctx->GPR22);
printk ("\t R23 = %x\n", ctx->GPR23);
printk ("\t R24 = %x\n", ctx->GPR24);
printk ("\t R25 = %x\n", ctx->GPR25);
printk ("\t R26 = %x\n", ctx->GPR26);
printk ("\t R27 = %x\n", ctx->GPR27);
printk ("\t R28 = %x\n", ctx->GPR28);
printk ("\t R29 = %x\n", ctx->GPR29);
printk ("\t R30 = %x\n", ctx->GPR30);
printk ("\t R31 = %x\n", ctx->GPR31);
printk ("\t CR = %x\n", ctx->EXC_CR);
printk ("\t CTR = %x\n", ctx->EXC_CTR);
printk ("\t XER = %x\n", ctx->EXC_XER);
printk ("\t LR = %x\n", ctx->EXC_LR);
printk ("\t MSR = %x\n", ctx->EXC_SRR1);
#endif
status = rtems_semaphore_create (rtems_build_name ('D', 'B', 'G', 'c'),
0,
RTEMS_FIFO |
RTEMS_COUNTING_SEMAPHORE |
RTEMS_NO_INHERIT_PRIORITY |
RTEMS_NO_PRIORITY_CEILING |
RTEMS_LOCAL, 0, &continueSemId);
if (status != RTEMS_SUCCESSFUL)
rtems_panic ("Can't create continue semaphore: `%s'\n",
rtems_status_text (status));
PushExceptCtx (_Thread_Executing->Object.id, continueSemId, ctx);
switch (ctx->_EXC_number) {
case ASM_TRACE_VECTOR:
DPRINTF ((" TRACE EXCEPTION !!!\n"));
ctx->EXC_SRR1 &= ~MSR_SE;
ExitForSingleStep--;
rtems_semaphore_release (wakeupEventSemId);
break;
case ASM_PROG_VECTOR:
DPRINTF ((" BREAKPOINT EXCEPTION !!!\n"));
rtems_semaphore_release (wakeupEventSemId);
break;
case ASM_SYS_VECTOR:
DPRINTF ((" ENTER RDBG !!!\n"));
rtems_semaphore_release (wakeupEventSemId);
break;
default:
DPRINTF ((" OTHER EXCEPTION !!!\n"));
rtems_semaphore_release (wakeupEventSemId);
break;
}
rtems_semaphore_obtain (continueSemId, RTEMS_WAIT, RTEMS_NO_TIMEOUT);
PopExceptCtx (_Thread_Executing->Object.id);
rtems_semaphore_delete (continueSemId);
}
}
|
