csky: Library functions
This patch adds string optimize codes and some auxiliary codes. Signed-off-by: Chen Linfei <linfei_chen@c-sky.com> Signed-off-by: Mao Han <han_mao@c-sky.com> Signed-off-by: Guo Ren <ren_guo@c-sky.com> Reviewed-by: Arnd Bergmann <arnd@arndb.de>
This commit is contained in:
Guo Ren
27
arch/csky/abiv2/inc/abi/string.h
Normal file
27
arch/csky/abiv2/inc/abi/string.h
Normal file
@@ -0,0 +1,27 @@
|
||||
/* SPDX-License-Identifier: GPL-2.0 */
|
||||
|
||||
#ifndef __ABI_CSKY_STRING_H
|
||||
#define __ABI_CSKY_STRING_H
|
||||
|
||||
#define __HAVE_ARCH_MEMCMP
|
||||
extern int memcmp(const void *, const void *, __kernel_size_t);
|
||||
|
||||
#define __HAVE_ARCH_MEMCPY
|
||||
extern void *memcpy(void *, const void *, __kernel_size_t);
|
||||
|
||||
#define __HAVE_ARCH_MEMMOVE
|
||||
extern void *memmove(void *, const void *, __kernel_size_t);
|
||||
|
||||
#define __HAVE_ARCH_MEMSET
|
||||
extern void *memset(void *, int, __kernel_size_t);
|
||||
|
||||
#define __HAVE_ARCH_STRCMP
|
||||
extern int strcmp(const char *, const char *);
|
||||
|
||||
#define __HAVE_ARCH_STRCPY
|
||||
extern char *strcpy(char *, const char *);
|
||||
|
||||
#define __HAVE_ARCH_STRLEN
|
||||
extern __kernel_size_t strlen(const char *);
|
||||
|
||||
#endif /* __ABI_CSKY_STRING_H */
|
||||
152
arch/csky/abiv2/memcmp.S
Normal file
152
arch/csky/abiv2/memcmp.S
Normal file
@@ -0,0 +1,152 @@
|
||||
/* SPDX-License-Identifier: GPL-2.0 */
|
||||
// Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd.
|
||||
|
||||
#include <linux/linkage.h>
|
||||
#include "sysdep.h"
|
||||
|
||||
ENTRY(memcmp)
|
||||
/* Test if len less than 4 bytes. */
|
||||
mov r3, r0
|
||||
movi r0, 0
|
||||
mov r12, r4
|
||||
cmplti r2, 4
|
||||
bt .L_compare_by_byte
|
||||
|
||||
andi r13, r0, 3
|
||||
movi r19, 4
|
||||
|
||||
/* Test if s1 is not 4 bytes aligned. */
|
||||
bnez r13, .L_s1_not_aligned
|
||||
|
||||
LABLE_ALIGN
|
||||
.L_s1_aligned:
|
||||
/* If dest is aligned, then copy. */
|
||||
zext r18, r2, 31, 4
|
||||
/* Test if len less than 16 bytes. */
|
||||
bez r18, .L_compare_by_word
|
||||
|
||||
.L_compare_by_4word:
|
||||
/* If aligned, load word each time. */
|
||||
ldw r20, (r3, 0)
|
||||
ldw r21, (r1, 0)
|
||||
/* If s1[i] != s2[i], goto .L_byte_check. */
|
||||
cmpne r20, r21
|
||||
bt .L_byte_check
|
||||
|
||||
ldw r20, (r3, 4)
|
||||
ldw r21, (r1, 4)
|
||||
cmpne r20, r21
|
||||
bt .L_byte_check
|
||||
|
||||
ldw r20, (r3, 8)
|
||||
ldw r21, (r1, 8)
|
||||
cmpne r20, r21
|
||||
bt .L_byte_check
|
||||
|
||||
ldw r20, (r3, 12)
|
||||
ldw r21, (r1, 12)
|
||||
cmpne r20, r21
|
||||
bt .L_byte_check
|
||||
|
||||
PRE_BNEZAD (r18)
|
||||
addi a3, 16
|
||||
addi a1, 16
|
||||
|
||||
BNEZAD (r18, .L_compare_by_4word)
|
||||
|
||||
.L_compare_by_word:
|
||||
zext r18, r2, 3, 2
|
||||
bez r18, .L_compare_by_byte
|
||||
.L_compare_by_word_loop:
|
||||
ldw r20, (r3, 0)
|
||||
ldw r21, (r1, 0)
|
||||
addi r3, 4
|
||||
PRE_BNEZAD (r18)
|
||||
cmpne r20, r21
|
||||
addi r1, 4
|
||||
bt .L_byte_check
|
||||
BNEZAD (r18, .L_compare_by_word_loop)
|
||||
|
||||
.L_compare_by_byte:
|
||||
zext r18, r2, 1, 0
|
||||
bez r18, .L_return
|
||||
.L_compare_by_byte_loop:
|
||||
ldb r0, (r3, 0)
|
||||
ldb r4, (r1, 0)
|
||||
addi r3, 1
|
||||
subu r0, r4
|
||||
PRE_BNEZAD (r18)
|
||||
addi r1, 1
|
||||
bnez r0, .L_return
|
||||
BNEZAD (r18, .L_compare_by_byte_loop)
|
||||
|
||||
.L_return:
|
||||
mov r4, r12
|
||||
rts
|
||||
|
||||
# ifdef __CSKYBE__
|
||||
/* d[i] != s[i] in word, so we check byte 0. */
|
||||
.L_byte_check:
|
||||
xtrb0 r0, r20
|
||||
xtrb0 r2, r21
|
||||
subu r0, r2
|
||||
bnez r0, .L_return
|
||||
|
||||
/* check byte 1 */
|
||||
xtrb1 r0, r20
|
||||
xtrb1 r2, r21
|
||||
subu r0, r2
|
||||
bnez r0, .L_return
|
||||
|
||||
/* check byte 2 */
|
||||
xtrb2 r0, r20
|
||||
xtrb2 r2, r21
|
||||
subu r0, r2
|
||||
bnez r0, .L_return
|
||||
|
||||
/* check byte 3 */
|
||||
xtrb3 r0, r20
|
||||
xtrb3 r2, r21
|
||||
subu r0, r2
|
||||
# else
|
||||
/* s1[i] != s2[i] in word, so we check byte 3. */
|
||||
.L_byte_check:
|
||||
xtrb3 r0, r20
|
||||
xtrb3 r2, r21
|
||||
subu r0, r2
|
||||
bnez r0, .L_return
|
||||
|
||||
/* check byte 2 */
|
||||
xtrb2 r0, r20
|
||||
xtrb2 r2, r21
|
||||
subu r0, r2
|
||||
bnez r0, .L_return
|
||||
|
||||
/* check byte 1 */
|
||||
xtrb1 r0, r20
|
||||
xtrb1 r2, r21
|
||||
subu r0, r2
|
||||
bnez r0, .L_return
|
||||
|
||||
/* check byte 0 */
|
||||
xtrb0 r0, r20
|
||||
xtrb0 r2, r21
|
||||
subu r0, r2
|
||||
br .L_return
|
||||
# endif /* !__CSKYBE__ */
|
||||
|
||||
/* Compare when s1 is not aligned. */
|
||||
.L_s1_not_aligned:
|
||||
sub r13, r19, r13
|
||||
sub r2, r13
|
||||
.L_s1_not_aligned_loop:
|
||||
ldb r0, (r3, 0)
|
||||
ldb r4, (r1, 0)
|
||||
addi r3, 1
|
||||
subu r0, r4
|
||||
PRE_BNEZAD (r13)
|
||||
addi r1, 1
|
||||
bnez r0, .L_return
|
||||
BNEZAD (r13, .L_s1_not_aligned_loop)
|
||||
br .L_s1_aligned
|
||||
ENDPROC(memcmp)
|
||||
110
arch/csky/abiv2/memcpy.S
Normal file
110
arch/csky/abiv2/memcpy.S
Normal file
@@ -0,0 +1,110 @@
|
||||
/* SPDX-License-Identifier: GPL-2.0 */
|
||||
// Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd.
|
||||
|
||||
#include <linux/linkage.h>
|
||||
#include "sysdep.h"
|
||||
|
||||
ENTRY(__memcpy)
|
||||
ENTRY(memcpy)
|
||||
/* Test if len less than 4 bytes. */
|
||||
mov r12, r0
|
||||
cmplti r2, 4
|
||||
bt .L_copy_by_byte
|
||||
|
||||
andi r13, r0, 3
|
||||
movi r19, 4
|
||||
/* Test if dest is not 4 bytes aligned. */
|
||||
bnez r13, .L_dest_not_aligned
|
||||
|
||||
/* Hardware can handle unaligned access directly. */
|
||||
.L_dest_aligned:
|
||||
/* If dest is aligned, then copy. */
|
||||
zext r18, r2, 31, 4
|
||||
|
||||
/* Test if len less than 16 bytes. */
|
||||
bez r18, .L_len_less_16bytes
|
||||
movi r19, 0
|
||||
|
||||
LABLE_ALIGN
|
||||
.L_len_larger_16bytes:
|
||||
#if defined(__CSKY_VDSPV2__)
|
||||
vldx.8 vr0, (r1), r19
|
||||
PRE_BNEZAD (r18)
|
||||
addi r1, 16
|
||||
vstx.8 vr0, (r0), r19
|
||||
addi r0, 16
|
||||
#elif defined(__CK860__)
|
||||
ldw r3, (r1, 0)
|
||||
stw r3, (r0, 0)
|
||||
ldw r3, (r1, 4)
|
||||
stw r3, (r0, 4)
|
||||
ldw r3, (r1, 8)
|
||||
stw r3, (r0, 8)
|
||||
ldw r3, (r1, 12)
|
||||
addi r1, 16
|
||||
stw r3, (r0, 12)
|
||||
addi r0, 16
|
||||
#else
|
||||
ldw r20, (r1, 0)
|
||||
ldw r21, (r1, 4)
|
||||
ldw r22, (r1, 8)
|
||||
ldw r23, (r1, 12)
|
||||
stw r20, (r0, 0)
|
||||
stw r21, (r0, 4)
|
||||
stw r22, (r0, 8)
|
||||
stw r23, (r0, 12)
|
||||
PRE_BNEZAD (r18)
|
||||
addi r1, 16
|
||||
addi r0, 16
|
||||
#endif
|
||||
BNEZAD (r18, .L_len_larger_16bytes)
|
||||
|
||||
.L_len_less_16bytes:
|
||||
zext r18, r2, 3, 2
|
||||
bez r18, .L_copy_by_byte
|
||||
.L_len_less_16bytes_loop:
|
||||
ldw r3, (r1, 0)
|
||||
PRE_BNEZAD (r18)
|
||||
addi r1, 4
|
||||
stw r3, (r0, 0)
|
||||
addi r0, 4
|
||||
BNEZAD (r18, .L_len_less_16bytes_loop)
|
||||
|
||||
/* Test if len less than 4 bytes. */
|
||||
.L_copy_by_byte:
|
||||
zext r18, r2, 1, 0
|
||||
bez r18, .L_return
|
||||
.L_copy_by_byte_loop:
|
||||
ldb r3, (r1, 0)
|
||||
PRE_BNEZAD (r18)
|
||||
addi r1, 1
|
||||
stb r3, (r0, 0)
|
||||
addi r0, 1
|
||||
BNEZAD (r18, .L_copy_by_byte_loop)
|
||||
|
||||
.L_return:
|
||||
mov r0, r12
|
||||
rts
|
||||
|
||||
/*
|
||||
* If dest is not aligned, just copying some bytes makes the
|
||||
* dest align.
|
||||
*/
|
||||
.L_dest_not_aligned:
|
||||
sub r13, r19, r13
|
||||
sub r2, r13
|
||||
|
||||
/* Makes the dest align. */
|
||||
.L_dest_not_aligned_loop:
|
||||
ldb r3, (r1, 0)
|
||||
PRE_BNEZAD (r13)
|
||||
addi r1, 1
|
||||
stb r3, (r0, 0)
|
||||
addi r0, 1
|
||||
BNEZAD (r13, .L_dest_not_aligned_loop)
|
||||
cmplti r2, 4
|
||||
bt .L_copy_by_byte
|
||||
|
||||
/* Check whether the src is aligned. */
|
||||
jbr .L_dest_aligned
|
||||
ENDPROC(__memcpy)
|
||||
108
arch/csky/abiv2/memmove.S
Normal file
108
arch/csky/abiv2/memmove.S
Normal file
@@ -0,0 +1,108 @@
|
||||
/* SPDX-License-Identifier: GPL-2.0 */
|
||||
// Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd.
|
||||
|
||||
#include <linux/linkage.h>
|
||||
#include "sysdep.h"
|
||||
|
||||
.weak memmove
|
||||
ENTRY(__memmove)
|
||||
ENTRY(memmove)
|
||||
subu r3, r0, r1
|
||||
cmphs r3, r2
|
||||
bt memcpy
|
||||
|
||||
mov r12, r0
|
||||
addu r0, r0, r2
|
||||
addu r1, r1, r2
|
||||
|
||||
/* Test if len less than 4 bytes. */
|
||||
cmplti r2, 4
|
||||
bt .L_copy_by_byte
|
||||
|
||||
andi r13, r0, 3
|
||||
/* Test if dest is not 4 bytes aligned. */
|
||||
bnez r13, .L_dest_not_aligned
|
||||
/* Hardware can handle unaligned access directly. */
|
||||
.L_dest_aligned:
|
||||
/* If dest is aligned, then copy. */
|
||||
zext r18, r2, 31, 4
|
||||
/* Test if len less than 16 bytes. */
|
||||
bez r18, .L_len_less_16bytes
|
||||
movi r19, 0
|
||||
|
||||
/* len > 16 bytes */
|
||||
LABLE_ALIGN
|
||||
.L_len_larger_16bytes:
|
||||
subi r1, 16
|
||||
subi r0, 16
|
||||
#if defined(__CSKY_VDSPV2__)
|
||||
vldx.8 vr0, (r1), r19
|
||||
PRE_BNEZAD (r18)
|
||||
vstx.8 vr0, (r0), r19
|
||||
#elif defined(__CK860__)
|
||||
ldw r3, (r1, 12)
|
||||
stw r3, (r0, 12)
|
||||
ldw r3, (r1, 8)
|
||||
stw r3, (r0, 8)
|
||||
ldw r3, (r1, 4)
|
||||
stw r3, (r0, 4)
|
||||
ldw r3, (r1, 0)
|
||||
stw r3, (r0, 0)
|
||||
#else
|
||||
ldw r20, (r1, 0)
|
||||
ldw r21, (r1, 4)
|
||||
ldw r22, (r1, 8)
|
||||
ldw r23, (r1, 12)
|
||||
stw r20, (r0, 0)
|
||||
stw r21, (r0, 4)
|
||||
stw r22, (r0, 8)
|
||||
stw r23, (r0, 12)
|
||||
PRE_BNEZAD (r18)
|
||||
#endif
|
||||
BNEZAD (r18, .L_len_larger_16bytes)
|
||||
|
||||
.L_len_less_16bytes:
|
||||
zext r18, r2, 3, 2
|
||||
bez r18, .L_copy_by_byte
|
||||
.L_len_less_16bytes_loop:
|
||||
subi r1, 4
|
||||
subi r0, 4
|
||||
ldw r3, (r1, 0)
|
||||
PRE_BNEZAD (r18)
|
||||
stw r3, (r0, 0)
|
||||
BNEZAD (r18, .L_len_less_16bytes_loop)
|
||||
|
||||
/* Test if len less than 4 bytes. */
|
||||
.L_copy_by_byte:
|
||||
zext r18, r2, 1, 0
|
||||
bez r18, .L_return
|
||||
.L_copy_by_byte_loop:
|
||||
subi r1, 1
|
||||
subi r0, 1
|
||||
ldb r3, (r1, 0)
|
||||
PRE_BNEZAD (r18)
|
||||
stb r3, (r0, 0)
|
||||
BNEZAD (r18, .L_copy_by_byte_loop)
|
||||
|
||||
.L_return:
|
||||
mov r0, r12
|
||||
rts
|
||||
|
||||
/* If dest is not aligned, just copy some bytes makes the dest
|
||||
align. */
|
||||
.L_dest_not_aligned:
|
||||
sub r2, r13
|
||||
.L_dest_not_aligned_loop:
|
||||
subi r1, 1
|
||||
subi r0, 1
|
||||
/* Makes the dest align. */
|
||||
ldb r3, (r1, 0)
|
||||
PRE_BNEZAD (r13)
|
||||
stb r3, (r0, 0)
|
||||
BNEZAD (r13, .L_dest_not_aligned_loop)
|
||||
cmplti r2, 4
|
||||
bt .L_copy_by_byte
|
||||
/* Check whether the src is aligned. */
|
||||
jbr .L_dest_aligned
|
||||
ENDPROC(memmove)
|
||||
ENDPROC(__memmove)
|
||||
83
arch/csky/abiv2/memset.S
Normal file
83
arch/csky/abiv2/memset.S
Normal file
@@ -0,0 +1,83 @@
|
||||
/* SPDX-License-Identifier: GPL-2.0 */
|
||||
// Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd.
|
||||
|
||||
#include <linux/linkage.h>
|
||||
#include "sysdep.h"
|
||||
|
||||
.weak memset
|
||||
ENTRY(__memset)
|
||||
ENTRY(memset)
|
||||
/* Test if len less than 4 bytes. */
|
||||
mov r12, r0
|
||||
cmplti r2, 8
|
||||
bt .L_set_by_byte
|
||||
|
||||
andi r13, r0, 3
|
||||
movi r19, 4
|
||||
/* Test if dest is not 4 bytes aligned. */
|
||||
bnez r13, .L_dest_not_aligned
|
||||
/* Hardware can handle unaligned access directly. */
|
||||
.L_dest_aligned:
|
||||
zextb r3, r1
|
||||
lsli r1, 8
|
||||
or r1, r3
|
||||
lsli r3, r1, 16
|
||||
or r3, r1
|
||||
|
||||
/* If dest is aligned, then copy. */
|
||||
zext r18, r2, 31, 4
|
||||
/* Test if len less than 16 bytes. */
|
||||
bez r18, .L_len_less_16bytes
|
||||
|
||||
LABLE_ALIGN
|
||||
.L_len_larger_16bytes:
|
||||
stw r3, (r0, 0)
|
||||
stw r3, (r0, 4)
|
||||
stw r3, (r0, 8)
|
||||
stw r3, (r0, 12)
|
||||
PRE_BNEZAD (r18)
|
||||
addi r0, 16
|
||||
BNEZAD (r18, .L_len_larger_16bytes)
|
||||
|
||||
.L_len_less_16bytes:
|
||||
zext r18, r2, 3, 2
|
||||
andi r2, 3
|
||||
bez r18, .L_set_by_byte
|
||||
.L_len_less_16bytes_loop:
|
||||
stw r3, (r0, 0)
|
||||
PRE_BNEZAD (r18)
|
||||
addi r0, 4
|
||||
BNEZAD (r18, .L_len_less_16bytes_loop)
|
||||
|
||||
/* Test if len less than 4 bytes. */
|
||||
.L_set_by_byte:
|
||||
zext r18, r2, 2, 0
|
||||
bez r18, .L_return
|
||||
.L_set_by_byte_loop:
|
||||
stb r1, (r0, 0)
|
||||
PRE_BNEZAD (r18)
|
||||
addi r0, 1
|
||||
BNEZAD (r18, .L_set_by_byte_loop)
|
||||
|
||||
.L_return:
|
||||
mov r0, r12
|
||||
rts
|
||||
|
||||
/* If dest is not aligned, just set some bytes makes the dest
|
||||
align. */
|
||||
|
||||
.L_dest_not_aligned:
|
||||
sub r13, r19, r13
|
||||
sub r2, r13
|
||||
.L_dest_not_aligned_loop:
|
||||
/* Makes the dest align. */
|
||||
stb r1, (r0, 0)
|
||||
PRE_BNEZAD (r13)
|
||||
addi r0, 1
|
||||
BNEZAD (r13, .L_dest_not_aligned_loop)
|
||||
cmplti r2, 8
|
||||
bt .L_set_by_byte
|
||||
/* Check whether the src is aligned. */
|
||||
jbr .L_dest_aligned
|
||||
ENDPROC(memset)
|
||||
ENDPROC(__memset)
|
||||
168
arch/csky/abiv2/strcmp.S
Normal file
168
arch/csky/abiv2/strcmp.S
Normal file
@@ -0,0 +1,168 @@
|
||||
/* SPDX-License-Identifier: GPL-2.0 */
|
||||
// Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd.
|
||||
|
||||
#include <linux/linkage.h>
|
||||
#include "sysdep.h"
|
||||
|
||||
ENTRY(strcmp)
|
||||
mov a3, a0
|
||||
/* Check if the s1 addr is aligned. */
|
||||
xor a2, a3, a1
|
||||
andi a2, 0x3
|
||||
bnez a2, 7f
|
||||
andi t1, a0, 0x3
|
||||
bnez t1, 5f
|
||||
|
||||
1:
|
||||
/* If aligned, load word each time. */
|
||||
ldw t0, (a3, 0)
|
||||
ldw t1, (a1, 0)
|
||||
/* If s1[i] != s2[i], goto 2f. */
|
||||
cmpne t0, t1
|
||||
bt 2f
|
||||
/* If s1[i] == s2[i], check if s1 or s2 is at the end. */
|
||||
tstnbz t0
|
||||
/* If at the end, goto 3f (finish comparing). */
|
||||
bf 3f
|
||||
|
||||
ldw t0, (a3, 4)
|
||||
ldw t1, (a1, 4)
|
||||
cmpne t0, t1
|
||||
bt 2f
|
||||
tstnbz t0
|
||||
bf 3f
|
||||
|
||||
ldw t0, (a3, 8)
|
||||
ldw t1, (a1, 8)
|
||||
cmpne t0, t1
|
||||
bt 2f
|
||||
tstnbz t0
|
||||
bf 3f
|
||||
|
||||
ldw t0, (a3, 12)
|
||||
ldw t1, (a1, 12)
|
||||
cmpne t0, t1
|
||||
bt 2f
|
||||
tstnbz t0
|
||||
bf 3f
|
||||
|
||||
ldw t0, (a3, 16)
|
||||
ldw t1, (a1, 16)
|
||||
cmpne t0, t1
|
||||
bt 2f
|
||||
tstnbz t0
|
||||
bf 3f
|
||||
|
||||
ldw t0, (a3, 20)
|
||||
ldw t1, (a1, 20)
|
||||
cmpne t0, t1
|
||||
bt 2f
|
||||
tstnbz t0
|
||||
bf 3f
|
||||
|
||||
ldw t0, (a3, 24)
|
||||
ldw t1, (a1, 24)
|
||||
cmpne t0, t1
|
||||
bt 2f
|
||||
tstnbz t0
|
||||
bf 3f
|
||||
|
||||
ldw t0, (a3, 28)
|
||||
ldw t1, (a1, 28)
|
||||
cmpne t0, t1
|
||||
bt 2f
|
||||
tstnbz t0
|
||||
bf 3f
|
||||
|
||||
addi a3, 32
|
||||
addi a1, 32
|
||||
|
||||
br 1b
|
||||
|
||||
# ifdef __CSKYBE__
|
||||
/* d[i] != s[i] in word, so we check byte 0. */
|
||||
2:
|
||||
xtrb0 a0, t0
|
||||
xtrb0 a2, t1
|
||||
subu a0, a2
|
||||
bez a2, 4f
|
||||
bnez a0, 4f
|
||||
|
||||
/* check byte 1 */
|
||||
xtrb1 a0, t0
|
||||
xtrb1 a2, t1
|
||||
subu a0, a2
|
||||
bez a2, 4f
|
||||
bnez a0, 4f
|
||||
|
||||
/* check byte 2 */
|
||||
xtrb2 a0, t0
|
||||
xtrb2 a2, t1
|
||||
subu a0, a2
|
||||
bez a2, 4f
|
||||
bnez a0, 4f
|
||||
|
||||
/* check byte 3 */
|
||||
xtrb3 a0, t0
|
||||
xtrb3 a2, t1
|
||||
subu a0, a2
|
||||
# else
|
||||
/* s1[i] != s2[i] in word, so we check byte 3. */
|
||||
2:
|
||||
xtrb3 a0, t0
|
||||
xtrb3 a2, t1
|
||||
subu a0, a2
|
||||
bez a2, 4f
|
||||
bnez a0, 4f
|
||||
|
||||
/* check byte 2 */
|
||||
xtrb2 a0, t0
|
||||
xtrb2 a2, t1
|
||||
subu a0, a2
|
||||
bez a2, 4f
|
||||
bnez a0, 4f
|
||||
|
||||
/* check byte 1 */
|
||||
xtrb1 a0, t0
|
||||
xtrb1 a2, t1
|
||||
subu a0, a2
|
||||
bez a2, 4f
|
||||
bnez a0, 4f
|
||||
|
||||
/* check byte 0 */
|
||||
xtrb0 a0, t0
|
||||
xtrb0 a2, t1
|
||||
subu a0, a2
|
||||
|
||||
# endif /* !__CSKYBE__ */
|
||||
jmp lr
|
||||
3:
|
||||
movi a0, 0
|
||||
4:
|
||||
jmp lr
|
||||
|
||||
/* Compare when s1 or s2 is not aligned. */
|
||||
5:
|
||||
subi t1, 4
|
||||
6:
|
||||
ldb a0, (a3, 0)
|
||||
ldb a2, (a1, 0)
|
||||
subu a0, a2
|
||||
bez a2, 4b
|
||||
bnez a0, 4b
|
||||
addi t1, 1
|
||||
addi a1, 1
|
||||
addi a3, 1
|
||||
bnez t1, 6b
|
||||
br 1b
|
||||
|
||||
7:
|
||||
ldb a0, (a3, 0)
|
||||
addi a3, 1
|
||||
ldb a2, (a1, 0)
|
||||
addi a1, 1
|
||||
subu a0, a2
|
||||
bnez a0, 4b
|
||||
bnez a2, 7b
|
||||
jmp r15
|
||||
ENDPROC(strcmp)
|
||||
123
arch/csky/abiv2/strcpy.S
Normal file
123
arch/csky/abiv2/strcpy.S
Normal file
@@ -0,0 +1,123 @@
|
||||
/* SPDX-License-Identifier: GPL-2.0 */
|
||||
// Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd.
|
||||
|
||||
#include <linux/linkage.h>
|
||||
#include "sysdep.h"
|
||||
|
||||
ENTRY(strcpy)
|
||||
mov a3, a0
|
||||
/* Check if the src addr is aligned. */
|
||||
andi t0, a1, 3
|
||||
bnez t0, 11f
|
||||
1:
|
||||
/* Check if all the bytes in the word are not zero. */
|
||||
ldw a2, (a1)
|
||||
tstnbz a2
|
||||
bf 9f
|
||||
stw a2, (a3)
|
||||
|
||||
ldw a2, (a1, 4)
|
||||
tstnbz a2
|
||||
bf 2f
|
||||
stw a2, (a3, 4)
|
||||
|
||||
ldw a2, (a1, 8)
|
||||
tstnbz a2
|
||||
bf 3f
|
||||
stw a2, (a3, 8)
|
||||
|
||||
ldw a2, (a1, 12)
|
||||
tstnbz a2
|
||||
bf 4f
|
||||
stw a2, (a3, 12)
|
||||
|
||||
ldw a2, (a1, 16)
|
||||
tstnbz a2
|
||||
bf 5f
|
||||
stw a2, (a3, 16)
|
||||
|
||||
ldw a2, (a1, 20)
|
||||
tstnbz a2
|
||||
bf 6f
|
||||
stw a2, (a3, 20)
|
||||
|
||||
ldw a2, (a1, 24)
|
||||
tstnbz a2
|
||||
bf 7f
|
||||
stw a2, (a3, 24)
|
||||
|
||||
ldw a2, (a1, 28)
|
||||
tstnbz a2
|
||||
bf 8f
|
||||
stw a2, (a3, 28)
|
||||
|
||||
addi a3, 32
|
||||
addi a1, 32
|
||||
br 1b
|
||||
|
||||
|
||||
2:
|
||||
addi a3, 4
|
||||
br 9f
|
||||
|
||||
3:
|
||||
addi a3, 8
|
||||
br 9f
|
||||
|
||||
4:
|
||||
addi a3, 12
|
||||
br 9f
|
||||
|
||||
5:
|
||||
addi a3, 16
|
||||
br 9f
|
||||
|
||||
6:
|
||||
addi a3, 20
|
||||
br 9f
|
||||
|
||||
7:
|
||||
addi a3, 24
|
||||
br 9f
|
||||
|
||||
8:
|
||||
addi a3, 28
|
||||
9:
|
||||
# ifdef __CSKYBE__
|
||||
xtrb0 t0, a2
|
||||
st.b t0, (a3)
|
||||
bez t0, 10f
|
||||
xtrb1 t0, a2
|
||||
st.b t0, (a3, 1)
|
||||
bez t0, 10f
|
||||
xtrb2 t0, a2
|
||||
st.b t0, (a3, 2)
|
||||
bez t0, 10f
|
||||
stw a2, (a3)
|
||||
# else
|
||||
xtrb3 t0, a2
|
||||
st.b t0, (a3)
|
||||
bez t0, 10f
|
||||
xtrb2 t0, a2
|
||||
st.b t0, (a3, 1)
|
||||
bez t0, 10f
|
||||
xtrb1 t0, a2
|
||||
st.b t0, (a3, 2)
|
||||
bez t0, 10f
|
||||
stw a2, (a3)
|
||||
# endif /* !__CSKYBE__ */
|
||||
10:
|
||||
jmp lr
|
||||
|
||||
11:
|
||||
subi t0, 4
|
||||
12:
|
||||
ld.b a2, (a1)
|
||||
st.b a2, (a3)
|
||||
bez a2, 10b
|
||||
addi t0, 1
|
||||
addi a1, a1, 1
|
||||
addi a3, a3, 1
|
||||
bnez t0, 12b
|
||||
jbr 1b
|
||||
ENDPROC(strcpy)
|
||||
12
arch/csky/abiv2/strksyms.c
Normal file
12
arch/csky/abiv2/strksyms.c
Normal file
@@ -0,0 +1,12 @@
|
||||
// SPDX-License-Identifier: GPL-2.0
|
||||
// Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd.
|
||||
|
||||
#include <linux/module.h>
|
||||
|
||||
EXPORT_SYMBOL(memcpy);
|
||||
EXPORT_SYMBOL(memset);
|
||||
EXPORT_SYMBOL(memcmp);
|
||||
EXPORT_SYMBOL(memmove);
|
||||
EXPORT_SYMBOL(strcmp);
|
||||
EXPORT_SYMBOL(strcpy);
|
||||
EXPORT_SYMBOL(strlen);
|
||||
97
arch/csky/abiv2/strlen.S
Normal file
97
arch/csky/abiv2/strlen.S
Normal file
@@ -0,0 +1,97 @@
|
||||
/* SPDX-License-Identifier: GPL-2.0 */
|
||||
// Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd.
|
||||
|
||||
#include <linux/linkage.h>
|
||||
#include "sysdep.h"
|
||||
|
||||
ENTRY(strlen)
|
||||
/* Check if the start addr is aligned. */
|
||||
mov r3, r0
|
||||
andi r1, r0, 3
|
||||
movi r2, 4
|
||||
movi r0, 0
|
||||
bnez r1, .L_start_not_aligned
|
||||
|
||||
LABLE_ALIGN
|
||||
.L_start_addr_aligned:
|
||||
/* Check if all the bytes in the word are not zero. */
|
||||
ldw r1, (r3)
|
||||
tstnbz r1
|
||||
bf .L_string_tail
|
||||
|
||||
ldw r1, (r3, 4)
|
||||
addi r0, 4
|
||||
tstnbz r1
|
||||
bf .L_string_tail
|
||||
|
||||
ldw r1, (r3, 8)
|
||||
addi r0, 4
|
||||
tstnbz r1
|
||||
bf .L_string_tail
|
||||
|
||||
ldw r1, (r3, 12)
|
||||
addi r0, 4
|
||||
tstnbz r1
|
||||
bf .L_string_tail
|
||||
|
||||
ldw r1, (r3, 16)
|
||||
addi r0, 4
|
||||
tstnbz r1
|
||||
bf .L_string_tail
|
||||
|
||||
ldw r1, (r3, 20)
|
||||
addi r0, 4
|
||||
tstnbz r1
|
||||
bf .L_string_tail
|
||||
|
||||
ldw r1, (r3, 24)
|
||||
addi r0, 4
|
||||
tstnbz r1
|
||||
bf .L_string_tail
|
||||
|
||||
ldw r1, (r3, 28)
|
||||
addi r0, 4
|
||||
tstnbz r1
|
||||
bf .L_string_tail
|
||||
|
||||
addi r0, 4
|
||||
addi r3, 32
|
||||
br .L_start_addr_aligned
|
||||
|
||||
.L_string_tail:
|
||||
# ifdef __CSKYBE__
|
||||
xtrb0 r3, r1
|
||||
bez r3, .L_return
|
||||
addi r0, 1
|
||||
xtrb1 r3, r1
|
||||
bez r3, .L_return
|
||||
addi r0, 1
|
||||
xtrb2 r3, r1
|
||||
bez r3, .L_return
|
||||
addi r0, 1
|
||||
# else
|
||||
xtrb3 r3, r1
|
||||
bez r3, .L_return
|
||||
addi r0, 1
|
||||
xtrb2 r3, r1
|
||||
bez r3, .L_return
|
||||
addi r0, 1
|
||||
xtrb1 r3, r1
|
||||
bez r3, .L_return
|
||||
addi r0, 1
|
||||
# endif /* !__CSKYBE__ */
|
||||
|
||||
.L_return:
|
||||
rts
|
||||
|
||||
.L_start_not_aligned:
|
||||
sub r2, r2, r1
|
||||
.L_start_not_aligned_loop:
|
||||
ldb r1, (r3)
|
||||
PRE_BNEZAD (r2)
|
||||
addi r3, 1
|
||||
bez r1, .L_return
|
||||
addi r0, 1
|
||||
BNEZAD (r2, .L_start_not_aligned_loop)
|
||||
br .L_start_addr_aligned
|
||||
ENDPROC(strlen)
|
||||
30
arch/csky/abiv2/sysdep.h
Normal file
30
arch/csky/abiv2/sysdep.h
Normal file
@@ -0,0 +1,30 @@
|
||||
/* SPDX-License-Identifier: GPL-2.0 */
|
||||
// Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd.
|
||||
|
||||
#ifndef __SYSDEP_H
|
||||
#define __SYSDEP_H
|
||||
|
||||
#ifdef __ASSEMBLER__
|
||||
|
||||
#if defined(__CK860__)
|
||||
#define LABLE_ALIGN \
|
||||
.balignw 16, 0x6c03
|
||||
|
||||
#define PRE_BNEZAD(R)
|
||||
|
||||
#define BNEZAD(R, L) \
|
||||
bnezad R, L
|
||||
#else
|
||||
#define LABLE_ALIGN \
|
||||
.balignw 8, 0x6c03
|
||||
|
||||
#define PRE_BNEZAD(R) \
|
||||
subi R, 1
|
||||
|
||||
#define BNEZAD(R, L) \
|
||||
bnez R, L
|
||||
#endif
|
||||
|
||||
#endif
|
||||
|
||||
#endif
|
||||
Reference in New Issue
Block a user