Subversion Repositories HelenOS

Rev

Rev 4665 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 4665 Rev 4666
Line 56... Line 56...
56
#define EXC_VECTORS          8
56
#define EXC_VECTORS          8
57
 
57
 
58
/** Size of memory block occupied by exception vectors. */
58
/** Size of memory block occupied by exception vectors. */
59
#define EXC_VECTORS_SIZE     (EXC_VECTORS * 4)
59
#define EXC_VECTORS_SIZE     (EXC_VECTORS * 4)
60
 
60
 
61
/** Switches to kernel stack and saves all registers there.
-
 
62
 *
-
 
63
 * Temporary exception stack is used to save a few registers
-
 
64
 * before stack switch takes place.
-
 
65
 *
-
 
66
 *  The stack fram created by the function looks like:
-
 
67
 *
-
 
68
 *      |_________________|
-
 
69
 *      |                 |
-
 
70
 *      |     SPSR        |
-
 
71
 *      |                 |
-
 
72
 *      |_________________|
-
 
73
 *      | Stack Pointer   |
-
 
74
 *      |      of         |
-
 
75
 *      | Previous Mode   |
-
 
76
 *      |_________________|
-
 
77
 *      | Return address  |
-
 
78
 *      |      of         |
-
 
79
 *      | Previous Mode   |
-
 
80
 *      |_________________|
-
 
81
 *      |   R0  - R12     |
-
 
82
 *      |      of         |
-
 
83
 *      | Previous Mode   |
-
 
84
 *      |_________________|
-
 
85
 *      | Return address  |
-
 
86
 *      |     from        |
-
 
87
 *      |Exception Handler|
-
 
88
 *      |_________________|
-
 
89
 *      |                 |
-
 
90
 *
-
 
91
 */
-
 
92
inline static void setup_stack_and_save_regs()
-
 
93
{
-
 
94
    asm volatile (
-
 
95
        "ldr r13, =exc_stack\n"
-
 
96
        "stmfd r13!, {r0-r3}\n"
-
 
97
        "mrs r1, cpsr\n"
-
 
98
        "bic r1, r1, #0x1f\n"
-
 
99
        "mrs r2, spsr\n"
-
 
100
        "and r0, r2, #0x1f\n"
-
 
101
        "cmp r0, #0x10\n"
-
 
102
        "bne 1f\n"
-
 
103
       
-
 
104
        /* prev mode was usermode */
-
 
105
        "mov r0, sp\n"
-
 
106
        "mov r3, lr\n"
-
 
107
 
-
 
108
        /* Switch to supervisor mode */
-
 
109
        "orr r1, r1, #0x13\n"
-
 
110
        "msr cpsr_c, r1\n"
-
 
111
 
-
 
112
        /* Load sp with [supervisor_sp] */
-
 
113
        "ldr r13, =supervisor_sp\n"
-
 
114
        "ldr r13, [r13]\n"
-
 
115
 
-
 
116
        /* Populate the stack frame */
-
 
117
        "msr spsr, r2\n"
-
 
118
        "mov lr, r3\n"
-
 
119
        "stmfd r13!, {lr}\n"
-
 
120
        "stmfd r13!, {r4-r12}\n"
-
 
121
        "ldmfd r0!, {r4-r7}\n"
-
 
122
        "stmfd r13!, {r4-r7}\n"
-
 
123
        "stmfd r13!, {r13, lr}^\n"
-
 
124
        "stmfd r13!, {r2}\n"
-
 
125
        "b 2f\n"
-
 
126
 
-
 
127
   
-
 
128
        /* mode was not usermode */
-
 
129
        "1:\n"
-
 
130
            /* Switch to previous mode which is undoubtedly the supervisor mode */
-
 
131
            "orr r1, r1, r0\n"
-
 
132
            "mov r0, lr\n"
-
 
133
            "mov r3, sp\n"
-
 
134
            "msr cpsr_c, r1\n"
-
 
135
 
-
 
136
            /* Populate the stack frame */
-
 
137
            "mov r1, sp\n"
-
 
138
            "stmfd r13!, {r0}\n"
-
 
139
            "stmfd r13!, {r4-r12}\n"
-
 
140
 
-
 
141
            /* Store r0-r3 in r4-r7 and then push it on to stack */
-
 
142
            "ldmfd r3!, {r4-r7}\n"
-
 
143
            "stmfd r13!, {r4-r7}\n"
-
 
144
 
-
 
145
            /* Push return address and stack pointer on to stack */
-
 
146
            "stmfd r13!, {lr}\n"
-
 
147
            "stmfd r13!, {r1}\n"
-
 
148
            "mov lr, r0\n"
-
 
149
            "msr spsr, r2\n"
-
 
150
            "stmfd r13!, {r2}\n"
-
 
151
 
-
 
152
        "2:\n"
-
 
153
    );
-
 
154
}
-
 
155
 
-
 
156
/** Returns from exception mode.
-
 
157
 *
-
 
158
 * Previously saved state of registers (including control register)
-
 
159
 * is restored from the stack.
-
 
160
 */
-
 
161
inline static void load_regs()
-
 
