Subversion Repositories or1k_soc_on_altera_embedded_dev_kit

/*
 * String handling functions for PowerPC.
 *
 * Copyright (C) 1996 Paul Mackerras.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version
 * 2 of the License, or (at your option) any later version.
 */
#include <asm/processor.h>
#include <asm/errno.h>
#include <asm/ppc_asm.h>

        .section __ex_table,"a"
#ifdef CONFIG_PPC64
        .align  3
#define EXTBL   .llong
#else
        .align  2
#define EXTBL   .long
#endif
        .text
        
_GLOBAL(strcpy)
        addi    r5,r3,-1
        addi    r4,r4,-1
1:      lbzu    r0,1(r4)
        cmpwi   0,r0,0
        stbu    r0,1(r5)
        bne     1b
        blr

/* This clears out any unused part of the destination buffer,
   just as the libc version does.  -- paulus */
_GLOBAL(strncpy)
        cmpwi   0,r5,0
        beqlr
        mtctr   r5
        addi    r6,r3,-1
        addi    r4,r4,-1
1:      lbzu    r0,1(r4)
        cmpwi   0,r0,0
        stbu    r0,1(r6)
        bdnzf   2,1b            /* dec ctr, branch if ctr != 0 && !cr0.eq */
        bnelr                   /* if we didn't hit a null char, we're done */
        mfctr   r5
        cmpwi   0,r5,0          /* any space left in destination buffer? */
        beqlr                   /* we know r0 == 0 here */
2:      stbu    r0,1(r6)        /* clear it out if so */
        bdnz    2b
        blr

_GLOBAL(strcat)
        addi    r5,r3,-1
        addi    r4,r4,-1
1:      lbzu    r0,1(r5)
        cmpwi   0,r0,0
        bne     1b
        addi    r5,r5,-1
1:      lbzu    r0,1(r4)
        cmpwi   0,r0,0
        stbu    r0,1(r5)
        bne     1b
        blr

_GLOBAL(strcmp)
        addi    r5,r3,-1
        addi    r4,r4,-1
1:      lbzu    r3,1(r5)
        cmpwi   1,r3,0
        lbzu    r0,1(r4)
        subf.   r3,r0,r3
        beqlr   1
        beq     1b
        blr

_GLOBAL(strlen)
        addi    r4,r3,-1
1:      lbzu    r0,1(r4)
        cmpwi   0,r0,0
        bne     1b
        subf    r3,r3,r4
        blr

_GLOBAL(memcmp)
        cmpwi   0,r5,0
        ble-    2f
        mtctr   r5
        addi    r6,r3,-1
        addi    r4,r4,-1
1:      lbzu    r3,1(r6)
        lbzu    r0,1(r4)
        subf.   r3,r0,r3
        bdnzt   2,1b
        blr
2:      li      r3,0
        blr

_GLOBAL(memchr)
        cmpwi   0,r5,0
        ble-    2f
        mtctr   r5
        addi    r3,r3,-1
1:      lbzu    r0,1(r3)
        cmpw    0,r0,r4
        bdnzf   2,1b
        beqlr
2:      li      r3,0
        blr

_GLOBAL(__clear_user)
        addi    r6,r3,-4
        li      r3,0
        li      r5,0
        cmplwi  0,r4,4
        blt     7f
        /* clear a single word */
11:     stwu    r5,4(r6)
        beqlr
        /* clear word sized chunks */
        andi.   r0,r6,3
        add     r4,r0,r4
        subf    r6,r0,r6
        srwi    r0,r4,2
        andi.   r4,r4,3
        mtctr   r0
        bdz     7f
1:      stwu    r5,4(r6)
        bdnz    1b
        /* clear byte sized chunks */
7:      cmpwi   0,r4,0
        beqlr
        mtctr   r4
        addi    r6,r6,3
8:      stbu    r5,1(r6)
        bdnz    8b
        blr
90:     mr      r3,r4
        blr
91:     mfctr   r3
        slwi    r3,r3,2
        add     r3,r3,r4
        blr
92:     mfctr   r3
        blr

        .section __ex_table,"a"
        EXTBL   11b,90b
        EXTBL   1b,91b
        EXTBL   8b,92b
        .text

_GLOBAL(__strncpy_from_user)
        addi    r6,r3,-1
        addi    r4,r4,-1
        cmpwi   0,r5,0
        beq     2f
        mtctr   r5
1:      lbzu    r0,1(r4)
        cmpwi   0,r0,0
        stbu    r0,1(r6)
        bdnzf   2,1b            /* dec ctr, branch if ctr != 0 && !cr0.eq */
        beq     3f
2:      addi    r6,r6,1
3:      subf    r3,r3,r6
        blr
99:     li      r3,-EFAULT
        blr

        .section __ex_table,"a"
        EXTBL   1b,99b
        .text

/* r3 = str, r4 = len (> 0), r5 = top (highest addr) */
_GLOBAL(__strnlen_user)
        addi    r7,r3,-1
        subf    r6,r7,r5        /* top+1 - str */
        cmplw   0,r4,r6
        bge     0f
        mr      r6,r4
0:      mtctr   r6              /* ctr = min(len, top - str) */
1:      lbzu    r0,1(r7)        /* get next byte */
        cmpwi   0,r0,0
        bdnzf   2,1b            /* loop if --ctr != 0 && byte != 0 */
        addi    r7,r7,1
        subf    r3,r3,r7        /* number of bytes we have looked at */
        beqlr                   /* return if we found a 0 byte */
        cmpw    0,r3,r4         /* did we look at all len bytes? */
        blt     99f             /* if not, must have hit top */
        addi    r3,r4,1         /* return len + 1 to indicate no null found */
        blr
99:     li      r3,0            /* bad address, return 0 */
        blr

        .section __ex_table,"a"
        EXTBL   1b,99b