Subversion Repositories HelenOS

Rev

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

Rev 4345 Rev 4346
Line 32... Line 32...
32 
/** @file
 32 
/** @file
33 
 *  @brief Exception handlers and exception initialization routines.
 33 
 *  @brief Exception handlers and exception initialization routines.
34 
 */
 34 
 */
35 
 
 35 
 
36 
#include <arch/exception.h>
 36 
#include <arch/exception.h>
37 
#include <arch/debug/print.h>
 - 
 
38 
#include <arch/memstr.h>
 37 
#include <arch/memstr.h>
39 
#include <arch/regutils.h>
 38 
#include <arch/regutils.h>
40 
#include <interrupt.h>
 39 
#include <interrupt.h>
41 
#include <arch/machine.h>
 - 
 
42 
#include <arch/mm/page_fault.h>
 40 
#include <arch/mm/page_fault.h>
43 
#include <arch/barrier.h>
 41 
#include <arch/barrier.h>
- 
 
 42 
#include <arch/drivers/gxemul.h>
44 
#include <print.h>
 43 
#include <print.h>
45 
#include <syscall/syscall.h>
 44 
#include <syscall/syscall.h>
46 
 
 45 
 
47 
/** Offset used in calculation of exception handler's relative address.
 46 
/** Offset used in calculation of exception handler's relative address.
48 
 *
 47 
 *
Line 258... Line 257...
258 
}
 257 
}
259 
 
 258 
 
260 
/** Low-level Prefetch Abort Exception handler. */
 259 
/** Low-level Prefetch Abort Exception handler. */
261 
static void prefetch_abort_exception_entry(void)
 260 
static void prefetch_abort_exception_entry(void)
262 
{
 261 
{
- 
 
 262 
    asm volatile (
263 
    asm("sub lr, lr, #4");
 263 
        "sub lr, lr, #4"
- 
 
 264 
    );
- 
 
 265 
   
264 
    PROCESS_EXCEPTION(EXC_PREFETCH_ABORT);
 266 
    PROCESS_EXCEPTION(EXC_PREFETCH_ABORT);
265 
}
 267 
}
266 
 
 268 
 
267 
/** Low-level Data Abort Exception handler. */
 269 
/** Low-level Data Abort Exception handler. */
268 
static void data_abort_exception_entry(void)
 270 
static void data_abort_exception_entry(void)
269 
{
 271 
{
- 
 
 272 
    asm volatile (
270 
    asm("sub lr, lr, #8");
 273 
        "sub lr, lr, #8"
- 
 
 274 
    );
- 
 
 275 
   
271 
    PROCESS_EXCEPTION(EXC_DATA_ABORT);
 276 
    PROCESS_EXCEPTION(EXC_DATA_ABORT);
272 
}
 277 
}
273 
 
 278 
 
274 
/** Low-level Interrupt Exception handler.
 279 
/** Low-level Interrupt Exception handler.
275 
 *
 280 
 *
Line 277... Line 282...
277 
 * because of possible occurence of nested interrupt exception, which
 282 
 * because of possible occurence of nested interrupt exception, which
278 
 * would overwrite (and thus spoil) stack pointer.
 283 
 * would overwrite (and thus spoil) stack pointer.
279 
 */
 284 
 */
280 
static void irq_exception_entry(void)
 285 
