hc
2024-12-19 9370bb92b2d16684ee45cf24e879c93c509162da
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
/* SPDX-License-Identifier: GPL-2.0-only */
/*
 *  linux/arch/arm/lib/io-writesb.S
 *
 *  Copyright (C) 1995-2000 Russell King
 */
#include <linux/linkage.h>
#include <asm/assembler.h>
 
       .macro    outword, rd
#ifndef __ARMEB__
       strb    \rd, [r0]
       mov    \rd, \rd, lsr #8
       strb    \rd, [r0]
       mov    \rd, \rd, lsr #8
       strb    \rd, [r0]
       mov    \rd, \rd, lsr #8
       strb    \rd, [r0]
#else
       mov    lr, \rd, lsr #24
       strb    lr, [r0]
       mov    lr, \rd, lsr #16
       strb    lr, [r0]
       mov    lr, \rd, lsr #8
       strb    lr, [r0]
       strb    \rd, [r0]
#endif
       .endm
 
.Loutsb_align:    rsb    ip, ip, #4
       cmp    ip, r2
       movgt    ip, r2
       cmp    ip, #2
       ldrb    r3, [r1], #1
       strb    r3, [r0]
       ldrbge    r3, [r1], #1
       strbge    r3, [r0]
       ldrbgt    r3, [r1], #1
       strbgt    r3, [r0]
       subs    r2, r2, ip
       bne    .Loutsb_aligned
 
ENTRY(__raw_writesb)
       teq    r2, #0        @ do we have to check for the zero len?
       reteq    lr
       ands    ip, r1, #3
       bne    .Loutsb_align
 
.Loutsb_aligned:
       stmfd    sp!, {r4, r5, lr}
 
       subs    r2, r2, #16
       bmi    .Loutsb_no_16
 
.Loutsb_16_lp:    ldmia    r1!, {r3, r4, r5, ip}
       outword    r3
       outword    r4
       outword    r5
       outword    ip
       subs    r2, r2, #16
       bpl    .Loutsb_16_lp
 
       tst    r2, #15
       ldmfdeq    sp!, {r4, r5, pc}
 
.Loutsb_no_16:    tst    r2, #8
       beq    .Loutsb_no_8
 
       ldmia    r1!, {r3, r4}
       outword    r3
       outword    r4
 
.Loutsb_no_8:    tst    r2, #4
       beq    .Loutsb_no_4
 
       ldr    r3, [r1], #4
       outword    r3
 
.Loutsb_no_4:    ands    r2, r2, #3
       ldmfdeq    sp!, {r4, r5, pc}
 
       cmp    r2, #2
       ldrb    r3, [r1], #1
       strb    r3, [r0]
       ldrbge    r3, [r1], #1
       strbge    r3, [r0]
       ldrbgt    r3, [r1]
       strbgt    r3, [r0]
 
       ldmfd    sp!, {r4, r5, pc}
ENDPROC(__raw_writesb)