Commit | Line | Data |
---|---|---|
080fc66f RK |
1 | /* |
2 | * linux/arch/arm/lib/io-writesw-armv3.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> | |
4dd1837d | 12 | #include <asm/export.h> |
080fc66f RK |
13 | |
14 | .Loutsw_bad_alignment: | |
15 | adr r0, .Loutsw_bad_align_msg | |
16 | mov r2, lr | |
17 | b panic | |
18 | .Loutsw_bad_align_msg: | |
19 | .asciz "outsw: bad buffer alignment (0x%p, lr=0x%08lX)\n" | |
20 | .align | |
21 | ||
22 | .Loutsw_align: tst r1, #1 | |
23 | bne .Loutsw_bad_alignment | |
24 | ||
25 | add r1, r1, #2 | |
26 | ||
27 | ldr r3, [r1, #-4] | |
28 | mov r3, r3, lsr #16 | |
29 | orr r3, r3, r3, lsl #16 | |
30 | str r3, [r0] | |
31 | subs r2, r2, #1 | |
6ebbf2ce | 32 | reteq lr |
080fc66f RK |
33 | |
34 | ENTRY(__raw_writesw) | |
35 | teq r2, #0 @ do we have to check for the zero len? | |
6ebbf2ce | 36 | reteq lr |
080fc66f RK |
37 | tst r1, #3 |
38 | bne .Loutsw_align | |
39 | ||
40 | stmfd sp!, {r4, r5, r6, lr} | |
41 | ||
42 | subs r2, r2, #8 | |
43 | bmi .Lno_outsw_8 | |
44 | ||
45 | .Loutsw_8_lp: ldmia r1!, {r3, r4, r5, r6} | |
46 | ||
47 | mov ip, r3, lsl #16 | |
48 | orr ip, ip, ip, lsr #16 | |
49 | str ip, [r0] | |
50 | ||
51 | mov ip, r3, lsr #16 | |
52 | orr ip, ip, ip, lsl #16 | |
53 | str ip, [r0] | |
54 | ||
55 | mov ip, r4, lsl #16 | |
56 | orr ip, ip, ip, lsr #16 | |
57 | str ip, [r0] | |
58 | ||
59 | mov ip, r4, lsr #16 | |
60 | orr ip, ip, ip, lsl #16 | |
61 | str ip, [r0] | |
62 | ||
63 | mov ip, r5, lsl #16 | |
64 | orr ip, ip, ip, lsr #16 | |
65 | str ip, [r0] | |
66 | ||
67 | mov ip, r5, lsr #16 | |
68 | orr ip, ip, ip, lsl #16 | |
69 | str ip, [r0] | |
70 | ||
71 | mov ip, r6, lsl #16 | |
72 | orr ip, ip, ip, lsr #16 | |
73 | str ip, [r0] | |
74 | ||
75 | mov ip, r6, lsr #16 | |
76 | orr ip, ip, ip, lsl #16 | |
77 | str ip, [r0] | |
78 | ||
79 | subs r2, r2, #8 | |
80 | bpl .Loutsw_8_lp | |
81 | ||
82 | tst r2, #7 | |
83 | ldmeqfd sp!, {r4, r5, r6, pc} | |
84 | ||
85 | .Lno_outsw_8: tst r2, #4 | |
86 | beq .Lno_outsw_4 | |
87 | ||
88 | ldmia r1!, {r3, r4} | |
89 | ||
90 | mov ip, r3, lsl #16 | |
91 | orr ip, ip, ip, lsr #16 | |
92 | str ip, [r0] | |
93 | ||
94 | mov ip, r3, lsr #16 | |
95 | orr ip, ip, ip, lsl #16 | |
96 | str ip, [r0] | |
97 | ||
98 | mov ip, r4, lsl #16 | |
99 | orr ip, ip, ip, lsr #16 | |
100 | str ip, [r0] | |
101 | ||
102 | mov ip, r4, lsr #16 | |
103 | orr ip, ip, ip, lsl #16 | |
104 | str ip, [r0] | |
105 | ||
106 | .Lno_outsw_4: tst r2, #2 | |
107 | beq .Lno_outsw_2 | |
108 | ||
109 | ldr r3, [r1], #4 | |
110 | ||
111 | mov ip, r3, lsl #16 | |
112 | orr ip, ip, ip, lsr #16 | |
113 | str ip, [r0] | |
114 | ||
115 | mov ip, r3, lsr #16 | |
116 | orr ip, ip, ip, lsl #16 | |
117 | str ip, [r0] | |
118 | ||
119 | .Lno_outsw_2: tst r2, #1 | |
120 | ||
121 | ldrne r3, [r1] | |
122 | ||
123 | movne ip, r3, lsl #16 | |
124 | orrne ip, ip, ip, lsr #16 | |
125 | strne ip, [r0] | |
126 | ||
127 | ldmfd sp!, {r4, r5, r6, pc} | |
4dd1837d | 128 | EXPORT_SYMBOL(__raw_writesw) |