| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128 |
- /* SPDX-License-Identifier: GPL-2.0-only */
- /*
- * linux/arch/arm/lib/io-readsw-armv4.S
- *
- * Copyright (C) 1995-2000 Russell King
- */
- #include <linux/linkage.h>
- #include <asm/assembler.h>
- .macro pack, rd, hw1, hw2
- #ifndef __ARMEB__
- orr \rd, \hw1, \hw2, lsl #16
- #else
- orr \rd, \hw2, \hw1, lsl #16
- #endif
- .endm
- .Linsw_align: movs ip, r1, lsl #31
- bne .Linsw_noalign
- ldrh ip, [r0]
- sub r2, r2, #1
- strh ip, [r1], #2
- ENTRY(__raw_readsw)
- teq r2, #0
- reteq lr
- tst r1, #3
- bne .Linsw_align
- stmfd sp!, {r4, r5, lr}
- subs r2, r2, #8
- bmi .Lno_insw_8
- .Linsw_8_lp: ldrh r3, [r0]
- ldrh r4, [r0]
- pack r3, r3, r4
- ldrh r4, [r0]
- ldrh r5, [r0]
- pack r4, r4, r5
- ldrh r5, [r0]
- ldrh ip, [r0]
- pack r5, r5, ip
- ldrh ip, [r0]
- ldrh lr, [r0]
- pack ip, ip, lr
- subs r2, r2, #8
- stmia r1!, {r3 - r5, ip}
- bpl .Linsw_8_lp
- .Lno_insw_8: tst r2, #4
- beq .Lno_insw_4
- ldrh r3, [r0]
- ldrh r4, [r0]
- pack r3, r3, r4
- ldrh r4, [r0]
- ldrh ip, [r0]
- pack r4, r4, ip
- stmia r1!, {r3, r4}
- .Lno_insw_4: movs r2, r2, lsl #31
- bcc .Lno_insw_2
- ldrh r3, [r0]
- ldrh ip, [r0]
- pack r3, r3, ip
- str r3, [r1], #4
- .Lno_insw_2: ldrhne r3, [r0]
- strhne r3, [r1]
- ldmfd sp!, {r4, r5, pc}
- #ifdef __ARMEB__
- #define _BE_ONLY_(code...) code
- #define _LE_ONLY_(code...)
- #define push_hbyte0 lsr #8
- #define pull_hbyte1 lsl #24
- #else
- #define _BE_ONLY_(code...)
- #define _LE_ONLY_(code...) code
- #define push_hbyte0 lsl #24
- #define pull_hbyte1 lsr #8
- #endif
- .Linsw_noalign: stmfd sp!, {r4, lr}
- ldrbcc ip, [r1, #-1]!
- bcc 1f
- ldrh ip, [r0]
- sub r2, r2, #1
- _BE_ONLY_( mov ip, ip, ror #8 )
- strb ip, [r1], #1
- _LE_ONLY_( mov ip, ip, lsr #8 )
- _BE_ONLY_( mov ip, ip, lsr #24 )
- 1: subs r2, r2, #2
- bmi 3f
- _BE_ONLY_( mov ip, ip, lsl #24 )
- 2: ldrh r3, [r0]
- ldrh r4, [r0]
- subs r2, r2, #2
- orr ip, ip, r3, lsl #8
- orr ip, ip, r4, push_hbyte0
- str ip, [r1], #4
- mov ip, r4, pull_hbyte1
- bpl 2b
- _BE_ONLY_( mov ip, ip, lsr #24 )
- 3: tst r2, #1
- strb ip, [r1], #1
- ldrhne ip, [r0]
- _BE_ONLY_( movne ip, ip, ror #8 )
- strbne ip, [r1], #1
- _LE_ONLY_( movne ip, ip, lsr #8 )
- _BE_ONLY_( movne ip, ip, lsr #24 )
- strbne ip, [r1]
- ldmfd sp!, {r4, pc}
- ENDPROC(__raw_readsw)
|
