memset.S 1.0 KB

123456789101112131415161718192021222324252627282930313233
  1. // SPDX-License-Identifier: GPL-2.0
  2. // Copyright (C) 2005-2017 Andes Technology Corporation
  3. #include <linux/linkage.h>
  4. .text
  5. ENTRY(memset)
  6. move $r5, $r0 ! Return value
  7. beqz $r2, end_memset ! Exit when len = 0
  8. srli $p1, $r2, 2 ! $p1 is how many words to copy
  9. andi $r2, $r2, 3 ! How many bytes are less than a word
  10. beqz $p1, byte_set ! When n is less than a word
  11. ! set $r1 from ??????ab to abababab
  12. andi $r1, $r1, #0x00ff ! $r1 = 000000ab
  13. slli $p0, $r1, #8 ! $p0 = 0000ab00
  14. or $r1, $r1, $p0 ! $r1 = 0000abab
  15. slli $p0, $r1, #16 ! $p0 = abab0000
  16. or $r1, $r1, $p0 ! $r1 = abababab
  17. word_set:
  18. addi $p1, $p1, #-1 ! How many words left to copy
  19. smw.bim $r1, [$r0], $r1 ! Copy the word to det
  20. bnez $p1, word_set ! Still words to set, continue looping
  21. beqz $r2, end_memset ! No left byte to set
  22. byte_set: ! Less than 4 bytes left to set
  23. addi $r2, $r2, #-1 ! Decrease len by 1
  24. sbi.bi $r1, [$r0], #1 ! Set data of the next byte to $r1
  25. bnez $r2, byte_set ! Still bytes left to set
  26. end_memset:
  27. move $r0, $r5
  28. ret
  29. ENDPROC(memset)