1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
|
/*
* Copyright 2010 The Android Open Source Project
*
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE file.
*/
/* Changes:
* 2010-08-11 Steve McIntyre <steve.mcintyre@arm.com>
* Added small changes to the two functions to make them work on the
* specified number of 16- or 32-bit values rather than the original
* code which was specified as a count of bytes. More verbose comments
* to aid future maintenance.
*/
.text
.align
.global arm_memset32
.type arm_memset32, %function
.global arm_memset16
.type arm_memset16, %function
/*
* Optimized memset functions for ARM.
*
* void arm_memset16(uint16_t* dst, uint16_t value, int count);
* void arm_memset32(uint32_t* dst, uint32_t value, int count);
*
*/
arm_memset16:
.fnstart
push {lr}
/* if count is equal to zero then abort */
teq r2, #0
ble .Lfinish
/* Multiply count by 2 - go from the number of 16-bit shorts
* to the number of bytes desired. */
mov r2, r2, lsl #1
/* expand the data to 32 bits */
orr r1, r1, lsl #16
/* align to 32 bits */
tst r0, #2
strneh r1, [r0], #2
subne r2, r2, #2
/* Now jump into the main loop below. */
b .Lwork_32
.fnend
arm_memset32:
.fnstart
push {lr}
/* if count is equal to zero then abort */
teq r2, #0
ble .Lfinish
/* Multiply count by 4 - go from the number of 32-bit words to
* the number of bytes desired. */
mov r2, r2, lsl #2
.Lwork_32:
/* Set up registers ready for writing them out. */
mov ip, r1
mov lr, r1
/* Try to align the destination to a cache line. Assume 32
* byte (8 word) cache lines, it's the common case. */
rsb r3, r0, #0
ands r3, r3, #0x1C
beq .Laligned32
cmp r3, r2
andhi r3, r2, #0x1C
sub r2, r2, r3
/* (Optionally) write any unaligned leading bytes.
* (0-28 bytes, length in r3) */
movs r3, r3, lsl #28
stmcsia r0!, {r1, lr}
stmcsia r0!, {r1, lr}
stmmiia r0!, {r1, lr}
movs r3, r3, lsl #2
strcs r1, [r0], #4
/* Now quickly loop through the cache-aligned data. */
.Laligned32:
mov r3, r1
1: subs r2, r2, #32
stmhsia r0!, {r1,r3,ip,lr}
stmhsia r0!, {r1,r3,ip,lr}
bhs 1b
add r2, r2, #32
/* (Optionally) store any remaining trailing bytes.
* (0-30 bytes, length in r2) */
movs r2, r2, lsl #28
stmcsia r0!, {r1,r3,ip,lr}
stmmiia r0!, {r1,lr}
movs r2, r2, lsl #2
strcs r1, [r0], #4
strmih lr, [r0], #2
.Lfinish:
pop {pc}
.fnend
|