162
{
-
 
163
    asm volatile(
-
 
164
        "ldmfd r13!, {r0}       \n"
-
 
165
        "msr spsr, r0           \n"
-
 
166
        "and r0, r0, #0x1f      \n"
-
 
167
        "cmp r0, #0x10          \n"
-
 
168
        "bne 1f             \n"
-
 
169
 
-
 
170
        /* return to user mode */
-
 
171
        "ldmfd r13!, {r13, lr}^     \n"
-
 
172
        "b 2f               \n"
-
 
173
 
-
 
174
        /* return to non-user mode */
-
 
175
    "1:\n"
-
 
176
        "ldmfd r13!, {r1, r2}       \n"
-
 
177
        "mrs r3, cpsr           \n"
-
 
178
        "bic r3, r3, #0x1f      \n"
-
 
179
        "orr r3, r3, r0         \n"
-
 
180
        "mrs r0, cpsr           \n"
-
 
181
        "msr cpsr_c, r3         \n"
-
 
182
 
-
 
183
        "mov lr, r2         \n"
-
 
184
        "msr cpsr_c, r0         \n"
-
 
185
 
-
 
186
        /* actual return */
-
 
187
    "2:\n"
-
 
188
        "ldmfd r13!, {r0-r12, pc}^\n"
-
 
189
    );
-
 
190
}
-
 
191
 
-
 
192
 
-
 
193
/** Calls exception dispatch routine. */
-
 
194
#define CALL_EXC_DISPATCH(exception) \
-
 
195
    asm volatile ( \
-
 
196
        "mov r0, %[exc]\n" \
-
 
197
        "mov r1, r13\n" \
-
 
198
        "bl exc_dispatch\n" \
-
 
199
        :: [exc] "i" (exception) \
-
 
200
    );\
-
 
201
 
-
 
202
/** General exception handler.
-
 
203
 *
-
 
204
 *  Stores registers, dispatches the exception,
-
 
205
 *  and finally restores registers and returns from exception processing.
-
 
206
 *
-
 
207
 *  @param exception Exception number.
-
 
208
 */
-
 
209
#define PROCESS_EXCEPTION(exception) \
-
 
210
    setup_stack_and_save_regs(); \
-
 
211
    CALL_EXC_DISPATCH(exception) \
-
 
212
    load_regs();
-
 
213
 
-
 
214
/** Updates specified exception vector to jump to given handler.
61
/** Updates specified exception vector to jump to given handler.
215
 *
62
 *
216
 *  Addresses of handlers are stored in memory following exception vectors.
63
 *  Addresses of handlers are stored in memory following exception vectors.
217
 */
64
 */
218
static void install_handler(unsigned handler_addr, unsigned *vector)
65
static void install_handler(unsigned handler_addr, unsigned *vector)
Line 230... Line 77...
230
    /* store handler's address */
77
    /* store handler's address */
231
    *(vector + EXC_VECTORS) = handler_addr;
78
    *(vector + EXC_VECTORS) = handler_addr;
232
 
79
 
233
}
80
}
234
 
81
 
235
/** Low-level Reset Exception handler. */
-
 
236
static void reset_exception_entry(void)
-
 
237
{
-
 
238
    PROCESS_EXCEPTION(EXC_RESET);
-
 
239
}
-
 
240
 
-
 
241
/** Low-level Software Interrupt Exception handler. */
-
 
242
static void swi_exception_entry(void)
-
 
243
{
-
 
244
    PROCESS_EXCEPTION(EXC_SWI);
-
 
245
}
-
 
246
 
-
 
247
/** Low-level Undefined Instruction Exception handler. */
-
 
248
static void undef_instr_exception_entry(void)
-
 
249
{
-
 
250
    PROCESS_EXCEPTION(EXC_UNDEF_INSTR);
-
 
251
}
-
 
252
 
-
 
253
/** Low-level Fast Interrupt Exception handler. */
-
 
254
static void fiq_exception_entry(void)
-
 
255
{
-
 
256
    PROCESS_EXCEPTION(EXC_FIQ);
-
 
257
}
-
 
258
 
-
 
259
/** Low-level Prefetch Abort Exception handler. */
-
 
260
static void prefetch_abort_exception_entry(void)
-
 
261
{
-
 
262
    asm volatile (
-
 
263
        "sub lr, lr, #4"
-
 
264
    );
-
 
265
   
-
 
266
    PROCESS_EXCEPTION(EXC_PREFETCH_ABORT);
-
 
267
}
-
 
268
 
-
 
269
/** Low-level Data Abort Exception handler. */
-
 
270
static void data_abort_exception_entry(void)
-
 
271
{
-
 
272
    asm volatile (
-
 
273
        "sub lr, lr, #8"
-
 
274
    );
-
 
275
   
-
 
276
    PROCESS_EXCEPTION(EXC_DATA_ABORT);
-
 
277
}
-
 
278
 
-
 
279
/** Low-level Interrupt Exception handler.
-
 
280
 *
-
 
281
 * CPU is switched to Undefined mode before further interrupt processing
-
 
282
 * because of possible occurence of nested interrupt exception, which
-
 
283
 * would overwrite (and thus spoil) stack pointer.
-
 
284
 */
-
 
285
static void irq_exception_entry(void)
-
 
286
{
-
 
287
    asm volatile (
-
 
288
        "sub lr, lr, #4"
-
 
289
    );
-
 
290
   
-
 
291
    PROCESS_EXCEPTION(EXC_IRQ)
-
 
292
}
-
 
293
 
-
 
294
/** Software Interrupt handler.
82
/** Software Interrupt handler.
295
 *
83
 *
296
 * Dispatches the syscall.
84
 * Dispatches the syscall.
297
 */
85
 */
298
static void swi_exception(int exc_no, istate_t *istate)
86
static void swi_exception(int exc_no, istate_t *istate)