~linaro-toolchain-dev/cortex-strings/trunk

103 by Will Newton
Split bionic reference code into A15 and A9 versions.
1
/*
2
 * Copyright (C) 2010 The Android Open Source Project
3
 * Copyright (c) 2008 ARM Ltd
4
 * All rights reserved.
5
 *
6
 * Redistribution and use in source and binary forms, with or without
7
 * modification, are permitted provided that the following conditions
8
 * are met:
9
 * 1. Redistributions of source code must retain the above copyright
10
 *    notice, this list of conditions and the following disclaimer.
11
 * 2. Redistributions in binary form must reproduce the above copyright
12
 *    notice, this list of conditions and the following disclaimer in the
13
 *    documentation and/or other materials provided with the distribution.
14
 * 3. The name of the company may not be used to endorse or promote
15
 *    products derived from this software without specific prior written
16
 *    permission.
17
 *
18
 * THIS SOFTWARE IS PROVIDED BY ARM LTD ``AS IS'' AND ANY EXPRESS OR IMPLIED
19
 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
20
 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21
 * IN NO EVENT SHALL ARM LTD BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
22
 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED
23
 * TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
24
 * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
25
 * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
26
 * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
27
 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28
 *
29
 * Android adaptation and tweak by Jim Huang <jserv@0xlab.org>.
30
 */
31
32
	.globl strcpy
33
	.type strcpy, %function
34
	.text
35
36
strcpy:
37
	.fnstart
38
	PLD [r1, #0]
39
	eor	r2, r0, r1
40
	mov	ip, r0
41
	tst	r2, #3
42
	bne	4f
43
	tst	r1, #3
44
	bne	3f
45
5:
46
	str	r5, [sp, #-4]!
47
	mov	r5, #0x01
48
	orr	r5, r5, r5, lsl #8
49
	orr	r5, r5, r5, lsl #16
50
51
	str	r4, [sp, #-4]!
52
	tst	r1, #4
53
	ldr	r3, [r1], #4
54
	beq	2f
55
	sub	r2, r3, r5
56
	bics	r2, r2, r3
57
	tst	r2, r5, lsl #7
58
	itt	eq
59
	streq	r3, [ip], #4
60
	ldreq	r3, [r1], #4
61
	bne	1f
62
       /* Inner loop.  We now know that r1 is 64-bit aligned, so we
63
	  can safely fetch up to two words.  This allows us to avoid
64
	  load stalls.  */
65
	.p2align 2
66
2:
67
	PLD [r1, #8]
68
	ldr	r4, [r1], #4
69
	sub	r2, r3, r5
70
	bics	r2, r2, r3
71
	tst	r2, r5, lsl #7
72
	sub	r2, r4, r5
73
	bne	1f
74
	str	r3, [ip], #4
75
	bics	r2, r2, r4
76
	tst	r2, r5, lsl #7
77
	itt	eq
78
	ldreq	r3, [r1], #4
79
	streq	r4, [ip], #4
80
	beq	2b
81
	mov	r3, r4
82
1:
83
#ifdef __ARMEB__
84
	rors	r3, r3, #24
85
#endif
86
	strb	r3, [ip], #1
87
	tst	r3, #0xff
88
#ifdef __ARMEL__
89
	ror	r3, r3, #8
90
#endif
91
	bne	1b
92
	ldr	r4, [sp], #4
93
	ldr	r5, [sp], #4
94
	bx	lr
95
96
       /* Strings have the same offset from word alignment, but it's
97
	  not zero.  */
98
3:
99
	tst	r1, #1
100
	beq	1f
101
	ldrb	r2, [r1], #1
102
	strb	r2, [ip], #1
103
	cmp	r2, #0
104
	it	eq
105
	bxeq	lr
106
1:
107
	tst	r1, #2
108
	beq	5b
109
	ldrh	r2, [r1], #2
110
#ifdef __ARMEB__
111
	tst	r2, #0xff00
112
	iteet	ne
113
	strneh	r2, [ip], #2
114
	lsreq	r2, r2, #8
115
	streqb	r2, [ip]
116
	tstne	r2, #0xff
117
#else
118
	tst	r2, #0xff
119
	itet	ne
120
	strneh	r2, [ip], #2
121
	streqb	r2, [ip]
122
	tstne	r2, #0xff00
123
#endif
124
	bne	5b
125
	bx	lr
126
127
       /* src and dst do not have a common word-alignement.  Fall back to
128
	  byte copying.  */
129
4:
130
	ldrb	r2, [r1], #1
131
	strb	r2, [ip], #1
132
	cmp	r2, #0
133
	bne	4b
134
	bx	lr
135
136
	.fnend