diff options
Diffstat (limited to 'c/src/lib/libbsp/m68k/efi68k/startup/setvec.c')
| -rw-r--r-- | c/src/lib/libbsp/m68k/efi68k/startup/setvec.c | 45 |
1 files changed, 45 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/m68k/efi68k/startup/setvec.c b/c/src/lib/libbsp/m68k/efi68k/startup/setvec.c new file mode 100644 index 0000000000..39eb7a1fa1 --- /dev/null +++ b/c/src/lib/libbsp/m68k/efi68k/startup/setvec.c @@ -0,0 +1,45 @@ +/* set_vector + * + * This routine installs an interrupt vector on the efi68k. + * + * INPUT: + * handler - interrupt handler entry point + * vector - vector number + * type - 0 indicates raw hardware connect + * 1 indicates RTEMS interrupt connect + * + * RETURNS: + * address of previous interrupt handler + * + * COPYRIGHT (c) 1989, 1990, 1991, 1992, 1993, 1994. + * On-Line Applications Research Corporation (OAR). + * All rights assigned to U.S. Government, 1994. + * + * This material may be reproduced by or for the U.S. Government pursuant + * to the copyright license under the clause at DFARS 252.227-7013. This + * notice must appear in all copies of this file and its derivatives. + * + * $Id$ + */ + +#include <bsp.h> + +m68k_isr_entry set_vector( /* returns old vector */ + rtems_isr_entry handler, /* isr routine */ + rtems_vector_number vector, /* vector number */ + int type /* RTEMS or RAW intr */ +) +{ + int *p; + m68k_isr_entry previous_isr; + + if ( type ) + rtems_interrupt_catch( handler, vector, (rtems_isr_entry *) &previous_isr ); + else { + p = (int *)(vector*6-12+2+(int)_VBR); + previous_isr = (m68k_isr_entry) *p; /* return old ISR */ + *p = (int) handler; /* install new ISR */ + } + return previous_isr; +} + |