|  | /* 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 ([email protected]) | 
|  | * Copyright (C) 1996 David S. Miller ([email protected]) | 
|  | * Copyright (C) 1996 Eddie C. Dost ([email protected]) | 
|  | * Copyright (C) 1996 Jakub Jelinek ([email protected]) | 
|  | */ | 
|  |  | 
|  | #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 |