xref: /titanic_51/usr/src/lib/libc/sparc/gen/memcpy.s (revision 3ad684d66b78e06edd37e2c4fd3b3949f095194b)
1/*
2 * CDDL HEADER START
3 *
4 * The contents of this file are subject to the terms of the
5 * Common Development and Distribution License (the "License").
6 * You may not use this file except in compliance with the License.
7 *
8 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
9 * or http://www.opensolaris.org/os/licensing.
10 * See the License for the specific language governing permissions
11 * and limitations under the License.
12 *
13 * When distributing Covered Code, include this CDDL HEADER in each
14 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
15 * If applicable, add the following below this CDDL HEADER, with the
16 * fields enclosed by brackets "[]" replaced with your own identifying
17 * information: Portions Copyright [yyyy] [name of copyright owner]
18 *
19 * CDDL HEADER END
20 */
21
22/*
23 * Copyright 2008 Sun Microsystems, Inc.  All rights reserved.
24 * Use is subject to license terms.
25 */
26
27	.ident	"%Z%%M%	%I%	%E% SMI"
28
29	.file	"%M%"
30
31/*
32 * memcpy(s1, s2, len)
33 *
34 * Copy s2 to s1, always copy n bytes.
35 * Note: this does not work for overlapped copies, bcopy() does
36 *
37 * Fast assembler language version of the following C-program for memcpy
38 * which represents the `standard' for the C-library.
39 *
40 *	void *
41 *	memcpy(void *s, const void *s0, size_t n)
42 *	{
43 *		if (n != 0) {
44 *	   	    char *s1 = s;
45 *		    const char *s2 = s0;
46 *		    do {
47 *			*s1++ = *s2++;
48 *		    } while (--n != 0);
49 *		}
50 *		return (s);
51 *	}
52 */
53
54#include <sys/asm_linkage.h>
55
56	ANSI_PRAGMA_WEAK(memcpy,function)
57
58#include "synonyms.h"
59
60	ENTRY(memcpy)
61	st	%o0, [%sp + 68]		! save des address for return val
62	cmp	%o2, 17			! for small counts copy bytes
63	bleu	.dbytecp
64	andcc	%o1, 3, %o5		! is src word aligned
65	bz	.aldst
66	cmp	%o5, 2			! is src half-word aligned
67	be	.s2algn
68	cmp	%o5, 3			! src is byte aligned
69.s1algn:ldub	[%o1], %o3		! move 1 or 3 bytes to align it
70	inc	1, %o1
71	stb	%o3, [%o0]		! move a byte to align src
72	inc	1, %o0
73	bne	.s2algn
74	dec	%o2
75	b	.ald			! now go align dest
76	andcc	%o0, 3, %o5
77
78.s2algn:lduh	[%o1], %o3		! know src is 2 byte alinged
79	inc	2, %o1
80	srl	%o3, 8, %o4
81	stb	%o4, [%o0]		! have to do bytes,
82	stb	%o3, [%o0 + 1]		! don't know dst alingment
83	inc	2, %o0
84	dec	2, %o2
85
86.aldst:	andcc	%o0, 3, %o5		! align the destination address
87.ald:	bz	.w4cp
88	cmp	%o5, 2
89	bz	.w2cp
90	cmp	%o5, 3
91.w3cp:	ld	[%o1], %o4
92	inc	4, %o1
93	srl	%o4, 24, %o5
94	stb	%o5, [%o0]
95	bne	.w1cp
96	inc	%o0
97	dec	1, %o2
98	andn	%o2, 3, %o3		! o3 is aligned word count
99	dec	4, %o3			! avoid reading beyond tail of src
100	sub	%o1, %o0, %o1		! o1 gets the difference
101
1021:	sll	%o4, 8, %g1		! save residual bytes
103	ld	[%o1+%o0], %o4
104	deccc	4, %o3
105	srl	%o4, 24, %o5		! merge with residual
106	or	%o5, %g1, %g1
107	st	%g1, [%o0]
108	bnz	1b
109	inc	4, %o0
110	sub	%o1, 3, %o1		! used one byte of last word read
111	and	%o2, 3, %o2
112	b	7f
113	inc	4, %o2
114
115.w1cp:	srl	%o4, 8, %o5
116	sth	%o5, [%o0]
117	inc	2, %o0
118	dec	3, %o2
119	andn	%o2, 3, %o3		! o3 is aligned word count
120	dec	4, %o3			! avoid reading beyond tail of src
121	sub	%o1, %o0, %o1		! o1 gets the difference
122
1232:	sll	%o4, 24, %g1		! save residual bytes
124	ld	[%o1+%o0], %o4
125	deccc	4, %o3
126	srl	%o4, 8, %o5		! merge with residual
127	or	%o5, %g1, %g1
128	st	%g1, [%o0]
129	bnz	2b
130	inc	4, %o0
131	sub	%o1, 1, %o1		! used three bytes of last word read
132	and	%o2, 3, %o2
133	b	7f
134	inc	4, %o2
135
136.w2cp:	ld	[%o1], %o4
137	inc	4, %o1
138	srl	%o4, 16, %o5
139	sth	%o5, [%o0]
140	inc	2, %o0
141	dec	2, %o2
142	andn	%o2, 3, %o3		! o3 is aligned word count
143	dec	4, %o3			! avoid reading beyond tail of src
144	sub	%o1, %o0, %o1		! o1 gets the difference
145
1463:	sll	%o4, 16, %g1		! save residual bytes
147	ld	[%o1+%o0], %o4
148	deccc	4, %o3
149	srl	%o4, 16, %o5		! merge with residual
150	or	%o5, %g1, %g1
151	st	%g1, [%o0]
152	bnz	3b
153	inc	4, %o0
154	sub	%o1, 2, %o1		! used two bytes of last word read
155	and	%o2, 3, %o2
156	b	7f
157	inc	4, %o2
158
159.w4cp:	andn	%o2, 3, %o3		! o3 is aligned word count
160	sub	%o1, %o0, %o1		! o1 gets the difference
161
1621:	ld	[%o1+%o0], %o4		! read from address
163	deccc	4, %o3			! decrement count
164	st	%o4, [%o0]		! write at destination address
165	bgu	1b
166	inc	4, %o0			! increment to address
167	b	7f
168	and	%o2, 3, %o2		! number of leftover bytes, if any
169
170	!
171	! differenced byte copy, works with any alignment
172	!
173.dbytecp:
174	b	7f
175	sub	%o1, %o0, %o1		! o1 gets the difference
176
1774:	stb	%o4, [%o0]		! write to address
178	inc	%o0			! inc to address
1797:	deccc	%o2			! decrement count
180	bgeu,a	4b			! loop till done
181	ldub	[%o1+%o0], %o4		! read from address
182	retl
183	ld	[%sp + 68], %o0		! return s1, destination address
184
185	SET_SIZE(memcpy)
186