hc
2024-12-19 9370bb92b2d16684ee45cf24e879c93c509162da
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
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
/*
 * String handling functions for PowerPC.
 *
 * Copyright (C) 1996 Paul Mackerras.
 *
 * SPDX-License-Identifier:    GPL-2.0+
 */
#include <ppc_asm.tmpl>
#include <linux/errno.h>
 
   .globl    strcpy
strcpy:
   addi    r5,r3,-1
   addi    r4,r4,-1
1:    lbzu    r0,1(r4)
   cmpwi    0,r0,0
   stbu    r0,1(r5)
   bne    1b
   blr
 
   .globl    strncpy
strncpy:
   cmpwi    0,r5,0
   beqlr
   mtctr    r5
   addi    r6,r3,-1
   addi    r4,r4,-1
1:    lbzu    r0,1(r4)
   cmpwi    0,r0,0
   stbu    r0,1(r6)
   bdnzf    2,1b        /* dec ctr, branch if ctr != 0 && !cr0.eq */
   blr
 
   .globl    strcat
strcat:
   addi    r5,r3,-1
   addi    r4,r4,-1
1:    lbzu    r0,1(r5)
   cmpwi    0,r0,0
   bne    1b
   addi    r5,r5,-1
1:    lbzu    r0,1(r4)
   cmpwi    0,r0,0
   stbu    r0,1(r5)
   bne    1b
   blr
 
   .globl    strcmp
strcmp:
   addi    r5,r3,-1
   addi    r4,r4,-1
1:    lbzu    r3,1(r5)
   cmpwi    1,r3,0
   lbzu    r0,1(r4)
   subf.    r3,r0,r3
   beqlr    1
   beq    1b
   blr
 
   .globl    strlen
strlen:
   addi    r4,r3,-1
1:    lbzu    r0,1(r4)
   cmpwi    0,r0,0
   bne    1b
   subf    r3,r3,r4
   blr
 
   .globl    memset
memset:
   rlwimi    r4,r4,8,16,23
   rlwimi    r4,r4,16,0,15
   addi    r6,r3,-4
   cmplwi    0,r5,4
   blt    7f
   stwu    r4,4(r6)
   beqlr
   andi.    r0,r6,3
   add    r5,r0,r5
   subf    r6,r0,r6
   rlwinm    r0,r5,32-2,2,31
   mtctr    r0
   bdz    6f
1:    stwu    r4,4(r6)
   bdnz    1b
6:    andi.    r5,r5,3
7:    cmpwi    0,r5,0
   beqlr
   mtctr    r5
   addi    r6,r6,3
8:    stbu    r4,1(r6)
   bdnz    8b
   blr
 
   .globl    memmove
memmove:
   cmplw    0,r3,r4
   bgt    backwards_memcpy
   /* fall through */
 
   .globl    memcpy
memcpy:
   rlwinm.    r7,r5,32-3,3,31        /* r0 = r5 >> 3 */
   addi    r6,r3,-4
   addi    r4,r4,-4
   beq    2f            /* if less than 8 bytes to do */
   andi.    r0,r6,3            /* get dest word aligned */
   mtctr    r7
   bne    5f
1:    lwz    r7,4(r4)
   lwzu    r8,8(r4)
   stw    r7,4(r6)
   stwu    r8,8(r6)
   bdnz    1b
   andi.    r5,r5,7
2:    cmplwi    0,r5,4
   blt    3f
   lwzu    r0,4(r4)
   addi    r5,r5,-4
   stwu    r0,4(r6)
3:    cmpwi    0,r5,0
   beqlr
   mtctr    r5
   addi    r4,r4,3
   addi    r6,r6,3
4:    lbzu    r0,1(r4)
   stbu    r0,1(r6)
   bdnz    4b
   blr
5:    subfic    r0,r0,4
   mtctr    r0
6:    lbz    r7,4(r4)
   addi    r4,r4,1
   stb    r7,4(r6)
   addi    r6,r6,1
   bdnz    6b
   subf    r5,r0,r5
   rlwinm.    r7,r5,32-3,3,31
   beq    2b
   mtctr    r7
   b    1b
 
   .globl    backwards_memcpy
backwards_memcpy:
   rlwinm.    r7,r5,32-3,3,31        /* r0 = r5 >> 3 */
   add    r6,r3,r5
   add    r4,r4,r5
   beq    2f
   andi.    r0,r6,3
   mtctr    r7
   bne    5f
1:    lwz    r7,-4(r4)
   lwzu    r8,-8(r4)
   stw    r7,-4(r6)
   stwu    r8,-8(r6)
   bdnz    1b
   andi.    r5,r5,7
2:    cmplwi    0,r5,4
   blt    3f
   lwzu    r0,-4(r4)
   subi    r5,r5,4
   stwu    r0,-4(r6)
3:    cmpwi    0,r5,0
   beqlr
   mtctr    r5
4:    lbzu    r0,-1(r4)
   stbu    r0,-1(r6)
   bdnz    4b
   blr
5:    mtctr    r0
6:    lbzu    r7,-1(r4)
   stbu    r7,-1(r6)
   bdnz    6b
   subf    r5,r0,r5
   rlwinm.    r7,r5,32-3,3,31
   beq    2b
   mtctr    r7
   b    1b
 
   .globl    memcmp
memcmp:
   cmpwi    0,r5,0
   ble-    2f
   mtctr    r5
   addi    r6,r3,-1
   addi    r4,r4,-1
1:    lbzu    r3,1(r6)
   lbzu    r0,1(r4)
   subf.    r3,r0,r3
   bdnzt    2,1b
   blr
2:    li    r3,0
   blr
 
   .global    memchr
memchr:
   cmpwi    0,r5,0
   ble-    2f
   mtctr    r5
   addi    r3,r3,-1
1:    lbzu    r0,1(r3)
   cmpw    0,r0,r4
   bdnzf    2,1b
   beqlr
2:    li    r3,0
   blr