blob: ff4f71b579eeb454a3bba5b01120c0ee06ae3f47 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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
Nicolas Pitrea9c48142005-11-11 21:51:48 +000025.Loutsw_align: movs ip, r1, lsl #31
26 bne .Loutsw_noalign
Linus Torvalds1da177e2005-04-16 15:20:36 -070027
28 ldrh r3, [r1], #2
29 sub r2, r2, #1
30 strh r3, [r0]
31
32ENTRY(__raw_writesw)
33 teq r2, #0
34 moveq pc, lr
35 ands r3, r1, #3
Nicolas Pitrea9c48142005-11-11 21:51:48 +000036 bne .Loutsw_align
Linus Torvalds1da177e2005-04-16 15:20:36 -070037
38 stmfd sp!, {r4, r5, lr}
39
40 subs r2, r2, #8
Nicolas Pitrea9c48142005-11-11 21:51:48 +000041 bmi .Lno_outsw_8
Linus Torvalds1da177e2005-04-16 15:20:36 -070042
Nicolas Pitrea9c48142005-11-11 21:51:48 +000043.Loutsw_8_lp: ldmia r1!, {r3, r4, r5, ip}
Linus Torvalds1da177e2005-04-16 15:20:36 -070044 subs r2, r2, #8
45 outword r3
46 outword r4
47 outword r5
48 outword ip
Nicolas Pitrea9c48142005-11-11 21:51:48 +000049 bpl .Loutsw_8_lp
Linus Torvalds1da177e2005-04-16 15:20:36 -070050
Nicolas Pitrea9c48142005-11-11 21:51:48 +000051.Lno_outsw_8: tst r2, #4
52 beq .Lno_outsw_4
Linus Torvalds1da177e2005-04-16 15:20:36 -070053
54 ldmia r1!, {r3, ip}
55 outword r3
56 outword ip
57
Nicolas Pitrea9c48142005-11-11 21:51:48 +000058.Lno_outsw_4: movs r2, r2, lsl #31
59 bcc .Lno_outsw_2
Linus Torvalds1da177e2005-04-16 15:20:36 -070060
61 ldr r3, [r1], #4
62 outword r3
63
Nicolas Pitrea9c48142005-11-11 21:51:48 +000064.Lno_outsw_2: ldrneh r3, [r1]
Linus Torvalds1da177e2005-04-16 15:20:36 -070065 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
Nicolas Pitrea9c48142005-11-11 21:51:48 +000077.Loutsw_noalign:
Catalin Marinas8b592782009-07-24 12:32:57 +010078 ARM( ldr r3, [r1, -r3]! )
79 THUMB( rsb r3, r3, #0 )
80 THUMB( ldr r3, [r1, r3] )
81 THUMB( sub r1, r3 )
Linus Torvalds1da177e2005-04-16 15:20:36 -070082 subcs r2, r2, #1
83 bcs 2f
84 subs r2, r2, #2
85 bmi 3f
86
871: mov ip, r3, lsr #8
88 strh ip, [r0]
892: 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]
Nicolas Pitreaeabbbb2005-06-08 19:00:16 +010094 bpl 1b
Linus Torvalds1da177e2005-04-16 15:20:36 -070095
Nicolas Pitreaeabbbb2005-06-08 19:00:16 +010096 tst r2, #1
973: movne ip, r3, lsr #8
Linus Torvalds1da177e2005-04-16 15:20:36 -070098 strneh ip, [r0]
99 mov pc, lr
Catalin Marinas93ed3972008-08-28 11:22:32 +0100100ENDPROC(__raw_writesw)