source: rtems/c/src/lib/libbsp/m68k/mcf5329/startup/init5329.c @ 40fe4b86

4.11
Last change on this file since 40fe4b86 was 40fe4b86, checked in by Sebastian Huber <sebastian.huber@…>, on Dec 6, 2012 at 4:40:08 PM

bsps: Use <bsp/bootcard.h>

  • Property mode set to 100644
File size: 1.4 KB
Line 
1/*
2 *  This is where the real hardware setup is done. A minimal stack
3 *  has been provided by the start.S code. No normal C or RTEMS
4 *  functions can be called from here.
5 */
6
7#include <bsp/bootcard.h>
8
9extern void _wr_vbr(uint32_t);
10extern void init_main(void);
11
12/*
13 * From linkcmds
14 */
15
16extern uint8_t _INTERRUPT_VECTOR[];
17
18extern uint8_t _clear_start[];
19extern uint8_t _clear_end[];
20
21extern uint8_t _data_src_start[];
22extern uint8_t _data_dest_start[];
23extern uint8_t _data_dest_end[];
24
25void Init5329(void)
26{
27  register uint32_t i;
28  register uint8_t *dbp, *sbp;
29  register uint32_t *dp, *sp;
30
31  /*
32   * Initialize the hardware
33   */
34  init_main();
35
36  /*
37   * Copy the vector table to RAM
38   */
39
40  if (&_VBR != _INTERRUPT_VECTOR) {
41    sp = (uint32_t *) _INTERRUPT_VECTOR;
42    dp = (uint32_t *) &_VBR;
43    for (i = 0; i < 256; i++) {
44      *dp++ = *sp++;
45    }
46  }
47
48  _wr_vbr((uint32_t) &_VBR);
49
50  /*
51   * Move initialized data from ROM to RAM.
52   */
53  if (_data_src_start != _data_dest_start) {
54    dbp = (uint8_t *) _data_dest_start;
55    sbp = (uint8_t *) _data_src_start;
56    i = _data_dest_end - _data_dest_start;
57    while (i--)
58      *dbp++ = *sbp++;
59  }
60
61  /*
62   * Zero uninitialized data
63   */
64
65  if (_clear_start != _clear_end) {
66    sbp = _clear_start;
67    dbp = _clear_end;
68    i = dbp - sbp;
69    while (i--)
70      *sbp++ = 0;
71  }
72
73  /*
74   * We have to call some kind of RTEMS function here!
75   */
76
77  boot_card(0);
78  for (;;) ;
79}
Note: See TracBrowser for help on using the repository browser.