arch/all-pc/kernel/cpu_traps.c

   1 /*
   2     Copyright © 2011-2017, 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 = GET_THIS_TASK;
  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 #define AMIGATRAP_COUNT 19
  59 static const char AmigaTraps[AMIGATRAP_COUNT] =
  60 {
  61      5,  9, -1,  4, 11, 2,
  62      4,  0,  8, 11,  3, 3,
  63      2,  8,  3, -1, 11, 3,
  64     -1
  65 };
  66
  67 void cpu_Trap(struct ExceptionContext *regs, unsigned long error_code, unsigned long irq_number)
  68 {
  69     D(bug("[Kernel] Trap exception %u\n", irq_number));
  70
  71     if (krnRunExceptionHandlers(KernelBase, irq_number, regs))
  72         return;
  73
  74     if ((irq_number < AMIGATRAP_COUNT) && (AmigaTraps[irq_number] != -1))
  75     {
  76         D(bug("[Kernel] Passing on to exec, Amiga trap %d\n", AmigaTraps[irq_number]));
  77
  78         if (core_Trap(AmigaTraps[irq_number], regs))
  79         {
  80             /* If the trap handler returned, we can continue */
  81             D(bug("[Kernel] Trap handler returned\n"));
  82             return;
  83         }
  84     }
  85
  86     bug("[Kernel] UNHANDLED EXCEPTION %lu\n", irq_number);
  87     PrintContext(regs, error_code);
  88
  89     while (1) asm volatile ("hlt");
  90 }