^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) /* SPDX-License-Identifier: GPL-2.0-only */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * linux/arch/arm/lib/io-readsl.S
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 1995-2000 Russell King
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/linkage.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <asm/assembler.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) ENTRY(__raw_readsl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) teq r2, #0 @ do we have to check for the zero len?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) reteq lr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) ands ip, r1, #3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) bne 3f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) subs r2, r2, #4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) bmi 2f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) stmfd sp!, {r4, lr}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 1: ldr r3, [r0, #0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) ldr r4, [r0, #0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) ldr ip, [r0, #0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) ldr lr, [r0, #0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) subs r2, r2, #4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) stmia r1!, {r3, r4, ip, lr}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) bpl 1b
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) ldmfd sp!, {r4, lr}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 2: movs r2, r2, lsl #31
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) ldrcs r3, [r0, #0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) ldrcs ip, [r0, #0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) stmiacs r1!, {r3, ip}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) ldrne r3, [r0, #0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) strne r3, [r1, #0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) ret lr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 3: ldr r3, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) cmp ip, #2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) mov ip, r3, get_byte_0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) strb ip, [r1], #1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) bgt 6f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) mov ip, r3, get_byte_1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) strb ip, [r1], #1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) beq 5f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) mov ip, r3, get_byte_2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) strb ip, [r1], #1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 4: subs r2, r2, #1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) mov ip, r3, lspull #24
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) ldrne r3, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) orrne ip, ip, r3, lspush #8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) strne ip, [r1], #4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) bne 4b
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) b 8f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 5: subs r2, r2, #1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) mov ip, r3, lspull #16
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) ldrne r3, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) orrne ip, ip, r3, lspush #16
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) strne ip, [r1], #4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) bne 5b
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) b 7f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 6: subs r2, r2, #1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) mov ip, r3, lspull #8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) ldrne r3, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) orrne ip, ip, r3, lspush #24
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) strne ip, [r1], #4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) bne 6b
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) mov r3, ip, get_byte_2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) strb r3, [r1, #2]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) 7: mov r3, ip, get_byte_1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) strb r3, [r1, #1]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) 8: mov r3, ip, get_byte_0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) strb r3, [r1, #0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) ret lr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) ENDPROC(__raw_readsl)