diff options
author | Joel Sherrill <joel.sherrill@OARcorp.com> | 1996-05-24 20:34:49 +0000 |
---|---|---|
committer | Joel Sherrill <joel.sherrill@OARcorp.com> | 1996-05-24 20:34:49 +0000 |
commit | 28fa54d9b9e30d782115d65456e4cd3d8b8fb6f2 (patch) | |
tree | 9b39581aa6c666641d5566f60c5592e15e3ab741 /c/src/lib/libbsp/m68k/mvme147/startup/bspclean.c | |
parent | changed joel's email address (diff) | |
download | rtems-28fa54d9b9e30d782115d65456e4cd3d8b8fb6f2.tar.bz2 |
added Motorola MVME147 BSP submitted by Dominique le Campion
(Dominique.LECAMPION@enst-bretagne.fr), for Telecom Bretagne and
T.N.I. (Brest, France)
Diffstat (limited to 'c/src/lib/libbsp/m68k/mvme147/startup/bspclean.c')
-rw-r--r-- | c/src/lib/libbsp/m68k/mvme147/startup/bspclean.c | 45 |
1 files changed, 45 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/m68k/mvme147/startup/bspclean.c b/c/src/lib/libbsp/m68k/mvme147/startup/bspclean.c new file mode 100644 index 0000000000..da6e0418dd --- /dev/null +++ b/c/src/lib/libbsp/m68k/mvme147/startup/bspclean.c @@ -0,0 +1,45 @@ +/* + * This routine returns control to 147Bug. + * + * 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. + * + * MVME147 port for TNI - Telecom Bretagne + * by Dominique LE CAMPION (Dominique.LECAMPION@enst-bretagne.fr) + * May 1996 + * + * $Id$ + */ + +#include <rtems.h> +#include <bsp.h> +#include <clockdrv.h> + +void bsp_return_to_monitor_trap() +{ + extern void start( void ); + + register volatile void *start_addr; + + m68k_set_vbr( 0 ); /* restore 147Bug vectors */ + asm volatile( "trap #15" ); /* trap to 147Bug */ + asm volatile( ".short 0x63" ); /* return to 147Bug (.RETURN) */ + /* restart program */ + start_addr = start; + + asm volatile ( "jmp %0@" : "=a" (start_addr) : "0" (start_addr) ); +} + +void bsp_cleanup( void ) +{ + pcc->timer1_int_control = 0; /* Disable Timer 1 */ + pcc->timer2_int_control = 0; /* Disable Timer 2 */ + + M68Kvec[ 45 ] = bsp_return_to_monitor_trap; /* install handler */ + asm volatile( "trap #13" ); /* insures SUPV mode */ +} |