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..2b3603007b --- /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-1997. + * On-Line Applications Research Corporation (OAR). + * Copyright assigned to U.S. Government, 1994. + * + * The license and distribution terms for this file may in + * the file LICENSE in this distribution or at + * http://www.OARcorp.com/rtems/license.html. + * + * $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; +} + |