mvme147/start/bspclean.c

0001 /* SPDX-License-Identifier: BSD-2-Clause */
0002
0003 /*
0004  *  This routine returns control to 147Bug.
0005  */
0006
0007 /*
0008  *  COPYRIGHT (c) 1989-2014.
0009  *  On-Line Applications Research Corporation (OAR).
0010  *
0011  * Redistribution and use in source and binary forms, with or without
0012  * modification, are permitted provided that the following conditions
0013  * are met:
0014  * 1. Redistributions of source code must retain the above copyright
0015  *    notice, this list of conditions and the following disclaimer.
0016  * 2. Redistributions in binary form must reproduce the above copyright
0017  *    notice, this list of conditions and the following disclaimer in the
0018  *    documentation and/or other materials provided with the distribution.
0019  *
0020  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
0021  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
0022  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
0023  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
0024  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
0025  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
0026  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
0027  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
0028  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
0029  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
0030  * POSSIBILITY OF SUCH DAMAGE.
0031  *
0032  *  MVME147 port for TNI - Telecom Bretagne
0033  *  by Dominique LE CAMPION (Dominique.LECAMPION@enst-bretagne.fr)
0034  *  May 1996
0035  */
0036
0037 #include <bsp.h>
0038 #include <bsp/bootcard.h>
0039
0040 extern void start(void);
0041
0042 static rtems_isr bsp_return_to_monitor_trap(
0043   rtems_vector_number vector
0044 )
0045 {
0046   register volatile void *start_addr;
0047
0048   m68k_set_vbr( 0 );                    /* restore 147Bug vectors */
0049   __asm__ volatile( "trap   #15"  );    /* trap to 147Bug */
0050   __asm__ volatile( ".short 0x63" );    /* return to 147Bug (.RETURN) */
0051                                         /* restart program */
0052   start_addr = start;
0053
0054   __asm__ volatile ( "jmp %0@" : "=a" (start_addr) : "0" (start_addr) );
0055 }
0056
0057 void bsp_reset( rtems_fatal_source source, rtems_fatal_code code )
0058 {
0059   (void) source;
0060   (void) code;
0061
0062    pcc->timer1_int_control = 0; /* Disable Timer 1 */
0063    pcc->timer2_int_control = 0; /* Disable Timer 2 */
0064
0065    M68Kvec[ 45 ] = bsp_return_to_monitor_trap;   /* install handler */
0066    __asm__ volatile( "trap #13" );               /* ensures SUPV mode */
0067    RTEMS_UNREACHABLE();
0068 }