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

4.11
Last change on this file since a8777397 was a8777397, checked in by Joel Sherrill <joel.sherrill@…>, on Oct 20, 2014 at 3:58:57 PM

m68k/mcf5329: Fix warnings

  • 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.h>
8#include <bsp/bootcard.h>
9
10extern void _wr_vbr(uint32_t);
11extern void init_main(void);
12
13/*
14 * From linkcmds
15 */
16
17extern uint8_t _INTERRUPT_VECTOR[];
18
19extern uint8_t _clear_start[];
20extern uint8_t _clear_end[];
21
22extern uint8_t _data_src_start[];
23extern uint8_t _data_dest_start[];
24extern uint8_t _data_dest_end[];
25
26void Init5329(void)
27{
28  register uint32_t i;
29  register uint8_t *dbp, *sbp;
30  register uint32_t *dp, *sp;
31
32  /*
33   * Initialize the hardware
34   */
35  init_main();
36
37  /*
38   * Copy the vector table to RAM
39   */
40  if (&_VBR != (void *) _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.