Home | History | Annotate | Line # | Download | only in string
memmove.S revision 1.2
      1 /* $NetBSD: memmove.S,v 1.2 2008/03/06 21:17:17 phx Exp $ */
      2 
      3 /* stropt/memmove.S, pl_string_common, pl_linux 10/11/04 11:45:37
      4  * ==========================================================================
      5  * Optimized memmove implementation for IBM PowerPC 405/440.
      6  *
      7  *	Copyright (c) 2003, IBM Corporation
      8  *	All rights reserved.
      9  *
     10  *	Redistribution and use in source and binary forms, with or
     11  *	without modification, are permitted provided that the following
     12  *	conditions are met:
     13  *
     14  *	* Redistributions of source code must retain the above
     15  *	copyright notice, this list of conditions and the following
     16  *	disclaimer.
     17  *	* Redistributions in binary form must reproduce the above
     18  *	copyright notice, this list of conditions and the following
     19  *	disclaimer in the documentation and/or other materials
     20  *	provided with the distribution.
     21  *	* Neither the name of IBM nor the names of its contributors
     22  *	may be used to endorse or promote products derived from this
     23  *	software without specific prior written permission.
     24  *
     25  *	THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND
     26  *	CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES,
     27  *	INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
     28  *	MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     29  *	DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
     30  *	BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
     31  *	OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
     32  *	PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
     33  *	PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY
     34  *	OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     35  *	(INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
     36  *	USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     37  *
     38  * ==========================================================================
     39  *
     40  * Function: Move memory area (handles overlapping regions)
     41  *
     42  *		void *memmove(void * dest, const void * src, int n)
     43  *
     44  * Input:	r3 - destination address
     45  *	 r4 - source address
     46  *	 r5 - byte count
     47  * Output: r3 - destination address
     48  *
     49  * ==========================================================================
     50  */
     51 
     52 #define _NOREGNAMES
     53 #include <machine/asm.h>
     54 
     55         .text
     56         .align 4
     57 #ifdef _BCOPY
     58 /* bcopy = memcpy/memmove with arguments reversed. */
     59 /* LINTSTUB: Func: void bcopy(void *, void *, size_t) */
     60 ENTRY(bcopy)
     61 	mr	%r6, %r3		/* swap src/dst */
     62 	mr	%r3, %r4
     63 	mr	%r4, %r6
     64 #else
     65 /* LINTSTUB: Func: void *memmove(void *, const void *, size_t) */
     66 ENTRY(memmove)
     67 #endif
     68 
     69 	mr	%r8, %r3		/* Save dst (return value)	*/
     70 
     71 	cmpw	%r4, %r8		/* Branch to reverse if 	*/
     72 	blt	reverse			/* src < dest. Don't want to	*/
     73 					/* overwrite end of src with	*/
     74 					/* start of dest 		*/
     75 
     76 	addi	%r4, %r4, -4		/* Back up src and dst pointers */
     77 	addi	%r8, %r8, -4		/* due to auto-update of 'load' */
     78 
     79 	srwi.	%r9,%r5,2			/* How many words in total cnt	*/
     80 	beq-	last1			/* Handle byte by byte if < 4	*/
     81 					/* bytes total 			*/
     82 	mtctr	%r9			/* Count of words for loop		*/
     83 	lwzu	%r7, 4(%r4)		/* Preload first word		*/
     84 
     85 	b	g1
     86 
     87 g0:					/* Main loop			*/
     88 
     89 	lwzu	%r7, 4(%r4)		/* Load a new word		*/
     90 	stwu	%r6, 4(%r8)		/* Store previous word		*/
     91 
     92 g1:
     93 
     94 	bdz-	last			/* Dec cnt, and branch if just	*/
     95 					/* one word to store		*/
     96 	lwzu	%r6, 4(%r4)		/* Load another word		*/
     97 	stwu	%r7, 4(%r8)		/* Store previous word		*/
     98 	bdnz+	g0			/* Dec cnt, and loop again if	*/
     99 					/* more words			*/
    100 	mr	%r7, %r6			/* If word count -> 0, then...	*/
    101 
    102 last:
    103 
    104 	stwu	%r7, 4(%r8)		/* ... store last word		*/
    105 
    106 last1:					/* Byte-by-byte copy		*/
    107 
    108 	clrlwi.	%r5,%r5,30		/* If count -> 0, then ...	*/
    109 	beqlr				/* we're done			*/
    110 
    111 	mtctr	%r5			/* else load count for loop	*/
    112 
    113 	lbzu	%r6, 4(%r4)		/* 1st byte: update addr by 4	*/
    114 	stbu	%r6, 4(%r8)		/* since we pre-adjusted by 4	*/
    115 	bdzlr-				/* in anticipation of main loop */
    116 
    117 last2:
    118 
    119 	lbzu	%r6, 1(%r4)		/* But handle the rest by		*/
    120 	stbu	%r6, 1(%r8)		/* updating addr by 1		*/
    121 	bdnz+	last2
    122 
    123 	blr
    124 
    125 	/* We're here since src < dest. Don't want to overwrite end of	*/
    126 	/* src with start of dest						*/
    127 
    128 reverse:
    129 
    130 	add	%r4, %r4, %r5		/* Work from end to beginning	*/
    131 	add	%r8, %r8, %r5 		/* so add count to string ptrs	*/
    132 	srwi.	%r9,%r5,2			/* Words in total count		*/
    133 	beq-	rlast1			/* Handle byte by byte if < 4	*/
    134 					/* bytes total 			*/
    135 
    136 	mtctr	%r9			/* Count of words for loop 	*/
    137 
    138 	lwzu	%r7, -4(%r4)		/* Preload first word		*/
    139 	b	rg1
    140 
    141 rg0:					/* Main loop			*/
    142 
    143 	lwzu	%r7, -4(%r4)		/* Load a new word		*/
    144 	stwu	%r6, -4(%r8)		/* Store previous word		*/
    145 
    146 rg1:
    147 
    148 	bdz-	rlast			/* Dec cnt, and branch if just	*/
    149 					/* one word to store		*/
    150 
    151 	lwzu	%r6, -4(%r4)		/* Load another word		*/
    152 	stwu	%r7, -4(%r8)		/* Store previous word		*/
    153 
    154 	bdnz+	rg0			/* Dec cnt, and loop again if	*/
    155 					/* more words			*/
    156 
    157 	mr	%r7, %r6			/* If word count -> 0, then...	*/
    158 
    159 rlast:
    160 
    161 	stwu	%r7, -4(%r8)		/* ... store last word		*/
    162 
    163 rlast1:					/* Byte-by-byte copy		*/
    164 
    165 	clrlwi.	%r5,%r5,30		/* If count -> 0, then...	*/
    166 	beqlr				/* ... we're done 		*/
    167 
    168 	mtctr	%r5			/* else load count for loop 	*/
    169 
    170 rlast2:
    171 
    172 	lbzu	%r6, -1(%r4)		/* Handle the rest, byte by 	*/
    173 	stbu	%r6, -1(%r8)		/* byte				*/
    174 
    175 	bdnz+	rlast2		 	/* Dec ctr, and branch if more	*/
    176 					/* bytes left			*/
    177 	blr
    178 
    179