summaryrefslogtreecommitdiff
path: root/startup/entry.cpp
blob: 64aac370e661413d863ad956f34fe1b9412472a8 (plain)
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
#include <stdint.h>
#include <rcc/rcc.h>
#include <cortex_m/fpu.h>

int main();

typedef void (*funcp_t)();

// Symbols from linker script.
extern uint32_t _data_rom;
extern uint32_t _data_start;
extern uint32_t _data_end;
extern uint32_t _bss_start;
extern uint32_t _bss_end;
extern funcp_t _init_array_start;
extern funcp_t _init_array_end;
extern funcp_t _fini_array_start;
extern funcp_t _fini_array_end;

void __attribute__((naked)) entry() {
	// Initialize HAL.
	rcc_init();
	
	// Load .data from rom image.
	uint32_t* rp = &_data_rom;
	uint32_t* wp = &_data_start;
	
	while(wp < &_data_end) {
		*wp++ = *rp++;
	}
	
	// Clear .bss.
	wp = &_bss_start;
	
	while(wp < &_bss_end) {
		*wp++ = 0;
	}
	
	// Enable FPU before calling any functions that can invoke FPU instructions.
	#ifdef HAS_FPU
	COPROC.CPAC |= (3 << 22) | (3 << 20);
	#endif
	
	// Call constructors.
	funcp_t* fp = &_init_array_start;
	
	while(fp < &_init_array_end) {
		(*fp++)();
	}
	
	// Call main().
	main();
	
	// Call destructors.
	fp = &_fini_array_start;
	
	while(fp < &_fini_array_end) {
		(*fp++)();
	}
	
	// Halt.
	while(1);
}

extern "C" void __cxa_pure_virtual() {
	while (1);
}

void* __dso_handle = 0;