diff options
author | Sam Ravnborg <sam@ravnborg.org> | 2008-12-03 06:10:25 -0500 |
---|---|---|
committer | David S. Miller <davem@davemloft.net> | 2008-12-04 12:17:19 -0500 |
commit | 478b8fecda511942404ac232897a718cecd13e48 (patch) | |
tree | e022fce8ca92f93a000e1cd686255f0b126e9fd5 /arch/sparc/lib/PeeCeeI.c | |
parent | 18269c0fd4db9bec2668f895f21d742486ccb90f (diff) |
sparc,sparc64: unify lib/
o Renamed files in sparc64 to <name>_64.S when identical
to sparc32 files.
o iomap.c were equal for sparc32 and sparc64
o adjusted sparc/Makefile now we have only one lib/
Signed-off-by: Sam Ravnborg <sam@ravnborg.org>
Signed-off-by: David S. Miller <davem@davemloft.net>
Diffstat (limited to 'arch/sparc/lib/PeeCeeI.c')
-rw-r--r-- | arch/sparc/lib/PeeCeeI.c | 203 |
1 files changed, 203 insertions, 0 deletions
diff --git a/arch/sparc/lib/PeeCeeI.c b/arch/sparc/lib/PeeCeeI.c new file mode 100644 index 000000000000..46053e6ddd7b --- /dev/null +++ b/arch/sparc/lib/PeeCeeI.c | |||
@@ -0,0 +1,203 @@ | |||
1 | /* | ||
2 | * PeeCeeI.c: The emerging standard... | ||
3 | * | ||
4 | * Copyright (C) 1997 David S. Miller (davem@caip.rutgers.edu) | ||
5 | */ | ||
6 | |||
7 | #include <asm/io.h> | ||
8 | #include <asm/byteorder.h> | ||
9 | |||
10 | void outsb(unsigned long __addr, const void *src, unsigned long count) | ||
11 | { | ||
12 | void __iomem *addr = (void __iomem *) __addr; | ||
13 | const u8 *p = src; | ||
14 | |||
15 | while (count--) | ||
16 | outb(*p++, addr); | ||
17 | } | ||
18 | |||
19 | void outsw(unsigned long __addr, const void *src, unsigned long count) | ||
20 | { | ||
21 | void __iomem *addr = (void __iomem *) __addr; | ||
22 | |||
23 | while (count--) { | ||
24 | __raw_writew(*(u16 *)src, addr); | ||
25 | src += sizeof(u16); | ||
26 | } | ||
27 | } | ||
28 | |||
29 | void outsl(unsigned long __addr, const void *src, unsigned long count) | ||
30 | { | ||
31 | void __iomem *addr = (void __iomem *) __addr; | ||
32 | u32 l, l2; | ||
33 | |||
34 | if (!count) | ||
35 | return; | ||
36 | |||
37 | switch (((unsigned long)src) & 0x3) { | ||
38 | case 0x0: | ||
39 | /* src is naturally aligned */ | ||
40 | while (count--) { | ||
41 | __raw_writel(*(u32 *)src, addr); | ||
42 | src += sizeof(u32); | ||
43 | } | ||
44 | break; | ||
45 | case 0x2: | ||
46 | /* 2-byte alignment */ | ||
47 | while (count--) { | ||
48 | l = (*(u16 *)src) << 16; | ||
49 | l |= *(u16 *)(src + sizeof(u16)); | ||
50 | __raw_writel(l, addr); | ||
51 | src += sizeof(u32); | ||
52 | } | ||
53 | break; | ||
54 | case 0x1: | ||
55 | /* Hold three bytes in l each time, grab a byte from l2 */ | ||
56 | l = (*(u8 *)src) << 24; | ||
57 | l |= (*(u16 *)(src + sizeof(u8))) << 8; | ||
58 | src += sizeof(u8) + sizeof(u16); | ||
59 | while (count--) { | ||
60 | l2 = *(u32 *)src; | ||
61 | l |= (l2 >> 24); | ||
62 | __raw_writel(l, addr); | ||
63 | l = l2 << 8; | ||
64 | src += sizeof(u32); | ||
65 | } | ||
66 | break; | ||
67 | case 0x3: | ||
68 | /* Hold a byte in l each time, grab 3 bytes from l2 */ | ||
69 | l = (*(u8 *)src) << 24; | ||
70 | src += sizeof(u8); | ||
71 | while (count--) { | ||
72 | l2 = *(u32 *)src; | ||
73 | l |= (l2 >> 8); | ||
74 | __raw_writel(l, addr); | ||
75 | l = l2 << 24; | ||
76 | src += sizeof(u32); | ||
77 | } | ||
78 | break; | ||
79 | } | ||
80 | } | ||
81 | |||
82 | void insb(unsigned long __addr, void *dst, unsigned long count) | ||
83 | { | ||
84 | void __iomem *addr = (void __iomem *) __addr; | ||
85 | |||
86 | if (count) { | ||
87 | u32 *pi; | ||
88 | u8 *pb = dst; | ||
89 | |||
90 | while ((((unsigned long)pb) & 0x3) && count--) | ||
91 | *pb++ = inb(addr); | ||
92 | pi = (u32 *)pb; | ||
93 | while (count >= 4) { | ||
94 | u32 w; | ||
95 | |||
96 | w = (inb(addr) << 24); | ||
97 | w |= (inb(addr) << 16); | ||
98 | w |= (inb(addr) << 8); | ||
99 | w |= (inb(addr) << 0); | ||
100 | *pi++ = w; | ||
101 | count -= 4; | ||
102 | } | ||
103 | pb = (u8 *)pi; | ||
104 | while (count--) | ||
105 | *pb++ = inb(addr); | ||
106 | } | ||
107 | } | ||
108 | |||
109 | void insw(unsigned long __addr, void *dst, unsigned long count) | ||
110 | { | ||
111 | void __iomem *addr = (void __iomem *) __addr; | ||
112 | |||
113 | if (count) { | ||
114 | u16 *ps = dst; | ||
115 | u32 *pi; | ||
116 | |||
117 | if (((unsigned long)ps) & 0x2) { | ||
118 | *ps++ = le16_to_cpu(inw(addr)); | ||
119 | count--; | ||
120 | } | ||
121 | pi = (u32 *)ps; | ||
122 | while (count >= 2) { | ||
123 | u32 w; | ||
124 | |||
125 | w = (le16_to_cpu(inw(addr)) << 16); | ||
126 | w |= (le16_to_cpu(inw(addr)) << 0); | ||
127 | *pi++ = w; | ||
128 | count -= 2; | ||
129 | } | ||
130 | ps = (u16 *)pi; | ||
131 | if (count) | ||
132 | *ps = le16_to_cpu(inw(addr)); | ||
133 | } | ||
134 | } | ||
135 | |||
136 | void insl(unsigned long __addr, void *dst, unsigned long count) | ||
137 | { | ||
138 | void __iomem *addr = (void __iomem *) __addr; | ||
139 | |||
140 | if (count) { | ||
141 | if ((((unsigned long)dst) & 0x3) == 0) { | ||
142 | u32 *pi = dst; | ||
143 | while (count--) | ||
144 | *pi++ = le32_to_cpu(inl(addr)); | ||
145 | } else { | ||
146 | u32 l = 0, l2, *pi; | ||
147 | u16 *ps; | ||
148 | u8 *pb; | ||
149 | |||
150 | switch (((unsigned long)dst) & 3) { | ||
151 | case 0x2: | ||
152 | ps = dst; | ||
153 | count -= 1; | ||
154 | l = le32_to_cpu(inl(addr)); | ||
155 | *ps++ = l; | ||
156 | pi = (u32 *)ps; | ||
157 | while (count--) { | ||
158 | l2 = le32_to_cpu(inl(addr)); | ||
159 | *pi++ = (l << 16) | (l2 >> 16); | ||
160 | l = l2; | ||
161 | } | ||
162 | ps = (u16 *)pi; | ||
163 | *ps = l; | ||
164 | break; | ||
165 | |||
166 | case 0x1: | ||
167 | pb = dst; | ||
168 | count -= 1; | ||
169 | l = le32_to_cpu(inl(addr)); | ||
170 | *pb++ = l >> 24; | ||
171 | ps = (u16 *)pb; | ||
172 | *ps++ = ((l >> 8) & 0xffff); | ||
173 | pi = (u32 *)ps; | ||
174 | while (count--) { | ||
175 | l2 = le32_to_cpu(inl(addr)); | ||
176 | *pi++ = (l << 24) | (l2 >> 8); | ||
177 | l = l2; | ||
178 | } | ||
179 | pb = (u8 *)pi; | ||
180 | *pb = l; | ||
181 | break; | ||
182 | |||
183 | case 0x3: | ||
184 | pb = (u8 *)dst; | ||
185 | count -= 1; | ||
186 | l = le32_to_cpu(inl(addr)); | ||
187 | *pb++ = l >> 24; | ||
188 | pi = (u32 *)pb; | ||
189 | while (count--) { | ||
190 | l2 = le32_to_cpu(inl(addr)); | ||
191 | *pi++ = (l << 8) | (l2 >> 24); | ||
192 | l = l2; | ||
193 | } | ||
194 | ps = (u16 *)pi; | ||
195 | *ps++ = ((l >> 8) & 0xffff); | ||
196 | pb = (u8 *)ps; | ||
197 | *pb = l; | ||
198 | break; | ||
199 | } | ||
200 | } | ||
201 | } | ||
202 | } | ||
203 | |||