io-writesb.S
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:2k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  *  linux/arch/arm/lib/io-writesb.S
  3.  *
  4.  *  Copyright (C) 1995-2000 Russell King
  5.  *
  6.  * This program is free software; you can redistribute it and/or modify
  7.  * it under the terms of the GNU General Public License version 2 as
  8.  * published by the Free Software Foundation.
  9.  */
  10. #include <linux/linkage.h>
  11. #include <asm/assembler.h>
  12. #include <asm/hardware.h>
  13. .outsb_align: rsb ip, ip, #4
  14. cmp ip, r2
  15. movgt ip, r2
  16. cmp ip, #2
  17. ldrb r3, [r1], #1
  18. strb r3, [r0]
  19. ldrgeb r3, [r1], #1
  20. strgeb r3, [r0]
  21. ldrgtb r3, [r1], #1
  22. strgtb r3, [r0]
  23. subs r2, r2, ip
  24. bne .outsb_aligned
  25. ENTRY(__raw_writesb)
  26. teq r2, #0 @ do we have to check for the zero len?
  27. moveq pc, lr
  28. ands ip, r1, #3
  29. bne .outsb_align
  30. .outsb_aligned: stmfd sp!, {r4 - r6, lr}
  31. subs r2, r2, #16
  32. bmi .outsb_no_16
  33. .outsb_16_lp: ldmia r1!, {r3 - r6}
  34. strb r3, [r0]
  35. mov r3, r3, lsr #8
  36. strb r3, [r0]
  37. mov r3, r3, lsr #8
  38. strb r3, [r0]
  39. mov r3, r3, lsr #8
  40. strb r3, [r0]
  41. strb r4, [r0]
  42. mov r4, r4, lsr #8
  43. strb r4, [r0]
  44. mov r4, r4, lsr #8
  45. strb r4, [r0]
  46. mov r4, r4, lsr #8
  47. strb r4, [r0]
  48. strb r5, [r0]
  49. mov r5, r5, lsr #8
  50. strb r5, [r0]
  51. mov r5, r5, lsr #8
  52. strb r5, [r0]
  53. mov r5, r5, lsr #8
  54. strb r5, [r0]
  55. strb r6, [r0]
  56. mov r6, r6, lsr #8
  57. strb r6, [r0]
  58. mov r6, r6, lsr #8
  59. strb r6, [r0]
  60. mov r6, r6, lsr #8
  61. strb r6, [r0]
  62. subs r2, r2, #16
  63. bpl .outsb_16_lp
  64. tst r2, #15
  65. LOADREGS(eqfd, sp!, {r4 - r6, pc})
  66. .outsb_no_16: tst r2, #8
  67. beq .outsb_no_8
  68. ldmia r1!, {r3, r4}
  69. strb r3, [r0]
  70. mov r3, r3, lsr #8
  71. strb r3, [r0]
  72. mov r3, r3, lsr #8
  73. strb r3, [r0]
  74. mov r3, r3, lsr #8
  75. strb r3, [r0]
  76. strb r4, [r0]
  77. mov r4, r4, lsr #8
  78. strb r4, [r0]
  79. mov r4, r4, lsr #8
  80. strb r4, [r0]
  81. mov r4, r4, lsr #8
  82. strb r4, [r0]
  83. .outsb_no_8: tst r2, #4
  84. beq .outsb_no_4
  85. ldr r3, [r1], #4
  86. strb r3, [r0]
  87. mov r3, r3, lsr #8
  88. strb r3, [r0]
  89. mov r3, r3, lsr #8
  90. strb r3, [r0]
  91. mov r3, r3, lsr #8
  92. strb r3, [r0]
  93. .outsb_no_4: ands r2, r2, #3
  94. LOADREGS(eqfd, sp!, {r4 - r6, pc})
  95. cmp r2, #2
  96. ldrb r3, [r1], #1
  97. strb r3, [r0]
  98. ldrgeb r3, [r1], #1
  99. strgeb r3, [r0]
  100. ldrgtb r3, [r1]
  101. strgtb r3, [r0]
  102. LOADREGS(fd, sp!, {r4 - r6, pc})