Prex Home / Browse Source - Prex Version: 0.9.0

root/bsp/hal/arm/arch/trap.c

/* [<][>][^][v][top][bottom][index][help] */

DEFINITIONS

This source file includes following definitions.
  1. trap_handler
  2. trap_dump

   1 /*-
   2  * Copyright (c) 2005-2009, Kohsuke Ohtani
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  * 3. Neither the name of the author nor the names of any co-contributors
  14  *    may be used to endorse or promote products derived from this software
  15  *    without specific prior written permission.
  16  *
  17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  27  * SUCH DAMAGE.
  28  */
  29 
  30 /*
  31  * trap.c - called from the abort handler when a processor detect abort.
  32  */
  33 
  34 #include <sys/signal.h>
  35 #include <kernel.h>
  36 #include <task.h>
  37 #include <hal.h>
  38 #include <exception.h>
  39 #include <cpu.h>
  40 #include <trap.h>
  41 #include <cpufunc.h>
  42 #include <context.h>
  43 #include <locore.h>
  44 
  45 #ifdef DEBUG
  46 /*
  47  * Trap name
  48  */
  49 static char *const trap_name[] = {
  50         "Undefined Instruction",
  51         "Prefetch Abort",
  52         "Data Abort"
  53 };
  54 #define MAXTRAP (sizeof(trap_name) / sizeof(void *) - 1)
  55 #endif  /* !DEBUG */
  56 
  57 /*
  58  * abort/exception mapping table.
  59  * ARM exception is translated to the architecture
  60  * independent exception code.
  61  */
  62 static const int exception_map[] = {
  63         SIGILL,         /* Undefined instruction */
  64         SIGSEGV,        /* Prefech abort */
  65         SIGSEGV,        /* Data abort */
  66 };
  67 
  68 /*
  69  * Trap handler
  70  * Invoke the exception handler if it is needed.
  71  */
  72 void
  73 trap_handler(struct cpu_regs *regs)
  74 {
  75         u_long trap_no = regs->r0;
  76 
  77         if ((regs->cpsr & PSR_MODE) == PSR_SVC_MODE &&
  78             trap_no == TRAP_DATA_ABORT &&
  79             (regs->pc - 4 == (uint32_t)known_fault1 ||
  80              regs->pc - 4 == (uint32_t)known_fault2 ||
  81              regs->pc - 4 == (uint32_t)known_fault3)) {
  82                 DPRINTF(("\n*** Detect Fault! address=%x task=%s ***\n",
  83                          get_faultaddress(), curtask->name));
  84                 regs->pc = (uint32_t)copy_fault;
  85                 return;
  86         }
  87 #ifdef DEBUG
  88         printf("=============================\n");
  89         printf("Trap %x: %s\n", (u_int)trap_no, trap_name[trap_no]);
  90         if (trap_no == TRAP_DATA_ABORT)
  91                 printf(" Fault address=%x\n", get_faultaddress());
  92         else if (trap_no == TRAP_PREFETCH_ABORT)
  93                 printf(" Fault address=%x\n", regs->pc);
  94         printf("=============================\n");
  95 
  96         trap_dump(regs);
  97         for (;;) ;
  98 #endif
  99         if ((regs->cpsr & PSR_MODE) != PSR_USR_MODE)
 100                 panic("Kernel exception");
 101 
 102         exception_mark(exception_map[trap_no]);
 103         exception_deliver();
 104 }
 105 
 106 #ifdef DEBUG
 107 void
 108 trap_dump(struct cpu_regs *r)
 109 {
 110 
 111         printf("Trap frame %x\n", r);
 112         printf(" r0  %08x r1  %08x r2  %08x r3  %08x r4  %08x r5  %08x\n",
 113                r->r0, r->r1, r->r2, r->r3, r->r4, r->r5);
 114         printf(" r6  %08x r7  %08x r8  %08x r9  %08x r10 %08x r11 %08x\n",
 115                r->r6, r->r7, r->r8, r->r9, r->r10, r->r11);
 116         printf(" r12 %08x sp  %08x lr  %08x pc  %08x cpsr %08x\n",
 117                r->r12, r->sp, r->lr, r->pc, r->cpsr);
 118 
 119         printf(" >> interrupt is %s\n",
 120                (r->cpsr & PSR_INT_MASK) ? "disabled" : "enabled");
 121 
 122         printf(" >> task=%s\n", curtask->name);
 123 }
 124 #endif /* !DEBUG */

/* [<][>][^][v][top][bottom][index][help] */