copy_template.S

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