aboutsummaryrefslogtreecommitdiffstats
path: root/roms/skiboot/libc/string/memset.c
blob: f96a0231f9fda2b17535efd608dcdde84a2764de (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
/******************************************************************************
 * Copyright (c) 2004, 2008 IBM Corporation
 * All rights reserved.
 * This program and the accompanying materials
 * are made available under the terms of the BSD License
 * which accompanies this distribution, and is available at
 * http://www.opensource.org/licenses/bsd-license.php
 *
 * Contributors:
 *     IBM Corporation - initial implementation
 *****************************************************************************/

#define CACHE_LINE_SIZE 128

#include <stddef.h>

void *memset(void *dest, int c, size_t size);
void *memset(void *dest, int c, size_t size)
{
	unsigned char *d = (unsigned char *)dest;
	unsigned long big_c = 0;

#if defined(__powerpc__) || defined(__powerpc64__)
	if (size > CACHE_LINE_SIZE && c==0) {
		while ((unsigned long long)d % CACHE_LINE_SIZE) {
			*d++ = (unsigned char)c;
			size--;
		}
		while (size >= CACHE_LINE_SIZE) {
			asm volatile ("dcbz 0,%0\n" : : "r"(d) : "memory");
			d+= CACHE_LINE_SIZE;
			size-= CACHE_LINE_SIZE;
		}
	}
#endif

	if (c) {
		big_c = c;
		big_c |= (big_c << 8) | big_c;
		big_c |= (big_c << 16) | big_c;
		big_c |= (big_c << 32) | big_c;
	}
	while (size >= 8 && c == 0) {
		*((unsigned long *)d) = big_c;
		d+=8;
		size-=8;
	}

	while (size-- > 0) {
		*d++ = (unsigned char)c;
	}

	return dest;
}