arch/all-pc/kernel/cpu_traps.c

   1 /*
   2     Copyright © 2011, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: Common trap handling routines for x86 CPU
   6     Lang: English
   7 */
   8
   9 #include <exec/execbase.h>
  10 #include <exec/tasks.h>
  11 #include <proto/exec.h>
  12
  13 #include "kernel_base.h"
  14 #include "kernel_debug.h"
  15 #include "kernel_interrupts.h"
  16 #include "kernel_intr.h"
  17 #include "cpu_traps.h"
  18
  19 #define D(x)
  20 #define DUMP_CONTEXT
  21
  22 #ifdef DUMP_CONTEXT
  23
  24 static void PrintContext(struct ExceptionContext *regs, unsigned long error_code)
  25 {
  26     int i;
  27     unsigned long *ptr;
  28     struct Task *t = SysBase->ThisTask;
  29
  30     if (t)
  31     {
  32         bug("[Kernel]  %s %p '%s'\n", t->tc_Node.ln_Type == NT_TASK?"task":"process", t, t->tc_Node.ln_Name);
  33         bug("[Kernel] SPLower=%p SPUpper=%p\n", t->tc_SPLower, t->tc_SPUpper);
  34
  35         if (((void *)SP(regs) < t->tc_SPLower) || ((void *)SP(regs) > t->tc_SPUpper))
  36             bug("[Kernel] Stack out of Bounds!\n");
  37     }
  38
  39     bug("[Kernel] Error 0x%p\n", error_code);
  40     PRINT_CPUCONTEXT(regs);
  41
  42     bug("[Kernel] Stack:\n");
  43     ptr = (unsigned long *)SP(regs);
  44     for (i=0; i < 10; i++)
  45         bug("[Kernel] %02x: %p\n", i * sizeof(unsigned long), ptr[i]);
  46 }
  47
  48 #else
  49
  50 #define PrintContext(regs, err)
  51
  52 #endif
  53
  54 /*
  55  * This table is used to translate x86 trap number
  56  * to AmigaOS trap number to be passed to exec exception handler.
  57  */
  58 static const char AmigaTraps[] =
  59 {
  60      5,  9, -1,  4, 11, 2,
  61      4,  0,  8, 11,  3, 3,
  62      2,  8,  3, -1, 11, 3,
  63     -1
  64 };
  65
  66 void cpu_Trap(struct ExceptionContext *regs, unsigned long error_code, unsigned long irq_number)
  67 {
  68     D(bug("[Kernel] Trap exception %u\n", irq_number));
  69
  70     if (krnRunExceptionHandlers(KernelBase, irq_number, regs))
  71         return;
  72
  73     D(bug("[Kernel] Passing on to exec, Amiga trap %d\n", AmigaTraps[irq_number]));
  74
  75     if (AmigaTraps[irq_number] != -1)
  76     {
  77         if (core_Trap(AmigaTraps[irq_number], regs))
  78         {
  79             /* If the trap handler returned, we can continue */
  80             D(bug("[Kernel] Trap handler returned\n"));
  81             return;
  82         }
  83     }
  84
  85     bug("[Kernel] UNHANDLED EXCEPTION %lu\n", irq_number);
  86     PrintContext(regs, error_code);
  87
  88     while (1) asm volatile ("hlt");
  89 }