Rev 2245 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 2245 | Rev 2262 | ||
---|---|---|---|
Line 135... | Line 135... | ||
135 | { |
135 | { |
136 | asm("sub lr, lr, #4"); |
136 | asm("sub lr, lr, #4"); |
137 | PROCESS_EXCEPTION(EXC_IRQ); |
137 | PROCESS_EXCEPTION(EXC_IRQ); |
138 | } |
138 | } |
139 | 139 | ||
- | 140 | static void prefetch_abort_exception(int exc_no, istate_t* istate) |
|
- | 141 | { |
|
- | 142 | //aux_puts("(PREFETCH|DATA) ABORT exception caught, not processed.\n"); |
|
- | 143 | } |
|
- | 144 | ||
140 | 145 | ||
141 | /** Interrupt Exception handler. |
146 | /** Interrupt Exception handler. |
142 | * Determines the sources of interrupt, and calls their handlers. |
147 | * Determines the sources of interrupt, and calls their handlers. |
143 | */ |
148 | */ |
144 | static void irq_exception(int exc_no, istate_t* istate) |
149 | static void irq_exception(int exc_no, istate_t* istate) |
Line 206... | Line 211... | ||
206 | 211 | ||
207 | install_handler((unsigned)fiq_exception_entry, |
212 | install_handler((unsigned)fiq_exception_entry, |
208 | (unsigned*)EXC_FIQ_VEC); |
213 | (unsigned*)EXC_FIQ_VEC); |
209 | } |
214 | } |
210 | 215 | ||
- | 216 | /** Activates using high exception vectors addresses. */ |
|
- | 217 | static void high_vectors() |
|
- | 218 | { |
|
- | 219 | uint32_t control_reg; |
|
- | 220 | ||
- | 221 | asm volatile( "mrc p15, 0, %0, c1, c1": "=r" (control_reg)); |
|
- | 222 | ||
- | 223 | //switch on the high vectors bit |
|
- | 224 | control_reg |= CP15_R1_HIGH_VECTORS_BIT; |
|
- | 225 | ||
- | 226 | asm volatile( "mcr p15, 0, %0, c1, c1" : : "r" (control_reg)); |
|
- | 227 | } |
|
- | 228 | ||
- | 229 | ||
211 | /** Initializes exception handling. |
230 | /** Initializes exception handling. |
212 | * |
231 | * |
213 | * Installs low-level exception handlers and then registers |
232 | * Installs low-level exception handlers and then registers |
214 | * exceptions and their handlers to kernel exception dispatcher. |
233 | * exceptions and their handlers to kernel exception dispatcher. |
215 | */ |
234 | */ |
216 | void exception_init(void) |
235 | void exception_init(void) |
217 | { |
236 | { |
- | 237 | #ifdef HIGH_EXCEPTION_VECTORS |
|
- | 238 | high_vectors(); |
|
- | 239 | #endif |
|
- | 240 | ||
218 | install_exception_handlers(); |
241 | install_exception_handlers(); |
219 | 242 | ||
220 | exc_register(EXC_IRQ, "interrupt", (iroutine) irq_exception); |
243 | exc_register(EXC_IRQ, "interrupt", (iroutine) irq_exception); |
- | 244 | exc_register(EXC_PREFETCH_ABORT, "prefetch abort", (iroutine) prefetch_abort_exception); |
|
- | 245 | exc_register(EXC_DATA_ABORT, "data abort", (iroutine) prefetch_abort_exception); |
|
221 | /* TODO add next */ |
246 | /* TODO add next */ |
222 | } |
247 | } |
223 | 248 | ||
224 | /* TODO change soon, temporary hack. */ |
249 | /* TODO change soon, temporary hack. */ |
225 | void setup_exception_stacks() |
250 | void setup_exception_stacks() |
226 | { |
251 | { |
227 | /* switch to particular mode and set "sp" there */ |
252 | /* switch to particular mode and set "sp" there */ |
- | 253 | ||
228 | uint32_t cspr = current_status_reg_read(); |
254 | uint32_t cspr = current_status_reg_read(); |
- | 255 | ||
- | 256 | /* IRQ stack */ |
|
229 | current_status_reg_control_write( |
257 | current_status_reg_control_write( |
230 | (cspr & ~STATUS_REG_MODE_MASK) | IRQ_MODE |
258 | (cspr & ~STATUS_REG_MODE_MASK) | IRQ_MODE |
231 | ); |
259 | ); |
232 | asm("ldr sp, =irq_stack"); |
260 | asm("ldr sp, =irq_stack"); |
- | 261 | ||
- | 262 | /* abort stack */ |
|
233 | current_status_reg_control_write( cspr); |
263 | current_status_reg_control_write( |
- | 264 | (cspr & ~STATUS_REG_MODE_MASK) | ABORT_MODE |
|
- | 265 | ); |
|
- | 266 | asm("ldr sp, =abort_stack"); |
|
234 | 267 | ||
235 | /* TODO if you want to test other exceptions than IRQ, |
268 | /* TODO if you want to test other exceptions than IRQ, |
236 | make stack analogous to irq_stack (in start.S), |
269 | make stack analogous to irq_stack (in start.S), |
237 | and then set stack pointer here */ |
270 | and then set stack pointer here */ |
- | 271 | ||
- | 272 | current_status_reg_control_write( cspr); |
|
- | 273 | ||
238 | } |
274 | } |
239 | 275 | ||
240 | /** @} |
276 | /** @} |
241 | */ |
277 | */ |