1/*
2 * arch/v850/lib/memset.c -- Memory initialization
3 *
4 *  Copyright (C) 2001,02,04  NEC Corporation
5 *  Copyright (C) 2001,02,04  Miles Bader <miles@gnu.org>
6 *
7 * This file is subject to the terms and conditions of the GNU General
8 * Public License.  See the file COPYING in the main directory of this
9 * archive for more details.
10 *
11 * Written by Miles Bader <miles@gnu.org>
12 */
13
14#include <linux/types.h>
15
16void *memset (void *dst, int val, __kernel_size_t count)
17{
18	if (count) {
19		register unsigned loop;
20		register void *ptr asm ("ep") = dst;
21
22		/* replicate VAL into a long.  */
23		val &= 0xff;
24		val |= val << 8;
25		val |= val << 16;
26
27		/* copy initial unaligned bytes.  */
28		if ((long)ptr & 1) {
29			*(char *)ptr = val;
30			ptr = (void *)((char *)ptr + 1);
31			count--;
32		}
33		if (count > 2 && ((long)ptr & 2)) {
34			*(short *)ptr = val;
35			ptr = (void *)((short *)ptr + 1);
36			count -= 2;
37		}
38
39		/* 32-byte copying loop.  */
40		for (loop = count / 32; loop; loop--) {
41			asm ("sst.w %0, 0[ep]; sst.w %0, 4[ep];"
42			     "sst.w %0, 8[ep]; sst.w %0, 12[ep];"
43			     "sst.w %0, 16[ep]; sst.w %0, 20[ep];"
44			     "sst.w %0, 24[ep]; sst.w %0, 28[ep]"
45			     :: "r" (val) : "memory");
46			ptr += 32;
47		}
48		count %= 32;
49
50		/* long copying loop.  */
51		for (loop = count / 4; loop; loop--) {
52			*(long *)ptr = val;
53			ptr = (void *)((long *)ptr + 1);
54		}
55		count %= 4;
56
57		/* finish up with any trailing bytes.  */
58		if (count & 2) {
59			*(short *)ptr = val;
60			ptr = (void *)((short *)ptr + 1);
61		}
62		if (count & 1) {
63			*(char *)ptr = val;
64		}
65	}
66
67	return dst;
68}
69