Index: lib/libc/powerpc64/string/Makefile.inc =================================================================== --- /dev/null +++ lib/libc/powerpc64/string/Makefile.inc @@ -0,0 +1,4 @@ +# $FreeBSD$ + +MDSRCS+= \ + strcpy.S Index: lib/libc/powerpc64/string/strcpy.S =================================================================== --- /dev/null +++ lib/libc/powerpc64/string/strcpy.S @@ -0,0 +1,143 @@ +/*- + * Copyright (c) 2018 Instituto de Pesquisas Eldorado + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. Neither the name of the author nor the names of its contributors may + * be used to endorse or promote products derived from this software + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + */ + +#include +__FBSDID("$FreeBSD$"); + +#if 0 + RCSID("$NetBSD: strcpy.S,v 1.0 2018/05/08 13:00:49 lbianc Exp $") +#endif + +ENTRY(strcpy) + std %r3,-8(%r1) + + + andi. %r0,%r4,0x7 + beq .Lcopy_dw /* Check if address is aligned. */ + +/* Align the reading address. */ +.Lalignment: + lbz %r0,0(%r4) + cmpdi cr7,%r0,0 + stb %r0,0(%r3) + beq cr7,.Lexit + addi %r4,%r4,1 + addi %r3,%r3,1 + andi. %r0,%r4,0x7 + bne .Lalignment + +/* Copy by double word with aligned address. */ +.Lcopy_dw: + ld %r0,0(%r4) + xor %r6,%r6,%r6 + cmpb %r5,%r0,%r6 + cmpdi cr7,%r5,0 + bne cr7,.Lcheck_zero + addi %r3,%r3,-8 +.Lcopy_dw_loop: + stdu %r0,8(%r3) + ldu %r0,8(%r4) + cmpb %r5,%r0,%r6 + cmpdi cr7,%r5,0 + beq cr7,.Lcopy_dw_loop + + addi %r3,%r3,8 /* Fix r3 to use std instruction. */ +/* Find where the zero is located. */ +.Lcheck_zero: + rldicr. %r5,%r0,0,7 + beq .Lfound_on_byte_1 + rldicr. %r7,%r0,8,7 + beq .Lfound_on_byte_2 + rldicr. %r7,%r0,16,7 + beq .Lfound_on_byte_3 + rldicr. %r7,%r0,24,7 + beq .Lfound_on_byte_4 + andis. %r7,%r0,0xff00 + beq .Lfound_on_byte_5 + andis. %r7,%r0,0xff + beq .Lfound_on_byte_6 + andi. %r7,%r0,0xff00 + beq .Lfound_on_byte_7 + +/* Treatment of each byte where the zero my be found, saving + the correct register data. */ +.Lfound_on_byte_8: + std %r0,0(%r3) + b .Lexit + +.Lfound_on_byte_7: + srdi %r6,%r0,32 + stw %r6,0(%r3) + srdi %r6,%r0,16 + sth %r6,4(%r3) + srdi %r6,%r0,8 + stb %r6,6(%r3) + b .Lexit + +.Lfound_on_byte_6: + srdi %r6,%r0,32 + stw %r6,0(%r3) + srdi %r6,%r0,16 + sth %r6,4(%r3) + b .Lexit + +.Lfound_on_byte_5: + srdi %r6,%r0,32 + stw %r6,0(%r3) + srdi %r6,%r0,24 + stb %r6,4(%r3) + b .Lexit + +.Lfound_on_byte_4: + srdi %r6,%r0,32 + stw %r6,0(%r3) + b .Lexit + +.Lfound_on_byte_3: + srdi %r6,%r0,48 + sth %r6,0(%r3) + srdi %r6,%r0,40 + stb %r6,2(%r3) + b .Lexit + +.Lfound_on_byte_2: + srdi %r6,%r0,48 + sth %r6,0(%r3) + b .Lexit + +.Lfound_on_byte_1: + srdi %r6,%r0,56 + stb %r6,0(%r3) +.Lexit: + xor %r0,%r0,%r0 /* Erase data from register 0. */ + ld %r3,-8(%r1) /* Load destination address. */ + blr + +END(strcpy) + + .section .note.GNU-stack,"",%progbits