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)
121