aboutsummaryrefslogtreecommitdiff
path: root/playground/src
diff options
context:
space:
mode:
Diffstat (limited to 'playground/src')
-rw-r--r--playground/src/init_high.cpp52
-rw-r--r--playground/src/init_low.s5
2 files changed, 47 insertions, 10 deletions
diff --git a/playground/src/init_high.cpp b/playground/src/init_high.cpp
index 700d17a..b877b7d 100644
--- a/playground/src/init_high.cpp
+++ b/playground/src/init_high.cpp
@@ -8,26 +8,60 @@
/**
* Symbols that are defined by the linker
*/
+extern "C"
+{
extern uint32_t _copy_data_load, _copy_data_store, _copy_data_store_end;
extern uint32_t _bss_start, _bss_end;
-extern int main();
+typedef void(*constructor_t)();
+extern constructor_t _init_array_start[], _init_array_end[];
+}
+
+extern "C"
+void *memset(void *dst, int i, size_t n) {
+ if (n) {
+ char *d = (char *) dst;
+ char c = (char) i;
+
+ do {
+ *d = c;
+ d++;
+ } while (--n);
+ }
+ return dst;
+}
+
+extern "C"
+void *memcpy(void *destination, void *source, size_t num) {
+ char *d = (char *) destination;
+ char *s = (char *) source;
+ for (size_t i = 0; i < num; i++) {
+ d[i] = s[i];
+ }
+ return destination;
+}
+__attribute__((used))
void init_high() {
// Copy data from flash to ram
uint32_t *src = &_copy_data_load;
- uint32_t *dest = &_copy_data_store;
+ uint32_t *dst = &_copy_data_store;
uint32_t *end = &_copy_data_store_end;
- while (dest <= end) {
- *dest++ = *src++;
+ while (dst <= end) {
+ *dst++ = *src++;
}
// Clear the BSS segment
- dest = &_bss_start;
+ dst = &_bss_start;
end = &_bss_end;
- while (dest <= end) {
- *dest++ = 0;
+ while (dst <= end) {
+ *dst++ = 0;
+ }
+
+ // Initialize c++ constructors
+ for (constructor_t *fn = _init_array_start; fn < _init_array_end; fn++) {
+ (*fn)();
}
main();
@@ -43,6 +77,7 @@ struct {
uint32_t BFAR;
} Default_Handler_Info;
+extern "C"
__attribute__((used))
void Default_Handler() {
Default_Handler_Info = {
@@ -97,9 +132,6 @@ void Default_Handler() {
if (Default_Handler_Info.CFSR & SCB_CFSR_IMPRECISERR) {
dbg_printf(" BFSR.IMPRECISERR\n");
}
- if (Default_Handler_Info.CFSR & SCB_CFSR_IMPRECISERR) {
- dbg_printf(" BFSR.IMPRECISERR\n");
- }
if (Default_Handler_Info.CFSR & SCB_CFSR_PRECISERR) {
dbg_printf(" BFSR.PRECISERR\n");
}
diff --git a/playground/src/init_low.s b/playground/src/init_low.s
index bc12b5b..b666ed4 100644
--- a/playground/src/init_low.s
+++ b/playground/src/init_low.s
@@ -16,10 +16,12 @@ halt:
b .
.thumb_func
+.global NMI_Handler
NMI_Handler:
b halt
.thumb_func
+.global HardFault_Handler
HardFault_Handler:
tst lr, #4
ite eq
@@ -28,14 +30,17 @@ HardFault_Handler:
b HardFault_Handler_C
.thumb_func
+.global MemManage_Handler
MemManage_Handler:
b halt
.thumb_func
+.global BusFault_Handler
BusFault_Handler:
b halt
.thumb_func
+.global UsageFault_Handler
UsageFault_Handler:
b halt