1/*
2 *  vectors.c
3 *
4 *  Copyright (C) 1993, 1994 by Hamish Macdonald
5 *
6 *  68040 fixes by Michael Rausch
7 *  68040 fixes by Martin Apel
8 *  68040 fixes and writeback by Richard Zidlicky
9 *  68060 fixes by Roman Hodek
10 *  68060 fixes by Jesper Skov
11 *
12 * This file is subject to the terms and conditions of the GNU General Public
13 * License.  See the file COPYING in the main directory of this archive
14 * for more details.
15 */
16
17/*
18 * Sets up all exception vectors
19 */
20#include <linux/sched.h>
21#include <linux/kernel.h>
22#include <linux/linkage.h>
23#include <linux/init.h>
24#include <linux/kallsyms.h>
25
26#include <asm/setup.h>
27#include <asm/fpu.h>
28#include <asm/traps.h>
29
30/* assembler routines */
31asmlinkage void system_call(void);
32asmlinkage void buserr(void);
33asmlinkage void trap(void);
34asmlinkage void nmihandler(void);
35#ifdef CONFIG_M68KFPU_EMU
36asmlinkage void fpu_emu(void);
37#endif
38
39e_vector vectors[256];
40
41/* nmi handler for the Amiga */
42asm(".text\n"
43    __ALIGN_STR "\n"
44    "nmihandler: rte");
45
46/*
47 * this must be called very early as the kernel might
48 * use some instruction that are emulated on the 060
49 * and so we're prepared for early probe attempts (e.g. nf_init).
50 */
51void __init base_trap_init(void)
52{
53	if (MACH_IS_SUN3X) {
54		extern e_vector *sun3x_prom_vbr;
55
56		__asm__ volatile ("movec %%vbr, %0" : "=r" (sun3x_prom_vbr));
57	}
58
59	/* setup the exception vector table */
60	__asm__ volatile ("movec %0,%%vbr" : : "r" ((void*)vectors));
61
62	if (CPU_IS_060) {
63		/* set up ISP entry points */
64		asmlinkage void unimp_vec(void) asm ("_060_isp_unimp");
65
66		vectors[VEC_UNIMPII] = unimp_vec;
67	}
68
69	vectors[VEC_BUSERR] = buserr;
70	vectors[VEC_ILLEGAL] = trap;
71	vectors[VEC_SYS] = system_call;
72}
73
74void __init trap_init (void)
75{
76	int i;
77
78	for (i = VEC_SPUR; i <= VEC_INT7; i++)
79		vectors[i] = bad_inthandler;
80
81	for (i = 0; i < VEC_USER; i++)
82		if (!vectors[i])
83			vectors[i] = trap;
84
85	for (i = VEC_USER; i < 256; i++)
86		vectors[i] = bad_inthandler;
87
88#ifdef CONFIG_M68KFPU_EMU
89	if (FPU_IS_EMU)
90		vectors[VEC_LINE11] = fpu_emu;
91#endif
92
93	if (CPU_IS_040 && !FPU_IS_EMU) {
94		/* set up FPSP entry points */
95		asmlinkage void dz_vec(void) asm ("dz");
96		asmlinkage void inex_vec(void) asm ("inex");
97		asmlinkage void ovfl_vec(void) asm ("ovfl");
98		asmlinkage void unfl_vec(void) asm ("unfl");
99		asmlinkage void snan_vec(void) asm ("snan");
100		asmlinkage void operr_vec(void) asm ("operr");
101		asmlinkage void bsun_vec(void) asm ("bsun");
102		asmlinkage void fline_vec(void) asm ("fline");
103		asmlinkage void unsupp_vec(void) asm ("unsupp");
104
105		vectors[VEC_FPDIVZ] = dz_vec;
106		vectors[VEC_FPIR] = inex_vec;
107		vectors[VEC_FPOVER] = ovfl_vec;
108		vectors[VEC_FPUNDER] = unfl_vec;
109		vectors[VEC_FPNAN] = snan_vec;
110		vectors[VEC_FPOE] = operr_vec;
111		vectors[VEC_FPBRUC] = bsun_vec;
112		vectors[VEC_LINE11] = fline_vec;
113		vectors[VEC_FPUNSUP] = unsupp_vec;
114	}
115
116	if (CPU_IS_060 && !FPU_IS_EMU) {
117		/* set up IFPSP entry points */
118		asmlinkage void snan_vec6(void) asm ("_060_fpsp_snan");
119		asmlinkage void operr_vec6(void) asm ("_060_fpsp_operr");
120		asmlinkage void ovfl_vec6(void) asm ("_060_fpsp_ovfl");
121		asmlinkage void unfl_vec6(void) asm ("_060_fpsp_unfl");
122		asmlinkage void dz_vec6(void) asm ("_060_fpsp_dz");
123		asmlinkage void inex_vec6(void) asm ("_060_fpsp_inex");
124		asmlinkage void fline_vec6(void) asm ("_060_fpsp_fline");
125		asmlinkage void unsupp_vec6(void) asm ("_060_fpsp_unsupp");
126		asmlinkage void effadd_vec6(void) asm ("_060_fpsp_effadd");
127
128		vectors[VEC_FPNAN] = snan_vec6;
129		vectors[VEC_FPOE] = operr_vec6;
130		vectors[VEC_FPOVER] = ovfl_vec6;
131		vectors[VEC_FPUNDER] = unfl_vec6;
132		vectors[VEC_FPDIVZ] = dz_vec6;
133		vectors[VEC_FPIR] = inex_vec6;
134		vectors[VEC_LINE11] = fline_vec6;
135		vectors[VEC_FPUNSUP] = unsupp_vec6;
136		vectors[VEC_UNIMPEA] = effadd_vec6;
137	}
138
139        /* if running on an amiga, make the NMI interrupt do nothing */
140	if (MACH_IS_AMIGA) {
141		vectors[VEC_INT7] = nmihandler;
142	}
143}
144
145