blob: e2ae312f0b69101469a11a918db55e56554a9438 [file] [log] [blame]
Thomas Gleixnerd2912cb2019-06-04 10:11:33 +02001/* SPDX-License-Identifier: GPL-2.0-only */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002/*
3 * linux/arch/arm/lib/io-writesb.S
4 *
5 * Copyright (C) 1995-2000 Russell King
Linus Torvalds1da177e2005-04-16 15:20:36 -07006 */
7#include <linux/linkage.h>
8#include <asm/assembler.h>
9
10 .macro outword, rd
11#ifndef __ARMEB__
12 strb \rd, [r0]
13 mov \rd, \rd, lsr #8
14 strb \rd, [r0]
15 mov \rd, \rd, lsr #8
16 strb \rd, [r0]
17 mov \rd, \rd, lsr #8
18 strb \rd, [r0]
19#else
20 mov lr, \rd, lsr #24
21 strb lr, [r0]
22 mov lr, \rd, lsr #16
23 strb lr, [r0]
24 mov lr, \rd, lsr #8
25 strb lr, [r0]
26 strb \rd, [r0]
27#endif
28 .endm
29
Nicolas Pitrea9c48142005-11-11 21:51:48 +000030.Loutsb_align: rsb ip, ip, #4
Linus Torvalds1da177e2005-04-16 15:20:36 -070031 cmp ip, r2
32 movgt ip, r2
33 cmp ip, #2
34 ldrb r3, [r1], #1
35 strb r3, [r0]
Stefan Agnere44fc382019-02-18 00:57:38 +010036 ldrbge r3, [r1], #1
37 strbge r3, [r0]
38 ldrbgt r3, [r1], #1
39 strbgt r3, [r0]
Linus Torvalds1da177e2005-04-16 15:20:36 -070040 subs r2, r2, ip
Nicolas Pitrea9c48142005-11-11 21:51:48 +000041 bne .Loutsb_aligned
Linus Torvalds1da177e2005-04-16 15:20:36 -070042
43ENTRY(__raw_writesb)
44 teq r2, #0 @ do we have to check for the zero len?
Russell King6ebbf2c2014-06-30 16:29:12 +010045 reteq lr
Linus Torvalds1da177e2005-04-16 15:20:36 -070046 ands ip, r1, #3
Nicolas Pitrea9c48142005-11-11 21:51:48 +000047 bne .Loutsb_align
Linus Torvalds1da177e2005-04-16 15:20:36 -070048
Nicolas Pitrea9c48142005-11-11 21:51:48 +000049.Loutsb_aligned:
50 stmfd sp!, {r4, r5, lr}
Linus Torvalds1da177e2005-04-16 15:20:36 -070051
52 subs r2, r2, #16
Nicolas Pitrea9c48142005-11-11 21:51:48 +000053 bmi .Loutsb_no_16
Linus Torvalds1da177e2005-04-16 15:20:36 -070054
Nicolas Pitrea9c48142005-11-11 21:51:48 +000055.Loutsb_16_lp: ldmia r1!, {r3, r4, r5, ip}
Linus Torvalds1da177e2005-04-16 15:20:36 -070056 outword r3
57 outword r4
58 outword r5
59 outword ip
60 subs r2, r2, #16
Nicolas Pitrea9c48142005-11-11 21:51:48 +000061 bpl .Loutsb_16_lp
Linus Torvalds1da177e2005-04-16 15:20:36 -070062
63 tst r2, #15
Stefan Agnere44fc382019-02-18 00:57:38 +010064 ldmfdeq sp!, {r4, r5, pc}
Linus Torvalds1da177e2005-04-16 15:20:36 -070065
Nicolas Pitrea9c48142005-11-11 21:51:48 +000066.Loutsb_no_16: tst r2, #8
67 beq .Loutsb_no_8
Linus Torvalds1da177e2005-04-16 15:20:36 -070068
69 ldmia r1!, {r3, r4}
70 outword r3
71 outword r4
72
Nicolas Pitrea9c48142005-11-11 21:51:48 +000073.Loutsb_no_8: tst r2, #4
74 beq .Loutsb_no_4
Linus Torvalds1da177e2005-04-16 15:20:36 -070075
76 ldr r3, [r1], #4
77 outword r3
78
Nicolas Pitrea9c48142005-11-11 21:51:48 +000079.Loutsb_no_4: ands r2, r2, #3
Stefan Agnere44fc382019-02-18 00:57:38 +010080 ldmfdeq sp!, {r4, r5, pc}
Linus Torvalds1da177e2005-04-16 15:20:36 -070081
82 cmp r2, #2
83 ldrb r3, [r1], #1
84 strb r3, [r0]
Stefan Agnere44fc382019-02-18 00:57:38 +010085 ldrbge r3, [r1], #1
86 strbge r3, [r0]
87 ldrbgt r3, [r1]
88 strbgt r3, [r0]
Linus Torvalds1da177e2005-04-16 15:20:36 -070089
Russell King1b93a712006-06-25 11:23:45 +010090 ldmfd sp!, {r4, r5, pc}
Catalin Marinas93ed3972008-08-28 11:22:32 +010091ENDPROC(__raw_writesb)