1 files changed, 95 insertions, 0 deletions
diff --git a/arch/arm/armv7-m/src/arch_exceptions.c b/arch/arm/armv7-m/src/arch_exceptions.c
new file mode 100644
index 00000000..3eb1d1f5
--- /dev/null
+++ b/arch/arm/armv7-m/src/arch_exceptions.c
@@ -0,0 +1,95 @@
+/*
+ * Arm SCP/MCP Software
+ * Copyright (c) 2015-2020, Arm Limited and Contributors. All rights reserved.
+ *
+ * SPDX-License-Identifier: BSD-3-Clause
+ *
+ * Description:
+ *      ARMv7-M exception handlers.
+ */
+
+#include <arch_exceptions.h>
+
+#include <fmw_cmsis.h>
+
+#include <stdint.h>
+#include <string.h>
+
+#ifdef BUILD_HAS_MULTITHREADING
+#    include <rtx_os.h>
+#endif
+
+#ifdef __NEWLIB__
+/*
+ * This function overloads a weak definition provided by Newlib. It is called
+ * during initialization of the C runtime just after .bss has been zeroed.
+ */
+void software_init_hook(void)
+{
+    extern char __data_load__;
+    extern char __data_start__;
+    extern char __data_end__;
+
+    char *load = &__data_load__;
+    char *start = &__data_start__;
+    char *end = &__data_end__;
+
+    if (load != start)
+        memcpy(start, load, end - start);
+}
+#endif
+
+#ifdef __ARMCC_VERSION
+extern char Image$$ARM_LIB_STACKHEAP$$ZI$$Limit;
+
+#    define arch_exception_stack (&Image$$ARM_LIB_STACKHEAP$$ZI$$Limit)
+#else
+extern char __stackheap_end__;
+
+#    define arch_exception_stack (&__stackheap_end__)
+#endif
+
+/*
+ * Set up the exception table. The structure below is is added to the
+ * .exceptions section which will be explicitly placed at the beginning of the
+ * binary by the linker script.
+ */
+
+const struct {
+    uintptr_t stack;
+    uintptr_t exceptions[NVIC_USER_IRQ_OFFSET - 1];
+} arch_exceptions __attribute__((section(".exceptions"))) = {
+    .stack = (uintptr_t)(arch_exception_stack),
+    .exceptions = {
+        [NVIC_USER_IRQ_OFFSET + Reset_IRQn - 1] =
+            (uintptr_t)(arch_exception_reset),
+        [NonMaskableInt_IRQn +  (NVIC_USER_IRQ_OFFSET - 1)] =
+            (uintptr_t)(arch_exception_invalid),
+        [NVIC_USER_IRQ_OFFSET + HardFault_IRQn - 1] =
+            (uintptr_t)(arch_exception_invalid),
+        [NVIC_USER_IRQ_OFFSET + MemoryManagement_IRQn - 1] =
+            (uintptr_t)(arch_exception_invalid),
+        [NVIC_USER_IRQ_OFFSET + BusFault_IRQn - 1] =
+            (uintptr_t)(arch_exception_invalid),
+        [NVIC_USER_IRQ_OFFSET + UsageFault_IRQn - 1] =
+            (uintptr_t)(arch_exception_invalid),
+        [NVIC_USER_IRQ_OFFSET + DebugMonitor_IRQn - 1] =
+            (uintptr_t)(arch_exception_invalid),
+
+#ifdef BUILD_HAS_MULTITHREADING
+        [NVIC_USER_IRQ_OFFSET + SVCall_IRQn - 1] =
+            (uintptr_t)(SVC_Handler),
+        [NVIC_USER_IRQ_OFFSET + PendSV_IRQn - 1] =
+            (uintptr_t)(PendSV_Handler),
+        [NVIC_USER_IRQ_OFFSET + SysTick_IRQn - 1] =
+            (uintptr_t)(SysTick_Handler),
+#else
+        [NVIC_USER_IRQ_OFFSET + SVCall_IRQn - 1] =
+            (uintptr_t)(arch_exception_invalid),
+        [NVIC_USER_IRQ_OFFSET + PendSV_IRQn - 1] =
+            (uintptr_t)(arch_exception_invalid),
+        [NVIC_USER_IRQ_OFFSET + SysTick_IRQn - 1] =
+            (uintptr_t)(arch_exception_invalid),
+#endif
+    },
+};