[mirror_ubuntu-bionic-kernel.git] / arch / tile / lib / memset_32.c

/*
 * Copyright 2010 Tilera Corporation. All Rights Reserved.
 *
 *   This program is free software; you can redistribute it and/or
 *   modify it under the terms of the GNU General Public License
 *   as published by the Free Software Foundation, version 2.
 *
 *   This program 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, GOOD TITLE or
 *   NON INFRINGEMENT.  See the GNU General Public License for
 *   more details.
 */

#include <linux/types.h>
#include <linux/string.h>
#include <linux/module.h>
#include <arch/chip.h>

void *memset(void *s, int c, size_t n)
{
	uint32_t *out32;
	int n32;
	uint32_t v16, v32;
	uint8_t *out8 = s;
	int to_align32;

	/* 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 < 3
	/* 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 >= 3 so this won't write past the end. */
	while (((uintptr_t) out8 & 3) != 0) {
		*out8++ = c;
		--n;
	}

	/* Align 'n'. */
	while (n & 3)
		out8[--n] = c;

	out32 = (uint32_t *) out8;
	n32 = n >> 2;

	/* Tile input byte out to 32 bits. */
	v16 = __insn_intlb(c, c);
	v32 = __insn_intlh(v16, v16);

	/* This must be at least 8 or the following loop doesn't work. */
#define CACHE_LINE_SIZE_IN_WORDS (CHIP_L2_LINE_SIZE() / 4)

	/* Determine how many words we need to emit before the 'out32'
	 * pointer becomes aligned modulo the cache line size.
	 */
	to_align32 =
		(-((uintptr_t)out32 >> 2)) & (CACHE_LINE_SIZE_IN_WORDS - 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_align32 <= n32 - CACHE_LINE_SIZE_IN_WORDS) {
		int lines_left;

		/* Align out32 mod the cache line size so we can use wh64. */
		n32 -= to_align32;
		for (; to_align32 != 0; to_align32--) {
			*out32 = v32;
			out32++;
		}

		/* Use unsigned divide to turn this into a right shift. */
		lines_left = (unsigned)n32 / CACHE_LINE_SIZE_IN_WORDS;

		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());
			uint32_t *wh = out32;
			int i = x;
			int j;

			lines_left -= x;

			do {
				__insn_wh64(wh);
				wh += CACHE_LINE_SIZE_IN_WORDS;
			} while (--i);

			for (j = x * (CACHE_LINE_SIZE_IN_WORDS / 4);
			     j != 0; j--) {
				*out32++ = v32;
				*out32++ = v32;
				*out32++ = v32;
				*out32++ = v32;
			}
		} while (lines_left != 0);

		/* We processed all full lines above, so only this many
		 * words remain to be processed.
		 */
		n32 &= CACHE_LINE_SIZE_IN_WORDS - 1;
	}

	/* Now handle any leftover values. */
	if (n32 != 0) {
		do {
			*out32 = v32;
			out32++;
		} while (--n32 != 0);
	}

	return s;
}
EXPORT_SYMBOL(memset);
Commit	Line	Data
867e359b CM	1	/*
	2	* Copyright 2010 Tilera Corporation. All Rights Reserved.
	3	*
	4	* This program is free software; you can redistribute it and/or
	5	* modify it under the terms of the GNU General Public License
	6	* as published by the Free Software Foundation, version 2.
	7	*
	8	* This program is distributed in the hope that it will be useful, but
	9	* WITHOUT ANY WARRANTY; without even the implied warranty of
	10	* MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
	11	* NON INFRINGEMENT. See the GNU General Public License for
	12	* more details.
	13	*/
	14
867e359b CM	15	#include <linux/types.h>
	16	#include <linux/string.h>
	17	#include <linux/module.h>
