2011-09-24 Sebastian Huber <sebastian.huber@embedded-brains.de>

	* rtems/score/armv7m.h, armv7m-context-initialize.c,
	armv7m-context-restore.c, armv7m-context-switch.c,
	armv7m-exception-handler-get.c, armv7m-exception-handler-set.c,
	armv7m-exception-priority-get.c, armv7m-exception-priority-set.c,
	armv7m-initialize.c, armv7m-isr-dispatch.c, armv7m-isr-enter-leave.c,
	armv7m-isr-level-get.c, armv7m-isr-level-set.c,
	armv7m-isr-vector-install.c, armv7m-multitasking-start-stop.c: New
	files.
	* Makefile.am, preinstall.am: Reflect changes above.
	* rtems/score/arm.h: Define ARM_MULTILIB_ARCH_V4 and
	ARM_MULTILIB_ARCH_V7M.
	* rtems/score/cpu.h, cpu_asm.S, cpu.c, arm_exc_abort.S,
	arm_exc_handler_high.c, arm_exc_handler_low.S, arm_exc_interrupt.S:
	Define CPU_HAS_HARDWARE_INTERRUPT_STACK to FALSE.  Use
	ARM_MULTILIB_ARCH_V4 and ARM_MULTILIB_ARCH_V7M.

1 files changed, 71 insertions, 0 deletions

diff --git a/cpukit/score/cpu/arm/armv7m-multitasking-start-stop.c b/cpukit/score/cpu/arm/armv7m-multitasking-start-stop.c
new file mode 100644
index 0000000000..1827f97dfa
--- /dev/null
+++ b/cpukit/score/cpu/arm/armv7m-multitasking-start-stop.c
@@ -0,0 +1,71 @@
+/*
+ * Copyright (c) 2011 Sebastian Huber.  All rights reserved.
+ *
+ *  embedded brains GmbH
+ *  Obere Lagerstr. 30
+ *  82178 Puchheim
+ *  Germany
+ *  <rtems@embedded-brains.de>
+ *
+ * The license and distribution terms for this file may be
+ * found in the file LICENSE in this distribution or at
+ * http://www.rtems.com/license/LICENSE.
+ */
+
+#ifdef HAVE_CONFIG_H
+  #include "config.h"
+#endif
+
+#include <rtems/score/cpu.h>
+
+#ifdef ARM_MULTILIB_ARCH_V7M
+
+#include <rtems/score/armv7m.h>
+
+void __attribute__((naked)) _ARMV7M_Start_multitasking(
+  Context_Control *bsp,
+  Context_Control *heir
+)
+{
+  __asm__ volatile (
+    /* Store BSP context */
+    "stm r0, {r4-r11, lr}\n"
+    "str sp, [r0, %[spctxoff]]\n"
+    /* Restore heir context */
+    "ldr r2, [r1, %[spctxoff]]\n"
+    "msr psp, r2\n"
+    "ldm r1, {r4-r11, lr}\n"
+    /* Enable process stack pointer (PSP) */
+    "mrs r2, control\n"
+    "orr r2, #0x2\n"
+    "msr control, r2\n"
+    /* Return to heir */
+    "bx lr\n"
+    :
+    : [spctxoff] "J" (offsetof(Context_Control, register_sp))
+  );
+}
+
+void __attribute__((naked)) _ARMV7M_Stop_multitasking( Context_Control *bsp )
+{
+  __asm__ volatile (
+    /* Disable interrupts */
+    "mov r2, #0x80\n"
+    "msr basepri_max, r2\n"
+    /* Restore BSP context */
+    "ldr r2, [r0, %[spctxoff]]\n"
+    "msr msp, r2\n"
+    "ldm r0, {r4-r11, lr}\n"
+    /* Disable process stack pointer (PSP) */
+    "mrs r2, control\n"
+    "bic r2, #0x2\n"
+    "msr control, r2\n"
+    /* Return to BSP */
+    "bx lr\n"
+    :
+    : [spctxoff] "J" (offsetof(Context_Control, register_sp))
+  );
+  __builtin_unreachable();
+}
+
+#endif /* ARM_MULTILIB_ARCH_V7M */