Subversion Repositories openrisc_me

! Entry: arg0: destination
!        arg1: source
! Exit:  result: destination
!
! SH5 code Copyright 2002 SuperH Ltd.

#include "asm.h"

ENTRY(strcpy)

#if __SHMEDIA__

        pta/l shortstring,tr1
        ldlo.q r3,0,r4
        ptabs r18,tr4
        shlli r3,3,r7
        addi r2, 8, r0
        mcmpeq.b r4,r63,r6
        SHHI r6,r7,r6
        bnei/u r6,0,tr1 // shortstring
        pta/l no_lddst, tr2
        ori r3,-8,r23
        sub r2, r23, r0
        sub r3, r2, r21
        addi r21, 8, r20
        ldx.q r0, r21, r5
        pta/l loop, tr0
        ori r2,-8,r22
        mcmpeq.b r5, r63, r6
        bgt/u r22, r23, tr2 // no_lddst

        // r22 < r23 :  Need to do a load from the destination.
        // r22 == r23 : Doesn't actually need to load from destination,
        //              but still can be handled here.
        ldlo.q r2, 0, r9
        movi -1, r8
        SHLO r8, r7, r8
        mcmv r4, r8, r9
        stlo.q r2, 0, r9
        beqi/l r6, 0, tr0 // loop

        add r5, r63, r4
        addi r0, 8, r0
        blink tr1, r63 // shortstring
no_lddst:
        // r22 > r23: note that for r22 == r23 the sthi.q would clobber
        //            bytes before the destination region.
        stlo.q r2, 0, r4
        SHHI r4, r7, r4
        sthi.q r0, -1, r4
        beqi/l r6, 0, tr0 // loop

        add r5, r63, r4
        addi r0, 8, r0
shortstring:
#ifndef __LITTLE_ENDIAN__
        pta/l shortstring2,tr1
        byterev r4,r4
#endif
shortstring2:
        st.b r0,-8,r4
        andi r4,0xff,r5
        shlri r4,8,r4
        addi r0,1,r0
        bnei/l r5,0,tr1
        blink tr4,r63 // return
        
        .balign 8
loop:
        stlo.q r0, 0, r5
        ldx.q r0, r20, r4
        addi r0, 16, r0
        sthi.q r0, -9, r5
        mcmpeq.b r4, r63, r6
        bnei/u r6, 0, tr1 // shortstring
        ldx.q r0, r21, r5
        stlo.q r0, -8, r4
        sthi.q r0, -1, r4
        mcmpeq.b r5, r63, r6
        beqi/l r6, 0, tr0 // loop

        add r5, r63, r4
        addi r0, 8, r0
        blink tr1, r63 // shortstring

#else /* ! __SHMEDIA__, i.e. SH 1..4 / SHcompact */

#ifdef __SH5__
#define DST r2
#define SRC r3
#define TMP r4
#define RESULT R2
!        r0,r1,r3,r4: clobbered
#else
#define DST r4
#define SRC r5
#define TMP r2
#define RESULT r0
!        r1-r2,r5: clobbered
#endif
        mov     DST,r0
        or      SRC,r0
        tst     #3,r0
        SL(bf, L_setup_char_loop, mov DST,r0)
        mov.l   @SRC+,r1
        mov     #0,TMP
        cmp/str TMP,r1
        SL(bt, Longword_loop_end, sub SRC,r0)
        .align  2
Longword_loop:
        mov.l   r1,@(r0,SRC)
        mov.l   @SRC+,r1
        cmp/str TMP,r1
        bt      Longword_loop_end
        mov.l   r1,@(r0,SRC)
        mov.l   @SRC+,r1
        cmp/str TMP,r1
        bf      Longword_loop
Longword_loop_end:
        add     #-4,SRC
        add     #3,r0
        .align  2
L_char_loop:
        mov.b   @SRC+,r1
L_char_loop_start:
        tst     r1,r1
        SL(bf, L_char_loop, mov.b r1,@(r0,SRC))
        rts
        mov DST,RESULT
L_setup_char_loop:
        mov.b   @SRC+,r1
        bra L_char_loop_start
        sub SRC,r0
#endif /* ! __SHMEDIA__ */