| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | #include <linux/types.h> |
| 2 | |
| 3 | void * memset(void * s, int c, size_t count) |
| 4 | { |
| 5 | void *xs = s; |
| 6 | size_t temp, temp1; |
| 7 | |
| 8 | if (!count) |
| 9 | return xs; |
| 10 | c &= 0xff; |
| 11 | c |= c << 8; |
| 12 | c |= c << 16; |
| 13 | if ((long) s & 1) |
| 14 | { |
| 15 | char *cs = s; |
| 16 | *cs++ = c; |
| 17 | s = cs; |
| 18 | count--; |
| 19 | } |
| 20 | if (count > 2 && (long) s & 2) |
| 21 | { |
| 22 | short *ss = s; |
| 23 | *ss++ = c; |
| 24 | s = ss; |
| 25 | count -= 2; |
| 26 | } |
| 27 | temp = count >> 2; |
| 28 | if (temp) |
| 29 | { |
| 30 | long *ls = s; |
| 31 | |
| 32 | __asm__ __volatile__("movel %1,%2\n\t" |
| 33 | "andw #7,%2\n\t" |
| 34 | "lsrl #3,%1\n\t" |
| 35 | "negw %2\n\t" |
| 36 | "jmp %%pc@(2f,%2:w:2)\n\t" |
| 37 | "1:\t" |
| 38 | "movel %3,%0@+\n\t" |
| 39 | "movel %3,%0@+\n\t" |
| 40 | "movel %3,%0@+\n\t" |
| 41 | "movel %3,%0@+\n\t" |
| 42 | "movel %3,%0@+\n\t" |
| 43 | "movel %3,%0@+\n\t" |
| 44 | "movel %3,%0@+\n\t" |
| 45 | "movel %3,%0@+\n\t" |
| 46 | "2:\t" |
| 47 | "dbra %1,1b\n\t" |
| 48 | "clrw %1\n\t" |
| 49 | "subql #1,%1\n\t" |
| 50 | "jpl 1b\n\t" |
| 51 | : "=a" (ls), "=d" (temp), "=&d" (temp1) |
| 52 | : "d" (c), "0" (ls), "1" (temp) |
| 53 | ); |
| 54 | s = ls; |
| 55 | } |
| 56 | if (count & 2) |
| 57 | { |
| 58 | short *ss = s; |
| 59 | *ss++ = c; |
| 60 | s = ss; |
| 61 | } |
| 62 | if (count & 1) |
| 63 | { |
| 64 | char *cs = s; |
| 65 | *cs = c; |
| 66 | } |
| 67 | return xs; |
| 68 | } |