vectors.c (3886B)
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