blob: 8885c0901b235d2740e5cdd9d762d10ba73607d2 (
plain) (
blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
|
#include "kern/init.h"
#include "arch.h"
#include "arch/stm32l4xxx/peripherals/clock.h"
#include "arch/stm32l4xxx/peripherals/system.h"
#include "kern/log.h"
/* Forward-declare the main function. This is implemented in main.c. */
int main();
/* These are defined in the linker script. */
#ifdef ARCH_STM32L4
extern uint32_t INIT_DATA_VALUES;
extern uint32_t DATA_SEGMENT_START;
extern uint32_t DATA_SEGMENT_STOP;
extern uint32_t BSS_START;
extern uint32_t BSS_END;
extern void (*INIT_ROUTINES_FLASH_START)();
extern void (*INIT_ROUTINES_FLASH_STOP)();
extern uint32_t INIT_0_END;
extern uint32_t INIT_1_END;
extern uint32_t INIT_2_END;
extern uint32_t INIT_3_END;
extern uint32_t INIT_4_END;
extern uint32_t INIT_5_END;
extern uint32_t INIT_6_END;
extern uint32_t INIT_7_END;
static _no_init init_level_t initlevel;
init_level_t get_system_init_level()
{
return initlevel;
}
init0()
{
/* Enable a higher clock speed. This is the first thing we do
* beacuse it will boost the boot up time. */
set_system_clock_MHz(80);
}
init1()
{
/* Next, we'll copy the data sections from flash to ram. */
uint32_t* src;
uint32_t* dest;
src = &INIT_DATA_VALUES;
dest = &DATA_SEGMENT_START;
/* Copy the values from flash into the data segment. */
while (dest != &DATA_SEGMENT_STOP) {
*(dest++) = *(src++);
}
/* Everything in the BSS segment is set to zero. */
dest = &BSS_START;
while (dest != &BSS_END) {
*(dest++) = 0;
}
}
init3()
{
klogf("--- System Restart ---\n");
klogf("Setting the vector offset table to point to the start of flash.\n");
/* Set the vector offset table to be at the start
* of FLASH memory. */
SCB.vto_r = 0x08000000;
}
void run_init_routines()
{
void* init_boundaries[] = {
&INIT_0_END,
&INIT_1_END,
&INIT_2_END,
&INIT_3_END,
&INIT_4_END,
&INIT_5_END,
&INIT_6_END,
&INIT_7_END,
};
void (**initfn)();
for (initfn = &INIT_ROUTINES_FLASH_START; initfn < &INIT_ROUTINES_FLASH_STOP;
++initfn) {
while (initfn == init_boundaries[initlevel] && initlevel < INIT_LEVEL_7) {
++initlevel;
if (initlevel > 2) {
klogf("[init%d]\n", initlevel);
}
}
(*initfn)();
}
while (initlevel < INIT_LEVEL_7) {
++initlevel;
klogf("[init%d]\n", initlevel);
}
klogf("Initialization Routines Complete. Onto main()\n");
}
/*
* Runs before main. Initializes the data and bss segments by loading them
* into memory.
*/
_Noreturn void on_reset()
{
initlevel = INIT_LEVEL_0;
run_init_routines();
/* Jump to main. */
main();
for (;;)
;
}
#endif /* ARCH_STM32L4 */
|
