-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathstartup.c
165 lines (148 loc) · 4.38 KB
/
startup.c
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
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
#include "stm32f05xxx.h"
#include "serial.h"
void ResetInit(void);
void Default_Handler(void);
void Hard_Fault_Handler(void);
void isr_usart1(void);
void Timer2ISR(void);
void Timer3ISR(void);
void Timer1ISR(void);
void Timer14ISR(void);
// Allocated stack space as defined in linker script stm32f05xxx.ld
extern unsigned int _StackTop;
void main(void);
// The section "vectors" is placed at the beginning of flash by the linker script stm32f05xxx.ld
const void * Vectors[] __attribute__((section(".vectors"))) ={
&_StackTop, /* Top of stack */
ResetInit, /* Reset Handler */
Default_Handler, /* NMI */
Hard_Fault_Handler, /* Hard Fault. If not using the right libraries this will happen. */
0, /* Reserved */
0, /* Reserved */
0, /* Reserved */
0, /* Reserved */
0, /* Reserved */
0, /* Reserved */
0, /* Reserved */
Default_Handler, /* SVC */
0, /* Reserved */
0, /* Reserved */
Default_Handler, /* PendSV */
Default_Handler, /* SysTick */
/* External interrupt handlers follow */
Default_Handler, /* WWDG */
Default_Handler, /* PVD */
Default_Handler, /* RTC */
Default_Handler, /* FLASH */
Default_Handler, /* RCC */
Default_Handler, /* EXTI0_1 */
Default_Handler, /* EXTI2_3 */
Default_Handler, /* EXTI4_15 */
Default_Handler, /* TSC */
Default_Handler, /* DMA_CH1 */
Default_Handler, /* DMA_CH2_3 */
Default_Handler, /* DMA_CH4_5 */
Default_Handler, /* ADC_COMP */
Timer1ISR, /* TIM1_BRK_UP_TRG_COM */
Default_Handler, /* TIM1_CC */
Timer2ISR, /* TIM2 */
Timer3ISR, /* TIM3 */
Default_Handler, /* TIM6_DAC */
Default_Handler, /* RESERVED */
Timer14ISR, /* TIM14 */
Default_Handler, /* TIM15 */
Default_Handler, /* TIM16 */
Default_Handler, /* TIM17 */
Default_Handler, /* I2C1 */
Default_Handler, /* I2C2 */
Default_Handler, /* SPI1 */
Default_Handler, /* SPI2 */
isr_usart1, /* USART1 */
Default_Handler, /* USART2 */
Default_Handler, /* RESERVED */
Default_Handler, /* CEC */
Default_Handler /* RESERVED */
};
// gcc and g++ compatible C runtime initialization.
extern unsigned int _etext, _data, _edata, _bss, _ebss;
extern unsigned int __init_array_start;
extern unsigned int __init_array_end;
//
static inline void crt0 (void)
{
unsigned int *src, *dest;
// copy the data section
src = &_etext;
dest = &_data;
while (dest < &_edata)
*(dest++) = *(src++);
// blank the bss section
while (dest < &_ebss)
*(dest++) = 0;
// call C++ constructors
dest = &__init_array_start;
while (dest < &__init_array_end)
(*(void(**)(void)) dest++)();
}
void initClock()
{
// Set the PLL up
// Disable PLL
RCC_CR &= ~BIT24; // PLL_ON=0
while( (RCC_CR & BIT25)); // wait for PLL ready to be cleared
// Warning here: if system clock is greater than 24MHz then wait-state(s) need to be
// inserted into Flash memory interface
FLASH_ACR |= BIT0;
FLASH_ACR &=~(BIT2 | BIT1);
// Turn on FLASH prefetch buffer
FLASH_ACR |= BIT4;
// set PLL multiplier to 12 (yielding 48MHz)
RCC_CFGR &= ~(BIT21 | BIT20 | BIT19 | BIT18);
RCC_CFGR |= (BIT21 | BIT19 );
// Need to limit ADC clock to below 14MHz so will change ADC prescaler to 4
RCC_CFGR |= BIT14;
// Do the following to push HSI clock out on PA8 (MCO)
// for measurement purposes. Should be 8MHz or thereabouts (verified with oscilloscope)
/*
RCC_CFGR |= ( BIT26 | BIT24 );
RCC_AHBENR |= BIT17;
GPIOA_MODER |= BIT17;
*/
// and turn the PLL back on again
RCC_CR |= BIT24;
// Wait for the PLL to lock
while( !(RCC_CR & BIT25));
// set PLL as system clock source
RCC_CFGR |= BIT1;
}
// Reset entry point. Sets up the C runtime environment.
__attribute__ ((section(".after_vectors"), naked))
void ResetInit()
{
initClock();
crt0();
initUART(115200);
enable_interrupts();
#ifdef SHOW_LD_SCRIPT_ASSIGMENTS
PRINTVAR(&_etext)
PRINTVAR(&_data)
PRINTVAR(&_edata)
PRINTVAR(&_bss)
PRINTVAR(&_ebss)
PRINTVAR(&__init_array_start)
PRINTVAR(&__init_array_end)
#endif
main();
//eputs("Returned from main()");
while (1) ; // hang if main returns
}
void Default_Handler()
{
eputs("Interrupt without ISR. System stop.");
while(1);
}
void Hard_Fault_Handler()
{
eputs("Hard Fault interrupt. System stop.");
while(1);
}