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

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  *  linux/arch/arm/lib/io-readsw-armv4.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. .insw_bad_alignment:
  14. adr r0, .insw_bad_align_msg
  15. mov r2, lr
  16. b SYMBOL_NAME(panic)
  17. .insw_bad_align_msg:
  18. .asciz "insw: bad buffer alignment (0x%p, lr=0x%08lX)n"
  19. .align
  20. .insw_align: tst r1, #1
  21. bne .insw_bad_alignment
  22. ldrh r3, [r0]
  23. strh r3, [r1], #2
  24. subs r2, r2, #1
  25. RETINSTR(moveq, pc, lr)
  26. ENTRY(__raw_readsw)
  27. teq r2, #0 @ do we have to check for the zero len?
  28. moveq pc, lr
  29. tst r1, #3
  30. bne .insw_align
  31. stmfd sp!, {r4, r5, lr}
  32. subs r2, r2, #8
  33. bmi .no_insw_8
  34. .insw_8_lp: ldrh r3, [r0]
  35. ldrh r4, [r0]
  36. orr r3, r3, r4, lsl #16
  37. ldrh r4, [r0]
  38. ldrh r5, [r0]
  39. orr r4, r4, r5, lsl #16
  40. ldrh r5, [r0]
  41. ldrh ip, [r0]
  42. orr r5, r5, ip, lsl #16
  43. ldrh ip, [r0]
  44. ldrh lr, [r0]
  45. orr ip, ip, lr, lsl #16
  46. stmia r1!, {r3 - r5, ip}
  47. subs r2, r2, #8
  48. bpl .insw_8_lp
  49. tst r2, #7
  50. LOADREGS(eqfd, sp!, {r4, r5, pc})
  51. .no_insw_8: tst r2, #4
  52. beq .no_insw_4
  53. ldrh r3, [r0]
  54. ldrh r4, [r0]
  55. orr r3, r3, r4, lsl #16
  56. ldrh r4, [r0]
  57. ldrh ip, [r0]
  58. orr r4, r4, ip, lsl #16
  59. stmia r1!, {r3, r4}
  60. .no_insw_4: tst r2, #2
  61. beq .no_insw_2
  62. ldrh r3, [r0]
  63. ldrh ip, [r0]
  64. orr r3, r3, ip, lsl #16
  65. str r3, [r1], #4
  66. .no_insw_2: tst r2, #1
  67. ldrneh r3, [r0]
  68. strneh r3, [r1]
  69. LOADREGS(fd, sp!, {r4, r5, pc})