Commit | Line | Data |
---|---|---|
d10ed2f5 GU |
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 | */ | |
1da177e4 | 6 | |
d10ed2f5 GU |
7 | #include <linux/module.h> |
8 | #include <linux/string.h> | |
9 | ||
10 | void *memset(void *s, int c, size_t count) | |
1da177e4 | 11 | { |
d10ed2f5 GU |
12 | void *xs = s; |
13 | size_t temp; | |
1da177e4 | 14 | |
d10ed2f5 GU |
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; | |
734c3ce3 GU |
35 | #if defined(CONFIG_M68000) || defined(CONFIG_COLDFIRE) |
36 | for (; temp; temp--) | |
37 | *ls++ = c; | |
38 | #else | |
d10ed2f5 GU |
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)); | |
d10ed2f5 GU |
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; | |
1da177e4 | 73 | } |
d10ed2f5 | 74 | EXPORT_SYMBOL(memset); |