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)