Loading...
1/* SPDX-License-Identifier: GPL-2.0-only */
2/*
3 * linux/arch/arm/lib/io-readsb.S
4 *
5 * Copyright (C) 1995-2000 Russell King
6 */
7#include <linux/linkage.h>
8#include <asm/assembler.h>
9
10.Linsb_align: rsb ip, ip, #4
11 cmp ip, r2
12 movgt ip, r2
13 cmp ip, #2
14 ldrb r3, [r0]
15 strb r3, [r1], #1
16 ldrbge r3, [r0]
17 strbge r3, [r1], #1
18 ldrbgt r3, [r0]
19 strbgt r3, [r1], #1
20 subs r2, r2, ip
21 bne .Linsb_aligned
22
23ENTRY(__raw_readsb)
24 teq r2, #0 @ do we have to check for the zero len?
25 reteq lr
26 ands ip, r1, #3
27 bne .Linsb_align
28
29.Linsb_aligned: stmfd sp!, {r4 - r6, lr}
30
31 subs r2, r2, #16
32 bmi .Linsb_no_16
33
34.Linsb_16_lp: ldrb r3, [r0]
35 ldrb r4, [r0]
36 ldrb r5, [r0]
37 mov r3, r3, put_byte_0
38 ldrb r6, [r0]
39 orr r3, r3, r4, put_byte_1
40 ldrb r4, [r0]
41 orr r3, r3, r5, put_byte_2
42 ldrb r5, [r0]
43 orr r3, r3, r6, put_byte_3
44 ldrb r6, [r0]
45 mov r4, r4, put_byte_0
46 ldrb ip, [r0]
47 orr r4, r4, r5, put_byte_1
48 ldrb r5, [r0]
49 orr r4, r4, r6, put_byte_2
50 ldrb r6, [r0]
51 orr r4, r4, ip, put_byte_3
52 ldrb ip, [r0]
53 mov r5, r5, put_byte_0
54 ldrb lr, [r0]
55 orr r5, r5, r6, put_byte_1
56 ldrb r6, [r0]
57 orr r5, r5, ip, put_byte_2
58 ldrb ip, [r0]
59 orr r5, r5, lr, put_byte_3
60 ldrb lr, [r0]
61 mov r6, r6, put_byte_0
62 orr r6, r6, ip, put_byte_1
63 ldrb ip, [r0]
64 orr r6, r6, lr, put_byte_2
65 orr r6, r6, ip, put_byte_3
66 stmia r1!, {r3 - r6}
67
68 subs r2, r2, #16
69 bpl .Linsb_16_lp
70
71 tst r2, #15
72 ldmfdeq sp!, {r4 - r6, pc}
73
74.Linsb_no_16: tst r2, #8
75 beq .Linsb_no_8
76
77 ldrb r3, [r0]
78 ldrb r4, [r0]
79 ldrb r5, [r0]
80 mov r3, r3, put_byte_0
81 ldrb r6, [r0]
82 orr r3, r3, r4, put_byte_1
83 ldrb r4, [r0]
84 orr r3, r3, r5, put_byte_2
85 ldrb r5, [r0]
86 orr r3, r3, r6, put_byte_3
87 ldrb r6, [r0]
88 mov r4, r4, put_byte_0
89 ldrb ip, [r0]
90 orr r4, r4, r5, put_byte_1
91 orr r4, r4, r6, put_byte_2
92 orr r4, r4, ip, put_byte_3
93 stmia r1!, {r3, r4}
94
95.Linsb_no_8: tst r2, #4
96 beq .Linsb_no_4
97
98 ldrb r3, [r0]
99 ldrb r4, [r0]
100 ldrb r5, [r0]
101 ldrb r6, [r0]
102 mov r3, r3, put_byte_0
103 orr r3, r3, r4, put_byte_1
104 orr r3, r3, r5, put_byte_2
105 orr r3, r3, r6, put_byte_3
106 str r3, [r1], #4
107
108.Linsb_no_4: ands r2, r2, #3
109 ldmfdeq sp!, {r4 - r6, pc}
110
111 cmp r2, #2
112 ldrb r3, [r0]
113 strb r3, [r1], #1
114 ldrbge r3, [r0]
115 strbge r3, [r1], #1
116 ldrbgt r3, [r0]
117 strbgt r3, [r1]
118
119 ldmfd sp!, {r4 - r6, pc}
120ENDPROC(__raw_readsb)
1/*
2 * linux/arch/arm/lib/io-readsb.S
3 *
4 * Copyright (C) 1995-2000 Russell King
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 */
10#include <linux/linkage.h>
11#include <asm/assembler.h>
12
13.Linsb_align: rsb ip, ip, #4
14 cmp ip, r2
15 movgt ip, r2
16 cmp ip, #2
17 ldrb r3, [r0]
18 strb r3, [r1], #1
19 ldrgeb r3, [r0]
20 strgeb r3, [r1], #1
21 ldrgtb r3, [r0]
22 strgtb r3, [r1], #1
23 subs r2, r2, ip
24 bne .Linsb_aligned
25
26ENTRY(__raw_readsb)
27 teq r2, #0 @ do we have to check for the zero len?
28 reteq lr
29 ands ip, r1, #3
30 bne .Linsb_align
31
32.Linsb_aligned: stmfd sp!, {r4 - r6, lr}
33
34 subs r2, r2, #16
35 bmi .Linsb_no_16
36
37.Linsb_16_lp: ldrb r3, [r0]
38 ldrb r4, [r0]
39 ldrb r5, [r0]
40 mov r3, r3, put_byte_0
41 ldrb r6, [r0]
42 orr r3, r3, r4, put_byte_1
43 ldrb r4, [r0]
44 orr r3, r3, r5, put_byte_2
45 ldrb r5, [r0]
46 orr r3, r3, r6, put_byte_3
47 ldrb r6, [r0]
48 mov r4, r4, put_byte_0
49 ldrb ip, [r0]
50 orr r4, r4, r5, put_byte_1
51 ldrb r5, [r0]
52 orr r4, r4, r6, put_byte_2
53 ldrb r6, [r0]
54 orr r4, r4, ip, put_byte_3
55 ldrb ip, [r0]
56 mov r5, r5, put_byte_0
57 ldrb lr, [r0]
58 orr r5, r5, r6, put_byte_1
59 ldrb r6, [r0]
60 orr r5, r5, ip, put_byte_2
61 ldrb ip, [r0]
62 orr r5, r5, lr, put_byte_3
63 ldrb lr, [r0]
64 mov r6, r6, put_byte_0
65 orr r6, r6, ip, put_byte_1
66 ldrb ip, [r0]
67 orr r6, r6, lr, put_byte_2
68 orr r6, r6, ip, put_byte_3
69 stmia r1!, {r3 - r6}
70
71 subs r2, r2, #16
72 bpl .Linsb_16_lp
73
74 tst r2, #15
75 ldmeqfd sp!, {r4 - r6, pc}
76
77.Linsb_no_16: tst r2, #8
78 beq .Linsb_no_8
79
80 ldrb r3, [r0]
81 ldrb r4, [r0]
82 ldrb r5, [r0]
83 mov r3, r3, put_byte_0
84 ldrb r6, [r0]
85 orr r3, r3, r4, put_byte_1
86 ldrb r4, [r0]
87 orr r3, r3, r5, put_byte_2
88 ldrb r5, [r0]
89 orr r3, r3, r6, put_byte_3
90 ldrb r6, [r0]
91 mov r4, r4, put_byte_0
92 ldrb ip, [r0]
93 orr r4, r4, r5, put_byte_1
94 orr r4, r4, r6, put_byte_2
95 orr r4, r4, ip, put_byte_3
96 stmia r1!, {r3, r4}
97
98.Linsb_no_8: tst r2, #4
99 beq .Linsb_no_4
100
101 ldrb r3, [r0]
102 ldrb r4, [r0]
103 ldrb r5, [r0]
104 ldrb r6, [r0]
105 mov r3, r3, put_byte_0
106 orr r3, r3, r4, put_byte_1
107 orr r3, r3, r5, put_byte_2
108 orr r3, r3, r6, put_byte_3
109 str r3, [r1], #4
110
111.Linsb_no_4: ands r2, r2, #3
112 ldmeqfd sp!, {r4 - r6, pc}
113
114 cmp r2, #2
115 ldrb r3, [r0]
116 strb r3, [r1], #1
117 ldrgeb r3, [r0]
118 strgeb r3, [r1], #1
119 ldrgtb r3, [r0]
120 strgtb r3, [r1]
121
122 ldmfd sp!, {r4 - r6, pc}
123ENDPROC(__raw_readsb)