TrustedFirmware Git Browser
Code Review Sign In
review.trustedfirmware.org / hafnium / third_party / linux.git / 0f672f6c0b52b7b0700b0915c72b540721af4465 / . / arch / arm / lib / io-writesb.S
blob: e2ae312f0b69101469a11a918db55e56554a9438 [file] [log] [blame]
David Brazdil0f672f62019-12-10 10:32:29 +0000[diff] [blame^]1/* SPDX-License-Identifier: GPL-2.0-only */
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000[diff] [blame]2/*
3 * linux/arch/arm/lib/io-writesb.S
4 *
5 * Copyright (C) 1995-2000 Russell King
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000[diff] [blame]6 */
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
30.Loutsb_align: rsb ip, ip, #4
31 cmp ip, r2
32 movgt ip, r2
33 cmp ip, #2
34 ldrb r3, [r1], #1
35 strb r3, [r0]
David Brazdil0f672f62019-12-10 10:32:29 +0000[diff] [blame^]36 ldrbge r3, [r1], #1
37 strbge r3, [r0]
38 ldrbgt r3, [r1], #1
39 strbgt r3, [r0]
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000[diff] [blame]40 subs r2, r2, ip
41 bne .Loutsb_aligned
42
43ENTRY(__raw_writesb)
44 teq r2, #0 @ do we have to check for the zero len?
45 reteq lr
46 ands ip, r1, #3
47 bne .Loutsb_align
48
49.Loutsb_aligned:
50 stmfd sp!, {r4, r5, lr}
51
52 subs r2, r2, #16
53 bmi .Loutsb_no_16
54
55.Loutsb_16_lp: ldmia r1!, {r3, r4, r5, ip}
56 outword r3
57 outword r4
58 outword r5
59 outword ip
60 subs r2, r2, #16
61 bpl .Loutsb_16_lp
62
63 tst r2, #15
David Brazdil0f672f62019-12-10 10:32:29 +0000[diff] [blame^]64 ldmfdeq sp!, {r4, r5, pc}
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000[diff] [blame]65
66.Loutsb_no_16: tst r2, #8
67 beq .Loutsb_no_8
68
69 ldmia r1!, {r3, r4}
70 outword r3
71 outword r4
72
73.Loutsb_no_8: tst r2, #4
74 beq .Loutsb_no_4
75
76 ldr r3, [r1], #4
77 outword r3
78
79.Loutsb_no_4: ands r2, r2, #3
David Brazdil0f672f62019-12-10 10:32:29 +0000[diff] [blame^]80 ldmfdeq sp!, {r4, r5, pc}
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000[diff] [blame]81
82 cmp r2, #2
83 ldrb r3, [r1], #1
84 strb r3, [r0]
David Brazdil0f672f62019-12-10 10:32:29 +0000[diff] [blame^]85 ldrbge r3, [r1], #1
86 strbge r3, [r0]
87 ldrbgt r3, [r1]
88 strbgt r3, [r0]
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000[diff] [blame]89
90 ldmfd sp!, {r4, r5, pc}
91ENDPROC(__raw_writesb)