Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /***************************************************************************/ |
2 | ||
3 | /* | |
ece9ae65 | 4 | * vectors.c -- high level trap setup for ColdFire |
1da177e4 | 5 | * |
2502b667 | 6 | * Copyright (C) 1999-2007, Greg Ungerer <gerg@snapgear.com> |
1da177e4 LT |
7 | */ |
8 | ||
9 | /***************************************************************************/ | |
10 | ||
1da177e4 | 11 | #include <linux/kernel.h> |
1da177e4 | 12 | #include <linux/init.h> |
2502b667 | 13 | #include <linux/irq.h> |
1da177e4 LT |
14 | #include <asm/traps.h> |
15 | #include <asm/machdep.h> | |
16 | #include <asm/coldfire.h> | |
1da177e4 | 17 | #include <asm/mcfsim.h> |
1da177e4 LT |
18 | #include <asm/mcfwdebug.h> |
19 | ||
20 | /***************************************************************************/ | |
21 | ||
22 | #ifdef TRAP_DBG_INTERRUPT | |
23 | ||
24 | asmlinkage void dbginterrupt_c(struct frame *fp) | |
25 | { | |
26 | extern void dump(struct pt_regs *fp); | |
27 | printk(KERN_DEBUG "%s(%d): BUS ERROR TRAP\n", __FILE__, __LINE__); | |
28 | dump((struct pt_regs *) fp); | |
29 | asm("halt"); | |
30 | } | |
31 | ||
32 | #endif | |
33 | ||
34 | /***************************************************************************/ | |
35 | ||
1da177e4 LT |
36 | /* Assembler routines */ |
37 | asmlinkage void buserr(void); | |
38 | asmlinkage void trap(void); | |
39 | asmlinkage void system_call(void); | |
40 | asmlinkage void inthandler(void); | |
41 | ||
622e9472 | 42 | void __init trap_init(void) |
1da177e4 LT |
43 | { |
44 | int i; | |
45 | ||
46 | /* | |
47 | * There is a common trap handler and common interrupt | |
48 | * handler that handle almost every vector. We treat | |
49 | * the system call and bus error special, they get their | |
50 | * own first level handlers. | |
51 | */ | |
52 | for (i = 3; (i <= 23); i++) | |
53 | _ramvec[i] = trap; | |
54 | for (i = 33; (i <= 63); i++) | |
55 | _ramvec[i] = trap; | |
56 | for (i = 24; (i <= 31); i++) | |
57 | _ramvec[i] = inthandler; | |
58 | for (i = 64; (i < 255); i++) | |
59 | _ramvec[i] = inthandler; | |
60 | _ramvec[255] = 0; | |
61 | ||
62 | _ramvec[2] = buserr; | |
63 | _ramvec[32] = system_call; | |
64 | ||
65 | #ifdef TRAP_DBG_INTERRUPT | |
66 | _ramvec[12] = dbginterrupt; | |
67 | #endif | |
68 | } | |
69 | ||
70 | /***************************************************************************/ |