io-writesw-armv4.S 1.77 KB
Newer Older
Linus Torvalds's avatar
Linus Torvalds committed
1 2 3 4 5 6 7 8 9
/*
 *  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.
 */
10 11
#include <asm/unified.h>

Linus Torvalds's avatar
Linus Torvalds committed
12 13 14 15 16 17 18 19 20 21 22 23 24 25 26
#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

27 28
.Loutsw_align:	movs	ip, r1, lsl #31
		bne	.Loutsw_noalign
Linus Torvalds's avatar
Linus Torvalds committed
29 30 31 32 33

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

34
		.type	__raw_writesw, %function
Linus Torvalds's avatar
Linus Torvalds committed
35 36
ENTRY(__raw_writesw)
		teq	r2, #0
37
		it	eq
Linus Torvalds's avatar
Linus Torvalds committed
38 39
		moveq	pc, lr
		ands	r3, r1, #3
40
		bne	.Loutsw_align
Linus Torvalds's avatar
Linus Torvalds committed
41 42 43 44

		stmfd	sp!, {r4, r5, lr}

		subs	r2, r2, #8
45
		bmi	.Lno_outsw_8
Linus Torvalds's avatar
Linus Torvalds committed
46

47
.Loutsw_8_lp:	ldmia	r1!, {r3, r4, r5, ip}
Linus Torvalds's avatar
Linus Torvalds committed
48 49 50 51 52
		subs	r2, r2, #8
		outword	r3
		outword	r4
		outword	r5
		outword	ip
53
		bpl	.Loutsw_8_lp
Linus Torvalds's avatar
Linus Torvalds committed
54

55 56
.Lno_outsw_8:	tst	r2, #4
		beq	.Lno_outsw_4
Linus Torvalds's avatar
Linus Torvalds committed
57 58 59 60 61

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

62 63
.Lno_outsw_4:	movs	r2, r2, lsl #31
		bcc	.Lno_outsw_2
Linus Torvalds's avatar
Linus Torvalds committed
64 65 66 67

		ldr	r3, [r1], #4
		outword	r3

68 69
.Lno_outsw_2:	itt	ne
		ldrneh	r3, [r1]
Linus Torvalds's avatar
Linus Torvalds committed
70 71 72 73 74 75 76 77 78 79 80 81
		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

82
.Loutsw_noalign:
83 84 85 86 87
 ARM(		ldr	r3, [r1, -r3]!	)
 THUMB(		rsb	r3, r3, #0	)
 THUMB(		ldr	r3, [r1, r3]	)
 THUMB(		sub	r1, r3		)
		it	cs
Linus Torvalds's avatar
Linus Torvalds committed
88 89 90 91 92 93 94 95 96 97 98 99
		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]
100
		bpl	1b
Linus Torvalds's avatar
Linus Torvalds committed
101

102
		tst	r2, #1
103 104
3:		itt	ne
		movne	ip, r3, lsr #8
Linus Torvalds's avatar
Linus Torvalds committed
105 106
		strneh	ip, [r0]
		mov	pc, lr