Loading...
1/* SPDX-License-Identifier: GPL-2.0 */
2/* copy_user.S: Sparc optimized copy_from_user and copy_to_user code.
3 *
4 * Copyright(C) 1995 Linus Torvalds
5 * Copyright(C) 1996 David S. Miller
6 * Copyright(C) 1996 Eddie C. Dost
7 * Copyright(C) 1996,1998 Jakub Jelinek
8 *
9 * derived from:
10 * e-mail between David and Eddie.
11 *
12 * Returns 0 if successful, otherwise count of bytes not copied yet
13 */
14
15#include <asm/ptrace.h>
16#include <asm/asmmacro.h>
17#include <asm/page.h>
18#include <asm/thread_info.h>
19#include <asm/export.h>
20
21/* Work around cpp -rob */
22#define ALLOC #alloc
23#define EXECINSTR #execinstr
24
25#define EX_ENTRY(l1, l2) \
26 .section __ex_table,ALLOC; \
27 .align 4; \
28 .word l1, l2; \
29 .text;
30
31#define EX(x,y,a,b) \
3298: x,y; \
33 .section .fixup,ALLOC,EXECINSTR; \
34 .align 4; \
3599: retl; \
36 a, b, %o0; \
37 EX_ENTRY(98b, 99b)
38
39#define EX2(x,y,c,d,e,a,b) \
4098: x,y; \
41 .section .fixup,ALLOC,EXECINSTR; \
42 .align 4; \
4399: c, d, e; \
44 retl; \
45 a, b, %o0; \
46 EX_ENTRY(98b, 99b)
47
48#define EXO2(x,y) \
4998: x, y; \
50 EX_ENTRY(98b, 97f)
51
52#define LD(insn, src, offset, reg, label) \
5398: insn [%src + (offset)], %reg; \
54 .section .fixup,ALLOC,EXECINSTR; \
5599: ba label; \
56 mov offset, %g5; \
57 EX_ENTRY(98b, 99b)
58
59#define ST(insn, dst, offset, reg, label) \
6098: insn %reg, [%dst + (offset)]; \
61 .section .fixup,ALLOC,EXECINSTR; \
6299: ba label; \
63 mov offset, %g5; \
64 EX_ENTRY(98b, 99b)
65
66/* Both these macros have to start with exactly the same insn */
67/* left: g7 + (g1 % 128) - offset */
68#define MOVE_BIGCHUNK(src, dst, offset, t0, t1, t2, t3, t4, t5, t6, t7) \
69 LD(ldd, src, offset + 0x00, t0, bigchunk_fault) \
70 LD(ldd, src, offset + 0x08, t2, bigchunk_fault) \
71 LD(ldd, src, offset + 0x10, t4, bigchunk_fault) \
72 LD(ldd, src, offset + 0x18, t6, bigchunk_fault) \
73 ST(st, dst, offset + 0x00, t0, bigchunk_fault) \
74 ST(st, dst, offset + 0x04, t1, bigchunk_fault) \
75 ST(st, dst, offset + 0x08, t2, bigchunk_fault) \
76 ST(st, dst, offset + 0x0c, t3, bigchunk_fault) \
77 ST(st, dst, offset + 0x10, t4, bigchunk_fault) \
78 ST(st, dst, offset + 0x14, t5, bigchunk_fault) \
79 ST(st, dst, offset + 0x18, t6, bigchunk_fault) \
80 ST(st, dst, offset + 0x1c, t7, bigchunk_fault)
81
82/* left: g7 + (g1 % 128) - offset */
83#define MOVE_BIGALIGNCHUNK(src, dst, offset, t0, t1, t2, t3, t4, t5, t6, t7) \
84 LD(ldd, src, offset + 0x00, t0, bigchunk_fault) \
85 LD(ldd, src, offset + 0x08, t2, bigchunk_fault) \
86 LD(ldd, src, offset + 0x10, t4, bigchunk_fault) \
87 LD(ldd, src, offset + 0x18, t6, bigchunk_fault) \
88 ST(std, dst, offset + 0x00, t0, bigchunk_fault) \
89 ST(std, dst, offset + 0x08, t2, bigchunk_fault) \
90 ST(std, dst, offset + 0x10, t4, bigchunk_fault) \
91 ST(std, dst, offset + 0x18, t6, bigchunk_fault)
92
93 .section .fixup,#alloc,#execinstr
94bigchunk_fault:
95 sub %g7, %g5, %o0
96 and %g1, 127, %g1
97 retl
98 add %o0, %g1, %o0
99
100/* left: offset + 16 + (g1 % 16) */
101#define MOVE_LASTCHUNK(src, dst, offset, t0, t1, t2, t3) \
102 LD(ldd, src, -(offset + 0x10), t0, lastchunk_fault) \
103 LD(ldd, src, -(offset + 0x08), t2, lastchunk_fault) \
104 ST(st, dst, -(offset + 0x10), t0, lastchunk_fault) \
105 ST(st, dst, -(offset + 0x0c), t1, lastchunk_fault) \
106 ST(st, dst, -(offset + 0x08), t2, lastchunk_fault) \
107 ST(st, dst, -(offset + 0x04), t3, lastchunk_fault)
108
109 .section .fixup,#alloc,#execinstr
110lastchunk_fault:
111 and %g1, 15, %g1
112 retl
113 sub %g1, %g5, %o0
114
115/* left: o3 + (o2 % 16) - offset */
116#define MOVE_HALFCHUNK(src, dst, offset, t0, t1, t2, t3) \
117 LD(lduh, src, offset + 0x00, t0, halfchunk_fault) \
118 LD(lduh, src, offset + 0x02, t1, halfchunk_fault) \
119 LD(lduh, src, offset + 0x04, t2, halfchunk_fault) \
120 LD(lduh, src, offset + 0x06, t3, halfchunk_fault) \
121 ST(sth, dst, offset + 0x00, t0, halfchunk_fault) \
122 ST(sth, dst, offset + 0x02, t1, halfchunk_fault) \
123 ST(sth, dst, offset + 0x04, t2, halfchunk_fault) \
124 ST(sth, dst, offset + 0x06, t3, halfchunk_fault)
125
126/* left: o3 + (o2 % 16) + offset + 2 */
127#define MOVE_SHORTCHUNK(src, dst, offset, t0, t1) \
128 LD(ldub, src, -(offset + 0x02), t0, halfchunk_fault) \
129 LD(ldub, src, -(offset + 0x01), t1, halfchunk_fault) \
130 ST(stb, dst, -(offset + 0x02), t0, halfchunk_fault) \
131 ST(stb, dst, -(offset + 0x01), t1, halfchunk_fault)
132
133 .section .fixup,#alloc,#execinstr
134halfchunk_fault:
135 and %o2, 15, %o2
136 sub %o3, %g5, %o3
137 retl
138 add %o2, %o3, %o0
139
140/* left: offset + 2 + (o2 % 2) */
141#define MOVE_LAST_SHORTCHUNK(src, dst, offset, t0, t1) \
142 LD(ldub, src, -(offset + 0x02), t0, last_shortchunk_fault) \
143 LD(ldub, src, -(offset + 0x01), t1, last_shortchunk_fault) \
144 ST(stb, dst, -(offset + 0x02), t0, last_shortchunk_fault) \
145 ST(stb, dst, -(offset + 0x01), t1, last_shortchunk_fault)
146
147 .section .fixup,#alloc,#execinstr
148last_shortchunk_fault:
149 and %o2, 1, %o2
150 retl
151 sub %o2, %g5, %o0
152
153 .text
154 .align 4
155
156 .globl __copy_user_begin
157__copy_user_begin:
158
159 .globl __copy_user
160 EXPORT_SYMBOL(__copy_user)
161dword_align:
162 andcc %o1, 1, %g0
163 be 4f
164 andcc %o1, 2, %g0
165
166 EXO2(ldub [%o1], %g2)
167 add %o1, 1, %o1
168 EXO2(stb %g2, [%o0])
169 sub %o2, 1, %o2
170 bne 3f
171 add %o0, 1, %o0
172
173 EXO2(lduh [%o1], %g2)
174 add %o1, 2, %o1
175 EXO2(sth %g2, [%o0])
176 sub %o2, 2, %o2
177 b 3f
178 add %o0, 2, %o0
1794:
180 EXO2(lduh [%o1], %g2)
181 add %o1, 2, %o1
182 EXO2(sth %g2, [%o0])
183 sub %o2, 2, %o2
184 b 3f
185 add %o0, 2, %o0
186
187__copy_user: /* %o0=dst %o1=src %o2=len */
188 xor %o0, %o1, %o4
1891:
190 andcc %o4, 3, %o5
1912:
192 bne cannot_optimize
193 cmp %o2, 15
194
195 bleu short_aligned_end
196 andcc %o1, 3, %g0
197
198 bne dword_align
1993:
200 andcc %o1, 4, %g0
201
202 be 2f
203 mov %o2, %g1
204
205 EXO2(ld [%o1], %o4)
206 sub %g1, 4, %g1
207 EXO2(st %o4, [%o0])
208 add %o1, 4, %o1
209 add %o0, 4, %o0
2102:
211 andcc %g1, 0xffffff80, %g7
212 be 3f
213 andcc %o0, 4, %g0
214
215 be ldd_std + 4
2165:
217 MOVE_BIGCHUNK(o1, o0, 0x00, o2, o3, o4, o5, g2, g3, g4, g5)
218 MOVE_BIGCHUNK(o1, o0, 0x20, o2, o3, o4, o5, g2, g3, g4, g5)
219 MOVE_BIGCHUNK(o1, o0, 0x40, o2, o3, o4, o5, g2, g3, g4, g5)
220 MOVE_BIGCHUNK(o1, o0, 0x60, o2, o3, o4, o5, g2, g3, g4, g5)
221 subcc %g7, 128, %g7
222 add %o1, 128, %o1
223 bne 5b
224 add %o0, 128, %o0
2253:
226 andcc %g1, 0x70, %g7
227 be copy_user_table_end
228 andcc %g1, 8, %g0
229
230 sethi %hi(copy_user_table_end), %o5
231 srl %g7, 1, %o4
232 add %g7, %o4, %o4
233 add %o1, %g7, %o1
234 sub %o5, %o4, %o5
235 jmpl %o5 + %lo(copy_user_table_end), %g0
236 add %o0, %g7, %o0
237
238 MOVE_LASTCHUNK(o1, o0, 0x60, g2, g3, g4, g5)
239 MOVE_LASTCHUNK(o1, o0, 0x50, g2, g3, g4, g5)
240 MOVE_LASTCHUNK(o1, o0, 0x40, g2, g3, g4, g5)
241 MOVE_LASTCHUNK(o1, o0, 0x30, g2, g3, g4, g5)
242 MOVE_LASTCHUNK(o1, o0, 0x20, g2, g3, g4, g5)
243 MOVE_LASTCHUNK(o1, o0, 0x10, g2, g3, g4, g5)
244 MOVE_LASTCHUNK(o1, o0, 0x00, g2, g3, g4, g5)
245copy_user_table_end:
246 be copy_user_last7
247 andcc %g1, 4, %g0
248
249 EX(ldd [%o1], %g2, and %g1, 0xf)
250 add %o0, 8, %o0
251 add %o1, 8, %o1
252 EX(st %g2, [%o0 - 0x08], and %g1, 0xf)
253 EX2(st %g3, [%o0 - 0x04], and %g1, 0xf, %g1, sub %g1, 4)
254copy_user_last7:
255 be 1f
256 andcc %g1, 2, %g0
257
258 EX(ld [%o1], %g2, and %g1, 7)
259 add %o1, 4, %o1
260 EX(st %g2, [%o0], and %g1, 7)
261 add %o0, 4, %o0
2621:
263 be 1f
264 andcc %g1, 1, %g0
265
266 EX(lduh [%o1], %g2, and %g1, 3)
267 add %o1, 2, %o1
268 EX(sth %g2, [%o0], and %g1, 3)
269 add %o0, 2, %o0
2701:
271 be 1f
272 nop
273
274 EX(ldub [%o1], %g2, add %g0, 1)
275 EX(stb %g2, [%o0], add %g0, 1)
2761:
277 retl
278 clr %o0
279
280ldd_std:
281 MOVE_BIGALIGNCHUNK(o1, o0, 0x00, o2, o3, o4, o5, g2, g3, g4, g5)
282 MOVE_BIGALIGNCHUNK(o1, o0, 0x20, o2, o3, o4, o5, g2, g3, g4, g5)
283 MOVE_BIGALIGNCHUNK(o1, o0, 0x40, o2, o3, o4, o5, g2, g3, g4, g5)
284 MOVE_BIGALIGNCHUNK(o1, o0, 0x60, o2, o3, o4, o5, g2, g3, g4, g5)
285 subcc %g7, 128, %g7
286 add %o1, 128, %o1
287 bne ldd_std
288 add %o0, 128, %o0
289
290 andcc %g1, 0x70, %g7
291 be copy_user_table_end
292 andcc %g1, 8, %g0
293
294 sethi %hi(copy_user_table_end), %o5
295 srl %g7, 1, %o4
296 add %g7, %o4, %o4
297 add %o1, %g7, %o1
298 sub %o5, %o4, %o5
299 jmpl %o5 + %lo(copy_user_table_end), %g0
300 add %o0, %g7, %o0
301
302cannot_optimize:
303 bleu short_end
304 cmp %o5, 2
305
306 bne byte_chunk
307 and %o2, 0xfffffff0, %o3
308
309 andcc %o1, 1, %g0
310 be 10f
311 nop
312
313 EXO2(ldub [%o1], %g2)
314 add %o1, 1, %o1
315 EXO2(stb %g2, [%o0])
316 sub %o2, 1, %o2
317 andcc %o2, 0xfffffff0, %o3
318 be short_end
319 add %o0, 1, %o0
32010:
321 MOVE_HALFCHUNK(o1, o0, 0x00, g2, g3, g4, g5)
322 MOVE_HALFCHUNK(o1, o0, 0x08, g2, g3, g4, g5)
323 subcc %o3, 0x10, %o3
324 add %o1, 0x10, %o1
325 bne 10b
326 add %o0, 0x10, %o0
327 b 2f
328 and %o2, 0xe, %o3
329
330byte_chunk:
331 MOVE_SHORTCHUNK(o1, o0, -0x02, g2, g3)
332 MOVE_SHORTCHUNK(o1, o0, -0x04, g2, g3)
333 MOVE_SHORTCHUNK(o1, o0, -0x06, g2, g3)
334 MOVE_SHORTCHUNK(o1, o0, -0x08, g2, g3)
335 MOVE_SHORTCHUNK(o1, o0, -0x0a, g2, g3)
336 MOVE_SHORTCHUNK(o1, o0, -0x0c, g2, g3)
337 MOVE_SHORTCHUNK(o1, o0, -0x0e, g2, g3)
338 MOVE_SHORTCHUNK(o1, o0, -0x10, g2, g3)
339 subcc %o3, 0x10, %o3
340 add %o1, 0x10, %o1
341 bne byte_chunk
342 add %o0, 0x10, %o0
343
344short_end:
345 and %o2, 0xe, %o3
3462:
347 sethi %hi(short_table_end), %o5
348 sll %o3, 3, %o4
349 add %o0, %o3, %o0
350 sub %o5, %o4, %o5
351 add %o1, %o3, %o1
352 jmpl %o5 + %lo(short_table_end), %g0
353 andcc %o2, 1, %g0
354 MOVE_LAST_SHORTCHUNK(o1, o0, 0x0c, g2, g3)
355 MOVE_LAST_SHORTCHUNK(o1, o0, 0x0a, g2, g3)
356 MOVE_LAST_SHORTCHUNK(o1, o0, 0x08, g2, g3)
357 MOVE_LAST_SHORTCHUNK(o1, o0, 0x06, g2, g3)
358 MOVE_LAST_SHORTCHUNK(o1, o0, 0x04, g2, g3)
359 MOVE_LAST_SHORTCHUNK(o1, o0, 0x02, g2, g3)
360 MOVE_LAST_SHORTCHUNK(o1, o0, 0x00, g2, g3)
361short_table_end:
362 be 1f
363 nop
364 EX(ldub [%o1], %g2, add %g0, 1)
365 EX(stb %g2, [%o0], add %g0, 1)
3661:
367 retl
368 clr %o0
369
370short_aligned_end:
371 bne short_end
372 andcc %o2, 8, %g0
373
374 be 1f
375 andcc %o2, 4, %g0
376
377 EXO2(ld [%o1 + 0x00], %g2)
378 EXO2(ld [%o1 + 0x04], %g3)
379 add %o1, 8, %o1
380 EXO2(st %g2, [%o0 + 0x00])
381 EX(st %g3, [%o0 + 0x04], sub %o2, 4)
382 add %o0, 8, %o0
3831:
384 b copy_user_last7
385 mov %o2, %g1
386
387 .section .fixup,#alloc,#execinstr
388 .align 4
38997:
390 retl
391 mov %o2, %o0
392
393 .globl __copy_user_end
394__copy_user_end:
1/* copy_user.S: Sparc optimized copy_from_user and copy_to_user code.
2 *
3 * Copyright(C) 1995 Linus Torvalds
4 * Copyright(C) 1996 David S. Miller
5 * Copyright(C) 1996 Eddie C. Dost
6 * Copyright(C) 1996,1998 Jakub Jelinek
7 *
8 * derived from:
9 * e-mail between David and Eddie.
10 *
11 * Returns 0 if successful, otherwise count of bytes not copied yet
12 */
13
14#include <asm/ptrace.h>
15#include <asm/asmmacro.h>
16#include <asm/page.h>
17#include <asm/thread_info.h>
18
19/* Work around cpp -rob */
20#define ALLOC #alloc
21#define EXECINSTR #execinstr
22#define EX(x,y,a,b) \
2398: x,y; \
24 .section .fixup,ALLOC,EXECINSTR; \
25 .align 4; \
2699: ba fixupretl; \
27 a, b, %g3; \
28 .section __ex_table,ALLOC; \
29 .align 4; \
30 .word 98b, 99b; \
31 .text; \
32 .align 4
33
34#define EX2(x,y,c,d,e,a,b) \
3598: x,y; \
36 .section .fixup,ALLOC,EXECINSTR; \
37 .align 4; \
3899: c, d, e; \
39 ba fixupretl; \
40 a, b, %g3; \
41 .section __ex_table,ALLOC; \
42 .align 4; \
43 .word 98b, 99b; \
44 .text; \
45 .align 4
46
47#define EXO2(x,y) \
4898: x, y; \
49 .section __ex_table,ALLOC; \
50 .align 4; \
51 .word 98b, 97f; \
52 .text; \
53 .align 4
54
55#define EXT(start,end,handler) \
56 .section __ex_table,ALLOC; \
57 .align 4; \
58 .word start, 0, end, handler; \
59 .text; \
60 .align 4
61
62/* Please do not change following macros unless you change logic used
63 * in .fixup at the end of this file as well
64 */
65
66/* Both these macros have to start with exactly the same insn */
67#define MOVE_BIGCHUNK(src, dst, offset, t0, t1, t2, t3, t4, t5, t6, t7) \
68 ldd [%src + (offset) + 0x00], %t0; \
69 ldd [%src + (offset) + 0x08], %t2; \
70 ldd [%src + (offset) + 0x10], %t4; \
71 ldd [%src + (offset) + 0x18], %t6; \
72 st %t0, [%dst + (offset) + 0x00]; \
73 st %t1, [%dst + (offset) + 0x04]; \
74 st %t2, [%dst + (offset) + 0x08]; \
75 st %t3, [%dst + (offset) + 0x0c]; \
76 st %t4, [%dst + (offset) + 0x10]; \
77 st %t5, [%dst + (offset) + 0x14]; \
78 st %t6, [%dst + (offset) + 0x18]; \
79 st %t7, [%dst + (offset) + 0x1c];
80
81#define MOVE_BIGALIGNCHUNK(src, dst, offset, t0, t1, t2, t3, t4, t5, t6, t7) \
82 ldd [%src + (offset) + 0x00], %t0; \
83 ldd [%src + (offset) + 0x08], %t2; \
84 ldd [%src + (offset) + 0x10], %t4; \
85 ldd [%src + (offset) + 0x18], %t6; \
86 std %t0, [%dst + (offset) + 0x00]; \
87 std %t2, [%dst + (offset) + 0x08]; \
88 std %t4, [%dst + (offset) + 0x10]; \
89 std %t6, [%dst + (offset) + 0x18];
90
91#define MOVE_LASTCHUNK(src, dst, offset, t0, t1, t2, t3) \
92 ldd [%src - (offset) - 0x10], %t0; \
93 ldd [%src - (offset) - 0x08], %t2; \
94 st %t0, [%dst - (offset) - 0x10]; \
95 st %t1, [%dst - (offset) - 0x0c]; \
96 st %t2, [%dst - (offset) - 0x08]; \
97 st %t3, [%dst - (offset) - 0x04];
98
99#define MOVE_HALFCHUNK(src, dst, offset, t0, t1, t2, t3) \
100 lduh [%src + (offset) + 0x00], %t0; \
101 lduh [%src + (offset) + 0x02], %t1; \
102 lduh [%src + (offset) + 0x04], %t2; \
103 lduh [%src + (offset) + 0x06], %t3; \
104 sth %t0, [%dst + (offset) + 0x00]; \
105 sth %t1, [%dst + (offset) + 0x02]; \
106 sth %t2, [%dst + (offset) + 0x04]; \
107 sth %t3, [%dst + (offset) + 0x06];
108
109#define MOVE_SHORTCHUNK(src, dst, offset, t0, t1) \
110 ldub [%src - (offset) - 0x02], %t0; \
111 ldub [%src - (offset) - 0x01], %t1; \
112 stb %t0, [%dst - (offset) - 0x02]; \
113 stb %t1, [%dst - (offset) - 0x01];
114
115 .text
116 .align 4
117
118 .globl __copy_user_begin
119__copy_user_begin:
120
121 .globl __copy_user
122dword_align:
123 andcc %o1, 1, %g0
124 be 4f
125 andcc %o1, 2, %g0
126
127 EXO2(ldub [%o1], %g2)
128 add %o1, 1, %o1
129 EXO2(stb %g2, [%o0])
130 sub %o2, 1, %o2
131 bne 3f
132 add %o0, 1, %o0
133
134 EXO2(lduh [%o1], %g2)
135 add %o1, 2, %o1
136 EXO2(sth %g2, [%o0])
137 sub %o2, 2, %o2
138 b 3f
139 add %o0, 2, %o0
1404:
141 EXO2(lduh [%o1], %g2)
142 add %o1, 2, %o1
143 EXO2(sth %g2, [%o0])
144 sub %o2, 2, %o2
145 b 3f
146 add %o0, 2, %o0
147
148__copy_user: /* %o0=dst %o1=src %o2=len */
149 xor %o0, %o1, %o4
1501:
151 andcc %o4, 3, %o5
1522:
153 bne cannot_optimize
154 cmp %o2, 15
155
156 bleu short_aligned_end
157 andcc %o1, 3, %g0
158
159 bne dword_align
1603:
161 andcc %o1, 4, %g0
162
163 be 2f
164 mov %o2, %g1
165
166 EXO2(ld [%o1], %o4)
167 sub %g1, 4, %g1
168 EXO2(st %o4, [%o0])
169 add %o1, 4, %o1
170 add %o0, 4, %o0
1712:
172 andcc %g1, 0xffffff80, %g7
173 be 3f
174 andcc %o0, 4, %g0
175
176 be ldd_std + 4
1775:
178 MOVE_BIGCHUNK(o1, o0, 0x00, o2, o3, o4, o5, g2, g3, g4, g5)
179 MOVE_BIGCHUNK(o1, o0, 0x20, o2, o3, o4, o5, g2, g3, g4, g5)
180 MOVE_BIGCHUNK(o1, o0, 0x40, o2, o3, o4, o5, g2, g3, g4, g5)
181 MOVE_BIGCHUNK(o1, o0, 0x60, o2, o3, o4, o5, g2, g3, g4, g5)
18280:
183 EXT(5b, 80b, 50f)
184 subcc %g7, 128, %g7
185 add %o1, 128, %o1
186 bne 5b
187 add %o0, 128, %o0
1883:
189 andcc %g1, 0x70, %g7
190 be copy_user_table_end
191 andcc %g1, 8, %g0
192
193 sethi %hi(copy_user_table_end), %o5
194 srl %g7, 1, %o4
195 add %g7, %o4, %o4
196 add %o1, %g7, %o1
197 sub %o5, %o4, %o5
198 jmpl %o5 + %lo(copy_user_table_end), %g0
199 add %o0, %g7, %o0
200
201copy_user_table:
202 MOVE_LASTCHUNK(o1, o0, 0x60, g2, g3, g4, g5)
203 MOVE_LASTCHUNK(o1, o0, 0x50, g2, g3, g4, g5)
204 MOVE_LASTCHUNK(o1, o0, 0x40, g2, g3, g4, g5)
205 MOVE_LASTCHUNK(o1, o0, 0x30, g2, g3, g4, g5)
206 MOVE_LASTCHUNK(o1, o0, 0x20, g2, g3, g4, g5)
207 MOVE_LASTCHUNK(o1, o0, 0x10, g2, g3, g4, g5)
208 MOVE_LASTCHUNK(o1, o0, 0x00, g2, g3, g4, g5)
209copy_user_table_end:
210 EXT(copy_user_table, copy_user_table_end, 51f)
211 be copy_user_last7
212 andcc %g1, 4, %g0
213
214 EX(ldd [%o1], %g2, and %g1, 0xf)
215 add %o0, 8, %o0
216 add %o1, 8, %o1
217 EX(st %g2, [%o0 - 0x08], and %g1, 0xf)
218 EX2(st %g3, [%o0 - 0x04], and %g1, 0xf, %g1, sub %g1, 4)
219copy_user_last7:
220 be 1f
221 andcc %g1, 2, %g0
222
223 EX(ld [%o1], %g2, and %g1, 7)
224 add %o1, 4, %o1
225 EX(st %g2, [%o0], and %g1, 7)
226 add %o0, 4, %o0
2271:
228 be 1f
229 andcc %g1, 1, %g0
230
231 EX(lduh [%o1], %g2, and %g1, 3)
232 add %o1, 2, %o1
233 EX(sth %g2, [%o0], and %g1, 3)
234 add %o0, 2, %o0
2351:
236 be 1f
237 nop
238
239 EX(ldub [%o1], %g2, add %g0, 1)
240 EX(stb %g2, [%o0], add %g0, 1)
2411:
242 retl
243 clr %o0
244
245ldd_std:
246 MOVE_BIGALIGNCHUNK(o1, o0, 0x00, o2, o3, o4, o5, g2, g3, g4, g5)
247 MOVE_BIGALIGNCHUNK(o1, o0, 0x20, o2, o3, o4, o5, g2, g3, g4, g5)
248 MOVE_BIGALIGNCHUNK(o1, o0, 0x40, o2, o3, o4, o5, g2, g3, g4, g5)
249 MOVE_BIGALIGNCHUNK(o1, o0, 0x60, o2, o3, o4, o5, g2, g3, g4, g5)
25081:
251 EXT(ldd_std, 81b, 52f)
252 subcc %g7, 128, %g7
253 add %o1, 128, %o1
254 bne ldd_std
255 add %o0, 128, %o0
256
257 andcc %g1, 0x70, %g7
258 be copy_user_table_end
259 andcc %g1, 8, %g0
260
261 sethi %hi(copy_user_table_end), %o5
262 srl %g7, 1, %o4
263 add %g7, %o4, %o4
264 add %o1, %g7, %o1
265 sub %o5, %o4, %o5
266 jmpl %o5 + %lo(copy_user_table_end), %g0
267 add %o0, %g7, %o0
268
269cannot_optimize:
270 bleu short_end
271 cmp %o5, 2
272
273 bne byte_chunk
274 and %o2, 0xfffffff0, %o3
275
276 andcc %o1, 1, %g0
277 be 10f
278 nop
279
280 EXO2(ldub [%o1], %g2)
281 add %o1, 1, %o1
282 EXO2(stb %g2, [%o0])
283 sub %o2, 1, %o2
284 andcc %o2, 0xfffffff0, %o3
285 be short_end
286 add %o0, 1, %o0
28710:
288 MOVE_HALFCHUNK(o1, o0, 0x00, g2, g3, g4, g5)
289 MOVE_HALFCHUNK(o1, o0, 0x08, g2, g3, g4, g5)
29082:
291 EXT(10b, 82b, 53f)
292 subcc %o3, 0x10, %o3
293 add %o1, 0x10, %o1
294 bne 10b
295 add %o0, 0x10, %o0
296 b 2f
297 and %o2, 0xe, %o3
298
299byte_chunk:
300 MOVE_SHORTCHUNK(o1, o0, -0x02, g2, g3)
301 MOVE_SHORTCHUNK(o1, o0, -0x04, g2, g3)
302 MOVE_SHORTCHUNK(o1, o0, -0x06, g2, g3)
303 MOVE_SHORTCHUNK(o1, o0, -0x08, g2, g3)
304 MOVE_SHORTCHUNK(o1, o0, -0x0a, g2, g3)
305 MOVE_SHORTCHUNK(o1, o0, -0x0c, g2, g3)
306 MOVE_SHORTCHUNK(o1, o0, -0x0e, g2, g3)
307 MOVE_SHORTCHUNK(o1, o0, -0x10, g2, g3)
30883:
309 EXT(byte_chunk, 83b, 54f)
310 subcc %o3, 0x10, %o3
311 add %o1, 0x10, %o1
312 bne byte_chunk
313 add %o0, 0x10, %o0
314
315short_end:
316 and %o2, 0xe, %o3
3172:
318 sethi %hi(short_table_end), %o5
319 sll %o3, 3, %o4
320 add %o0, %o3, %o0
321 sub %o5, %o4, %o5
322 add %o1, %o3, %o1
323 jmpl %o5 + %lo(short_table_end), %g0
324 andcc %o2, 1, %g0
32584:
326 MOVE_SHORTCHUNK(o1, o0, 0x0c, g2, g3)
327 MOVE_SHORTCHUNK(o1, o0, 0x0a, g2, g3)
328 MOVE_SHORTCHUNK(o1, o0, 0x08, g2, g3)
329 MOVE_SHORTCHUNK(o1, o0, 0x06, g2, g3)
330 MOVE_SHORTCHUNK(o1, o0, 0x04, g2, g3)
331 MOVE_SHORTCHUNK(o1, o0, 0x02, g2, g3)
332 MOVE_SHORTCHUNK(o1, o0, 0x00, g2, g3)
333short_table_end:
334 EXT(84b, short_table_end, 55f)
335 be 1f
336 nop
337 EX(ldub [%o1], %g2, add %g0, 1)
338 EX(stb %g2, [%o0], add %g0, 1)
3391:
340 retl
341 clr %o0
342
343short_aligned_end:
344 bne short_end
345 andcc %o2, 8, %g0
346
347 be 1f
348 andcc %o2, 4, %g0
349
350 EXO2(ld [%o1 + 0x00], %g2)
351 EXO2(ld [%o1 + 0x04], %g3)
352 add %o1, 8, %o1
353 EXO2(st %g2, [%o0 + 0x00])
354 EX(st %g3, [%o0 + 0x04], sub %o2, 4)
355 add %o0, 8, %o0
3561:
357 b copy_user_last7
358 mov %o2, %g1
359
360 .section .fixup,#alloc,#execinstr
361 .align 4
36297:
363 mov %o2, %g3
364fixupretl:
365 sethi %hi(PAGE_OFFSET), %g1
366 cmp %o0, %g1
367 blu 1f
368 cmp %o1, %g1
369 bgeu 1f
370 ld [%g6 + TI_PREEMPT], %g1
371 cmp %g1, 0
372 bne 1f
373 nop
374 save %sp, -64, %sp
375 mov %i0, %o0
376 call __bzero
377 mov %g3, %o1
378 restore
3791: retl
380 mov %g3, %o0
381
382/* exception routine sets %g2 to (broken_insn - first_insn)>>2 */
38350:
384/* This magic counts how many bytes are left when crash in MOVE_BIGCHUNK
385 * happens. This is derived from the amount ldd reads, st stores, etc.
386 * x = g2 % 12;
387 * g3 = g1 + g7 - ((g2 / 12) * 32 + (x < 4) ? 0 : (x - 4) * 4);
388 * o0 += (g2 / 12) * 32;
389 */
390 cmp %g2, 12
391 add %o0, %g7, %o0
392 bcs 1f
393 cmp %g2, 24
394 bcs 2f
395 cmp %g2, 36
396 bcs 3f
397 nop
398 sub %g2, 12, %g2
399 sub %g7, 32, %g7
4003: sub %g2, 12, %g2
401 sub %g7, 32, %g7
4022: sub %g2, 12, %g2
403 sub %g7, 32, %g7
4041: cmp %g2, 4
405 bcs,a 60f
406 clr %g2
407 sub %g2, 4, %g2
408 sll %g2, 2, %g2
40960: and %g1, 0x7f, %g3
410 sub %o0, %g7, %o0
411 add %g3, %g7, %g3
412 ba fixupretl
413 sub %g3, %g2, %g3
41451:
415/* i = 41 - g2; j = i % 6;
416 * g3 = (g1 & 15) + (i / 6) * 16 + (j < 4) ? (j + 1) * 4 : 16;
417 * o0 -= (i / 6) * 16 + 16;
418 */
419 neg %g2
420 and %g1, 0xf, %g1
421 add %g2, 41, %g2
422 add %o0, %g1, %o0
4231: cmp %g2, 6
424 bcs,a 2f
425 cmp %g2, 4
426 add %g1, 16, %g1
427 b 1b
428 sub %g2, 6, %g2
4292: bcc,a 2f
430 mov 16, %g2
431 inc %g2
432 sll %g2, 2, %g2
4332: add %g1, %g2, %g3
434 ba fixupretl
435 sub %o0, %g3, %o0
43652:
437/* g3 = g1 + g7 - (g2 / 8) * 32 + (g2 & 4) ? (g2 & 3) * 8 : 0;
438 o0 += (g2 / 8) * 32 */
439 andn %g2, 7, %g4
440 add %o0, %g7, %o0
441 andcc %g2, 4, %g0
442 and %g2, 3, %g2
443 sll %g4, 2, %g4
444 sll %g2, 3, %g2
445 bne 60b
446 sub %g7, %g4, %g7
447 ba 60b
448 clr %g2
44953:
450/* g3 = o3 + (o2 & 15) - (g2 & 8) - (g2 & 4) ? (g2 & 3) * 2 : 0;
451 o0 += (g2 & 8) */
452 and %g2, 3, %g4
453 andcc %g2, 4, %g0
454 and %g2, 8, %g2
455 sll %g4, 1, %g4
456 be 1f
457 add %o0, %g2, %o0
458 add %g2, %g4, %g2
4591: and %o2, 0xf, %g3
460 add %g3, %o3, %g3
461 ba fixupretl
462 sub %g3, %g2, %g3
46354:
464/* g3 = o3 + (o2 & 15) - (g2 / 4) * 2 - (g2 & 2) ? (g2 & 1) : 0;
465 o0 += (g2 / 4) * 2 */
466 srl %g2, 2, %o4
467 and %g2, 1, %o5
468 srl %g2, 1, %g2
469 add %o4, %o4, %o4
470 and %o5, %g2, %o5
471 and %o2, 0xf, %o2
472 add %o0, %o4, %o0
473 sub %o3, %o5, %o3
474 sub %o2, %o4, %o2
475 ba fixupretl
476 add %o2, %o3, %g3
47755:
478/* i = 27 - g2;
479 g3 = (o2 & 1) + i / 4 * 2 + !(i & 3);
480 o0 -= i / 4 * 2 + 1 */
481 neg %g2
482 and %o2, 1, %o2
483 add %g2, 27, %g2
484 srl %g2, 2, %o5
485 andcc %g2, 3, %g0
486 mov 1, %g2
487 add %o5, %o5, %o5
488 be,a 1f
489 clr %g2
4901: add %g2, %o5, %g3
491 sub %o0, %g3, %o0
492 ba fixupretl
493 add %g3, %o2, %g3
494
495 .globl __copy_user_end
496__copy_user_end: