152 lines
4.1 KiB
C
152 lines
4.1 KiB
C
/* Copyright (C) 2011-2014 Free Software Foundation, Inc.
|
|
This file is part of the GNU C Library.
|
|
Contributed by Chris Metcalf <cmetcalf@tilera.com>, 2011.
|
|
|
|
The GNU C Library is free software; you can redistribute it and/or
|
|
modify it under the terms of the GNU Lesser General Public
|
|
License as published by the Free Software Foundation; either
|
|
version 2.1 of the License, or (at your option) any later version.
|
|
|
|
The GNU C Library is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
Lesser General Public License for more details.
|
|
|
|
You should have received a copy of the GNU Lesser General Public
|
|
License along with the GNU C Library. If not, see
|
|
<http://www.gnu.org/licenses/>. */
|
|
|
|
#include <arch/chip.h>
|
|
#include <string.h>
|
|
#include <stdint.h>
|
|
#include "string-endian.h"
|
|
|
|
void *
|
|
__memset (void *s, int c, size_t n)
|
|
{
|
|
uint64_t *out64;
|
|
int n64, to_align64;
|
|
uint64_t v64;
|
|
uint8_t *out8 = s;
|
|
|
|
/* Experimentation shows that a trivial tight loop is a win up until
|
|
around a size of 20, where writing a word at a time starts to win. */
|
|
#define BYTE_CUTOFF 20
|
|
|
|
#if BYTE_CUTOFF < 7
|
|
/* This must be at least at least this big, or some code later
|
|
on doesn't work. */
|
|
# error "BYTE_CUTOFF is too small."
|
|
#endif
|
|
|
|
if (n < BYTE_CUTOFF)
|
|
{
|
|
/* Strangely, this turns out to be the tightest way to write
|
|
this loop. */
|
|
if (n != 0)
|
|
{
|
|
do
|
|
{
|
|
/* Strangely, combining these into one line performs worse. */
|
|
*out8 = c;
|
|
out8++;
|
|
}
|
|
while (--n != 0);
|
|
}
|
|
|
|
return s;
|
|
}
|
|
|
|
/* Align 'out8'. We know n >= 7 so this won't write past the end. */
|
|
while (((uintptr_t) out8 & 7) != 0)
|
|
{
|
|
*out8++ = c;
|
|
--n;
|
|
}
|
|
|
|
/* Align 'n'. */
|
|
while (n & 7)
|
|
out8[--n] = c;
|
|
|
|
out64 = (uint64_t *) out8;
|
|
n64 = n >> 3;
|
|
|
|
/* Tile input byte out to 64 bits. */
|
|
v64 = copy_byte(c);
|
|
|
|
/* This must be at least 8 or the following loop doesn't work. */
|
|
#define CACHE_LINE_SIZE_IN_DOUBLEWORDS (CHIP_L2_LINE_SIZE() / 8)
|
|
|
|
/* Determine how many words we need to emit before the 'out32'
|
|
pointer becomes aligned modulo the cache line size. */
|
|
to_align64 = (-((uintptr_t) out64 >> 3)) &
|
|
(CACHE_LINE_SIZE_IN_DOUBLEWORDS - 1);
|
|
|
|
/* Only bother aligning and using wh64 if there is at least
|
|
one full cache line to process. This check also prevents
|
|
overrunning the end of the buffer with alignment words. */
|
|
if (to_align64 <= n64 - CACHE_LINE_SIZE_IN_DOUBLEWORDS)
|
|
{
|
|
int lines_left;
|
|
|
|
/* Align out64 mod the cache line size so we can use wh64. */
|
|
n64 -= to_align64;
|
|
for (; to_align64 != 0; to_align64--)
|
|
{
|
|
*out64 = v64;
|
|
out64++;
|
|
}
|
|
|
|
/* Use unsigned divide to turn this into a right shift. */
|
|
lines_left = (unsigned) n64 / CACHE_LINE_SIZE_IN_DOUBLEWORDS;
|
|
|
|
do
|
|
{
|
|
/* Only wh64 a few lines at a time, so we don't exceed the
|
|
maximum number of victim lines. */
|
|
int x = ((lines_left < CHIP_MAX_OUTSTANDING_VICTIMS ()) ? lines_left
|
|
: CHIP_MAX_OUTSTANDING_VICTIMS ());
|
|
uint64_t *wh = out64;
|
|
int i = x;
|
|
int j;
|
|
|
|
lines_left -= x;
|
|
|
|
do
|
|
{
|
|
__insn_wh64 (wh);
|
|
wh += CACHE_LINE_SIZE_IN_DOUBLEWORDS;
|
|
}
|
|
while (--i);
|
|
|
|
for (j = x * (CACHE_LINE_SIZE_IN_DOUBLEWORDS / 4); j != 0; j--)
|
|
{
|
|
*out64++ = v64;
|
|
*out64++ = v64;
|
|
*out64++ = v64;
|
|
*out64++ = v64;
|
|
}
|
|
}
|
|
while (lines_left != 0);
|
|
|
|
/* We processed all full lines above, so only this many
|
|
words remain to be processed. */
|
|
n64 &= CACHE_LINE_SIZE_IN_DOUBLEWORDS - 1;
|
|
}
|
|
|
|
/* Now handle any leftover values. */
|
|
if (n64 != 0)
|
|
{
|
|
do
|
|
{
|
|
*out64 = v64;
|
|
out64++;
|
|
}
|
|
while (--n64 != 0);
|
|
}
|
|
|
|
return s;
|
|
}
|
|
weak_alias (__memset, memset)
|
|
libc_hidden_builtin_def (memset)
|