blob: c8e85bd653b7aaa7b7cb8c30b0a90615390fd1ea [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:
78 ldr r3, [r1, -r3]!
Linus Torvalds1da177e2005-04-16 15:20:36 -070079 subcs r2, r2, #1
80 bcs 2f
81 subs r2, r2, #2
82 bmi 3f
83
841: mov ip, r3, lsr #8
85 strh ip, [r0]
862: 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]
Nicolas Pitreaeabbbb2005-06-08 19:00:16 +010091 bpl 1b
Linus Torvalds1da177e2005-04-16 15:20:36 -070092
Nicolas Pitreaeabbbb2005-06-08 19:00:16 +010093 tst r2, #1
943: movne ip, r3, lsr #8
Linus Torvalds1da177e2005-04-16 15:20:36 -070095 strneh ip, [r0]
96 mov pc, lr