]> git.sur5r.net Git - u-boot/blob - lib_ppc/ppcstring.S
[MIPS] Implement flush_cache()
[u-boot] / lib_ppc / ppcstring.S
1 /*
2  * String handling functions for PowerPC.
3  *
4  * Copyright (C) 1996 Paul Mackerras.
5  *
6  * This program is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU General Public License
8  * as published by the Free Software Foundation; either version
9  * 2 of the License, or (at your option) any later version.
10  */
11 #include <ppc_asm.tmpl>
12 #include <asm/errno.h>
13
14         .globl  strcpy
15 strcpy:
16         addi    r5,r3,-1
17         addi    r4,r4,-1
18 1:      lbzu    r0,1(r4)
19         cmpwi   0,r0,0
20         stbu    r0,1(r5)
21         bne     1b
22         blr
23
24         .globl  strncpy
25 strncpy:
26         cmpwi   0,r5,0
27         beqlr
28         mtctr   r5
29         addi    r6,r3,-1
30         addi    r4,r4,-1
31 1:      lbzu    r0,1(r4)
32         cmpwi   0,r0,0
33         stbu    r0,1(r6)
34         bdnzf   2,1b            /* dec ctr, branch if ctr != 0 && !cr0.eq */
35         blr
36
37         .globl  strcat
38 strcat:
39         addi    r5,r3,-1
40         addi    r4,r4,-1
41 1:      lbzu    r0,1(r5)
42         cmpwi   0,r0,0
43         bne     1b
44         addi    r5,r5,-1
45 1:      lbzu    r0,1(r4)
46         cmpwi   0,r0,0
47         stbu    r0,1(r5)
48         bne     1b
49         blr
50
51         .globl  strcmp
52 strcmp:
53         addi    r5,r3,-1
54         addi    r4,r4,-1
55 1:      lbzu    r3,1(r5)
56         cmpwi   1,r3,0
57         lbzu    r0,1(r4)
58         subf.   r3,r0,r3
59         beqlr   1
60         beq     1b
61         blr
62
63         .globl  strlen
64 strlen:
65         addi    r4,r3,-1
66 1:      lbzu    r0,1(r4)
67         cmpwi   0,r0,0
68         bne     1b
69         subf    r3,r3,r4
70         blr
71
72         .globl  memset
73 memset:
74         rlwimi  r4,r4,8,16,23
75         rlwimi  r4,r4,16,0,15
76         addi    r6,r3,-4
77         cmplwi  0,r5,4
78         blt     7f
79         stwu    r4,4(r6)
80         beqlr
81         andi.   r0,r6,3
82         add     r5,r0,r5
83         subf    r6,r0,r6
84         rlwinm  r0,r5,32-2,2,31
85         mtctr   r0
86         bdz     6f
87 1:      stwu    r4,4(r6)
88         bdnz    1b
89 6:      andi.   r5,r5,3
90 7:      cmpwi   0,r5,0
91         beqlr
92         mtctr   r5
93         addi    r6,r6,3
94 8:      stbu    r4,1(r6)
95         bdnz    8b
96         blr
97
98         .globl  bcopy
99 bcopy:
100         mr      r6,r3
101         mr      r3,r4
102         mr      r4,r6
103         b       memcpy
104
105         .globl  memmove
106 memmove:
107         cmplw   0,r3,r4
108         bgt     backwards_memcpy
109         /* fall through */
110
111         .globl  memcpy
112 memcpy:
113         rlwinm. r7,r5,32-3,3,31         /* r0 = r5 >> 3 */
114         addi    r6,r3,-4
115         addi    r4,r4,-4
116         beq     2f                      /* if less than 8 bytes to do */
117         andi.   r0,r6,3                 /* get dest word aligned */
118         mtctr   r7
119         bne     5f
120 1:      lwz     r7,4(r4)
121         lwzu    r8,8(r4)
122         stw     r7,4(r6)
123         stwu    r8,8(r6)
124         bdnz    1b
125         andi.   r5,r5,7
126 2:      cmplwi  0,r5,4
127         blt     3f
128         lwzu    r0,4(r4)
129         addi    r5,r5,-4
130         stwu    r0,4(r6)
131 3:      cmpwi   0,r5,0
132         beqlr
133         mtctr   r5
134         addi    r4,r4,3
135         addi    r6,r6,3
136 4:      lbzu    r0,1(r4)
137         stbu    r0,1(r6)
138         bdnz    4b
139         blr
140 5:      subfic  r0,r0,4
141         mtctr   r0
142 6:      lbz     r7,4(r4)
143         addi    r4,r4,1
144         stb     r7,4(r6)
145         addi    r6,r6,1
146         bdnz    6b
147         subf    r5,r0,r5
148         rlwinm. r7,r5,32-3,3,31
149         beq     2b
150         mtctr   r7
151         b       1b
152
153         .globl  backwards_memcpy
154 backwards_memcpy:
155         rlwinm. r7,r5,32-3,3,31         /* r0 = r5 >> 3 */
156         add     r6,r3,r5
157         add     r4,r4,r5
158         beq     2f
159         andi.   r0,r6,3
160         mtctr   r7
161         bne     5f
162 1:      lwz     r7,-4(r4)
163         lwzu    r8,-8(r4)
164         stw     r7,-4(r6)
165         stwu    r8,-8(r6)
166         bdnz    1b
167         andi.   r5,r5,7
168 2:      cmplwi  0,r5,4
169         blt     3f
170         lwzu    r0,-4(r4)
171         subi    r5,r5,4
172         stwu    r0,-4(r6)
173 3:      cmpwi   0,r5,0
174         beqlr
175         mtctr   r5
176 4:      lbzu    r0,-1(r4)
177         stbu    r0,-1(r6)
178         bdnz    4b
179         blr
180 5:      mtctr   r0
181 6:      lbzu    r7,-1(r4)
182         stbu    r7,-1(r6)
183         bdnz    6b
184         subf    r5,r0,r5
185         rlwinm. r7,r5,32-3,3,31
186         beq     2b
187         mtctr   r7
188         b       1b
189
190         .globl  memcmp
191 memcmp:
192         cmpwi   0,r5,0
193         ble-    2f
194         mtctr   r5
195         addi    r6,r3,-1
196         addi    r4,r4,-1
197 1:      lbzu    r3,1(r6)
198         lbzu    r0,1(r4)
199         subf.   r3,r0,r3
200         bdnzt   2,1b
201         blr
202 2:      li      r3,0
203         blr
204
205         .global memchr
206 memchr:
207         cmpwi   0,r5,0
208         ble-    2f
209         mtctr   r5
210         addi    r3,r3,-1
211 1:      lbzu    r0,1(r3)
212         cmpw    0,r0,r4
213         bdnzf   2,1b
214         beqlr
215 2:      li      r3,0
216         blr