[mirror_ubuntu-jammy-kernel.git] / arch / arm / lib / io-writesw-armv4.S

/* SPDX-License-Identifier: GPL-2.0-only */
/*
 *  linux/arch/arm/lib/io-writesw-armv4.S
 *
 *  Copyright (C) 1995-2000 Russell King
 */
#include <linux/linkage.h>
#include <asm/assembler.h>

		.macro	outword, rd
#ifndef __ARMEB__
		strh	\rd, [r0]
		mov	\rd, \rd, lsr #16
		strh	\rd, [r0]
#else
		mov	lr, \rd, lsr #16
		strh	lr, [r0]
		strh	\rd, [r0]
#endif
		.endm

.Loutsw_align:	movs	ip, r1, lsl #31
		bne	.Loutsw_noalign

		ldrh	r3, [r1], #2
		sub	r2, r2, #1
		strh	r3, [r0]

ENTRY(__raw_writesw)
		teq	r2, #0
		reteq	lr
		ands	r3, r1, #3
		bne	.Loutsw_align

		stmfd	sp!, {r4, r5, lr}

		subs	r2, r2, #8
		bmi	.Lno_outsw_8

.Loutsw_8_lp:	ldmia	r1!, {r3, r4, r5, ip}
		subs	r2, r2, #8
		outword	r3
		outword	r4
		outword	r5
		outword	ip
		bpl	.Loutsw_8_lp

.Lno_outsw_8:	tst	r2, #4
		beq	.Lno_outsw_4

		ldmia	r1!, {r3, ip}
		outword	r3
		outword	ip

.Lno_outsw_4:	movs	r2, r2, lsl #31
		bcc	.Lno_outsw_2

		ldr	r3, [r1], #4
		outword	r3

.Lno_outsw_2:	ldrhne	r3, [r1]
		strhne	r3, [r0]

		ldmfd	sp!, {r4, r5, pc}

#ifdef __ARMEB__
#define pull_hbyte0	lsl #8
#define push_hbyte1	lsr #24
#else
#define pull_hbyte0	lsr #24
#define push_hbyte1	lsl #8
#endif

.Loutsw_noalign:
 ARM(		ldr	r3, [r1, -r3]!	)
 THUMB(		rsb	r3, r3, #0	)
 THUMB(		ldr	r3, [r1, r3]	)
 THUMB(		sub	r1, r3		)
		subcs	r2, r2, #1
		bcs	2f
		subs	r2, r2, #2
		bmi	3f

1:		mov	ip, r3, lsr #8
		strh	ip, [r0]
2:		mov	ip, r3, pull_hbyte0
		ldr	r3, [r1, #4]!
		subs	r2, r2, #2
		orr	ip, ip, r3, push_hbyte1
		strh	ip, [r0]
		bpl	1b

		tst	r2, #1
3:		movne	ip, r3, lsr #8
		strhne	ip, [r0]
		ret	lr
ENDPROC(__raw_writesw)
Commit	Line	Data
d2912cb1	1	/* SPDX-License-Identifier: GPL-2.0-only */
1da177e4 LT	2	/*
	3	* linux/arch/arm/lib/io-writesw-armv4.S
	4	*
	5	* Copyright (C) 1995-2000 Russell King
1da177e4 LT	6	*/
	7	#include <linux/linkage.h>
	8	#include <asm/assembler.h>
	9
	10	.macro outword, rd
	11	#ifndef __ARMEB__
	12	strh \rd, [r0]
	13	mov \rd, \rd, lsr #16
	14	strh \rd, [r0]
	15	#else
	16	mov lr, \rd, lsr #16
	17	strh lr, [r0]
	18	strh \rd, [r0]
	19	#endif
	20	.endm
	21
a9c4814d NP	22	.Loutsw_align: movs ip, r1, lsl #31
a9c4814d NP	23	bne .Loutsw_noalign
1da177e4 LT	24
	25	ldrh r3, [r1], #2
	26	sub r2, r2, #1
	27	strh r3, [r0]
	28
	29	ENTRY(__raw_writesw)
	30	teq r2, #0
6ebbf2ce	31	reteq lr
1da177e4	32	ands r3, r1, #3
a9c4814d	33	bne .Loutsw_align
1da177e4 LT	34
	35	stmfd sp!, {r4, r5, lr}
	36
	37	subs r2, r2, #8
a9c4814d	38	bmi .Lno_outsw_8
1da177e4	39
a9c4814d	40	.Loutsw_8_lp: ldmia r1!, {r3, r4, r5, ip}
1da177e4 LT	41	subs r2, r2, #8
	42	outword r3
	43	outword r4
	44	outword r5
	45	outword ip
a9c4814d	46	bpl .Loutsw_8_lp
1da177e4	47
a9c4814d NP	48	.Lno_outsw_8: tst r2, #4
a9c4814d NP	49	beq .Lno_outsw_4
1da177e4 LT	50
	51	ldmia r1!, {r3, ip}
	52	outword r3
	53	outword ip
	54
a9c4814d NP	55	.Lno_outsw_4: movs r2, r2, lsl #31
a9c4814d NP	56	bcc .Lno_outsw_2
1da177e4 LT	57
	58	ldr r3, [r1], #4
	59	outword r3
	60
e44fc388 SA	61	.Lno_outsw_2: ldrhne r3, [r1]
e44fc388 SA	62	strhne r3, [r0]
1da177e4 LT	63
	64	ldmfd sp!, {r4, r5, pc}
	65
	66	#ifdef __ARMEB__
	67	#define pull_hbyte0 lsl #8
	68	#define push_hbyte1 lsr #24
	69	#else
	70	#define pull_hbyte0 lsr #24
	71	#define push_hbyte1 lsl #8
	72	#endif
	73
a9c4814d	74	.Loutsw_noalign:
8b592783 CM	75	ARM( ldr r3, [r1, -r3]! )
	76	THUMB( rsb r3, r3, #0 )
	77	THUMB( ldr r3, [r1, r3] )
	78	THUMB( sub r1, r3 )
1da177e4 LT	79	subcs r2, r2, #1
	80	bcs 2f
	81	subs r2, r2, #2
	82	bmi 3f
	83
	84	1: mov ip, r3, lsr #8
	85	strh ip, [r0]
	86	2: mov ip, r3, pull_hbyte0
	87	ldr r3, [r1, #4]!
	88	subs r2, r2, #2
	89	orr ip, ip, r3, push_hbyte1
	90	strh ip, [r0]
aeabbbbe	91	bpl 1b
1da177e4	92
aeabbbbe NP	93	tst r2, #1
aeabbbbe NP	94	3: movne ip, r3, lsr #8
e44fc388	95	strhne ip, [r0]
6ebbf2ce	96	ret lr
93ed3970	97	ENDPROC(__raw_writesw)