1151 lines
22 KiB
ArmAsm
1151 lines
22 KiB
ArmAsm
/* 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)
|
|
*/
|
|
|
|
#ifdef __KERNEL__
|
|
|
|
#define FUNC(x) \
|
|
.globl x; \
|
|
.type x,@function; \
|
|
.align 4; \
|
|
x:
|
|
|
|
#undef FASTER_REVERSE
|
|
#undef FASTER_NONALIGNED
|
|
#define FASTER_ALIGNED
|
|
|
|
/* In kernel these functions don't return a value.
|
|
* One should use macros in asm/string.h for that purpose.
|
|
* We return 0, so that bugs are more apparent.
|
|
*/
|
|
#define SETUP_RETL
|
|
#define RETL_INSN clr %o0
|
|
|
|
#else
|
|
|
|
/* libc */
|
|
|
|
#include "DEFS.h"
|
|
|
|
#define FASTER_REVERSE
|
|
#define FASTER_NONALIGNED
|
|
#define FASTER_ALIGNED
|
|
|
|
#define SETUP_RETL mov %o0, %g6
|
|
#define RETL_INSN mov %g6, %o0
|
|
|
|
#endif
|
|
|
|
/* 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];
|
|
|
|
/* Both these macros have to start with exactly the same insn */
|
|
#define RMOVE_BIGCHUNK(src, dst, offset, t0, t1, t2, t3, t4, t5, t6, t7) \
|
|
ldd [%src - (offset) - 0x20], %t0; \
|
|
ldd [%src - (offset) - 0x18], %t2; \
|
|
ldd [%src - (offset) - 0x10], %t4; \
|
|
ldd [%src - (offset) - 0x08], %t6; \
|
|
st %t0, [%dst - (offset) - 0x20]; \
|
|
st %t1, [%dst - (offset) - 0x1c]; \
|
|
st %t2, [%dst - (offset) - 0x18]; \
|
|
st %t3, [%dst - (offset) - 0x14]; \
|
|
st %t4, [%dst - (offset) - 0x10]; \
|
|
st %t5, [%dst - (offset) - 0x0c]; \
|
|
st %t6, [%dst - (offset) - 0x08]; \
|
|
st %t7, [%dst - (offset) - 0x04];
|
|
|
|
#define RMOVE_BIGALIGNCHUNK(src, dst, offset, t0, t1, t2, t3, t4, t5, t6, t7) \
|
|
ldd [%src - (offset) - 0x20], %t0; \
|
|
ldd [%src - (offset) - 0x18], %t2; \
|
|
ldd [%src - (offset) - 0x10], %t4; \
|
|
ldd [%src - (offset) - 0x08], %t6; \
|
|
std %t0, [%dst - (offset) - 0x20]; \
|
|
std %t2, [%dst - (offset) - 0x18]; \
|
|
std %t4, [%dst - (offset) - 0x10]; \
|
|
std %t6, [%dst - (offset) - 0x08];
|
|
|
|
#define RMOVE_LASTCHUNK(src, dst, offset, t0, t1, t2, t3) \
|
|
ldd [%src + (offset) + 0x00], %t0; \
|
|
ldd [%src + (offset) + 0x08], %t2; \
|
|
st %t0, [%dst + (offset) + 0x00]; \
|
|
st %t1, [%dst + (offset) + 0x04]; \
|
|
st %t2, [%dst + (offset) + 0x08]; \
|
|
st %t3, [%dst + (offset) + 0x0c];
|
|
|
|
#define RMOVE_SHORTCHUNK(src, dst, offset, t0, t1) \
|
|
ldub [%src + (offset) + 0x00], %t0; \
|
|
ldub [%src + (offset) + 0x01], %t1; \
|
|
stb %t0, [%dst + (offset) + 0x00]; \
|
|
stb %t1, [%dst + (offset) + 0x01];
|
|
|
|
#define SMOVE_CHUNK(src, dst, offset, t0, t1, t2, t3, t4, t5, t6, prev, shil, shir, offset2) \
|
|
ldd [%src + (offset) + 0x00], %t0; \
|
|
ldd [%src + (offset) + 0x08], %t2; \
|
|
srl %t0, shir, %t5; \
|
|
srl %t1, shir, %t6; \
|
|
sll %t0, shil, %t0; \
|
|
or %t5, %prev, %t5; \
|
|
sll %t1, shil, %prev; \
|
|
or %t6, %t0, %t0; \
|
|
srl %t2, shir, %t1; \
|
|
srl %t3, shir, %t6; \
|
|
sll %t2, shil, %t2; \
|
|
or %t1, %prev, %t1; \
|
|
std %t4, [%dst + (offset) + (offset2) - 0x04]; \
|
|
std %t0, [%dst + (offset) + (offset2) + 0x04]; \
|
|
sll %t3, shil, %prev; \
|
|
or %t6, %t2, %t4;
|
|
|
|
#define SMOVE_ALIGNCHUNK(src, dst, offset, t0, t1, t2, t3, t4, t5, t6, prev, shil, shir, offset2) \
|
|
ldd [%src + (offset) + 0x00], %t0; \
|
|
ldd [%src + (offset) + 0x08], %t2; \
|
|
srl %t0, shir, %t4; \
|
|
srl %t1, shir, %t5; \
|
|
sll %t0, shil, %t6; \
|
|
or %t4, %prev, %t0; \
|
|
sll %t1, shil, %prev; \
|
|
or %t5, %t6, %t1; \
|
|
srl %t2, shir, %t4; \
|
|
srl %t3, shir, %t5; \
|
|
sll %t2, shil, %t6; \
|
|
or %t4, %prev, %t2; \
|
|
sll %t3, shil, %prev; \
|
|
or %t5, %t6, %t3; \
|
|
std %t0, [%dst + (offset) + (offset2) + 0x00]; \
|
|
std %t2, [%dst + (offset) + (offset2) + 0x08];
|
|
|
|
.text
|
|
.align 4
|
|
|
|
#ifdef FASTER_REVERSE
|
|
|
|
70: /* rdword_align */
|
|
|
|
andcc %o1, 1, %g0
|
|
be 4f
|
|
andcc %o1, 2, %g0
|
|
|
|
ldub [%o1 - 1], %g2
|
|
sub %o1, 1, %o1
|
|
stb %g2, [%o0 - 1]
|
|
sub %o2, 1, %o2
|
|
be 3f
|
|
sub %o0, 1, %o0
|
|
4:
|
|
lduh [%o1 - 2], %g2
|
|
sub %o1, 2, %o1
|
|
sth %g2, [%o0 - 2]
|
|
sub %o2, 2, %o2
|
|
b 3f
|
|
sub %o0, 2, %o0
|
|
|
|
#endif /* FASTER_REVERSE */
|
|
|
|
0:
|
|
retl
|
|
nop ! Only bcopy returns here and it retuns void...
|
|
|
|
#ifdef __KERNEL__
|
|
FUNC(amemmove)
|
|
FUNC(__memmove)
|
|
#endif
|
|
FUNC(memmove)
|
|
cmp %o0, %o1
|
|
SETUP_RETL
|
|
bleu 9f
|
|
sub %o0, %o1, %o4
|
|
|
|
add %o1, %o2, %o3
|
|
cmp %o3, %o0
|
|
bleu 0f
|
|
andcc %o4, 3, %o5
|
|
|
|
#ifndef FASTER_REVERSE
|
|
|
|
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
|
|
RETL_INSN
|
|
|
|
#else /* FASTER_REVERSE */
|
|
|
|
add %o1, %o2, %o1
|
|
add %o0, %o2, %o0
|
|
bne 77f
|
|
cmp %o2, 15
|
|
bleu 91f
|
|
andcc %o1, 3, %g0
|
|
bne 70b
|
|
3:
|
|
andcc %o1, 4, %g0
|
|
|
|
be 2f
|
|
mov %o2, %g1
|
|
|
|
ld [%o1 - 4], %o4
|
|
sub %g1, 4, %g1
|
|
st %o4, [%o0 - 4]
|
|
sub %o1, 4, %o1
|
|
sub %o0, 4, %o0
|
|
2:
|
|
andcc %g1, 0xffffff80, %g7
|
|
be 3f
|
|
andcc %o0, 4, %g0
|
|
|
|
be 74f + 4
|
|
5:
|
|
RMOVE_BIGCHUNK(o1, o0, 0x00, o2, o3, o4, o5, g2, g3, g4, g5)
|
|
RMOVE_BIGCHUNK(o1, o0, 0x20, o2, o3, o4, o5, g2, g3, g4, g5)
|
|
RMOVE_BIGCHUNK(o1, o0, 0x40, o2, o3, o4, o5, g2, g3, g4, g5)
|
|
RMOVE_BIGCHUNK(o1, o0, 0x60, o2, o3, o4, o5, g2, g3, g4, g5)
|
|
subcc %g7, 128, %g7
|
|
sub %o1, 128, %o1
|
|
bne 5b
|
|
sub %o0, 128, %o0
|
|
3:
|
|
andcc %g1, 0x70, %g7
|
|
be 72f
|
|
andcc %g1, 8, %g0
|
|
|
|
sethi %hi(72f), %o5
|
|
srl %g7, 1, %o4
|
|
add %g7, %o4, %o4
|
|
sub %o1, %g7, %o1
|
|
sub %o5, %o4, %o5
|
|
jmpl %o5 + %lo(72f), %g0
|
|
sub %o0, %g7, %o0
|
|
|
|
71: /* rmemcpy_table */
|
|
RMOVE_LASTCHUNK(o1, o0, 0x60, g2, g3, g4, g5)
|
|
RMOVE_LASTCHUNK(o1, o0, 0x50, g2, g3, g4, g5)
|
|
RMOVE_LASTCHUNK(o1, o0, 0x40, g2, g3, g4, g5)
|
|
RMOVE_LASTCHUNK(o1, o0, 0x30, g2, g3, g4, g5)
|
|
RMOVE_LASTCHUNK(o1, o0, 0x20, g2, g3, g4, g5)
|
|
RMOVE_LASTCHUNK(o1, o0, 0x10, g2, g3, g4, g5)
|
|
RMOVE_LASTCHUNK(o1, o0, 0x00, g2, g3, g4, g5)
|
|
|
|
72: /* rmemcpy_table_end */
|
|
|
|
be 73f
|
|
andcc %g1, 4, %g0
|
|
|
|
ldd [%o1 - 0x08], %g2
|
|
sub %o0, 8, %o0
|
|
sub %o1, 8, %o1
|
|
st %g2, [%o0]
|
|
st %g3, [%o0 + 0x04]
|
|
|
|
73: /* rmemcpy_last7 */
|
|
|
|
be 1f
|
|
andcc %g1, 2, %g0
|
|
|
|
ld [%o1 - 4], %g2
|
|
sub %o1, 4, %o1
|
|
st %g2, [%o0 - 4]
|
|
sub %o0, 4, %o0
|
|
1:
|
|
be 1f
|
|
andcc %g1, 1, %g0
|
|
|
|
lduh [%o1 - 2], %g2
|
|
sub %o1, 2, %o1
|
|
sth %g2, [%o0 - 2]
|
|
sub %o0, 2, %o0
|
|
1:
|
|
be 1f
|
|
nop
|
|
|
|
ldub [%o1 - 1], %g2
|
|
stb %g2, [%o0 - 1]
|
|
1:
|
|
retl
|
|
RETL_INSN
|
|
|
|
74: /* rldd_std */
|
|
RMOVE_BIGALIGNCHUNK(o1, o0, 0x00, o2, o3, o4, o5, g2, g3, g4, g5)
|
|
RMOVE_BIGALIGNCHUNK(o1, o0, 0x20, o2, o3, o4, o5, g2, g3, g4, g5)
|
|
RMOVE_BIGALIGNCHUNK(o1, o0, 0x40, o2, o3, o4, o5, g2, g3, g4, g5)
|
|
RMOVE_BIGALIGNCHUNK(o1, o0, 0x60, o2, o3, o4, o5, g2, g3, g4, g5)
|
|
subcc %g7, 128, %g7
|
|
sub %o1, 128, %o1
|
|
bne 74b
|
|
sub %o0, 128, %o0
|
|
|
|
andcc %g1, 0x70, %g7
|
|
be 72b
|
|
andcc %g1, 8, %g0
|
|
|
|
sethi %hi(72b), %o5
|
|
srl %g7, 1, %o4
|
|
add %g7, %o4, %o4
|
|
sub %o1, %g7, %o1
|
|
sub %o5, %o4, %o5
|
|
jmpl %o5 + %lo(72b), %g0
|
|
sub %o0, %g7, %o0
|
|
|
|
75: /* rshort_end */
|
|
|
|
and %o2, 0xe, %o3
|
|
2:
|
|
sethi %hi(76f), %o5
|
|
sll %o3, 3, %o4
|
|
sub %o0, %o3, %o0
|
|
sub %o5, %o4, %o5
|
|
sub %o1, %o3, %o1
|
|
jmpl %o5 + %lo(76f), %g0
|
|
andcc %o2, 1, %g0
|
|
|
|
RMOVE_SHORTCHUNK(o1, o0, 0x0c, g2, g3)
|
|
RMOVE_SHORTCHUNK(o1, o0, 0x0a, g2, g3)
|
|
RMOVE_SHORTCHUNK(o1, o0, 0x08, g2, g3)
|
|
RMOVE_SHORTCHUNK(o1, o0, 0x06, g2, g3)
|
|
RMOVE_SHORTCHUNK(o1, o0, 0x04, g2, g3)
|
|
RMOVE_SHORTCHUNK(o1, o0, 0x02, g2, g3)
|
|
RMOVE_SHORTCHUNK(o1, o0, 0x00, g2, g3)
|
|
|
|
76: /* rshort_table_end */
|
|
|
|
be 1f
|
|
nop
|
|
ldub [%o1 - 1], %g2
|
|
stb %g2, [%o0 - 1]
|
|
1:
|
|
retl
|
|
RETL_INSN
|
|
|
|
91: /* rshort_aligned_end */
|
|
|
|
bne 75b
|
|
andcc %o2, 8, %g0
|
|
|
|
be 1f
|
|
andcc %o2, 4, %g0
|
|
|
|
ld [%o1 - 0x08], %g2
|
|
ld [%o1 - 0x04], %g3
|
|
sub %o1, 8, %o1
|
|
st %g2, [%o0 - 0x08]
|
|
st %g3, [%o0 - 0x04]
|
|
sub %o0, 8, %o0
|
|
1:
|
|
b 73b
|
|
mov %o2, %g1
|
|
|
|
77: /* rnon_aligned */
|
|
cmp %o2, 15
|
|
bleu 75b
|
|
andcc %o0, 3, %g0
|
|
be 64f
|
|
andcc %o0, 1, %g0
|
|
be 63f
|
|
andcc %o0, 2, %g0
|
|
ldub [%o1 - 1], %g5
|
|
sub %o1, 1, %o1
|
|
stb %g5, [%o0 - 1]
|
|
sub %o0, 1, %o0
|
|
be 64f
|
|
sub %o2, 1, %o2
|
|
63:
|
|
ldub [%o1 - 1], %g5
|
|
sub %o1, 2, %o1
|
|
stb %g5, [%o0 - 1]
|
|
sub %o0, 2, %o0
|
|
ldub [%o1], %g5
|
|
sub %o2, 2, %o2
|
|
stb %g5, [%o0]
|
|
64:
|
|
and %o1, 3, %g2
|
|
and %o1, -4, %o1
|
|
and %o2, 0xc, %g3
|
|
add %o1, 4, %o1
|
|
cmp %g3, 4
|
|
sll %g2, 3, %g4
|
|
mov 32, %g2
|
|
be 4f
|
|
sub %g2, %g4, %g7
|
|
|
|
blu 3f
|
|
cmp %g3, 8
|
|
|
|
be 2f
|
|
srl %o2, 2, %g3
|
|
|
|
ld [%o1 - 4], %o3
|
|
add %o0, -8, %o0
|
|
ld [%o1 - 8], %o4
|
|
add %o1, -16, %o1
|
|
b 7f
|
|
add %g3, 1, %g3
|
|
2:
|
|
ld [%o1 - 4], %o4
|
|
add %o0, -4, %o0
|
|
ld [%o1 - 8], %g1
|
|
add %o1, -12, %o1
|
|
b 8f
|
|
add %g3, 2, %g3
|
|
3:
|
|
ld [%o1 - 4], %o5
|
|
add %o0, -12, %o0
|
|
ld [%o1 - 8], %o3
|
|
add %o1, -20, %o1
|
|
b 6f
|
|
srl %o2, 2, %g3
|
|
4:
|
|
ld [%o1 - 4], %g1
|
|
srl %o2, 2, %g3
|
|
ld [%o1 - 8], %o5
|
|
add %o1, -24, %o1
|
|
add %o0, -16, %o0
|
|
add %g3, -1, %g3
|
|
|
|
ld [%o1 + 12], %o3
|
|
5:
|
|
sll %o5, %g4, %g2
|
|
srl %g1, %g7, %g5
|
|
or %g2, %g5, %g2
|
|
st %g2, [%o0 + 12]
|
|
6:
|
|
ld [%o1 + 8], %o4
|
|
sll %o3, %g4, %g2
|
|
srl %o5, %g7, %g5
|
|
or %g2, %g5, %g2
|
|
st %g2, [%o0 + 8]
|
|
7:
|
|
ld [%o1 + 4], %g1
|
|
sll %o4, %g4, %g2
|
|
srl %o3, %g7, %g5
|
|
or %g2, %g5, %g2
|
|
st %g2, [%o0 + 4]
|
|
8:
|
|
ld [%o1], %o5
|
|
sll %g1, %g4, %g2
|
|
srl %o4, %g7, %g5
|
|
addcc %g3, -4, %g3
|
|
or %g2, %g5, %g2
|
|
add %o1, -16, %o1
|
|
st %g2, [%o0]
|
|
add %o0, -16, %o0
|
|
bne,a 5b
|
|
ld [%o1 + 12], %o3
|
|
sll %o5, %g4, %g2
|
|
srl %g1, %g7, %g5
|
|
srl %g4, 3, %g3
|
|
or %g2, %g5, %g2
|
|
add %o1, %g3, %o1
|
|
andcc %o2, 2, %g0
|
|
st %g2, [%o0 + 12]
|
|
be 1f
|
|
andcc %o2, 1, %g0
|
|
|
|
ldub [%o1 + 15], %g5
|
|
add %o1, -2, %o1
|
|
stb %g5, [%o0 + 11]
|
|
add %o0, -2, %o0
|
|
ldub [%o1 + 16], %g5
|
|
stb %g5, [%o0 + 12]
|
|
1:
|
|
be 1f
|
|
nop
|
|
ldub [%o1 + 15], %g5
|
|
stb %g5, [%o0 + 11]
|
|
1:
|
|
retl
|
|
RETL_INSN
|
|
|
|
#endif /* FASTER_REVERSE */
|
|
|
|
/* 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
|
|
|
|
#ifdef __KERNEL__
|
|
FUNC(__memcpy)
|
|
#endif
|
|
FUNC(memcpy) /* %o0=dst %o1=src %o2=len */
|
|
|
|
sub %o0, %o1, %o4
|
|
SETUP_RETL
|
|
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, %g7
|
|
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)
|
|
subcc %g7, 128, %g7
|
|
add %o1, 128, %o1
|
|
bne 5b
|
|
add %o0, 128, %o0
|
|
3:
|
|
andcc %g1, 0x70, %g7
|
|
be 80f
|
|
andcc %g1, 8, %g0
|
|
|
|
sethi %hi(80f), %o5
|
|
srl %g7, 1, %o4
|
|
add %g7, %o4, %o4
|
|
add %o1, %g7, %o1
|
|
sub %o5, %o4, %o5
|
|
jmpl %o5 + %lo(80f), %g0
|
|
add %o0, %g7, %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
|
|
RETL_INSN
|
|
|
|
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 %g7, 128, %g7
|
|
add %o1, 128, %o1
|
|
bne 82b
|
|
add %o0, 128, %o0
|
|
|
|
#ifndef FASTER_ALIGNED
|
|
|
|
andcc %g1, 0x70, %g7
|
|
be 80b
|
|
andcc %g1, 8, %g0
|
|
|
|
sethi %hi(80b), %o5
|
|
srl %g7, 1, %o4
|
|
add %g7, %o4, %o4
|
|
add %o1, %g7, %o1
|
|
sub %o5, %o4, %o5
|
|
jmpl %o5 + %lo(80b), %g0
|
|
add %o0, %g7, %o0
|
|
|
|
#else /* FASTER_ALIGNED */
|
|
|
|
andcc %g1, 0x70, %g7
|
|
be 84f
|
|
andcc %g1, 8, %g0
|
|
|
|
sethi %hi(84f), %o5
|
|
add %o1, %g7, %o1
|
|
sub %o5, %g7, %o5
|
|
jmpl %o5 + %lo(84f), %g0
|
|
add %o0, %g7, %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
|
|
RETL_INSN
|
|
|
|
#endif /* FASTER_ALIGNED */
|
|
|
|
86: /* non_aligned */
|
|
cmp %o2, 6
|
|
bleu 88f
|
|
|
|
#ifdef FASTER_NONALIGNED
|
|
|
|
cmp %o2, 256
|
|
bcc 87f
|
|
|
|
#endif /* FASTER_NONALIGNED */
|
|
|
|
andcc %o0, 3, %g0
|
|
be 61f
|
|
andcc %o0, 1, %g0
|
|
be 60f
|
|
andcc %o0, 2, %g0
|
|
|
|
ldub [%o1], %g5
|
|
add %o1, 1, %o1
|
|
stb %g5, [%o0]
|
|
sub %o2, 1, %o2
|
|
bne 61f
|
|
add %o0, 1, %o0
|
|
60:
|
|
ldub [%o1], %g3
|
|
add %o1, 2, %o1
|
|
stb %g3, [%o0]
|
|
sub %o2, 2, %o2
|
|
ldub [%o1 - 1], %g3
|
|
add %o0, 2, %o0
|
|
stb %g3, [%o0 - 1]
|
|
61:
|
|
and %o1, 3, %g2
|
|
and %o2, 0xc, %g3
|
|
and %o1, -4, %o1
|
|
cmp %g3, 4
|
|
sll %g2, 3, %g4
|
|
mov 32, %g2
|
|
be 4f
|
|
sub %g2, %g4, %g7
|
|
|
|
blu 3f
|
|
cmp %g3, 0x8
|
|
|
|
be 2f
|
|
srl %o2, 2, %g3
|
|
|
|
ld [%o1], %o3
|
|
add %o0, -8, %o0
|
|
ld [%o1 + 4], %o4
|
|
b 8f
|
|
add %g3, 1, %g3
|
|
2:
|
|
ld [%o1], %o4
|
|
add %o0, -12, %o0
|
|
ld [%o1 + 4], %o5
|
|
add %g3, 2, %g3
|
|
b 9f
|
|
add %o1, -4, %o1
|
|
3:
|
|
ld [%o1], %g1
|
|
add %o0, -4, %o0
|
|
ld [%o1 + 4], %o3
|
|
srl %o2, 2, %g3
|
|
b 7f
|
|
add %o1, 4, %o1
|
|
4:
|
|
ld [%o1], %o5
|
|
cmp %o2, 7
|
|
ld [%o1 + 4], %g1
|
|
srl %o2, 2, %g3
|
|
bleu 10f
|
|
add %o1, 8, %o1
|
|
|
|
ld [%o1], %o3
|
|
add %g3, -1, %g3
|
|
5:
|
|
sll %o5, %g4, %g2
|
|
srl %g1, %g7, %g5
|
|
or %g2, %g5, %g2
|
|
st %g2, [%o0]
|
|
7:
|
|
ld [%o1 + 4], %o4
|
|
sll %g1, %g4, %g2
|
|
srl %o3, %g7, %g5
|
|
or %g2, %g5, %g2
|
|
st %g2, [%o0 + 4]
|
|
8:
|
|
ld [%o1 + 8], %o5
|
|
sll %o3, %g4, %g2
|
|
srl %o4, %g7, %g5
|
|
or %g2, %g5, %g2
|
|
st %g2, [%o0 + 8]
|
|
9:
|
|
ld [%o1 + 12], %g1
|
|
sll %o4, %g4, %g2
|
|
srl %o5, %g7, %g5
|
|
addcc %g3, -4, %g3
|
|
or %g2, %g5, %g2
|
|
add %o1, 16, %o1
|
|
st %g2, [%o0 + 12]
|
|
add %o0, 16, %o0
|
|
bne,a 5b
|
|
ld [%o1], %o3
|
|
10:
|
|
sll %o5, %g4, %g2
|
|
srl %g1, %g7, %g5
|
|
srl %g7, 3, %g3
|
|
or %g2, %g5, %g2
|
|
sub %o1, %g3, %o1
|
|
andcc %o2, 2, %g0
|
|
st %g2, [%o0]
|
|
be 1f
|
|
andcc %o2, 1, %g0
|
|
|
|
ldub [%o1], %g2
|
|
add %o1, 2, %o1
|
|
stb %g2, [%o0 + 4]
|
|
add %o0, 2, %o0
|
|
ldub [%o1 - 1], %g2
|
|
stb %g2, [%o0 + 3]
|
|
1:
|
|
be 1f
|
|
nop
|
|
ldub [%o1], %g2
|
|
stb %g2, [%o0 + 4]
|
|
1:
|
|
retl
|
|
RETL_INSN
|
|
|
|
#ifdef FASTER_NONALIGNED
|
|
|
|
87: /* faster_nonaligned */
|
|
|
|
andcc %o1, 3, %g0
|
|
be 3f
|
|
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
|
|
srl %g2, 8, %g3
|
|
sub %o2, 2, %o2
|
|
stb %g3, [%o0]
|
|
add %o0, 2, %o0
|
|
stb %g2, [%o0 - 1]
|
|
3:
|
|
andcc %o1, 4, %g0
|
|
|
|
bne 2f
|
|
cmp %o5, 1
|
|
|
|
ld [%o1], %o4
|
|
srl %o4, 24, %g2
|
|
stb %g2, [%o0]
|
|
srl %o4, 16, %g3
|
|
stb %g3, [%o0 + 1]
|
|
srl %o4, 8, %g2
|
|
stb %g2, [%o0 + 2]
|
|
sub %o2, 4, %o2
|
|
stb %o4, [%o0 + 3]
|
|
add %o1, 4, %o1
|
|
add %o0, 4, %o0
|
|
2:
|
|
be 33f
|
|
cmp %o5, 2
|
|
be 32f
|
|
sub %o2, 4, %o2
|
|
31:
|
|
ld [%o1], %g2
|
|
add %o1, 4, %o1
|
|
srl %g2, 24, %g3
|
|
and %o0, 7, %g5
|
|
stb %g3, [%o0]
|
|
cmp %g5, 7
|
|
sll %g2, 8, %g1
|
|
add %o0, 4, %o0
|
|
be 41f
|
|
and %o2, 0xffffffc0, %o3
|
|
ld [%o0 - 7], %o4
|
|
4:
|
|
SMOVE_CHUNK(o1, o0, 0x00, g2, g3, g4, g5, o4, o5, g7, g1, 8, 24, -3)
|
|
SMOVE_CHUNK(o1, o0, 0x10, g2, g3, g4, g5, o4, o5, g7, g1, 8, 24, -3)
|
|
SMOVE_CHUNK(o1, o0, 0x20, g2, g3, g4, g5, o4, o5, g7, g1, 8, 24, -3)
|
|
SMOVE_CHUNK(o1, o0, 0x30, g2, g3, g4, g5, o4, o5, g7, g1, 8, 24, -3)
|
|
subcc %o3, 64, %o3
|
|
add %o1, 64, %o1
|
|
bne 4b
|
|
add %o0, 64, %o0
|
|
|
|
andcc %o2, 0x30, %o3
|
|
be,a 1f
|
|
srl %g1, 16, %g2
|
|
4:
|
|
SMOVE_CHUNK(o1, o0, 0x00, g2, g3, g4, g5, o4, o5, g7, g1, 8, 24, -3)
|
|
subcc %o3, 16, %o3
|
|
add %o1, 16, %o1
|
|
bne 4b
|
|
add %o0, 16, %o0
|
|
|
|
srl %g1, 16, %g2
|
|
1:
|
|
st %o4, [%o0 - 7]
|
|
sth %g2, [%o0 - 3]
|
|
srl %g1, 8, %g4
|
|
b 88f
|
|
stb %g4, [%o0 - 1]
|
|
32:
|
|
ld [%o1], %g2
|
|
add %o1, 4, %o1
|
|
srl %g2, 16, %g3
|
|
and %o0, 7, %g5
|
|
sth %g3, [%o0]
|
|
cmp %g5, 6
|
|
sll %g2, 16, %g1
|
|
add %o0, 4, %o0
|
|
be 42f
|
|
and %o2, 0xffffffc0, %o3
|
|
ld [%o0 - 6], %o4
|
|
4:
|
|
SMOVE_CHUNK(o1, o0, 0x00, g2, g3, g4, g5, o4, o5, g7, g1, 16, 16, -2)
|
|
SMOVE_CHUNK(o1, o0, 0x10, g2, g3, g4, g5, o4, o5, g7, g1, 16, 16, -2)
|
|
SMOVE_CHUNK(o1, o0, 0x20, g2, g3, g4, g5, o4, o5, g7, g1, 16, 16, -2)
|
|
SMOVE_CHUNK(o1, o0, 0x30, g2, g3, g4, g5, o4, o5, g7, g1, 16, 16, -2)
|
|
subcc %o3, 64, %o3
|
|
add %o1, 64, %o1
|
|
bne 4b
|
|
add %o0, 64, %o0
|
|
|
|
andcc %o2, 0x30, %o3
|
|
be,a 1f
|
|
srl %g1, 16, %g2
|
|
4:
|
|
SMOVE_CHUNK(o1, o0, 0x00, g2, g3, g4, g5, o4, o5, g7, g1, 16, 16, -2)
|
|
subcc %o3, 16, %o3
|
|
add %o1, 16, %o1
|
|
bne 4b
|
|
add %o0, 16, %o0
|
|
|
|
srl %g1, 16, %g2
|
|
1:
|
|
st %o4, [%o0 - 6]
|
|
b 88f
|
|
sth %g2, [%o0 - 2]
|
|
33:
|
|
ld [%o1], %g2
|
|
sub %o2, 4, %o2
|
|
srl %g2, 24, %g3
|
|
and %o0, 7, %g5
|
|
stb %g3, [%o0]
|
|
cmp %g5, 5
|
|
srl %g2, 8, %g4
|
|
sll %g2, 24, %g1
|
|
sth %g4, [%o0 + 1]
|
|
add %o1, 4, %o1
|
|
be 43f
|
|
and %o2, 0xffffffc0, %o3
|
|
|
|
ld [%o0 - 1], %o4
|
|
add %o0, 4, %o0
|
|
4:
|
|
SMOVE_CHUNK(o1, o0, 0x00, g2, g3, g4, g5, o4, o5, g7, g1, 24, 8, -1)
|
|
SMOVE_CHUNK(o1, o0, 0x10, g2, g3, g4, g5, o4, o5, g7, g1, 24, 8, -1)
|
|
SMOVE_CHUNK(o1, o0, 0x20, g2, g3, g4, g5, o4, o5, g7, g1, 24, 8, -1)
|
|
SMOVE_CHUNK(o1, o0, 0x30, g2, g3, g4, g5, o4, o5, g7, g1, 24, 8, -1)
|
|
subcc %o3, 64, %o3
|
|
add %o1, 64, %o1
|
|
bne 4b
|
|
add %o0, 64, %o0
|
|
|
|
andcc %o2, 0x30, %o3
|
|
be,a 1f
|
|
srl %g1, 24, %g2
|
|
4:
|
|
SMOVE_CHUNK(o1, o0, 0x00, g2, g3, g4, g5, o4, o5, g7, g1, 24, 8, -1)
|
|
subcc %o3, 16, %o3
|
|
add %o1, 16, %o1
|
|
bne 4b
|
|
add %o0, 16, %o0
|
|
|
|
srl %g1, 24, %g2
|
|
1:
|
|
st %o4, [%o0 - 5]
|
|
b 88f
|
|
stb %g2, [%o0 - 1]
|
|
41:
|
|
SMOVE_ALIGNCHUNK(o1, o0, 0x00, g2, g3, g4, g5, o4, o5, g7, g1, 8, 24, -3)
|
|
SMOVE_ALIGNCHUNK(o1, o0, 0x10, g2, g3, g4, g5, o4, o5, g7, g1, 8, 24, -3)
|
|
SMOVE_ALIGNCHUNK(o1, o0, 0x20, g2, g3, g4, g5, o4, o5, g7, g1, 8, 24, -3)
|
|
SMOVE_ALIGNCHUNK(o1, o0, 0x30, g2, g3, g4, g5, o4, o5, g7, g1, 8, 24, -3)
|
|
subcc %o3, 64, %o3
|
|
add %o1, 64, %o1
|
|
bne 41b
|
|
add %o0, 64, %o0
|
|
|
|
andcc %o2, 0x30, %o3
|
|
be,a 1f
|
|
srl %g1, 16, %g2
|
|
4:
|
|
SMOVE_ALIGNCHUNK(o1, o0, 0x00, g2, g3, g4, g5, o4, o5, g7, g1, 8, 24, -3)
|
|
subcc %o3, 16, %o3
|
|
add %o1, 16, %o1
|
|
bne 4b
|
|
add %o0, 16, %o0
|
|
|
|
srl %g1, 16, %g2
|
|
1:
|
|
sth %g2, [%o0 - 3]
|
|
srl %g1, 8, %g4
|
|
b 88f
|
|
stb %g4, [%o0 - 1]
|
|
43:
|
|
SMOVE_ALIGNCHUNK(o1, o0, 0x00, g2, g3, g4, g5, o4, o5, g7, g1, 24, 8, 3)
|
|
SMOVE_ALIGNCHUNK(o1, o0, 0x10, g2, g3, g4, g5, o4, o5, g7, g1, 24, 8, 3)
|
|
SMOVE_ALIGNCHUNK(o1, o0, 0x20, g2, g3, g4, g5, o4, o5, g7, g1, 24, 8, 3)
|
|
SMOVE_ALIGNCHUNK(o1, o0, 0x30, g2, g3, g4, g5, o4, o5, g7, g1, 24, 8, 3)
|
|
subcc %o3, 64, %o3
|
|
add %o1, 64, %o1
|
|
bne 43b
|
|
add %o0, 64, %o0
|
|
|
|
andcc %o2, 0x30, %o3
|
|
be,a 1f
|
|
srl %g1, 24, %g2
|
|
4:
|
|
SMOVE_ALIGNCHUNK(o1, o0, 0x00, g2, g3, g4, g5, o4, o5, g7, g1, 24, 8, 3)
|
|
subcc %o3, 16, %o3
|
|
add %o1, 16, %o1
|
|
bne 4b
|
|
add %o0, 16, %o0
|
|
|
|
srl %g1, 24, %g2
|
|
1:
|
|
stb %g2, [%o0 + 3]
|
|
b 88f
|
|
add %o0, 4, %o0
|
|
42:
|
|
SMOVE_ALIGNCHUNK(o1, o0, 0x00, g2, g3, g4, g5, o4, o5, g7, g1, 16, 16, -2)
|
|
SMOVE_ALIGNCHUNK(o1, o0, 0x10, g2, g3, g4, g5, o4, o5, g7, g1, 16, 16, -2)
|
|
SMOVE_ALIGNCHUNK(o1, o0, 0x20, g2, g3, g4, g5, o4, o5, g7, g1, 16, 16, -2)
|
|
SMOVE_ALIGNCHUNK(o1, o0, 0x30, g2, g3, g4, g5, o4, o5, g7, g1, 16, 16, -2)
|
|
subcc %o3, 64, %o3
|
|
add %o1, 64, %o1
|
|
bne 42b
|
|
add %o0, 64, %o0
|
|
|
|
andcc %o2, 0x30, %o3
|
|
be,a 1f
|
|
srl %g1, 16, %g2
|
|
4:
|
|
SMOVE_ALIGNCHUNK(o1, o0, 0x00, g2, g3, g4, g5, o4, o5, g7, g1, 16, 16, -2)
|
|
subcc %o3, 16, %o3
|
|
add %o1, 16, %o1
|
|
bne 4b
|
|
add %o0, 16, %o0
|
|
|
|
srl %g1, 16, %g2
|
|
1:
|
|
sth %g2, [%o0 - 2]
|
|
|
|
/* Fall through */
|
|
|
|
#endif /* FASTER_NONALIGNED */
|
|
|
|
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
|
|
RETL_INSN
|
|
|
|
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
|