|
Packit |
6c4009 |
/* Copyright (C) 2010-2018 Free Software Foundation, Inc.
|
|
Packit |
6c4009 |
This file is part of the GNU C Library.
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
The GNU C Library is free software; you can redistribute it and/or
|
|
Packit |
6c4009 |
modify it under the terms of the GNU Lesser General Public
|
|
Packit |
6c4009 |
License as published by the Free Software Foundation; either
|
|
Packit |
6c4009 |
version 2.1 of the License, or (at your option) any later version.
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
The GNU C Library is distributed in the hope that it will be useful,
|
|
Packit |
6c4009 |
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
Packit |
6c4009 |
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
Packit |
6c4009 |
Lesser General Public License for more details.
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
You should have received a copy of the GNU Lesser General Public
|
|
Packit |
6c4009 |
License along with the GNU C Library. If not, see
|
|
Packit |
6c4009 |
<http://www.gnu.org/licenses/>. */
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/*
|
|
Packit |
6c4009 |
Assumes:
|
|
Packit |
6c4009 |
ARMv6T2, AArch32
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
*/
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#include <arm-features.h>
|
|
Packit |
6c4009 |
#include <sysdep.h>
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#ifdef __ARMEB__
|
|
Packit |
6c4009 |
#define S2LO lsl
|
|
Packit |
6c4009 |
#define S2HI lsr
|
|
Packit |
6c4009 |
#else
|
|
Packit |
6c4009 |
#define S2LO lsr
|
|
Packit |
6c4009 |
#define S2HI lsl
|
|
Packit |
6c4009 |
#endif
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* This code is best on Thumb. */
|
|
Packit |
6c4009 |
.thumb
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Parameters and result. */
|
|
Packit |
6c4009 |
#define srcin r0
|
|
Packit |
6c4009 |
#define result r0
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Internal variables. */
|
|
Packit |
6c4009 |
#define src r1
|
|
Packit |
6c4009 |
#define data1a r2
|
|
Packit |
6c4009 |
#define data1b r3
|
|
Packit |
6c4009 |
#define const_m1 r12
|
|
Packit |
6c4009 |
#define const_0 r4
|
|
Packit |
6c4009 |
#define tmp1 r4 /* Overlaps const_0 */
|
|
Packit |
6c4009 |
#define tmp2 r5
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
.text
|
|
Packit |
6c4009 |
.p2align 6
|
|
Packit |
6c4009 |
ENTRY(strlen)
|
|
Packit |
6c4009 |
pld [srcin, #0]
|
|
Packit |
6c4009 |
strd r4, r5, [sp, #-8]!
|
|
Packit |
6c4009 |
cfi_adjust_cfa_offset (8)
|
|
Packit |
6c4009 |
cfi_rel_offset (r4, 0)
|
|
Packit |
6c4009 |
cfi_rel_offset (r5, 4)
|
|
Packit |
6c4009 |
cfi_remember_state
|
|
Packit |
6c4009 |
bic src, srcin, #7
|
|
Packit |
6c4009 |
mvn const_m1, #0
|
|
Packit |
6c4009 |
ands tmp1, srcin, #7 /* (8 - bytes) to alignment. */
|
|
Packit |
6c4009 |
pld [src, #32]
|
|
Packit |
6c4009 |
bne.w .Lmisaligned8
|
|
Packit |
6c4009 |
mov const_0, #0
|
|
Packit |
6c4009 |
mov result, #-8
|
|
Packit |
6c4009 |
.Lloop_aligned:
|
|
Packit |
6c4009 |
/* Bytes 0-7. */
|
|
Packit |
6c4009 |
ldrd data1a, data1b, [src]
|
|
Packit |
6c4009 |
pld [src, #64]
|
|
Packit |
6c4009 |
add result, result, #8
|
|
Packit |
6c4009 |
.Lstart_realigned:
|
|
Packit |
6c4009 |
uadd8 data1a, data1a, const_m1 /* Saturating GE<0:3> set. */
|
|
Packit |
6c4009 |
sel data1a, const_0, const_m1 /* Select based on GE<0:3>. */
|
|
Packit |
6c4009 |
uadd8 data1b, data1b, const_m1
|
|
Packit |
6c4009 |
sel data1b, data1a, const_m1 /* Only used if d1a == 0. */
|
|
Packit |
6c4009 |
cbnz data1b, .Lnull_found
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Bytes 8-15. */
|
|
Packit |
6c4009 |
ldrd data1a, data1b, [src, #8]
|
|
Packit |
6c4009 |
uadd8 data1a, data1a, const_m1 /* Saturating GE<0:3> set. */
|
|
Packit |
6c4009 |
add result, result, #8
|
|
Packit |
6c4009 |
sel data1a, const_0, const_m1 /* Select based on GE<0:3>. */
|
|
Packit |
6c4009 |
uadd8 data1b, data1b, const_m1
|
|
Packit |
6c4009 |
sel data1b, data1a, const_m1 /* Only used if d1a == 0. */
|
|
Packit |
6c4009 |
cbnz data1b, .Lnull_found
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Bytes 16-23. */
|
|
Packit |
6c4009 |
ldrd data1a, data1b, [src, #16]
|
|
Packit |
6c4009 |
uadd8 data1a, data1a, const_m1 /* Saturating GE<0:3> set. */
|
|
Packit |
6c4009 |
add result, result, #8
|
|
Packit |
6c4009 |
sel data1a, const_0, const_m1 /* Select based on GE<0:3>. */
|
|
Packit |
6c4009 |
uadd8 data1b, data1b, const_m1
|
|
Packit |
6c4009 |
sel data1b, data1a, const_m1 /* Only used if d1a == 0. */
|
|
Packit |
6c4009 |
cbnz data1b, .Lnull_found
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Bytes 24-31. */
|
|
Packit |
6c4009 |
ldrd data1a, data1b, [src, #24]
|
|
Packit |
6c4009 |
add src, src, #32
|
|
Packit |
6c4009 |
uadd8 data1a, data1a, const_m1 /* Saturating GE<0:3> set. */
|
|
Packit |
6c4009 |
add result, result, #8
|
|
Packit |
6c4009 |
sel data1a, const_0, const_m1 /* Select based on GE<0:3>. */
|
|
Packit |
6c4009 |
uadd8 data1b, data1b, const_m1
|
|
Packit |
6c4009 |
sel data1b, data1a, const_m1 /* Only used if d1a == 0. */
|
|
Packit |
6c4009 |
cmp data1b, #0
|
|
Packit |
6c4009 |
beq .Lloop_aligned
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
.Lnull_found:
|
|
Packit |
6c4009 |
cmp data1a, #0
|
|
Packit |
6c4009 |
itt eq
|
|
Packit |
6c4009 |
addeq result, result, #4
|
|
Packit |
6c4009 |
moveq data1a, data1b
|
|
Packit |
6c4009 |
#ifndef __ARMEB__
|
|
Packit |
6c4009 |
rev data1a, data1a
|
|
Packit |
6c4009 |
#endif
|
|
Packit |
6c4009 |
clz data1a, data1a
|
|
Packit |
6c4009 |
ldrd r4, r5, [sp], #8
|
|
Packit |
6c4009 |
cfi_adjust_cfa_offset (-8)
|
|
Packit |
6c4009 |
cfi_restore (r4)
|
|
Packit |
6c4009 |
cfi_restore (r5)
|
|
Packit |
6c4009 |
add result, result, data1a, lsr #3 /* Bits -> Bytes. */
|
|
Packit |
6c4009 |
DO_RET(lr)
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
.Lmisaligned8:
|
|
Packit |
6c4009 |
cfi_restore_state
|
|
Packit |
6c4009 |
ldrd data1a, data1b, [src]
|
|
Packit |
6c4009 |
and tmp2, tmp1, #3
|
|
Packit |
6c4009 |
rsb result, tmp1, #0
|
|
Packit |
6c4009 |
lsl tmp2, tmp2, #3 /* Bytes -> bits. */
|
|
Packit |
6c4009 |
tst tmp1, #4
|
|
Packit |
6c4009 |
pld [src, #64]
|
|
Packit |
6c4009 |
S2HI tmp2, const_m1, tmp2
|
|
Packit |
6c4009 |
orn data1a, data1a, tmp2
|
|
Packit |
6c4009 |
itt ne
|
|
Packit |
6c4009 |
ornne data1b, data1b, tmp2
|
|
Packit |
6c4009 |
movne data1a, const_m1
|
|
Packit |
6c4009 |
mov const_0, #0
|
|
Packit |
6c4009 |
b .Lstart_realigned
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
END(strlen)
|
|
Packit |
6c4009 |
libc_hidden_builtin_def (strlen)
|