1 files changed, 33 insertions, 2 deletions

diff --git a/apps/plugins/fractals/cpu_coldfire.h b/apps/plugins/fractals/cpu_coldfire.h
index 452f18e2c5..9be207ee2f 100644
--- a/apps/plugins/fractals/cpu_coldfire.h
+++ b/apps/plugins/fractals/cpu_coldfire.h
@@ -22,8 +22,39 @@
 #ifndef _CPU_COLDFIRE_H
 #define _CPU_COLDFIRE_H
 
-inline short muls16_asr10(short a, short b);
+inline static short muls16_asr10(short a, short b)
+{
+    asm (
+        "muls.w  %[a],%[b]   \n"
+        "asr.l   #8,%[b]     \n"
+        "asr.l   #2,%[b]     \n"
+        : /* outputs */
+        [b]"+d"(b)
+        : /* inputs */
+        [a]"d" (a)
+    );
+    return b;
+}
 
-inline long muls32_asr26(long a, long b);
+inline static long muls32_asr26(long a, long b)
+{
+    long r, t1;
+    asm (
+        "mac.l   %[a], %[b], %%acc0  \n" /* multiply */
+        "move.l  %%accext01, %[t1]   \n" /* get low part */
+        "movclr.l %%acc0, %[r]       \n" /* get high part */
+        "asl.l   #5, %[r]            \n" /* hi <<= 5, plus one free */
+        "lsr.l   #3, %[t1]           \n" /* lo >>= 3 */
+        "and.l   #0x1f, %[t1]        \n" /* mask out unrelated bits */
+        "or.l    %[t1], %[r]         \n" /* combine result */
+        : /* outputs */
+        [r] "=d"(r),
+        [t1]"=d"(t1)
+        : /* inputs */
+        [a] "d" (a),
+        [b] "d" (b)
+    );
+    return r;
+}
 
 #endif