c53c70a9	18	#include <arch/chip.h>
867e359b CM	19
	20	void memset(void s, int c, size_t n)
	21	{
	22	uint32_t *out32;
	23	int n32;
	24	uint32_t v16, v32;
	25	uint8_t *out8 = s;
867e359b	26	int to_align32;
867e359b CM	27
	28	/* Experimentation shows that a trivial tight loop is a win up until
	29	* around a size of 20, where writing a word at a time starts to win.
	30	*/
	31	#define BYTE_CUTOFF 20
	32
	33	#if BYTE_CUTOFF < 3
	34	/* This must be at least at least this big, or some code later
	35	* on doesn't work.
	36	*/
	37	#error "BYTE_CUTOFF is too small"
	38	#endif
	39
	40	if (n < BYTE_CUTOFF) {
	41	/* Strangely, this turns out to be the tightest way to
	42	* write this loop.
	43	*/
	44	if (n != 0) {
	45	do {
	46	/* Strangely, combining these into one line
	47	* performs worse.
	48	*/
	49	*out8 = c;
	50	out8++;
	51	} while (--n != 0);
	52	}
	53
	54	return s;
	55	}
	56
867e359b CM	57	/* Align 'out8'. We know n >= 3 so this won't write past the end. */
	58	while (((uintptr_t) out8 & 3) != 0) {
	59	*out8++ = c;
	60	--n;
	61	}
	62
	63	/* Align 'n'. */
	64	while (n & 3)
	65	out8[--n] = c;
	66
	67	out32 = (uint32_t *) out8;
	68	n32 = n >> 2;
	69
	70	/* Tile input byte out to 32 bits. */
	71	v16 = __insn_intlb(c, c);
	72	v32 = __insn_intlh(v16, v16);
	73
	74	/* This must be at least 8 or the following loop doesn't work. */
	75	#define CACHE_LINE_SIZE_IN_WORDS (CHIP_L2_LINE_SIZE() / 4)
	76
867e359b CM	77	/* Determine how many words we need to emit before the 'out32'
	78	* pointer becomes aligned modulo the cache line size.
	79	*/
	80	to_align32 =
	81	(-((uintptr_t)out32 >> 2)) & (CACHE_LINE_SIZE_IN_WORDS - 1);
	82
	83	/* Only bother aligning and using wh64 if there is at least
	84	* one full cache line to process. This check also prevents
	85	* overrunning the end of the buffer with alignment words.
	86	*/
	87	if (to_align32 <= n32 - CACHE_LINE_SIZE_IN_WORDS) {
	88	int lines_left;
	89
	90	/* Align out32 mod the cache line size so we can use wh64. */
	91	n32 -= to_align32;
	92	for (; to_align32 != 0; to_align32--) {
	93	*out32 = v32;
	94	out32++;
	95	}
	96
	97	/* Use unsigned divide to turn this into a right shift. */
	98	lines_left = (unsigned)n32 / CACHE_LINE_SIZE_IN_WORDS;
	99
	100	do {
	101	/* Only wh64 a few lines at a time, so we don't
	102	* exceed the maximum number of victim lines.
	103	*/
	104	int x = ((lines_left < CHIP_MAX_OUTSTANDING_VICTIMS())
	105	? lines_left
	106	: CHIP_MAX_OUTSTANDING_VICTIMS());
	107	uint32_t *wh = out32;
	108	int i = x;
	109	int j;
	110
	111	lines_left -= x;
	112
	113	do {
	114	__insn_wh64(wh);
	115	wh += CACHE_LINE_SIZE_IN_WORDS;
	116	} while (--i);
	117
0707ad30 CM	118	for (j = x * (CACHE_LINE_SIZE_IN_WORDS / 4);
0707ad30 CM	119	j != 0; j--) {
867e359b CM	120	*out32++ = v32;
	121	*out32++ = v32;
	122	*out32++ = v32;
	123	*out32++ = v32;
	124	}
	125	} while (lines_left != 0);
	126
	127	/* We processed all full lines above, so only this many
	128	* words remain to be processed.
	129	*/
	130	n32 &= CACHE_LINE_SIZE_IN_WORDS - 1;
	131	}
	132
867e359b CM	133	/* Now handle any leftover values. */
	134	if (n32 != 0) {
	135	do {
	136	*out32 = v32;
	137	out32++;
	138	} while (--n32 != 0);
	139	}
	140
	141	return s;
	142	}
	143	EXPORT_SYMBOL(memset);