/* Initialization code for coldfire boards.
|
/* Initialization code for coldfire boards.
|
*
|
*
|
* Copyright (c) 2006 CodeSourcery Inc
|
* Copyright (c) 2006 CodeSourcery Inc
|
*
|
*
|
* The authors hereby grant permission to use, copy, modify, distribute,
|
* The authors hereby grant permission to use, copy, modify, distribute,
|
* and license this software and its documentation for any purpose, provided
|
* and license this software and its documentation for any purpose, provided
|
* that existing copyright notices are retained in all copies and that this
|
* that existing copyright notices are retained in all copies and that this
|
* notice is included verbatim in any distributions. No written agreement,
|
* notice is included verbatim in any distributions. No written agreement,
|
* license, or royalty fee is required for any of the authorized uses.
|
* license, or royalty fee is required for any of the authorized uses.
|
* Modifications to this software may be copyrighted by their authors
|
* Modifications to this software may be copyrighted by their authors
|
* and need not follow the licensing terms described here, provided that
|
* and need not follow the licensing terms described here, provided that
|
* the new terms are clearly indicated on the first page of each file where
|
* the new terms are clearly indicated on the first page of each file where
|
* they apply.
|
* they apply.
|
*/
|
*/
|
|
|
#include <stdlib.h>
|
#include <stdlib.h>
|
|
|
extern const int __interrupt_vector[];
|
extern const int __interrupt_vector[];
|
extern void __reset (void);
|
extern void __reset (void);
|
|
|
extern const char __data_load[] __attribute__ ((aligned (4)));
|
extern const char __data_load[] __attribute__ ((aligned (4)));
|
extern char __data_start[] __attribute__ ((aligned (4)));
|
extern char __data_start[] __attribute__ ((aligned (4)));
|
extern char __bss_start[] __attribute__ ((aligned (4)));
|
extern char __bss_start[] __attribute__ ((aligned (4)));
|
extern char __end[] __attribute__ ((aligned (4)));
|
extern char __end[] __attribute__ ((aligned (4)));
|
void *__heap_limit;
|
void *__heap_limit;
|
extern void software_init_hook (void) __attribute__ ((weak));
|
extern void software_init_hook (void) __attribute__ ((weak));
|
extern void hardware_init_hook (void) __attribute__ ((weak));
|
extern void hardware_init_hook (void) __attribute__ ((weak));
|
extern void _init (void);
|
extern void _init (void);
|
extern void _fini (void);
|
extern void _fini (void);
|
|
|
extern int main (int, char **, char **);
|
extern int main (int, char **, char **);
|
|
|
/* This is called from a tiny assembly stub. */
|
/* This is called from a tiny assembly stub. */
|
void __start1 (void *heap_limit)
|
void __start1 (void *heap_limit)
|
{
|
{
|
unsigned ix;
|
unsigned ix;
|
|
|
if (hardware_init_hook)
|
if (hardware_init_hook)
|
hardware_init_hook ();
|
hardware_init_hook ();
|
|
|
/* Initialize memory */
|
/* Initialize memory */
|
if (__data_load != __data_start)
|
if (__data_load != __data_start)
|
memcpy (__data_start, __data_load, __bss_start - __data_start);
|
memcpy (__data_start, __data_load, __bss_start - __data_start);
|
memset (__bss_start, 0, __end - __bss_start);
|
memset (__bss_start, 0, __end - __bss_start);
|
|
|
__heap_limit = heap_limit;
|
__heap_limit = heap_limit;
|
|
|
if (software_init_hook)
|
if (software_init_hook)
|
software_init_hook ();
|
software_init_hook ();
|
|
|
_init ();
|
_init ();
|
|
|
/* I'm not sure how useful it is to have a fini_section in an
|
/* I'm not sure how useful it is to have a fini_section in an
|
embedded system. */
|
embedded system. */
|
atexit (_fini);
|
atexit (_fini);
|
|
|
ix = main (0, NULL, NULL);
|
ix = main (0, NULL, NULL);
|
exit (ix);
|
exit (ix);
|
|
|
while (1)
|
while (1)
|
__reset ();
|
__reset ();
|
}
|
}
|
|
|
/* A default hardware init hook. */
|
/* A default hardware init hook. */
|
|
|
void __attribute__ ((weak)) hardware_init_hook (void)
|
void __attribute__ ((weak)) hardware_init_hook (void)
|
{
|
{
|
/* Set the VBR. */
|
/* Set the VBR. */
|
__asm__ __volatile__ ("movec.l %0,%/vbr" :: "r" (__interrupt_vector));
|
__asm__ __volatile__ ("movec.l %0,%/vbr" :: "r" (__interrupt_vector));
|
|
|
#if !defined(__mcf_family_5213) && !defined(__mcf_family_51qe)
|
#if !defined(__mcf_family_5213) && !defined(__mcf_family_51qe)
|
/* Flush & enable the caches */
|
/* Flush & enable the caches */
|
#define CACR_CINV (1 << 24)
|
#define CACR_CINV (1 << 24)
|
#define CACR_CENB (1 << 31)
|
#define CACR_CENB (1 << 31)
|
__asm__ __volatile__ ("movec.l %0,%/cacr" :: "r" (CACR_CINV | CACR_CENB));
|
__asm__ __volatile__ ("movec.l %0,%/cacr" :: "r" (CACR_CINV | CACR_CENB));
|
#endif
|
#endif
|
|
|
/* Should we drop into user mode here? */
|
/* Should we drop into user mode here? */
|
}
|
}
|
|
|
