source: rtems/c/src/lib/libbsp/m68k/mcf52235/startup/init52235.c @ 3bba2a9b

4.115
Last change on this file since 3bba2a9b was 3bba2a9b, checked in by Joel Sherrill <joel.sherrill@…>, on 10/20/14 at 15:58:09

m68k/mcf52235: Fix warnings

  • Property mode set to 100644
File size: 1.4 KB
RevLine 
[8d26950]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
[3bba2a9b]7#include <bsp.h>
[40fe4b86]8#include <bsp/bootcard.h>
[8d26950]9
10extern void _wr_vbr(uint32_t);
[a840853]11extern void init_main(void);
[8d26950]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 Init52235(void)
27{
28  register uint32_t i;
29  register uint32_t *dp, *sp;
30  register uint8_t *dbp, *sbp;
31
[d4b4664b]32  /*
[8d26950]33   * Initialize the hardware
34   */
35  init_main();
36
[d4b4664b]37  /*
38   * Copy the vector table to RAM
[8d26950]39   */
[597caed]40  if (&_VBR != (void *) _INTERRUPT_VECTOR) {
[8d26950]41    sp = (uint32_t *) _INTERRUPT_VECTOR;
[40fe4b86]42    dp = (uint32_t *) &_VBR;
[8d26950]43    for (i = 0; i < 256; i++) {
44      *dp++ = *sp++;
45    }
46  }
47
[40fe4b86]48  _wr_vbr((uint32_t) &_VBR);
[8d26950]49
[d4b4664b]50  /*
51   * Move initialized data from ROM to RAM.
[8d26950]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
[d4b4664b]61  /*
62   * Zero uninitialized data
[8d26950]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
[bcd1228]77  boot_card(0);
[8d26950]78  for (;;) ;
[bcd1228]79}
Note: See TracBrowser for help on using the repository browser.