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