Pileus Git - ~andy/linux/blob - arch/mn10300/kernel/traps.c

   1 /* MN10300 Exception handling
   2  *
   3  * Copyright (C) 2007 Matsushita Electric Industrial Co., Ltd.
   4  * Copyright (C) 2007 Red Hat, Inc. All Rights Reserved.
   5  * Modified by David Howells (dhowells@redhat.com)
   6  *
   7  * This program is free software; you can redistribute it and/or
   8  * modify it under the terms of the GNU General Public Licence
   9  * as published by the Free Software Foundation; either version
  10  * 2 of the Licence, or (at your option) any later version.
  11  */
  12 #include <linux/sched.h>
  13 #include <linux/kernel.h>
  14 #include <linux/string.h>
  15 #include <linux/errno.h>
  16 #include <linux/ptrace.h>
  17 #include <linux/timer.h>
  18 #include <linux/mm.h>
  19 #include <linux/smp.h>
  20 #include <linux/init.h>
  21 #include <linux/delay.h>
  22 #include <linux/spinlock.h>
  23 #include <linux/interrupt.h>
  24 #include <linux/kallsyms.h>
  25 #include <linux/pci.h>
  26 #include <linux/kdebug.h>
  27 #include <linux/bug.h>
  28 #include <linux/irq.h>
  29 #include <asm/processor.h>
  30 #include <linux/uaccess.h>
  31 #include <asm/io.h>
  32 #include <linux/atomic.h>
  33 #include <asm/smp.h>
  34 #include <asm/pgalloc.h>
  35 #include <asm/cacheflush.h>
  36 #include <asm/cpu-regs.h>
  37 #include <asm/busctl-regs.h>
  38 #include <unit/leds.h>
  39 #include <asm/fpu.h>
  40 #include <asm/sections.h>
  41 #include <asm/debugger.h>
  42 #include "internal.h"
  43
  44 #if (CONFIG_INTERRUPT_VECTOR_BASE & 0xffffff)
  45 #error "INTERRUPT_VECTOR_BASE not aligned to 16MiB boundary!"
  46 #endif
  47
  48 int kstack_depth_to_print = 24;
  49
  50 spinlock_t die_lock = __SPIN_LOCK_UNLOCKED(die_lock);
  51
  52 struct exception_to_signal_map {
  53         u8      signo;
  54         u32     si_code;
  55 };
  56
  57 static const struct exception_to_signal_map exception_to_signal_map[256] = {
  58         /* MMU exceptions */
  59         [EXCEP_ITLBMISS >> 3]   = { 0, 0 },
  60         [EXCEP_DTLBMISS >> 3]   = { 0, 0 },
  61         [EXCEP_IAERROR >> 3]    = { 0, 0 },
  62         [EXCEP_DAERROR >> 3]    = { 0, 0 },
  63
  64         /* system exceptions */
  65         [EXCEP_TRAP >> 3]       = { SIGTRAP,    TRAP_BRKPT },
  66         [EXCEP_ISTEP >> 3]      = { SIGTRAP,    TRAP_TRACE },   /* Monitor */
  67         [EXCEP_IBREAK >> 3]     = { SIGTRAP,    TRAP_HWBKPT },  /* Monitor */
  68         [EXCEP_OBREAK >> 3]     = { SIGTRAP,    TRAP_HWBKPT },  /* Monitor */
  69         [EXCEP_PRIVINS >> 3]    = { SIGILL,     ILL_PRVOPC },
  70         [EXCEP_UNIMPINS >> 3]   = { SIGILL,     ILL_ILLOPC },
  71         [EXCEP_UNIMPEXINS >> 3] = { SIGILL,     ILL_ILLOPC },
  72         [EXCEP_MEMERR >> 3]     = { SIGSEGV,    SEGV_ACCERR },
  73         [EXCEP_MISALIGN >> 3]   = { SIGBUS,     BUS_ADRALN },
  74         [EXCEP_BUSERROR >> 3]   = { SIGBUS,     BUS_ADRERR },
  75         [EXCEP_ILLINSACC >> 3]  = { SIGSEGV,    SEGV_ACCERR },
  76         [EXCEP_ILLDATACC >> 3]  = { SIGSEGV,    SEGV_ACCERR },
  77         [EXCEP_IOINSACC >> 3]   = { SIGSEGV,    SEGV_ACCERR },
  78         [EXCEP_PRIVINSACC >> 3] = { SIGSEGV,    SEGV_ACCERR }, /* userspace */
  79         [EXCEP_PRIVDATACC >> 3] = { SIGSEGV,    SEGV_ACCERR }, /* userspace */
  80         [EXCEP_DATINSACC >> 3]  = { SIGSEGV,    SEGV_ACCERR },
  81         [EXCEP_DOUBLE_FAULT >> 3] = { SIGILL,   ILL_BADSTK },
  82
  83         /* FPU exceptions */
  84         [EXCEP_FPU_DISABLED >> 3] = { SIGILL,   ILL_COPROC },
  85         [EXCEP_FPU_UNIMPINS >> 3] = { SIGILL,   ILL_COPROC },
  86         [EXCEP_FPU_OPERATION >> 3] = { SIGFPE,  FPE_INTDIV },
  87
  88         /* interrupts */
  89         [EXCEP_WDT >> 3]        = { SIGALRM,    0 },
  90         [EXCEP_NMI >> 3]        = { SIGQUIT,    0 },
  91         [EXCEP_IRQ_LEVEL0 >> 3] = { SIGINT,     0 },
  92         [EXCEP_IRQ_LEVEL1 >> 3] = { 0, 0 },
  93         [EXCEP_IRQ_LEVEL2 >> 3] = { 0, 0 },
  94         [EXCEP_IRQ_LEVEL3 >> 3] = { 0, 0 },
  95         [EXCEP_IRQ_LEVEL4 >> 3] = { 0, 0 },
  96         [EXCEP_IRQ_LEVEL5 >> 3] = { 0, 0 },
  97         [EXCEP_IRQ_LEVEL6 >> 3] = { 0, 0 },
  98
  99         /* system calls */
 100         [EXCEP_SYSCALL0 >> 3]   = { 0, 0 },
 101         [EXCEP_SYSCALL1 >> 3]   = { SIGILL,     ILL_ILLTRP },
 102         [EXCEP_SYSCALL2 >> 3]   = { SIGILL,     ILL_ILLTRP },
 103         [EXCEP_SYSCALL3 >> 3]   = { SIGILL,     ILL_ILLTRP },
 104         [EXCEP_SYSCALL4 >> 3]   = { SIGILL,     ILL_ILLTRP },
 105         [EXCEP_SYSCALL5 >> 3]   = { SIGILL,     ILL_ILLTRP },
 106         [EXCEP_SYSCALL6 >> 3]   = { SIGILL,     ILL_ILLTRP },
 107         [EXCEP_SYSCALL7 >> 3]   = { SIGILL,     ILL_ILLTRP },
 108         [EXCEP_SYSCALL8 >> 3]   = { SIGILL,     ILL_ILLTRP },
 109         [EXCEP_SYSCALL9 >> 3]   = { SIGILL,     ILL_ILLTRP },
 110         [EXCEP_SYSCALL10 >> 3]  = { SIGILL,     ILL_ILLTRP },
 111         [EXCEP_SYSCALL11 >> 3]  = { SIGILL,     ILL_ILLTRP },
 112         [EXCEP_SYSCALL12 >> 3]  = { SIGILL,     ILL_ILLTRP },
 113         [EXCEP_SYSCALL13 >> 3]  = { SIGILL,     ILL_ILLTRP },
 114         [EXCEP_SYSCALL14 >> 3]  = { SIGILL,     ILL_ILLTRP },
 115         [EXCEP_SYSCALL15 >> 3]  = { SIGABRT,    0 },
 116 };
 117
 118 /*
 119  * Handle kernel exceptions.
 120  *
 121  * See if there's a fixup handler we can force a jump to when an exception
 122  * happens due to something kernel code did
 123  */
 124 int die_if_no_fixup(const char *str, struct pt_regs *regs,
 125                     enum exception_code code)
 126 {
 127         u8 opcode;
 128         int signo, si_code;
 129
 130         if (user_mode(regs))
 131                 return 0;
 132
 133         peripheral_leds_display_exception(code);
 134
 135         signo = exception_to_signal_map[code >> 3].signo;
 136         si_code = exception_to_signal_map[code >> 3].si_code;
 137
 138         switch (code) {
 139                 /* see if we can fixup the kernel accessing memory */
 140         case EXCEP_ITLBMISS:
 141         case EXCEP_DTLBMISS:
 142         case EXCEP_IAERROR:
 143         case EXCEP_DAERROR:
 144         case EXCEP_MEMERR:
 145         case EXCEP_MISALIGN:
 146         case EXCEP_BUSERROR:
 147         case EXCEP_ILLDATACC:
 148         case EXCEP_IOINSACC:
 149         case EXCEP_PRIVINSACC:
 150         case EXCEP_PRIVDATACC:
 151         case EXCEP_DATINSACC:
 152                 if (fixup_exception(regs))
 153                         return 1;
 154                 break;
 155
 156         case EXCEP_TRAP:
 157         case EXCEP_UNIMPINS:
 158                 if (probe_kernel_read(&opcode, (u8 *)regs->pc, 1) < 0)
 159                         break;
 160                 if (opcode == 0xff) {
 161                         if (notify_die(DIE_BREAKPOINT, str, regs, code, 0, 0))
 162                                 return 1;
 163                         if (at_debugger_breakpoint(regs))
 164                                 regs->pc++;
 165                         signo = SIGTRAP;
 166                         si_code = TRAP_BRKPT;
 167                 }
 168                 break;
 169
 170         case EXCEP_SYSCALL1 ... EXCEP_SYSCALL14:
 171                 /* syscall return addr is _after_ the instruction */
 172                 regs->pc -= 2;
 173                 break;
 174
 175         case EXCEP_SYSCALL15:
 176                 if (report_bug(regs->pc, regs) == BUG_TRAP_TYPE_WARN)
 177                         return 1;
 178
 179                 /* syscall return addr is _after_ the instruction */
 180                 regs->pc -= 2;
 181                 break;
 182
 183         default:
 184                 break;
 185         }
 186
 187         if (debugger_intercept(code, signo, si_code, regs) == 0)
 188                 return 1;
 189
 190         if (notify_die(DIE_GPF, str, regs, code, 0, 0))
 191                 return 1;
 192
 193         /* make the process die as the last resort */
 194         die(str, regs, code);
 195 }
 196
 197 /*
 198  * General exception handler
 199  */
 200 asmlinkage void handle_exception(struct pt_regs *regs, u32 intcode)
 201 {
 202         siginfo_t info;
 203
 204         /* deal with kernel exceptions here */
 205         if (die_if_no_fixup(NULL, regs, intcode))
 206                 return;
 207
 208         /* otherwise it's a userspace exception */
 209         info.si_signo = exception_to_signal_map[intcode >> 3].signo;
 210         info.si_code = exception_to_signal_map[intcode >> 3].si_code;
 211         info.si_errno = 0;
 212         info.si_addr = (void *) regs->pc;
 213         force_sig_info(info.si_signo, &info, current);
 214 }
 215
 216 /*
 217  * handle NMI
 218  */
 219 asmlinkage void nmi(struct pt_regs *regs, enum exception_code code)
 220 {
 221         /* see if gdbstub wants to deal with it */
 222         if (debugger_intercept(code, SIGQUIT, 0, regs))
 223                 return;
 224
 225         printk(KERN_WARNING "--- Register Dump ---\n");
 226         show_registers(regs);
 227         printk(KERN_WARNING "---------------------\n");
 228 }
 229
 230 /*
 231  * show a stack trace from the specified stack pointer
 232  */
 233 void show_trace(unsigned long *sp)
 234 {
 235         unsigned long bottom, stack, addr, fp, raslot;
 236
 237         printk(KERN_EMERG "\nCall Trace:\n");
 238
 239         //stack = (unsigned long)sp;
 240         asm("mov sp,%0" : "=a"(stack));
 241         asm("mov a3,%0" : "=r"(fp));
 242
 243         raslot = ULONG_MAX;
 244         bottom = (stack + THREAD_SIZE) & ~(THREAD_SIZE - 1);
 245         for (; stack < bottom; stack += sizeof(addr)) {
 246                 addr = *(unsigned long *)stack;
 247                 if (stack == fp) {
 248                         if (addr > stack && addr < bottom) {
 249                                 fp = addr;
 250                                 raslot = stack + sizeof(addr);
 251                                 continue;
 252                         }
 253                         fp = 0;
 254                         raslot = ULONG_MAX;
 255                 }
 256
 257                 if (__kernel_text_address(addr)) {
 258                         printk(" [<%08lx>]", addr);
 259                         if (stack >= raslot)
 260                                 raslot = ULONG_MAX;
 261                         else
 262                                 printk(" ?");
 263                         print_symbol(" %s", addr);
 264                         printk("\n");
 265                 }
 266         }
 267
 268         printk("\n");
 269 }
 270
 271 /*
 272  * show the raw stack from the specified stack pointer
 273  */
 274 void show_stack(struct task_struct *task, unsigned long *sp)
 275 {
 276         unsigned long *stack;
 277         int i;
 278
 279         if (!sp)
 280                 sp = (unsigned long *) &sp;
 281
 282         stack = sp;
 283         printk(KERN_EMERG "Stack:");
 284         for (i = 0; i < kstack_depth_to_print; i++) {
 285                 if (((long) stack & (THREAD_SIZE - 1)) == 0)
 286                         break;
 287                 if ((i % 8) == 0)
 288                         printk(KERN_EMERG "  ");
 289                 printk("%08lx ", *stack++);
 290         }
 291
 292         show_trace(sp);
 293 }
 294
 295 /*
 296  * the architecture-independent dump_stack generator
 297  */
 298 void dump_stack(void)
 299 {
 300         unsigned long stack;
 301
 302         show_stack(current, &stack);
 303 }
 304 EXPORT_SYMBOL(dump_stack);
 305
 306 /*
 307  * dump the register file in the specified exception frame
 308  */
 309 void show_registers_only(struct pt_regs *regs)
 310 {
 311         unsigned long ssp;
 312
 313         ssp = (unsigned long) regs + sizeof(*regs);
 314
 315         printk(KERN_EMERG "PC:  %08lx EPSW:  %08lx  SSP: %08lx mode: %s\n",
 316                regs->pc, regs->epsw, ssp, user_mode(regs) ? "User" : "Super");
 317         printk(KERN_EMERG "d0:  %08lx   d1:  %08lx   d2: %08lx   d3: %08lx\n",
 318                regs->d0, regs->d1, regs->d2, regs->d3);
 319         printk(KERN_EMERG "a0:  %08lx   a1:  %08lx   a2: %08lx   a3: %08lx\n",
 320                regs->a0, regs->a1, regs->a2, regs->a3);
 321         printk(KERN_EMERG "e0:  %08lx   e1:  %08lx   e2: %08lx   e3: %08lx\n",
 322                regs->e0, regs->e1, regs->e2, regs->e3);
 323         printk(KERN_EMERG "e4:  %08lx   e5:  %08lx   e6: %08lx   e7: %08lx\n",
 324                regs->e4, regs->e5, regs->e6, regs->e7);
 325         printk(KERN_EMERG "lar: %08lx   lir: %08lx  mdr: %08lx  usp: %08lx\n",
 326                regs->lar, regs->lir, regs->mdr, regs->sp);
 327         printk(KERN_EMERG "cvf: %08lx   crl: %08lx  crh: %08lx  drq: %08lx\n",
 328                regs->mcvf, regs->mcrl, regs->mcrh, regs->mdrq);
 329         printk(KERN_EMERG "threadinfo=%p task=%p)\n",
 330                current_thread_info(), current);
 331
 332         if ((unsigned long) current >= PAGE_OFFSET &&
 333             (unsigned long) current < (unsigned long)high_memory)
 334                 printk(KERN_EMERG "Process %s (pid: %d)\n",
 335                        current->comm, current->pid);
 336
 337 #ifdef CONFIG_SMP
 338         printk(KERN_EMERG "CPUID:  %08x\n", CPUID);
 339 #endif
 340         printk(KERN_EMERG "CPUP:   %04hx\n", CPUP);
 341         printk(KERN_EMERG "TBR:    %08x\n", TBR);
 342         printk(KERN_EMERG "DEAR:   %08x\n", DEAR);
 343         printk(KERN_EMERG "sISR:   %08x\n", sISR);
 344         printk(KERN_EMERG "NMICR:  %04hx\n", NMICR);
 345         printk(KERN_EMERG "BCBERR: %08x\n", BCBERR);
 346         printk(KERN_EMERG "BCBEAR: %08x\n", BCBEAR);
 347         printk(KERN_EMERG "MMUFCR: %08x\n", MMUFCR);
 348         printk(KERN_EMERG "IPTEU : %08x  IPTEL2: %08x\n", IPTEU, IPTEL2);
 349         printk(KERN_EMERG "DPTEU:  %08x  DPTEL2: %08x\n", DPTEU, DPTEL2);
 350 }
 351
 352 /*
 353  * dump the registers and the stack
 354  */
 355 void show_registers(struct pt_regs *regs)
 356 {
 357         unsigned long sp;
 358         int i;
 359
 360         show_registers_only(regs);
 361
 362         if (!user_mode(regs))
 363                 sp = (unsigned long) regs + sizeof(*regs);
 364         else
 365                 sp = regs->sp;
 366
 367         /* when in-kernel, we also print out the stack and code at the
 368          * time of the fault..
 369          */
 370         if (!user_mode(regs)) {
 371                 printk(KERN_EMERG "\n");
 372                 show_stack(current, (unsigned long *) sp);
 373
 374 #if 0
 375                 printk(KERN_EMERG "\nCode: ");
 376                 if (regs->pc < PAGE_OFFSET)
 377                         goto bad;
 378
 379                 for (i = 0; i < 20; i++) {
 380                         unsigned char c;
 381                         if (__get_user(c, &((unsigned char *) regs->pc)[i]))
 382                                 goto bad;
 383                         printk("%02x ", c);
 384                 }
 385 #else
 386                 i = 0;
 387 #endif
 388         }
 389
 390         printk("\n");
 391         return;
 392
 393 #if 0
 394 bad:
 395         printk(KERN_EMERG " Bad PC value.");
 396         break;
 397 #endif
 398 }
 399
 400 /*
 401  *
 402  */
 403 void show_trace_task(struct task_struct *tsk)
 404 {
 405         unsigned long sp = tsk->thread.sp;
 406
 407         /* User space on another CPU? */
 408         if ((sp ^ (unsigned long) tsk) & (PAGE_MASK << 1))
 409                 return;
 410
 411         show_trace((unsigned long *) sp);
 412 }
 413
 414 /*
 415  * note the untimely death of part of the kernel
 416  */
 417 void die(const char *str, struct pt_regs *regs, enum exception_code code)
 418 {
 419         console_verbose();
 420         spin_lock_irq(&die_lock);
 421         printk(KERN_EMERG "\n%s: %04x\n",
 422                str, code & 0xffff);
 423         show_registers(regs);
 424
 425         if (regs->pc >= 0x02000000 && regs->pc < 0x04000000 &&
 426             (regs->epsw & (EPSW_IM | EPSW_IE)) != (EPSW_IM | EPSW_IE)) {
 427                 printk(KERN_EMERG "Exception in usermode interrupt handler\n");
 428                 printk(KERN_EMERG "\nPlease connect to kernel debugger !!\n");
 429                 asm volatile ("0: bra 0b");
 430         }
 431
 432         spin_unlock_irq(&die_lock);
 433         do_exit(SIGSEGV);
 434 }
 435
 436 /*
 437  * display the register file when the stack pointer gets clobbered
 438  */
 439 asmlinkage void do_double_fault(struct pt_regs *regs)
 440 {
 441         struct task_struct *tsk = current;
 442
 443         strcpy(tsk->comm, "emergency tsk");
 444         tsk->pid = 0;
 445         console_verbose();
 446         printk(KERN_EMERG "--- double fault ---\n");
 447         show_registers(regs);
 448 }
 449
 450 /*
 451  * asynchronous bus error (external, usually I/O DMA)
 452  */
 453 asmlinkage void io_bus_error(u32 bcberr, u32 bcbear, struct pt_regs *regs)
 454 {
 455         console_verbose();
 456
 457         printk(KERN_EMERG "Asynchronous I/O Bus Error\n");
 458         printk(KERN_EMERG "==========================\n");
 459
 460         if (bcberr & BCBERR_BEME)
 461                 printk(KERN_EMERG "- Multiple recorded errors\n");
 462
 463         printk(KERN_EMERG "- Faulting Buses:%s%s%s\n",
 464                bcberr & BCBERR_BEMR_CI  ? " CPU-Ins-Fetch" : "",
 465                bcberr & BCBERR_BEMR_CD  ? " CPU-Data" : "",
 466                bcberr & BCBERR_BEMR_DMA ? " DMA" : "");
 467
 468         printk(KERN_EMERG "- %s %s access made to %s at address %08x\n",
 469                bcberr & BCBERR_BEBST ? "Burst" : "Single",
 470                bcberr & BCBERR_BERW ? "Read" : "Write",
 471                bcberr & BCBERR_BESB_MON  ? "Monitor Space" :
 472                bcberr & BCBERR_BESB_IO   ? "Internal CPU I/O Space" :
 473                bcberr & BCBERR_BESB_EX   ? "External I/O Bus" :
 474                bcberr & BCBERR_BESB_OPEX ? "External Memory Bus" :
 475                "On Chip Memory",
 476                bcbear
 477                );
 478
 479         printk(KERN_EMERG "- Detected by the %s\n",
 480                bcberr&BCBERR_BESD ? "Bus Control Unit" : "Slave Bus");
 481
 482 #ifdef CONFIG_PCI
 483 #define BRIDGEREGB(X) (*(volatile __u8  *)(0xBE040000 + (X)))
 484 #define BRIDGEREGW(X) (*(volatile __u16 *)(0xBE040000 + (X)))
 485 #define BRIDGEREGL(X) (*(volatile __u32 *)(0xBE040000 + (X)))
 486
 487         printk(KERN_EMERG "- PCI Memory Paging Reg:         %08x\n",
 488                *(volatile __u32 *) (0xBFFFFFF4));
 489         printk(KERN_EMERG "- PCI Bridge Base Address 0:     %08x\n",
 490                BRIDGEREGL(PCI_BASE_ADDRESS_0));
 491         printk(KERN_EMERG "- PCI Bridge AMPCI Base Address: %08x\n",
 492                BRIDGEREGL(0x48));
 493         printk(KERN_EMERG "- PCI Bridge Command:                %04hx\n",
 494                BRIDGEREGW(PCI_COMMAND));
 495         printk(KERN_EMERG "- PCI Bridge Status:                 %04hx\n",
 496                BRIDGEREGW(PCI_STATUS));
 497         printk(KERN_EMERG "- PCI Bridge Int Status:         %08hx\n",
 498                BRIDGEREGL(0x4c));
 499 #endif
 500
 501         printk(KERN_EMERG "\n");
 502         show_registers(regs);
 503
 504         panic("Halted due to asynchronous I/O Bus Error\n");
 505 }
 506
 507 /*
 508  * handle an exception for which a handler has not yet been installed
 509  */
 510 asmlinkage void uninitialised_exception(struct pt_regs *regs,
 511                                         enum exception_code code)
 512 {
 513
 514         /* see if gdbstub wants to deal with it */
 515         if (debugger_intercept(code, SIGSYS, 0, regs) == 0)
 516                 return;
 517
 518         peripheral_leds_display_exception(code);
 519         printk(KERN_EMERG "Uninitialised Exception 0x%04x\n", code & 0xFFFF);
 520         show_registers(regs);
 521
 522         for (;;)
 523                 continue;
 524 }
 525
 526 /*
 527  * set an interrupt stub to jump to a handler
 528  * ! NOTE: this does *not* flush the caches
 529  */
 530 void __init __set_intr_stub(enum exception_code code, void *handler)
 531 {
 532         unsigned long addr;
 533         u8 *vector = (u8 *)(CONFIG_INTERRUPT_VECTOR_BASE + code);
 534
 535         addr = (unsigned long) handler - (unsigned long) vector;
 536         vector[0] = 0xdc;               /* JMP handler */
 537         vector[1] = addr;
 538         vector[2] = addr >> 8;
 539         vector[3] = addr >> 16;
 540         vector[4] = addr >> 24;
 541         vector[5] = 0xcb;
 542         vector[6] = 0xcb;
 543         vector[7] = 0xcb;
 544 }
 545
 546 /*
 547  * set an interrupt stub to jump to a handler
 548  */
 549 void __init set_intr_stub(enum exception_code code, void *handler)
 550 {
 551         unsigned long addr;
 552         u8 *vector = (u8 *)(CONFIG_INTERRUPT_VECTOR_BASE + code);
 553         unsigned long flags;
 554
 555         addr = (unsigned long) handler - (unsigned long) vector;
 556
 557         flags = arch_local_cli_save();
 558
 559         vector[0] = 0xdc;               /* JMP handler */
 560         vector[1] = addr;
 561         vector[2] = addr >> 8;
 562         vector[3] = addr >> 16;
 563         vector[4] = addr >> 24;
 564         vector[5] = 0xcb;
 565         vector[6] = 0xcb;
 566         vector[7] = 0xcb;
 567
 568         arch_local_irq_restore(flags);
 569
 570 #ifndef CONFIG_MN10300_CACHE_SNOOP
 571         mn10300_dcache_flush_inv();
 572         mn10300_icache_inv();
 573 #endif
 574 }
 575
 576 /*
 577  * initialise the exception table
 578  */
 579 void __init trap_init(void)
 580 {
 581         set_excp_vector(EXCEP_TRAP,             handle_exception);
 582         set_excp_vector(EXCEP_ISTEP,            handle_exception);
 583         set_excp_vector(EXCEP_IBREAK,           handle_exception);
 584         set_excp_vector(EXCEP_OBREAK,           handle_exception);
 585
 586         set_excp_vector(EXCEP_PRIVINS,          handle_exception);
 587         set_excp_vector(EXCEP_UNIMPINS,         handle_exception);
 588         set_excp_vector(EXCEP_UNIMPEXINS,       handle_exception);
 589         set_excp_vector(EXCEP_MEMERR,           handle_exception);
 590         set_excp_vector(EXCEP_MISALIGN,         misalignment);
 591         set_excp_vector(EXCEP_BUSERROR,         handle_exception);
 592         set_excp_vector(EXCEP_ILLINSACC,        handle_exception);
 593         set_excp_vector(EXCEP_ILLDATACC,        handle_exception);
 594         set_excp_vector(EXCEP_IOINSACC,         handle_exception);
 595         set_excp_vector(EXCEP_PRIVINSACC,       handle_exception);
 596         set_excp_vector(EXCEP_PRIVDATACC,       handle_exception);
 597         set_excp_vector(EXCEP_DATINSACC,        handle_exception);
 598         set_excp_vector(EXCEP_FPU_UNIMPINS,     handle_exception);
 599         set_excp_vector(EXCEP_FPU_OPERATION,    fpu_exception);
 600
 601         set_excp_vector(EXCEP_NMI,              nmi);
 602
 603         set_excp_vector(EXCEP_SYSCALL1,         handle_exception);
 604         set_excp_vector(EXCEP_SYSCALL2,         handle_exception);
 605         set_excp_vector(EXCEP_SYSCALL3,         handle_exception);
 606         set_excp_vector(EXCEP_SYSCALL4,         handle_exception);
 607         set_excp_vector(EXCEP_SYSCALL5,         handle_exception);
 608         set_excp_vector(EXCEP_SYSCALL6,         handle_exception);
 609         set_excp_vector(EXCEP_SYSCALL7,         handle_exception);
 610         set_excp_vector(EXCEP_SYSCALL8,         handle_exception);
 611         set_excp_vector(EXCEP_SYSCALL9,         handle_exception);
 612         set_excp_vector(EXCEP_SYSCALL10,        handle_exception);
 613         set_excp_vector(EXCEP_SYSCALL11,        handle_exception);
 614         set_excp_vector(EXCEP_SYSCALL12,        handle_exception);
 615         set_excp_vector(EXCEP_SYSCALL13,        handle_exception);
 616         set_excp_vector(EXCEP_SYSCALL14,        handle_exception);
 617         set_excp_vector(EXCEP_SYSCALL15,        handle_exception);
 618 }
 619
 620 /*
 621  * determine if a program counter value is a valid bug address
 622  */
 623 int is_valid_bugaddr(unsigned long pc)
 624 {
 625         return pc >= PAGE_OFFSET;
 626 }