Subversion Repositories or1k

/*
 *  linux/arch/or32/lib/string.S
 *
 *  or32 version
 *    author(s): Matjaz Breskvar (phoenix@opencores.org)
 *
 *  changes:
 *  18. 11. 2003: Matjaz Breskvar (phoenix@opencores.org)
 *    initial port to or32 architecture
 *
 */

#include <linux/linkage.h>
#include <linux/config.h>
#include <asm/processor.h>
#include <asm/cache.h>
#include <asm/errno.h>
#include <asm/or32_asm.h>

        /*
         * this can be optimized by doing gcc inline assemlby with
         * proper constraints (no need to save args registers...)
         *
         */

        
/*
 *
 * int __copy_tofrom_user(void *to, const void *from, unsigned long size);
 *
 * NOTE: it returns number of bytes NOT copied !!!
 *
 */
        .global ___copy_tofrom_user
___copy_tofrom_user:
        l.addi  r1,r1,-12
        l.sw    0(r1),r6
        l.sw    4(r1),r4
        l.sw    8(r1),r3
        
        l.addi  r11,r5,0
2:      l.sfeq  r11,r0
        l.bf    1f
        l.addi  r11,r11,-1
8:      l.lbz   r6,0(r4)
9:      l.sb    0(r3),r6
        l.addi  r3,r3,1
        l.j     2b
        l.addi  r4,r4,1
1:
        l.addi  r11,r11,1               // r11 holds the return value
                
        l.lwz   r6,0(r1)
        l.lwz   r4,4(r1)
        l.lwz   r3,8(r1)
        l.jr    r9
        l.addi  r1,r1,12

        .section .fixup, "ax"
99:             
                l.j     1b
                l.nop
        .previous

        .section __ex_table, "a"
                .long 8b, 99b           // read fault
                .long 9b, 99b           // write fault
        .previous

/*
 * unsigned long clear_user(void *addr, unsigned long size) ;
 *
 * NOTE: it returns number of bytes NOT cleared !!!
 */
        .global ___clear_user
___clear_user:
        l.addi  r1,r1,-8
        l.sw    0(r1),r4
        l.sw    4(r1),r3
        
2:      l.sfeq  r4,r0
        l.bf    1f
        l.addi  r4,r4,-1        
9:      l.sb    0(r3),r0
        l.j     2b
        l.addi  r3,r3,1
        
1:
        l.addi  r11,r4,1
        
        l.lwz   r4,0(r1)
        l.lwz   r3,4(r1)
        l.jr    r9
        l.addi  r1,r1,8
        
        .section .fixup, "ax"
99:             
                l.j     1b
                l.nop
        .previous

        .section __ex_table, "a"
                .long 9b, 99b           // write fault
        .previous

/*
 * long strncpy_from_user(char *dst, const char *src, long count)
 *
 *
 */
        .global ___strncpy_from_user
___strncpy_from_user:
        l.addi  r1,r1,-16
        l.sw    0(r1),r6
        l.sw    4(r1),r5
        l.sw    8(r1),r4
        l.sw    12(r1),r3

        l.addi  r11,r5,0
2:      l.sfeq  r5,r0
        l.bf    1f
        l.addi  r5,r5,-1
8:      l.lbz   r6,0(r4)
        l.sfeq  r6,r0
        l.bf    1f
9:      l.sb    0(r3),r6
        l.addi  r3,r3,1
        l.j     2b
        l.addi  r4,r4,1
1:      
        l.lwz   r6,0(r1)
        l.addi  r5,r5,1
        l.sub   r11,r11,r5              // r11 holds the return value

        l.lwz   r6,0(r1)
        l.lwz   r5,4(r1)
        l.lwz   r4,8(r1)
        l.lwz   r3,12(r1)
        l.jr    r9
        l.addi  r1,r1,16

        .section .fixup, "ax"
99:             
                l.movhi r11,hi(-EFAULT)
                l.ori   r11,r11,lo(-EFAULT)

                l.lwz   r6,0(r1)
                l.lwz   r5,4(r1)
                l.lwz   r4,8(r1)
                l.lwz   r3,12(r1)
                l.jr    r9
                l.addi  r1,r1,16
        .previous

        .section __ex_table, "a"
                .long 8b, 99b           // read fault
        .previous

/*
 * extern int __strnlen_user(const char *str, long len, unsigned long top);
 *
 *
 * RTRN: - length of a string including NUL termination character
 *       - on page fault 0
 */
                
        .global ___strnlen_user
___strnlen_user:
        l.addi  r1,r1,-8
        l.sw    0(r1),r6
        l.sw    4(r1),r3

        l.addi  r11,r0,0
2:      l.sfeq  r11,r4
        l.bf    1f
        l.addi  r11,r11,1
8:      l.lbz   r6,0(r3)
        l.sfeq  r6,r0
        l.bf    1f
        l.sfgeu r3,r5                  // are we over the top ?
        l.bf    99f
        l.j     2b  
        l.addi  r3,r3,1

1:      
        l.lwz   r6,0(r1)
        l.lwz   r3,4(r1)
        l.jr    r9
        l.addi  r1,r1,8
        
        .section .fixup, "ax"
99:             
                l.addi  r11,r0,0
        
                l.lwz   r6,0(r1)
                l.lwz   r3,4(r1)
                l.jr    r9
                l.addi  r1,r1,8
        .previous

        .section __ex_table, "a"
                .long 8b, 99b           // read fault
        .previous