forked from Imagelibrary/rtems
262cbd69f3
GCC warned about comparing arrays by name. Changed to casting all array names to (uintptr_t).
80 lines
1.5 KiB
C
80 lines
1.5 KiB
C
/*
|
|
* This is where the real hardware setup is done. A minimal stack
|
|
* has been provided by the start.S code. No normal C or RTEMS
|
|
* functions can be called from here.
|
|
*/
|
|
|
|
#include <bsp.h>
|
|
#include <bsp/bootcard.h>
|
|
|
|
extern void _wr_vbr(uint32_t);
|
|
extern void init_main(void);
|
|
|
|
/*
|
|
* From linkcmds
|
|
*/
|
|
|
|
extern uint8_t _INTERRUPT_VECTOR[];
|
|
|
|
extern uint8_t _clear_start[];
|
|
extern uint8_t _clear_end[];
|
|
|
|
extern uint8_t _data_src_start[];
|
|
extern uint8_t _data_dest_start[];
|
|
extern uint8_t _data_dest_end[];
|
|
|
|
void Init5329(void)
|
|
{
|
|
register uint32_t i;
|
|
register uint8_t *dbp, *sbp;
|
|
register uint32_t *dp, *sp;
|
|
|
|
/*
|
|
* Initialize the hardware
|
|
*/
|
|
init_main();
|
|
|
|
/*
|
|
* Copy the vector table to RAM
|
|
*/
|
|
if ((uintptr_t)&_VBR != (uintptr_t)_INTERRUPT_VECTOR) {
|
|
sp = (uint32_t *) _INTERRUPT_VECTOR;
|
|
dp = (uint32_t *) &_VBR;
|
|
for (i = 0; i < 256; i++) {
|
|
*dp++ = *sp++;
|
|
}
|
|
}
|
|
|
|
_wr_vbr((uint32_t) &_VBR);
|
|
|
|
/*
|
|
* Move initialized data from ROM to RAM.
|
|
*/
|
|
if ((uintptr_t)_data_src_start != (uintptr_t)_data_dest_start) {
|
|
dbp = (uint8_t *) _data_dest_start;
|
|
sbp = (uint8_t *) _data_src_start;
|
|
i = _data_dest_end - _data_dest_start;
|
|
while (i--)
|
|
*dbp++ = *sbp++;
|
|
}
|
|
|
|
/*
|
|
* Zero uninitialized data
|
|
*/
|
|
|
|
if ((uintptr_t)_clear_start != (uintptr_t)_clear_end) {
|
|
sbp = _clear_start;
|
|
dbp = _clear_end;
|
|
i = dbp - sbp;
|
|
while (i--)
|
|
*sbp++ = 0;
|
|
}
|
|
|
|
/*
|
|
* We have to call some kind of RTEMS function here!
|
|
*/
|
|
|
|
boot_card(0);
|
|
for (;;) ;
|
|
}
|