summaryrefslogtreecommitdiffstats
path: root/arch/m68k/lib/memset.c
diff options
context:
space:
mode:
Diffstat (limited to 'arch/m68k/lib/memset.c')
-rw-r--r--arch/m68k/lib/memset.c68
1 files changed, 68 insertions, 0 deletions
diff --git a/arch/m68k/lib/memset.c b/arch/m68k/lib/memset.c
new file mode 100644
index 000000000000..d55fdb2ee9d3
--- /dev/null
+++ b/arch/m68k/lib/memset.c
@@ -0,0 +1,68 @@
+#include <linux/types.h>
+
+void * memset(void * s, int c, size_t count)
+{
+ void *xs = s;
+ size_t temp, temp1;
+
+ if (!count)
+ return xs;
+ c &= 0xff;
+ c |= c << 8;
+ c |= c << 16;
+ if ((long) s & 1)
+ {
+ char *cs = s;
+ *cs++ = c;
+ s = cs;
+ count--;
+ }
+ if (count > 2 && (long) s & 2)
+ {
+ short *ss = s;
+ *ss++ = c;
+ s = ss;
+ count -= 2;
+ }
+ temp = count >> 2;
+ if (temp)
+ {
+ long *ls = s;
+
+ __asm__ __volatile__("movel %1,%2\n\t"
+ "andw #7,%2\n\t"
+ "lsrl #3,%1\n\t"
+ "negw %2\n\t"
+ "jmp %%pc@(2f,%2:w:2)\n\t"
+ "1:\t"
+ "movel %3,%0@+\n\t"
+ "movel %3,%0@+\n\t"
+ "movel %3,%0@+\n\t"
+ "movel %3,%0@+\n\t"
+ "movel %3,%0@+\n\t"
+ "movel %3,%0@+\n\t"
+ "movel %3,%0@+\n\t"
+ "movel %3,%0@+\n\t"
+ "2:\t"
+ "dbra %1,1b\n\t"
+ "clrw %1\n\t"
+ "subql #1,%1\n\t"
+ "jpl 1b\n\t"
+ : "=a" (ls), "=d" (temp), "=&d" (temp1)
+ : "d" (c), "0" (ls), "1" (temp)
+ );
+ s = ls;
+ }
+ if (count & 2)
+ {
+ short *ss = s;
+ *ss++ = c;
+ s = ss;
+ }
+ if (count & 1)
+ {
+ char *cs = s;
+ *cs = c;
+ }
+ return xs;
+}