xref: /linux/arch/m68k/lib/memset.c (revision 12871a0bd67dd4db4418e1daafcd46e9d329ef10)
1 /*
2  * This file is subject to the terms and conditions of the GNU General Public
3  * License.  See the file COPYING in the main directory of this archive
4  * for more details.
5  */
6 
7 #include <linux/module.h>
8 #include <linux/string.h>
9 
10 void *memset(void *s, int c, size_t count)
11 {
12 	void *xs = s;
13 	size_t temp;
14 
15 	if (!count)
16 		return xs;
17 	c &= 0xff;
18 	c |= c << 8;
19 	c |= c << 16;
20 	if ((long)s & 1) {
21 		char *cs = s;
22 		*cs++ = c;
23 		s = cs;
24 		count--;
25 	}
26 	if (count > 2 && (long)s & 2) {
27 		short *ss = s;
28 		*ss++ = c;
29 		s = ss;
30 		count -= 2;
31 	}
32 	temp = count >> 2;
33 	if (temp) {
34 		long *ls = s;
35 #if defined(__mc68020__) || defined(__mc68030__) || \
36     defined(__mc68040__) || defined(__mc68060__) || defined(__mcpu32__)
37 		size_t temp1;
38 		asm volatile (
39 			"	movel %1,%2\n"
40 			"	andw  #7,%2\n"
41 			"	lsrl  #3,%1\n"
42 			"	negw  %2\n"
43 			"	jmp   %%pc@(2f,%2:w:2)\n"
44 			"1:	movel %3,%0@+\n"
45 			"	movel %3,%0@+\n"
46 			"	movel %3,%0@+\n"
47 			"	movel %3,%0@+\n"
48 			"	movel %3,%0@+\n"
49 			"	movel %3,%0@+\n"
50 			"	movel %3,%0@+\n"
51 			"	movel %3,%0@+\n"
52 			"2:	dbra  %1,1b\n"
53 			"	clrw  %1\n"
54 			"	subql #1,%1\n"
55 			"	jpl   1b"
56 			: "=a" (ls), "=d" (temp), "=&d" (temp1)
57 			: "d" (c), "0" (ls), "1" (temp));
58 #else
59 		for (; temp; temp--)
60 			*ls++ = c;
61 #endif
62 		s = ls;
63 	}
64 	if (count & 2) {
65 		short *ss = s;
66 		*ss++ = c;
67 		s = ss;
68 	}
69 	if (count & 1) {
70 		char *cs = s;
71 		*cs = c;
72 	}
73 	return xs;
74 }
75 EXPORT_SYMBOL(memset);
76