Move codfire inline asm into cpu specific file.

git-svn-id: svn://svn.rockbox.org/rockbox/trunk@28910 a1c6a512-1295-4272-9138-f99709370657

2 files changed, 15 insertions, 8 deletions

diff --git a/firmware/target/coldfire/thread-coldfire.c b/firmware/target/coldfire/thread-coldfire.c
index f151a971c7..c94580a4e7 100644
--- a/firmware/target/coldfire/thread-coldfire.c
+++ b/firmware/target/coldfire/thread-coldfire.c
@@ -95,3 +95,17 @@ static inline void core_sleep(void)
     /* Supervisor mode, interrupts enabled upon wakeup */
     asm volatile ("stop #0x2000");
 };
+
+/*---------------------------------------------------------------------------
+ * Call this from asm to make sure the sp is pointing to the
+ * correct place before the context is saved.
+ *---------------------------------------------------------------------------
+ */
+static inline void _profile_thread_stopped(int current_thread)
+{
+    asm volatile ("move.l %[id], -(%%sp)\n\t"
+                  "jsr profile_thread_stopped\n\t"
+                  "addq.l #4, %%sp\n\t"
+                  :: [id] "r" (current_thread)
+                  : "cc", "memory");
+}
diff --git a/firmware/thread.c b/firmware/thread.c
index 91fe81be4a..6cd4d33c6e 100644
--- a/firmware/thread.c
+++ b/firmware/thread.c
@@ -1150,14 +1150,7 @@ void switch_thread(void)
 
 #ifdef RB_PROFILE
 #ifdef CPU_COLDFIRE
-    /* Call this from asm to make sure the sp is pointing to the
-       correct place before the context is saved */
-    uint16_t id = thread->id & THREAD_ID_SLOT_MASK;
-    asm volatile ("move.l %[id], -(%%sp)\n\t"
-                  "jsr profile_thread_stopped\n\t"
-                  "addq.l #4, %%sp\n\t"
-                  :: [id] "r" (id)
-                  : "cc", "memory");
+    _profile_thread_stopped(thread->id & THREAD_ID_SLOT_MASK);
 #else
     profile_thread_stopped(thread->id & THREAD_ID_SLOT_MASK);
 #endif