Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /***************************************************************************/ |
2 | ||
3 | /* | |
33a21263 | 4 | * linux/arch/m68knommu/platform/coldfire/vectors.c |
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 | ||
36 | extern e_vector *_ramvec; | |
37 | ||
38 | void set_evector(int vecnum, void (*handler)(void)) | |
39 | { | |
40 | if (vecnum >= 0 && vecnum <= 255) | |
41 | _ramvec[vecnum] = handler; | |
42 | } | |
43 | ||
44 | /***************************************************************************/ | |
45 | ||
46 | /* Assembler routines */ | |
47 | asmlinkage void buserr(void); | |
48 | asmlinkage void trap(void); | |
49 | asmlinkage void system_call(void); | |
50 | asmlinkage void inthandler(void); | |
51 | ||
2502b667 | 52 | void __init init_vectors(void) |
1da177e4 LT |
53 | { |
54 | int i; | |
55 | ||
56 | /* | |
57 | * There is a common trap handler and common interrupt | |
58 | * handler that handle almost every vector. We treat | |
59 | * the system call and bus error special, they get their | |
60 | * own first level handlers. | |
61 | */ | |
62 | for (i = 3; (i <= 23); i++) | |
63 | _ramvec[i] = trap; | |
64 | for (i = 33; (i <= 63); i++) | |
65 | _ramvec[i] = trap; | |
66 | for (i = 24; (i <= 31); i++) | |
67 | _ramvec[i] = inthandler; | |
68 | for (i = 64; (i < 255); i++) | |
69 | _ramvec[i] = inthandler; | |
70 | _ramvec[255] = 0; | |
71 | ||
72 | _ramvec[2] = buserr; | |
73 | _ramvec[32] = system_call; | |
74 | ||
75 | #ifdef TRAP_DBG_INTERRUPT | |
76 | _ramvec[12] = dbginterrupt; | |
77 | #endif | |
78 | } | |
79 | ||
80 | /***************************************************************************/ |