1d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand/* Copyright (C) 2002, 2003 Free Software Foundation, Inc.
2d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand   This file is part of the GNU C Library.
3d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand   Contributed by Hartvig Ekner <hartvige@mips.com>, 2002.
4d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
5d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand   The GNU C Library is free software; you can redistribute it and/or
6d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand   modify it under the terms of the GNU Lesser General Public
7d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand   License as published by the Free Software Foundation; either
8d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand   version 2.1 of the License, or (at your option) any later version.
9d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
10d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand   The GNU C Library is distributed in the hope that it will be useful,
11d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand   but WITHOUT ANY WARRANTY; without even the implied warranty of
12d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
13d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand   Lesser General Public License for more details.
14d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
15d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand   You should have received a copy of the GNU Lesser General Public
16d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand   License along with the GNU C Library; if not, write to the Free
17d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand   Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
18d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand   02111-1307 USA.  */
19d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
20d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand/* void *memset_omips(void *s, int c, size_t n).  */
21d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
22d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand#include "machine/asm.h"
23d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
24d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand#ifdef __mips64
25d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand#error mips32 code being compiled for mips64!
26d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand#endif
27d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
28d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand#if defined(__MIPSEB__)
29d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand#error big-endian is not supported in Broadcom MIPS Android platform
30d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand# define SWHI	swl		/* high part is left in big-endian	*/
31d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand#else
32d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand# define SWHI	swr		/* high part is right in little-endian	*/
33d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand#endif
34d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
35d4a80984fcf1066e244a8909354df03ba1e3f786Duane SandLEAF (memset_omips,0)
36d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	.set	noreorder
37d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
38d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	slti	t1, a2, 8		# Less than 8?
39d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	bne	t1, zero, .Llast8
40d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	move	v0, a0			# Setup exit value before too late
41d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
42d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	beq	a1, zero, .Lueven	# If zero pattern, no need to extend
43d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	andi	a1, 0xff		# Avoid problems with bogus arguments
44d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	sll	t0, a1, 8
45d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	or	a1, t0
46d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	sll	t0, a1, 16
47d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	or	a1, t0			# a1 is now pattern in full word
48d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
49d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand.Lueven:
50d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	subu	t0, zero, a0		# Unaligned address?
51d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	andi	t0, 0x3
52d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	beq	t0, zero, .Lchkw
53d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	subu	a2, t0
54d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	SWHI	a1, 0(a0)		# Yes, handle first unaligned part
55d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	addu	a0, t0			# Now both a0 and a2 are updated
56d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
57d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand.Lchkw:
58d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	andi	t0, a2, 0x7		# Enough left for one loop iteration?
59d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	beq	t0, a2, .Lchkl
60d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	subu	a3, a2, t0
61d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	addu	a3, a0			# a3 is last loop address +1
62d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	move	a2, t0			# a2 is now # of bytes left after loop
63d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand.Lloopw:
64d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	addiu	a0, 8			# Handle 2 words pr. iteration
65d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	sw	a1, -8(a0)
66d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	bne	a0, a3, .Lloopw
67d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	sw	a1, -4(a0)
68d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
69d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand.Lchkl:
70d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	andi	t0, a2, 0x4		# Check if there is at least a full
71d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	beq	t0, zero, .Llast8	#  word remaining after the loop
72d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	subu	a2, t0
73d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	sw	a1, 0(a0)		# Yes...
74d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	addiu	a0, 4
75d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
76d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand.Llast8:
77d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	blez	a2, .Lexit		# Handle last 8 bytes (if cnt>0)
78d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	addu	a3, a2, a0		# a3 is last address +1
79d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand.Llst8l:
80d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	addiu	a0, 1
81d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	bne	a0, a3, .Llst8l
82d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	sb	a1, -1(a0)
83d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand.Lexit:
84d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	j	ra			# Bye, bye
85d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	nop
86d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
87d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand	.set	reorder
88d4a80984fcf1066e244a8909354df03ba1e3f786Duane SandEND (memset_omips)
89d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
90d4a80984fcf1066e244a8909354df03ba1e3f786Duane Sand
91