forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
462 lines
8.7 KiB
462 lines
8.7 KiB
/* SPDX-License-Identifier: GPL-2.0 */ |
|
/* memcpy.S: Sparc optimized memcpy and memmove code |
|
* Hand optimized from GNU libc's memcpy and memmove |
|
* Copyright (C) 1991,1996 Free Software Foundation |
|
* Copyright (C) 1995 Linus Torvalds (Linus.Torvalds@helsinki.fi) |
|
* Copyright (C) 1996 David S. Miller (davem@caip.rutgers.edu) |
|
* Copyright (C) 1996 Eddie C. Dost (ecd@skynet.be) |
|
* Copyright (C) 1996 Jakub Jelinek (jj@sunsite.mff.cuni.cz) |
|
*/ |
|
|
|
#include <asm/export.h> |
|
#define FUNC(x) \ |
|
.globl x; \ |
|
.type x,@function; \ |
|
.align 4; \ |
|
x: |
|
|
|
/* Both these macros have to start with exactly the same insn */ |
|
#define MOVE_BIGCHUNK(src, dst, offset, t0, t1, t2, t3, t4, t5, t6, t7) \ |
|
ldd [%src + (offset) + 0x00], %t0; \ |
|
ldd [%src + (offset) + 0x08], %t2; \ |
|
ldd [%src + (offset) + 0x10], %t4; \ |
|
ldd [%src + (offset) + 0x18], %t6; \ |
|
st %t0, [%dst + (offset) + 0x00]; \ |
|
st %t1, [%dst + (offset) + 0x04]; \ |
|
st %t2, [%dst + (offset) + 0x08]; \ |
|
st %t3, [%dst + (offset) + 0x0c]; \ |
|
st %t4, [%dst + (offset) + 0x10]; \ |
|
st %t5, [%dst + (offset) + 0x14]; \ |
|
st %t6, [%dst + (offset) + 0x18]; \ |
|
st %t7, [%dst + (offset) + 0x1c]; |
|
|
|
#define MOVE_BIGALIGNCHUNK(src, dst, offset, t0, t1, t2, t3, t4, t5, t6, t7) \ |
|
ldd [%src + (offset) + 0x00], %t0; \ |
|
ldd [%src + (offset) + 0x08], %t2; \ |
|
ldd [%src + (offset) + 0x10], %t4; \ |
|
ldd [%src + (offset) + 0x18], %t6; \ |
|
std %t0, [%dst + (offset) + 0x00]; \ |
|
std %t2, [%dst + (offset) + 0x08]; \ |
|
std %t4, [%dst + (offset) + 0x10]; \ |
|
std %t6, [%dst + (offset) + 0x18]; |
|
|
|
#define MOVE_LASTCHUNK(src, dst, offset, t0, t1, t2, t3) \ |
|
ldd [%src - (offset) - 0x10], %t0; \ |
|
ldd [%src - (offset) - 0x08], %t2; \ |
|
st %t0, [%dst - (offset) - 0x10]; \ |
|
st %t1, [%dst - (offset) - 0x0c]; \ |
|
st %t2, [%dst - (offset) - 0x08]; \ |
|
st %t3, [%dst - (offset) - 0x04]; |
|
|
|
#define MOVE_LASTALIGNCHUNK(src, dst, offset, t0, t1, t2, t3) \ |
|
ldd [%src - (offset) - 0x10], %t0; \ |
|
ldd [%src - (offset) - 0x08], %t2; \ |
|
std %t0, [%dst - (offset) - 0x10]; \ |
|
std %t2, [%dst - (offset) - 0x08]; |
|
|
|
#define MOVE_SHORTCHUNK(src, dst, offset, t0, t1) \ |
|
ldub [%src - (offset) - 0x02], %t0; \ |
|
ldub [%src - (offset) - 0x01], %t1; \ |
|
stb %t0, [%dst - (offset) - 0x02]; \ |
|
stb %t1, [%dst - (offset) - 0x01]; |
|
|
|
.text |
|
.align 4 |
|
|
|
FUNC(memmove) |
|
EXPORT_SYMBOL(memmove) |
|
cmp %o0, %o1 |
|
mov %o0, %g7 |
|
bleu 9f |
|
sub %o0, %o1, %o4 |
|
|
|
add %o1, %o2, %o3 |
|
cmp %o3, %o0 |
|
bleu 0f |
|
andcc %o4, 3, %o5 |
|
|
|
add %o1, %o2, %o1 |
|
add %o0, %o2, %o0 |
|
sub %o1, 1, %o1 |
|
sub %o0, 1, %o0 |
|
|
|
1: /* reverse_bytes */ |
|
|
|
ldub [%o1], %o4 |
|
subcc %o2, 1, %o2 |
|
stb %o4, [%o0] |
|
sub %o1, 1, %o1 |
|
bne 1b |
|
sub %o0, 1, %o0 |
|
|
|
retl |
|
mov %g7, %o0 |
|
|
|
/* NOTE: This code is executed just for the cases, |
|
where %src (=%o1) & 3 is != 0. |
|
We need to align it to 4. So, for (%src & 3) |
|
1 we need to do ldub,lduh |
|
2 lduh |
|
3 just ldub |
|
so even if it looks weird, the branches |
|
are correct here. -jj |
|
*/ |
|
78: /* dword_align */ |
|
|
|
andcc %o1, 1, %g0 |
|
be 4f |
|
andcc %o1, 2, %g0 |
|
|
|
ldub [%o1], %g2 |
|
add %o1, 1, %o1 |
|
stb %g2, [%o0] |
|
sub %o2, 1, %o2 |
|
bne 3f |
|
add %o0, 1, %o0 |
|
4: |
|
lduh [%o1], %g2 |
|
add %o1, 2, %o1 |
|
sth %g2, [%o0] |
|
sub %o2, 2, %o2 |
|
b 3f |
|
add %o0, 2, %o0 |
|
|
|
FUNC(memcpy) /* %o0=dst %o1=src %o2=len */ |
|
EXPORT_SYMBOL(memcpy) |
|
|
|
sub %o0, %o1, %o4 |
|
mov %o0, %g7 |
|
9: |
|
andcc %o4, 3, %o5 |
|
0: |
|
bne 86f |
|
cmp %o2, 15 |
|
|
|
bleu 90f |
|
andcc %o1, 3, %g0 |
|
|
|
bne 78b |
|
3: |
|
andcc %o1, 4, %g0 |
|
|
|
be 2f |
|
mov %o2, %g1 |
|
|
|
ld [%o1], %o4 |
|
sub %g1, 4, %g1 |
|
st %o4, [%o0] |
|
add %o1, 4, %o1 |
|
add %o0, 4, %o0 |
|
2: |
|
andcc %g1, 0xffffff80, %g0 |
|
be 3f |
|
andcc %o0, 4, %g0 |
|
|
|
be 82f + 4 |
|
5: |
|
MOVE_BIGCHUNK(o1, o0, 0x00, o2, o3, o4, o5, g2, g3, g4, g5) |
|
MOVE_BIGCHUNK(o1, o0, 0x20, o2, o3, o4, o5, g2, g3, g4, g5) |
|
MOVE_BIGCHUNK(o1, o0, 0x40, o2, o3, o4, o5, g2, g3, g4, g5) |
|
MOVE_BIGCHUNK(o1, o0, 0x60, o2, o3, o4, o5, g2, g3, g4, g5) |
|
sub %g1, 128, %g1 |
|
add %o1, 128, %o1 |
|
cmp %g1, 128 |
|
bge 5b |
|
add %o0, 128, %o0 |
|
3: |
|
andcc %g1, 0x70, %g4 |
|
be 80f |
|
andcc %g1, 8, %g0 |
|
|
|
sethi %hi(80f), %o5 |
|
srl %g4, 1, %o4 |
|
add %g4, %o4, %o4 |
|
add %o1, %g4, %o1 |
|
sub %o5, %o4, %o5 |
|
jmpl %o5 + %lo(80f), %g0 |
|
add %o0, %g4, %o0 |
|
|
|
79: /* memcpy_table */ |
|
|
|
MOVE_LASTCHUNK(o1, o0, 0x60, g2, g3, g4, g5) |
|
MOVE_LASTCHUNK(o1, o0, 0x50, g2, g3, g4, g5) |
|
MOVE_LASTCHUNK(o1, o0, 0x40, g2, g3, g4, g5) |
|
MOVE_LASTCHUNK(o1, o0, 0x30, g2, g3, g4, g5) |
|
MOVE_LASTCHUNK(o1, o0, 0x20, g2, g3, g4, g5) |
|
MOVE_LASTCHUNK(o1, o0, 0x10, g2, g3, g4, g5) |
|
MOVE_LASTCHUNK(o1, o0, 0x00, g2, g3, g4, g5) |
|
|
|
80: /* memcpy_table_end */ |
|
be 81f |
|
andcc %g1, 4, %g0 |
|
|
|
ldd [%o1], %g2 |
|
add %o0, 8, %o0 |
|
st %g2, [%o0 - 0x08] |
|
add %o1, 8, %o1 |
|
st %g3, [%o0 - 0x04] |
|
|
|
81: /* memcpy_last7 */ |
|
|
|
be 1f |
|
andcc %g1, 2, %g0 |
|
|
|
ld [%o1], %g2 |
|
add %o1, 4, %o1 |
|
st %g2, [%o0] |
|
add %o0, 4, %o0 |
|
1: |
|
be 1f |
|
andcc %g1, 1, %g0 |
|
|
|
lduh [%o1], %g2 |
|
add %o1, 2, %o1 |
|
sth %g2, [%o0] |
|
add %o0, 2, %o0 |
|
1: |
|
be 1f |
|
nop |
|
|
|
ldub [%o1], %g2 |
|
stb %g2, [%o0] |
|
1: |
|
retl |
|
mov %g7, %o0 |
|
|
|
82: /* ldd_std */ |
|
MOVE_BIGALIGNCHUNK(o1, o0, 0x00, o2, o3, o4, o5, g2, g3, g4, g5) |
|
MOVE_BIGALIGNCHUNK(o1, o0, 0x20, o2, o3, o4, o5, g2, g3, g4, g5) |
|
MOVE_BIGALIGNCHUNK(o1, o0, 0x40, o2, o3, o4, o5, g2, g3, g4, g5) |
|
MOVE_BIGALIGNCHUNK(o1, o0, 0x60, o2, o3, o4, o5, g2, g3, g4, g5) |
|
subcc %g1, 128, %g1 |
|
add %o1, 128, %o1 |
|
cmp %g1, 128 |
|
bge 82b |
|
add %o0, 128, %o0 |
|
|
|
andcc %g1, 0x70, %g4 |
|
be 84f |
|
andcc %g1, 8, %g0 |
|
|
|
sethi %hi(84f), %o5 |
|
add %o1, %g4, %o1 |
|
sub %o5, %g4, %o5 |
|
jmpl %o5 + %lo(84f), %g0 |
|
add %o0, %g4, %o0 |
|
|
|
83: /* amemcpy_table */ |
|
|
|
MOVE_LASTALIGNCHUNK(o1, o0, 0x60, g2, g3, g4, g5) |
|
MOVE_LASTALIGNCHUNK(o1, o0, 0x50, g2, g3, g4, g5) |
|
MOVE_LASTALIGNCHUNK(o1, o0, 0x40, g2, g3, g4, g5) |
|
MOVE_LASTALIGNCHUNK(o1, o0, 0x30, g2, g3, g4, g5) |
|
MOVE_LASTALIGNCHUNK(o1, o0, 0x20, g2, g3, g4, g5) |
|
MOVE_LASTALIGNCHUNK(o1, o0, 0x10, g2, g3, g4, g5) |
|
MOVE_LASTALIGNCHUNK(o1, o0, 0x00, g2, g3, g4, g5) |
|
|
|
84: /* amemcpy_table_end */ |
|
be 85f |
|
andcc %g1, 4, %g0 |
|
|
|
ldd [%o1], %g2 |
|
add %o0, 8, %o0 |
|
std %g2, [%o0 - 0x08] |
|
add %o1, 8, %o1 |
|
85: /* amemcpy_last7 */ |
|
be 1f |
|
andcc %g1, 2, %g0 |
|
|
|
ld [%o1], %g2 |
|
add %o1, 4, %o1 |
|
st %g2, [%o0] |
|
add %o0, 4, %o0 |
|
1: |
|
be 1f |
|
andcc %g1, 1, %g0 |
|
|
|
lduh [%o1], %g2 |
|
add %o1, 2, %o1 |
|
sth %g2, [%o0] |
|
add %o0, 2, %o0 |
|
1: |
|
be 1f |
|
nop |
|
|
|
ldub [%o1], %g2 |
|
stb %g2, [%o0] |
|
1: |
|
retl |
|
mov %g7, %o0 |
|
|
|
86: /* non_aligned */ |
|
cmp %o2, 6 |
|
bleu 88f |
|
nop |
|
|
|
save %sp, -96, %sp |
|
andcc %i0, 3, %g0 |
|
be 61f |
|
andcc %i0, 1, %g0 |
|
be 60f |
|
andcc %i0, 2, %g0 |
|
|
|
ldub [%i1], %g5 |
|
add %i1, 1, %i1 |
|
stb %g5, [%i0] |
|
sub %i2, 1, %i2 |
|
bne 61f |
|
add %i0, 1, %i0 |
|
60: |
|
ldub [%i1], %g3 |
|
add %i1, 2, %i1 |
|
stb %g3, [%i0] |
|
sub %i2, 2, %i2 |
|
ldub [%i1 - 1], %g3 |
|
add %i0, 2, %i0 |
|
stb %g3, [%i0 - 1] |
|
61: |
|
and %i1, 3, %g2 |
|
and %i2, 0xc, %g3 |
|
and %i1, -4, %i1 |
|
cmp %g3, 4 |
|
sll %g2, 3, %g4 |
|
mov 32, %g2 |
|
be 4f |
|
sub %g2, %g4, %l0 |
|
|
|
blu 3f |
|
cmp %g3, 0x8 |
|
|
|
be 2f |
|
srl %i2, 2, %g3 |
|
|
|
ld [%i1], %i3 |
|
add %i0, -8, %i0 |
|
ld [%i1 + 4], %i4 |
|
b 8f |
|
add %g3, 1, %g3 |
|
2: |
|
ld [%i1], %i4 |
|
add %i0, -12, %i0 |
|
ld [%i1 + 4], %i5 |
|
add %g3, 2, %g3 |
|
b 9f |
|
add %i1, -4, %i1 |
|
3: |
|
ld [%i1], %g1 |
|
add %i0, -4, %i0 |
|
ld [%i1 + 4], %i3 |
|
srl %i2, 2, %g3 |
|
b 7f |
|
add %i1, 4, %i1 |
|
4: |
|
ld [%i1], %i5 |
|
cmp %i2, 7 |
|
ld [%i1 + 4], %g1 |
|
srl %i2, 2, %g3 |
|
bleu 10f |
|
add %i1, 8, %i1 |
|
|
|
ld [%i1], %i3 |
|
add %g3, -1, %g3 |
|
5: |
|
sll %i5, %g4, %g2 |
|
srl %g1, %l0, %g5 |
|
or %g2, %g5, %g2 |
|
st %g2, [%i0] |
|
7: |
|
ld [%i1 + 4], %i4 |
|
sll %g1, %g4, %g2 |
|
srl %i3, %l0, %g5 |
|
or %g2, %g5, %g2 |
|
st %g2, [%i0 + 4] |
|
8: |
|
ld [%i1 + 8], %i5 |
|
sll %i3, %g4, %g2 |
|
srl %i4, %l0, %g5 |
|
or %g2, %g5, %g2 |
|
st %g2, [%i0 + 8] |
|
9: |
|
ld [%i1 + 12], %g1 |
|
sll %i4, %g4, %g2 |
|
srl %i5, %l0, %g5 |
|
addcc %g3, -4, %g3 |
|
or %g2, %g5, %g2 |
|
add %i1, 16, %i1 |
|
st %g2, [%i0 + 12] |
|
add %i0, 16, %i0 |
|
bne,a 5b |
|
ld [%i1], %i3 |
|
10: |
|
sll %i5, %g4, %g2 |
|
srl %g1, %l0, %g5 |
|
srl %l0, 3, %g3 |
|
or %g2, %g5, %g2 |
|
sub %i1, %g3, %i1 |
|
andcc %i2, 2, %g0 |
|
st %g2, [%i0] |
|
be 1f |
|
andcc %i2, 1, %g0 |
|
|
|
ldub [%i1], %g2 |
|
add %i1, 2, %i1 |
|
stb %g2, [%i0 + 4] |
|
add %i0, 2, %i0 |
|
ldub [%i1 - 1], %g2 |
|
stb %g2, [%i0 + 3] |
|
1: |
|
be 1f |
|
nop |
|
ldub [%i1], %g2 |
|
stb %g2, [%i0 + 4] |
|
1: |
|
ret |
|
restore %g7, %g0, %o0 |
|
|
|
88: /* short_end */ |
|
|
|
and %o2, 0xe, %o3 |
|
20: |
|
sethi %hi(89f), %o5 |
|
sll %o3, 3, %o4 |
|
add %o0, %o3, %o0 |
|
sub %o5, %o4, %o5 |
|
add %o1, %o3, %o1 |
|
jmpl %o5 + %lo(89f), %g0 |
|
andcc %o2, 1, %g0 |
|
|
|
MOVE_SHORTCHUNK(o1, o0, 0x0c, g2, g3) |
|
MOVE_SHORTCHUNK(o1, o0, 0x0a, g2, g3) |
|
MOVE_SHORTCHUNK(o1, o0, 0x08, g2, g3) |
|
MOVE_SHORTCHUNK(o1, o0, 0x06, g2, g3) |
|
MOVE_SHORTCHUNK(o1, o0, 0x04, g2, g3) |
|
MOVE_SHORTCHUNK(o1, o0, 0x02, g2, g3) |
|
MOVE_SHORTCHUNK(o1, o0, 0x00, g2, g3) |
|
|
|
89: /* short_table_end */ |
|
|
|
be 1f |
|
nop |
|
|
|
ldub [%o1], %g2 |
|
stb %g2, [%o0] |
|
1: |
|
retl |
|
mov %g7, %o0 |
|
|
|
90: /* short_aligned_end */ |
|
bne 88b |
|
andcc %o2, 8, %g0 |
|
|
|
be 1f |
|
andcc %o2, 4, %g0 |
|
|
|
ld [%o1 + 0x00], %g2 |
|
ld [%o1 + 0x04], %g3 |
|
add %o1, 8, %o1 |
|
st %g2, [%o0 + 0x00] |
|
st %g3, [%o0 + 0x04] |
|
add %o0, 8, %o0 |
|
1: |
|
b 81b |
|
mov %o2, %g1
|
|
|