io-readsw-armv3.S 1.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103
  1. /* SPDX-License-Identifier: GPL-2.0-only */
  2. /*
  3. * linux/arch/arm/lib/io-readsw-armv3.S
  4. *
  5. * Copyright (C) 1995-2000 Russell King
  6. */
  7. #include <linux/linkage.h>
  8. #include <asm/assembler.h>
  9. .Linsw_bad_alignment:
  10. adr r0, .Linsw_bad_align_msg
  11. mov r2, lr
  12. b panic
  13. .Linsw_bad_align_msg:
  14. .asciz "insw: bad buffer alignment (0x%p, lr=0x%08lX)\n"
  15. .align
  16. .Linsw_align: tst r1, #1
  17. bne .Linsw_bad_alignment
  18. ldr r3, [r0]
  19. strb r3, [r1], #1
  20. mov r3, r3, lsr #8
  21. strb r3, [r1], #1
  22. subs r2, r2, #1
  23. reteq lr
  24. ENTRY(__raw_readsw)
  25. teq r2, #0 @ do we have to check for the zero len?
  26. reteq lr
  27. tst r1, #3
  28. bne .Linsw_align
  29. .Linsw_aligned: mov ip, #0xff
  30. orr ip, ip, ip, lsl #8
  31. stmfd sp!, {r4, r5, r6, lr}
  32. subs r2, r2, #8
  33. bmi .Lno_insw_8
  34. .Linsw_8_lp: ldr r3, [r0]
  35. and r3, r3, ip
  36. ldr r4, [r0]
  37. orr r3, r3, r4, lsl #16
  38. ldr r4, [r0]
  39. and r4, r4, ip
  40. ldr r5, [r0]
  41. orr r4, r4, r5, lsl #16
  42. ldr r5, [r0]
  43. and r5, r5, ip
  44. ldr r6, [r0]
  45. orr r5, r5, r6, lsl #16
  46. ldr r6, [r0]
  47. and r6, r6, ip
  48. ldr lr, [r0]
  49. orr r6, r6, lr, lsl #16
  50. stmia r1!, {r3 - r6}
  51. subs r2, r2, #8
  52. bpl .Linsw_8_lp
  53. tst r2, #7
  54. ldmfdeq sp!, {r4, r5, r6, pc}
  55. .Lno_insw_8: tst r2, #4
  56. beq .Lno_insw_4
  57. ldr r3, [r0]
  58. and r3, r3, ip
  59. ldr r4, [r0]
  60. orr r3, r3, r4, lsl #16
  61. ldr r4, [r0]
  62. and r4, r4, ip
  63. ldr r5, [r0]
  64. orr r4, r4, r5, lsl #16
  65. stmia r1!, {r3, r4}
  66. .Lno_insw_4: tst r2, #2
  67. beq .Lno_insw_2
  68. ldr r3, [r0]
  69. and r3, r3, ip
  70. ldr r4, [r0]
  71. orr r3, r3, r4, lsl #16
  72. str r3, [r1], #4
  73. .Lno_insw_2: tst r2, #1
  74. ldrne r3, [r0]
  75. strbne r3, [r1], #1
  76. movne r3, r3, lsr #8
  77. strbne r3, [r1]
  78. ldmfd sp!, {r4, r5, r6, pc}