Home | History | Annotate | Line # | Download | only in string
memmove.S revision 1.3
      1 /* $NetBSD: memmove.S,v 1.3 2011/01/15 07:31:12 matt 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 #include <machine/asm.h>
     53 
     54         .text
     55         .align 4
     56 #ifdef _BCOPY
     57 /* bcopy = memcpy/memmove with arguments reversed. */
     58 /* LINTSTUB: Func: void bcopy(void *, void *, size_t) */
     59 ENTRY(bcopy)
     60 	mr	%r6, %r3		/* swap src/dst */
     61 	mr	%r3, %r4
     62 	mr	%r4, %r6
     63 #else
     64 /* LINTSTUB: Func: void *memmove(void *, const void *, size_t) */
     65 ENTRY(memmove)
     66 #endif
     67 
     68 	mr	%r8, %r3		/* Save dst (return value)	*/
     69 
     70 	cmpw	%r4, %r8		/* Branch to reverse if 	*/
     71 	blt	reverse			/* src < dest. Don't want to	*/
     72 					/* overwrite end of src with	*/
     73 					/* start of dest 		*/
     74 
     75 	addi	%r4, %r4, -4		/* Back up src and dst pointers */
     76 	addi	%r8, %r8, -4		/* due to auto-update of 'load' */
     77 
     78 	srwi.	%r9,%r5,2			/* How many words in total cnt	*/
     79 	beq-	last1			/* Handle byte by byte if < 4	*/
     80 					/* bytes total 			*/
     81 	mtctr	%r9			/* Count of words for loop		*/
     82 	lwzu	%r7, 4(%r4)		/* Preload first word		*/
     83 
     84 	b	g1
     85 
     86 g0:					/* Main loop			*/
     87 
     88 	lwzu	%r7, 4(%r4)		/* Load a new word		*/
     89 	stwu	%r6, 4(%r8)		/* Store previous word		*/
     90 
     91 g1:
     92 
     93 	bdz-	last			/* Dec cnt, and branch if just	*/
     94 					/* one word to store		*/
     95 	lwzu	%r6, 4(%r4)		/* Load another word		*/
     96 	stwu	%r7, 4(%r8)		/* Store previous word		*/
     97 	bdnz+	g0			/* Dec cnt, and loop again if	*/
     98 					/* more words			*/
     99 	mr	%r7, %r6			/* If word count -> 0, then...	*/
    100 
    101 last:
    102 
    103 	stwu	%r7, 4(%r8)		/* ... store last word		*/
    104 
    105 last1:					/* Byte-by-byte copy		*/
    106 
    107 	clrlwi.	%r5,%r5,30		/* If count -> 0, then ...	*/
    108 	beqlr				/* we're done			*/
    109 
    110 	mtctr	%r5			/* else load count for loop	*/
    111 
    112 	lbzu	%r6, 4(%r4)		/* 1st byte: update addr by 4	*/
    113 	stbu	%r6, 4(%r8)		/* since we pre-adjusted by 4	*/
    114 	bdzlr-				/* in anticipation of main loop */
    115 
    116 last2:
    117 
    118 	lbzu	%r6, 1(%r4)		/* But handle the rest by		*/
    119 	stbu	%r6, 1(%r8)		/* updating addr by 1		*/
    120 	bdnz+	last2
    121 
    122 	blr
    123 
    124 	/* We're here since src < dest. Don't want to overwrite end of	*/
    125 	/* src with start of dest						*/
    126 
    127 reverse:
    128 
    129 	add	%r4, %r4, %r5		/* Work from end to beginning	*/
    130 	add	%r8, %r8, %r5 		/* so add count to string ptrs	*/
    131 	srwi.	%r9,%r5,2			/* Words in total count		*/
    132 	beq-	rlast1			/* Handle byte by byte if < 4	*/
    133 					/* bytes total 			*/
    134 
    135 	mtctr	%r9			/* Count of words for loop 	*/
    136 
    137 	lwzu	%r7, -4(%r4)		/* Preload first word		*/
    138 	b	rg1
    139 
    140 rg0:					/* Main loop			*/
    141 
    142 	lwzu	%r7, -4(%r4)		/* Load a new word		*/
    143 	stwu	%r6, -4(%r8)		/* Store previous word		*/
    144 
    145 rg1:
    146 
    147 	bdz-	rlast			/* Dec cnt, and branch if just	*/
    148 					/* one word to store		*/
    149 
    150 	lwzu	%r6, -4(%r4)		/* Load another word		*/
    151 	stwu	%r7, -4(%r8)		/* Store previous word		*/
    152 
    153 	bdnz+	rg0			/* Dec cnt, and loop again if	*/
    154 					/* more words			*/
    155 
    156 	mr	%r7, %r6			/* If word count -> 0, then...	*/
    157 
    158 rlast:
    159 
    160 	stwu	%r7, -4(%r8)		/* ... store last word		*/
    161 
    162 rlast1:					/* Byte-by-byte copy		*/
    163 
    164 	clrlwi.	%r5,%r5,30		/* If count -> 0, then...	*/
    165 	beqlr				/* ... we're done 		*/
    166 
    167 	mtctr	%r5			/* else load count for loop 	*/
    168 
    169 rlast2:
    170 
    171 	lbzu	%r6, -1(%r4)		/* Handle the rest, byte by 	*/
    172 	stbu	%r6, -1(%r8)		/* byte				*/
    173 
    174 	bdnz+	rlast2		 	/* Dec ctr, and branch if more	*/
    175 					/* bytes left			*/
    176 	blr
    177 
    178 #ifdef _BCOPY
    179 END(bcopy)
    180 #else
    181 END(memmove)
    182 #endif
    183