gen68340/start/init68340.c

0001 /*
0002  * MC68340/349 support routines
0003  *
0004  * Geoffroy Montel
0005  * France Telecom - CNET/DSM/TAM/CAT
0006  * 4, rue du Clos Courtel
0007  * 35512 CESSON-SEVIGNE
0008  * FRANCE
0009  *
0010  * e-mail: g_montel@yahoo.com
0011  */
0012
0013 #include <rtems.h>
0014 #include <bsp.h>
0015
0016 extern void _CopyDataClearBSSAndStart (void);
0017
0018 /*
0019  * Initialize MC68340
0020  */
0021 void _Init68340 (void)
0022 {
0023     rtems_isr_entry *vbr;
0024     int i;
0025
0026     /*
0027      * Copy  the exception vector table to system RAM
0028      */
0029     m68k_get_vbr (vbr);
0030     for (i = 0; i < 256; ++i)
0031         M68Kvec[i] = vbr[i];
0032     m68k_set_vbr (M68Kvec);
0033
0034     /*
0035      * Copy data, clear BSS, switch stacks and call main()
0036      */
0037     _CopyDataClearBSSAndStart ();
0038 }