diff options
Diffstat (limited to 'c/src/lib/libbsp/m68k/gen68340/startup/init68340.c')
| -rw-r--r-- | c/src/lib/libbsp/m68k/gen68340/startup/init68340.c | 39 |
1 files changed, 39 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/m68k/gen68340/startup/init68340.c b/c/src/lib/libbsp/m68k/gen68340/startup/init68340.c new file mode 100644 index 0000000000..96caf9e585 --- /dev/null +++ b/c/src/lib/libbsp/m68k/gen68340/startup/init68340.c @@ -0,0 +1,39 @@ +/* + * MC68340/349 support routines + * + * Geoffroy Montel + * France Telecom - CNET/DSM/TAM/CAT + * 4, rue du Clos Courtel + * 35512 CESSON-SEVIGNE + * FRANCE + * + * e-mail: g_montel@yahoo.com + * + * $Id$ + */ + +#include <rtems.h> +#include <bsp.h> + +/* + * Initialize MC68340 + */ +void _Init68340 (void) +{ + extern void _CopyDataClearBSSAndStart (void); + m68k_isr_entry *vbr; + int i; + + /* + * Copy the exception vector table to system RAM + */ + m68k_get_vbr (vbr); + for (i = 0; i < 256; ++i) + M68Kvec[i] = vbr[i]; + m68k_set_vbr (M68Kvec); + + /* + * Copy data, clear BSS, switch stacks and call main() + */ + _CopyDataClearBSSAndStart (); +} |