/*	$NetBSD: vector.c,v 1.12 1995/01/18 17:14:47 gwr Exp $	*/

/*
 * Copyright (c) 1994 Gordon W. Ross
 * Copyright (c) 1993 Adam Glass
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. All advertising materials mentioning features or use of this software
 *    must display the following acknowledgement:
 *	This product includes software developed by Adam Glass.
 * 4. The name of the Author may not be used to endorse or promote products
 *    derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY Adam Glass ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 */

#include <sys/param.h>
#include <sys/systm.h>

#include "vector.h"

#define BADTRAP16 badtrap, badtrap, badtrap, badtrap, \
                  badtrap, badtrap, badtrap, badtrap, \
                  badtrap, badtrap, badtrap, badtrap, \
                  badtrap, badtrap, badtrap, badtrap

void addrerr(), badtrap(), buserr(), chkinst(), coperr(), fmterr(),
    fpfline(),  fpunsupp(), illinst(), privinst(), trace(), trap0(),
    trap1(), trap12(), trap15(), trap2(), trapvinst(), zerodiv(), fpfault();

void level0intr(), level1intr(), level2intr(), level3intr();
void level4intr(), level5intr(), level6intr(), level7intr();

#define fpbsun fpfault
#define fpdz fpfault
#define fpinex fpfault
#define fpoperr fpfault
#define fpovfl fpfault
#define fpsnan fpfault
#define fpunfl fpfault

void (*vector_table[NVECTORS])() = {
	(void*)0xfffe000,		/* 0: NOT USED (reset SP) */
	(void*)0xfef0000,		/* 1: NOT USED (reset PC) */
	buserr,					/* 2: bus error */
	addrerr,				/* 3: address error */
	illinst,				/* 4: illegal instruction */
	zerodiv,				/* 5: zero divide */
	chkinst,				/* 6: CHK instruction */
	trapvinst,				/* 7: TRAPV instruction */
	privinst,				/* 8: privilege violation */
	trace,					/* 9: trace */
	illinst,				/* 10: line 1010 emulator */
	fpfline,				/* 11: line 1111 emulator */
	badtrap,				/* 12: unassigned, reserved */
	coperr,					/* 13: coprocessor protocol violatio */
	fmterr,					/* 14: format error */
	badtrap,				/* 15: uninitialized interrupt vecto */
	badtrap,				/* 16: unassigned, reserved */
	badtrap,				/* 17: unassigned, reserved */
	badtrap,				/* 18: unassigned, reserved */
	badtrap,				/* 19: unassigned, reserved */
	badtrap,				/* 20: unassigned, reserved */
	badtrap,				/* 21: unassigned, reserved */
	badtrap,				/* 22: unassigned, reserved */
	badtrap,				/* 23: unassigned, reserved */
	level0intr,				/* 24: spurious interrupt */
	level1intr,				/* 25: level 1 interrupt autovector */
	level2intr,				/* 26: level 2 interrupt autovector */
	level3intr,				/* 27: level 3 interrupt autovector */
	level4intr,				/* 28: level 4 interrupt autovector */
	level5intr,				/* 29: level 5 interrupt autovector */
	level6intr,				/* 30: level 6 interrupt autovector */
	level7intr,				/* 31: level 7 interrupt autovector */
	trap0,					/* 32: syscalls (at least on hp300) */
	trap1,					/* 33: sigreturn syscall or breakpoi */
	trap2,					/* 34: breakpoint or sigreturn sysca */
	illinst,				/* 35: TRAP instruction vector */
	illinst,				/* 36: TRAP instruction vector */
	illinst,				/* 37: TRAP instruction vector */
	illinst,				/* 38: TRAP instruction vector */
	illinst,				/* 39: TRAP instruction vector */
	illinst,				/* 40: TRAP instruction vector */
	illinst,				/* 41: TRAP instruction vector */
	illinst,				/* 42: TRAP instruction vector */
	illinst,				/* 43: TRAP instruction vector */
	trap12,  				/* 44: TRAP instruction vector */
	illinst,				/* 45: TRAP instruction vector */
	illinst,				/* 46: TRAP instruction vector */
	trap15,					/* 47: TRAP instruction vector */
	fpbsun, 				/* 48: FPCP branch/set on unordered */
	fpinex, 				/* 49: FPCP inexact result */
	fpdz,   				/* 50: FPCP divide by zero */
	fpunfl, 				/* 51: FPCP underflow */
	fpoperr,				/* 52: FPCP operand error */
	fpovfl, 				/* 53: FPCP overflow */
	fpsnan, 				/* 54: FPCP signalling NAN */
	fpunsupp,				/* 55: FPCP unimplemented data type */
	badtrap,				/* 56: unassigned, reserved */
	badtrap,				/* 57: unassigned, reserved */
	badtrap,				/* 58: unassigned, reserved */
	badtrap,				/* 59: unassigned, reserved */
	badtrap,				/* 60: unassigned, reserved */
	badtrap,				/* 61: unassigned, reserved */
	badtrap,				/* 62: unassigned, reserved */
	badtrap,				/* 63: unassigned, reserved */

	/* 64-255: set later by isr_add_vectored() */

	BADTRAP16,	BADTRAP16,	BADTRAP16,	BADTRAP16,
	BADTRAP16,	BADTRAP16,	BADTRAP16,	BADTRAP16,
	BADTRAP16,	BADTRAP16,	BADTRAP16,	BADTRAP16,
};


void set_vector_entry(entry, handler)
	int entry;
	void (*handler)();
{
	if ((entry <0) || (entry >= NVECTORS))
	panic("set_vector_entry: setting vector too high or low\n");
	vector_table[entry] =  handler;
}

unsigned int get_vector_entry(entry)
	int entry;
{
	if ((entry <0) || (entry >= NVECTORS))
	panic("get_vector_entry: setting vector too high or low\n");
	return (unsigned int) vector_table[entry];
}