memset.S
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:3k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  * This file is subject to the terms and conditions of the GNU General Public
  3.  * License.  See the file "COPYING" in the main directory of this archive
  4.  * for more details.
  5.  *
  6.  * Copyright (C) 1998 by Ralf Baechle
  7.  */
  8. #include <asm/asm.h>
  9. #include <asm/offset.h>
  10. #include <asm/regdef.h>
  11. #define EX(insn,reg,addr,handler)
  12. 9: insn reg, addr;
  13. .section __ex_table,"a"; 
  14. PTR 9b, handler; 
  15. .previous
  16. #define F_FILL64(dst, offset, val, fixup)
  17. EX(sw, val, (offset + 0x00)(dst), fixup);
  18. EX(sw, val, (offset + 0x04)(dst), fixup);
  19. EX(sw, val, (offset + 0x08)(dst), fixup);
  20. EX(sw, val, (offset + 0x0c)(dst), fixup);
  21. EX(sw, val, (offset + 0x10)(dst), fixup);
  22. EX(sw, val, (offset + 0x14)(dst), fixup);
  23. EX(sw, val, (offset + 0x18)(dst), fixup);
  24. EX(sw, val, (offset + 0x1c)(dst), fixup);
  25. EX(sw, val, (offset + 0x20)(dst), fixup);
  26. EX(sw, val, (offset + 0x24)(dst), fixup);
  27. EX(sw, val, (offset + 0x28)(dst), fixup);
  28. EX(sw, val, (offset + 0x2c)(dst), fixup);
  29. EX(sw, val, (offset + 0x30)(dst), fixup);
  30. EX(sw, val, (offset + 0x34)(dst), fixup);
  31. EX(sw, val, (offset + 0x38)(dst), fixup);
  32. EX(sw, val, (offset + 0x3c)(dst), fixup)
  33. /*
  34.  * memset(void *s, int c, size_t n)
  35.  *
  36.  * a0: start of area to clear
  37.  * a1: char to fill with
  38.  * a2: size of area to clear
  39.  */
  40. .set noreorder
  41. .align 5
  42. LEAF(memset)
  43. beqz a1, 1f
  44.  move v0, a0 /* result */
  45. andi a1, 0xff /* spread fillword */
  46. sll t1, a1, 8
  47. or a1, t1
  48. sll t1, a1, 16
  49. or a1, t1
  50. 1:
  51. EXPORT(__bzero)
  52. sltiu t0, a2, 4 /* very small region? */
  53. bnez t0, small_memset
  54.  andi t0, a0, 3 /* aligned? */
  55. beqz t0, 1f
  56.  subu t0, 4 /* alignment in bytes */
  57. #ifdef __MIPSEB__
  58. EX(swl, a1, (a0), first_fixup) /* make word aligned */
  59. #endif
  60. #ifdef __MIPSEL__
  61. EX(swr, a1, (a0), first_fixup) /* make word aligned */
  62. #endif
  63. subu a0, t0 /* word align ptr */
  64. addu a2, t0 /* correct size */
  65. 1: ori t1, a2, 0x3f /* # of full blocks */
  66. xori t1, 0x3f
  67. beqz t1, memset_partial /* no block to fill */
  68.  andi t0, a2, 0x3c
  69. addu t1, a0 /* end address */
  70. .set reorder
  71. 1: addiu a0, 64
  72. F_FILL64(a0, -64, a1, fwd_fixup)
  73. bne t1, a0, 1b
  74. .set noreorder
  75. memset_partial:
  76. PTR_LA t1, 2f /* where to start */
  77. subu t1, t0
  78. jr t1
  79.  addu a0, t0 /* dest ptr */
  80. .set push
  81. .set noreorder
  82. .set nomacro
  83. F_FILL64(a0, -64, a1, partial_fixup) /* ... but first do wrds ... */
  84. 2: .set pop
  85. andi a2, 3 /* 0 <= n <= 3 to go */
  86. beqz a2, 1f
  87.  addu a0, a2 /* What's left */
  88. #ifdef __MIPSEB__
  89. EX(swr, a1, -1(a0), last_fixup)
  90. #endif
  91. #ifdef __MIPSEL__
  92. EX(swl, a1, -1(a0), last_fixup)
  93. #endif
  94. 1: jr ra
  95.  move a2, zero
  96. small_memset:
  97. beqz a2, 2f
  98.  addu t1, a0, a2
  99. 1: addiu a0, 1 /* fill bytewise */
  100. bne t1, a0, 1b
  101.  sb a1, -1(a0)
  102. 2: jr ra /* done */
  103.  move a2, zero
  104. END(memset)
  105. first_fixup:
  106. jr ra
  107.  nop
  108. fwd_fixup:
  109. lw t0, THREAD_BUADDR($28)
  110. andi a2, 0x3f
  111. addu a2, t1
  112. jr ra
  113.  subu a2, t0
  114. partial_fixup:
  115. lw t0, THREAD_BUADDR($28)
  116. andi a2, 3
  117. addu a2, t1
  118. jr ra
  119.  subu a2, t0
  120. last_fixup:
  121. jr ra
  122.  andi v1, a2, 3