110 lines
3.3 KiB
ArmAsm
110 lines
3.3 KiB
ArmAsm
/*
|
|
Copyright (c) 2015, Synopsys, Inc. All rights reserved.
|
|
|
|
Redistribution and use in source and binary forms, with or without
|
|
modification, are permitted provided that the following conditions are met:
|
|
|
|
1) Redistributions of source code must retain the above copyright notice,
|
|
this list of conditions and the following disclaimer.
|
|
|
|
2) Redistributions in binary form must reproduce the above copyright notice,
|
|
this list of conditions and the following disclaimer in the documentation
|
|
and/or other materials provided with the distribution.
|
|
|
|
3) Neither the name of the Synopsys, Inc., nor the names of its contributors
|
|
may be used to endorse or promote products derived from this software
|
|
without specific prior written permission.
|
|
|
|
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
|
AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
|
|
LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
|
SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
|
INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
|
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
/* This implementation is optimized for performance. For code size a generic
|
|
implementation of this function from newlib/libc/string/memset.c will be
|
|
used. */
|
|
#if !defined (__OPTIMIZE_SIZE__) && !defined (PREFER_SIZE_OVER_SPEED)
|
|
|
|
#include "asm.h"
|
|
|
|
#if defined (__ARC601__) || (!defined (__Xbarrel_shifter) && !defined (__HS__))
|
|
|
|
/* To deal with alignment/loop issues, SMALL must be at least 2. */
|
|
#define SMALL 8 /* Even faster if aligned. */
|
|
|
|
.global __strncpy_bzero
|
|
.hidden __strncpy_bzero
|
|
/* __strncpy_bzero provides the following interface to strncpy:
|
|
r0: return value
|
|
r2: zeroing length
|
|
r3: zeroing start address
|
|
No attempt is made here for __strncpy_memset to speed up aligned
|
|
cases, because the copying of a string presumably leaves start address
|
|
and length alignment for the zeroing randomly distributed. */
|
|
|
|
ENTRY (memset)
|
|
brls.d r2,SMALL,.Ltiny
|
|
mov_s r3,r0
|
|
or r12,r0,r2
|
|
bmsk.f r12,r12,1
|
|
breq_s r1,0,.Lbzero
|
|
mov r4,0
|
|
stb.a r1,[sp,-4]
|
|
stb r1,[sp,1]
|
|
stb r1,[sp,2]
|
|
stb r1,[sp,3]
|
|
ld.ab r1,[sp,4]
|
|
.Lbzero:
|
|
beq.d .Laligned
|
|
.Lbzero2:
|
|
add r6,r2,r3
|
|
.Lnot_tiny:
|
|
stb r1,[r6,-1]
|
|
bclr r12,r6,0
|
|
stw r1,[r12,-2]
|
|
stb.ab r1,[r3,1]
|
|
bclr_s r3,r3,0
|
|
stw.ab r1,[r3,2]
|
|
bclr_s r3,r3,1
|
|
.Laligned: ; This code address should be aligned for speed.
|
|
sub r6,r6,8
|
|
brlo.d r6,r3,.Loop_end
|
|
sub r6,r6,8
|
|
3:
|
|
st_l r1,[r3,4]
|
|
brhs.d r6,r3,3b
|
|
st.ab r1,[r3,8]
|
|
.Loop_end:
|
|
bic r12,r6,3
|
|
j_s.d [blink]
|
|
st_s r1,[r12,12]
|
|
.balign 4
|
|
__strncpy_bzero:
|
|
brhi.d r2,8,.Lbzero2
|
|
mov_s r1,0
|
|
.Ltiny:
|
|
sub_s r2,r2,11
|
|
sub1 r12,pcl,r2
|
|
j_s [r12]
|
|
stb_s r1,[r3,7]
|
|
stb_s r1,[r3,6]
|
|
stb_s r1,[r3,5]
|
|
stb_s r1,[r3,4]
|
|
stb_s r1,[r3,3]
|
|
stb_s r1,[r3,2]
|
|
stb_s r1,[r3,1]
|
|
stb_s r1,[r3]
|
|
j_s [blink]
|
|
ENDFUNC (memset)
|
|
#endif /* __ARC601__ || (!__Xbarrel_shifter && !__HS__) */
|
|
|
|
#endif /* !__OPTIMIZE_SIZE__ && !PREFER_SIZE_OVER_SPEED */
|