| // 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: |