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