^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-readsw-armv4.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) .macro pack, rd, hw1, hw2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #ifndef __ARMEB__
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) orr \rd, \hw1, \hw2, lsl #16
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) orr \rd, \hw2, \hw1, lsl #16
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) .endm
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) .Linsw_align: movs ip, r1, lsl #31
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) bne .Linsw_noalign
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) ldrh ip, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) sub r2, r2, #1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) strh ip, [r1], #2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) ENTRY(__raw_readsw)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) teq r2, #0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) reteq lr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) tst r1, #3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) bne .Linsw_align
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) stmfd sp!, {r4, r5, lr}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) subs r2, r2, #8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) bmi .Lno_insw_8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) .Linsw_8_lp: ldrh r3, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) ldrh r4, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) pack r3, r3, r4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) ldrh r4, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) ldrh r5, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) pack r4, r4, r5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) ldrh r5, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) ldrh ip, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) pack r5, r5, ip
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) ldrh ip, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) ldrh lr, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) pack ip, ip, lr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) subs r2, r2, #8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) stmia r1!, {r3 - r5, ip}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) bpl .Linsw_8_lp
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) .Lno_insw_8: tst r2, #4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) beq .Lno_insw_4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) ldrh r3, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) ldrh r4, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) pack r3, r3, r4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) ldrh r4, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) ldrh ip, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) pack r4, r4, ip
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) stmia r1!, {r3, r4}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) .Lno_insw_4: movs r2, r2, lsl #31
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) bcc .Lno_insw_2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) ldrh r3, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) ldrh ip, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) pack r3, r3, ip
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) str r3, [r1], #4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) .Lno_insw_2: ldrhne r3, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) strhne r3, [r1]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) ldmfd sp!, {r4, r5, pc}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) #ifdef __ARMEB__
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) #define _BE_ONLY_(code...) code
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) #define _LE_ONLY_(code...)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) #define push_hbyte0 lsr #8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) #define pull_hbyte1 lsl #24
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) #define _BE_ONLY_(code...)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) #define _LE_ONLY_(code...) code
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) #define push_hbyte0 lsl #24
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) #define pull_hbyte1 lsr #8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) .Linsw_noalign: stmfd sp!, {r4, lr}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) ldrbcc ip, [r1, #-1]!
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) bcc 1f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) ldrh ip, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) sub r2, r2, #1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) _BE_ONLY_( mov ip, ip, ror #8 )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) strb ip, [r1], #1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) _LE_ONLY_( mov ip, ip, lsr #8 )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) _BE_ONLY_( mov ip, ip, lsr #24 )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 1: subs r2, r2, #2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) bmi 3f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) _BE_ONLY_( mov ip, ip, lsl #24 )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 2: ldrh r3, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) ldrh r4, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) subs r2, r2, #2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) orr ip, ip, r3, lsl #8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) orr ip, ip, r4, push_hbyte0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) str ip, [r1], #4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) mov ip, r4, pull_hbyte1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) bpl 2b
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) _BE_ONLY_( mov ip, ip, lsr #24 )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 3: tst r2, #1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) strb ip, [r1], #1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) ldrhne ip, [r0]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) _BE_ONLY_( movne ip, ip, ror #8 )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) strbne ip, [r1], #1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) _LE_ONLY_( movne ip, ip, lsr #8 )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) _BE_ONLY_( movne ip, ip, lsr #24 )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) strbne ip, [r1]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) ldmfd sp!, {r4, pc}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) ENDPROC(__raw_readsw)
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags