70 lines
1.4 KiB
ArmAsm
70 lines
1.4 KiB
ArmAsm
|
// SPDX-License-Identifier: GPL-2.0
|
||
|
|
// Copyright (C) 2005-2017 Andes Technology Corporation
|
||
|
|
|
||
|
|
|
||
|
|
beq $r1, $r0, quit_memcpy
|
||
|
|
beqz $r2, quit_memcpy
|
||
|
|
srli $r3, $r2, #5 ! check if len < cache-line size 32
|
||
|
|
beqz $r3, word_copy_entry
|
||
|
|
andi $r4, $r0, #0x3 ! check byte-align
|
||
|
|
beqz $r4, unalign_word_copy_entry
|
||
|
|
|
||
|
|
addi $r4, $r4,#-4
|
||
|
|
abs $r4, $r4 ! check how many un-align byte to copy
|
||
|
|
sub $r2, $r2, $r4 ! update $R2
|
||
|
|
|
||
|
|
unalign_byte_copy:
|
||
|
|
lbi1 $r3, $r1, #1
|
||
|
|
addi $r4, $r4, #-1
|
||
|
|
sbi1 $r3, $r0, #1
|
||
|
|
bnez $r4, unalign_byte_copy
|
||
|
|
beqz $r2, quit_memcpy
|
||
|
|
|
||
|
|
unalign_word_copy_entry:
|
||
|
|
andi $r3, $r0, 0x1f ! check cache-line unaligncount
|
||
|
|
beqz $r3, cache_copy
|
||
|
|
|
||
|
|
addi $r3, $r3, #-32
|
||
|
|
abs $r3, $r3
|
||
|
|
sub $r2, $r2, $r3 ! update $R2
|
||
|
|
|
||
|
|
unalign_word_copy:
|
||
|
|
lmw1 $r4, $r1, $r4
|
||
|
|
addi $r3, $r3, #-4
|
||
|
|
smw1 $r4, $r0, $r4
|
||
|
|
bnez $r3, unalign_word_copy
|
||
|
|
beqz $r2, quit_memcpy
|
||
|
|
|
||
|
|
addi $r3, $r2, #-32 ! to check $r2< cache_line , than go to word_copy
|
||
|
|
bltz $r3, word_copy_entry
|
||
|
|
cache_copy:
|
||
|
|
srli $r3, $r2, #5
|
||
|
|
beqz $r3, word_copy_entry
|
||
|
|
3:
|
||
|
|
lmw1 $r17, $r1, $r24
|
||
|
|
addi $r3, $r3, #-1
|
||
|
|
smw1 $r17, $r0, $r24
|
||
|
|
bnez $r3, 3b
|
||
|
|
|
||
|
|
word_copy_entry:
|
||
|
|
andi $r2, $r2, #31
|
||
|
|
|
||
|
|
beqz $r2, quit_memcpy
|
||
|
|
5:
|
||
|
|
srli $r3, $r2, #2
|
||
|
|
beqz $r3, byte_copy
|
||
|
|
word_copy:
|
||
|
|
lmw1 $r4, $r1, $r4
|
||
|
|
addi $r3, $r3, #-1
|
||
|
|
smw1 $r4, $r0, $r4
|
||
|
|
bnez $r3, word_copy
|
||
|
|
andi $r2, $r2, #3
|
||
|
|
beqz $r2, quit_memcpy
|
||
|
|
byte_copy:
|
||
|
|
lbi1 $r3, $r1, #1
|
||
|
|
addi $r2, $r2, #-1
|
||
|
|
|
||
|
|
sbi1 $r3, $r0, #1
|
||
|
|
bnez $r2, byte_copy
|
||
|
|
quit_memcpy:
|