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