static void irq_exception_entry(void)
281 
{
 286 
{
- 
 
 287 
    asm volatile (
282 
    asm("sub lr, lr, #4");
 288 
        "sub lr, lr, #4"
- 
 
 289 
    );
- 
 
 290 
   
283 
    setup_stack_and_save_regs();
 291 
    setup_stack_and_save_regs();
284 
   
 292 
   
285 
    switch_to_irq_servicing_mode();
 293 
    switch_to_irq_servicing_mode();
286 
   
 294 
   
287 
    CALL_EXC_DISPATCH(EXC_IRQ)
 295 
    CALL_EXC_DISPATCH(EXC_IRQ)
Line 297... Line 305...
297 
{
 305 
{
298 
    istate->r0 = syscall_handler(istate->r0, istate->r1, istate->r2,
 306 
    istate->r0 = syscall_handler(istate->r0, istate->r1, istate->r2,
299 
        istate->r3, istate->r4, istate->r5, istate->r6);
 307 
        istate->r3, istate->r4, istate->r5, istate->r6);
300 
}
 308 
}
301 
 
 309 
 
- 
 
 310 
/** Returns the mask of active interrupts. */
- 
 
 311 
static inline uint32_t gxemul_irqc_get_sources(void)
- 
 
 312 
{
- 
 
 313 
    return *((uint32_t *) gxemul_irqc);
- 
 
 314 
}
- 
 
 315 
 
302 
/** Interrupt Exception handler.
 316 
/** Interrupt Exception handler.
303 
 *
 317 
 *
304 
 * Determines the sources of interrupt and calls their handlers.
 318 
 * Determines the sources of interrupt and calls their handlers.
305 
 */
 319 
 */
306 
static void irq_exception(int exc_no, istate_t *istate)
 320 
static void irq_exception(int exc_no, istate_t *istate)
307 
{
 321 
{
- 
 
 322 
    uint32_t sources = gxemul_irqc_get_sources();
- 
 
 323 
    unsigned int i;
- 
 
 324 
   
- 
 
 325 
    for (i = 0; i < GXEMUL_IRQC_MAX_IRQ; i++) {
- 
 
 326 
        if (sources & (1 << i)) {
308 
    machine_irq_exception(exc_no, istate);
 327 
            irq_t *irq = irq_dispatch_and_lock(i);
- 
 
 328 
            if (irq) {
- 
 
 329 
                /* The IRQ handler was found. */
- 
 
 330 
                irq->handler(irq);
- 
 
 331 
                spinlock_unlock(&irq->lock);
- 
 
 332 
            } else {
- 
 
 333 
                /* Spurious interrupt.*/
- 
 
 334 
                printf("cpu%d: spurious interrupt (inum=%d)\n",
- 
 
 335 
                    CPU->id, i);
- 
 
 336 
            }
- 
 
 337 
        }
- 
 
 338 
    }
309 
}
 339 
}
310 
 
 340 
 
311 
/** Fills exception vectors with appropriate exception handlers. */
 341 
/** Fills exception vectors with appropriate exception handlers. */
312 
void install_exception_handlers(void)
 342 
void install_exception_handlers(void)
313 
{
 343 
{
Line 327... Line 357...
327 
        (unsigned *) EXC_DATA_ABORT_VEC);
 357 
        (unsigned *) EXC_DATA_ABORT_VEC);
328 
   
 358 
   
329 
    install_handler((unsigned) irq_exception_entry,
 359 
    install_handler((unsigned) irq_exception_entry,
330 
        (unsigned *) EXC_IRQ_VEC);
 360 
        (unsigned *) EXC_IRQ_VEC);
331 
   
 361 
   
332 
    install_handler((unsigned)fiq_exception_entry,
 362 
    install_handler((unsigned) fiq_exception_entry,
333 
        (unsigned *) EXC_FIQ_VEC);
 363 
        (unsigned *) EXC_FIQ_VEC);
334 
}
 364 
}
335 
 
 365 
 
336 
#ifdef HIGH_EXCEPTION_VECTORS
 366 
#ifdef HIGH_EXCEPTION_VECTORS
337 
/** Activates use of high exception vectors addresses. */
 367 
/** Activates use of high exception vectors addresses. */
Line 377... Line 407...
377 
 *
 407 
 *
378 
 * @param istate Structure to be printed.
 408 
 * @param istate Structure to be printed.
379 
 */
 409 
 */
380 
void print_istate(istate_t *istate)
 410 
void print_istate(istate_t *istate)
381 
{
 411 
{
382 
    dprintf("istate dump:\n");
 412 
    printf("istate dump:\n");
383 
 
 413 
   
384 
    dprintf(" r0: %x    r1: %x    r2: %x    r3: %x\n",
 414 
    printf(" r0: %x    r1: %x    r2: %x    r3: %x\n",
385 
        istate->r0, istate->r1, istate->r2, istate->r3);
 415 
        istate->r0, istate->r1, istate->r2, istate->r3);
386 
    dprintf(" r4: %x    r5: %x    r6: %x    r7: %x\n",
 416 
    printf(" r4: %x    r5: %x    r6: %x    r7: %x\n",
387 
        istate->r4, istate->r5, istate->r6, istate->r7);
 417 
        istate->r4, istate->r5, istate->r6, istate->r7);
388 
    dprintf(" r8: %x    r8: %x   r10: %x   r11: %x\n",
 418 
    printf(" r8: %x    r8: %x   r10: %x   r11: %x\n",
389 
        istate->r8, istate->r9, istate->r10, istate->r11);
 419 
        istate->r8, istate->r9, istate->r10, istate->r11);
390 
    dprintf(" r12: %x    sp: %x    lr: %x  spsr: %x\n",
 420 
    printf(" r12: %x    sp: %x    lr: %x  spsr: %x\n",
391 
        istate->r12, istate->sp, istate->lr, istate->spsr);
 421 
        istate->r12, istate->sp, istate->lr, istate->spsr);
392 
 
 422 
   
393 
    dprintf(" pc: %x\n", istate->pc);
 423 
    printf(" pc: %x\n", istate->pc);
394 
}
 424 
}
395 
 
 425 
 
396 
/** @}
 426 
/** @}
397 
 */
 427 
 */