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(CONFIG_M68000) || defined(CONFIG_COLDFIRE)
36 for (; temp; temp--)
37 *ls++ = c;
38 #else
39 size_t temp1;
40 asm volatile (
41 " movel %1,%2\n"
42 " andw #7,%2\n"
43 " lsrl #3,%1\n"
44 " negw %2\n"
45 " jmp %%pc@(2f,%2:w:2)\n"
46 "1: 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 " movel %3,%0@+\n"
53 " movel %3,%0@+\n"
54 "2: dbra %1,1b\n"
55 " clrw %1\n"
56 " subql #1,%1\n"
57 " jpl 1b"
58 : "=a" (ls), "=d" (temp), "=&d" (temp1)
59 : "d" (c), "0" (ls), "1" (temp));
60 #endif
61 s = ls;
62 }
63 if (count & 2) {
64 short *ss = s;
65 *ss++ = c;
66 s = ss;
67 }
68 if (count & 1) {
69 char *cs = s;
70 *cs = c;
71 }
72 return xs;
73 }
74 EXPORT_SYMBOL(memset);