[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / arm / lib / io-writesw-armv4.S

/*
 *  linux/arch/arm/lib/io-writesw-armv4.S
 *
 *  Copyright (C) 1995-2000 Russell King
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */
#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
		moveq	pc, 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:	ldrneh	r3, [r1]
		strneh	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
		strneh	ip, [r0]
		mov	pc, lr
ENDPROC(__raw_writesw)
Commit	Line	Data
1da177e4 LT	1	/*
	2	* linux/arch/arm/lib/io-writesw-armv4.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	.macro outword, rd
	14	#ifndef __ARMEB__
	15	strh \rd, [r0]
	16	mov \rd, \rd, lsr #16
	17	strh \rd, [r0]
	18	#else
	19	mov lr, \rd, lsr #16
	20	strh lr, [r0]
	21	strh \rd, [r0]
	22	#endif
	23	.endm
	24
a9c4814d NP	25	.Loutsw_align: movs ip, r1, lsl #31
a9c4814d NP	26	bne .Loutsw_noalign
1da177e4 LT	27
	28	ldrh r3, [r1], #2
	29	sub r2, r2, #1
	30	strh r3, [r0]
	31
	32	ENTRY(__raw_writesw)
	33	teq r2, #0
	34	moveq pc, lr
	35	ands r3, r1, #3
a9c4814d	36	bne .Loutsw_align
1da177e4 LT	37
	38	stmfd sp!, {r4, r5, lr}
	39
	40	subs r2, r2, #8
a9c4814d	41	bmi .Lno_outsw_8
1da177e4	42
a9c4814d	43	.Loutsw_8_lp: ldmia r1!, {r3, r4, r5, ip}
1da177e4 LT	44	subs r2, r2, #8
	45	outword r3
	46	outword r4
	47	outword r5
	48	outword ip
a9c4814d	49	bpl .Loutsw_8_lp
1da177e4	50
a9c4814d NP	51	.Lno_outsw_8: tst r2, #4
a9c4814d NP	52	beq .Lno_outsw_4
1da177e4 LT	53
	54	ldmia r1!, {r3, ip}
	55	outword r3
	56	outword ip
	57
a9c4814d NP	58	.Lno_outsw_4: movs r2, r2, lsl #31
a9c4814d NP	59	bcc .Lno_outsw_2
1da177e4 LT	60
	61	ldr r3, [r1], #4
	62	outword r3
	63
a9c4814d	64	.Lno_outsw_2: ldrneh r3, [r1]
1da177e4 LT	65	strneh r3, [r0]
	66
	67	ldmfd sp!, {r4, r5, pc}
	68
	69	#ifdef __ARMEB__
	70	#define pull_hbyte0 lsl #8
	71	#define push_hbyte1 lsr #24
	72	#else
	73	#define pull_hbyte0 lsr #24
	74	#define push_hbyte1 lsl #8
	75	#endif
	76
a9c4814d	77	.Loutsw_noalign:
8b592783 CM	78	ARM( ldr r3, [r1, -r3]! )
	79	THUMB( rsb r3, r3, #0 )
	80	THUMB( ldr r3, [r1, r3] )
	81	THUMB( sub r1, r3 )
1da177e4 LT	82	subcs r2, r2, #1
	83	bcs 2f
	84	subs r2, r2, #2
	85	bmi 3f
	86
	87	1: mov ip, r3, lsr #8
	88	strh ip, [r0]
	89	2: mov ip, r3, pull_hbyte0
	90	ldr r3, [r1, #4]!
	91	subs r2, r2, #2
	92	orr ip, ip, r3, push_hbyte1
	93	strh ip, [r0]
aeabbbbe	94	bpl 1b
1da177e4	95
aeabbbbe NP	96	tst r2, #1
aeabbbbe NP	97	3: movne ip, r3, lsr #8
1da177e4 LT	98	strneh ip, [r0]
1da177e4 LT	99	mov pc, lr
93ed3970	100	ENDPROC(__raw_writesw)