]>
Commit | Line | Data |
---|---|---|
ab93bbe2 FB |
1 | #ifndef BSWAP_H |
2 | #define BSWAP_H | |
3 | ||
4 | #include "config-host.h" | |
5 | ||
6 | #include <inttypes.h> | |
7 | ||
5735147e | 8 | #ifdef CONFIG_MACHINE_BSWAP_H |
1360677c BS |
9 | #include <sys/endian.h> |
10 | #include <sys/types.h> | |
11 | #include <machine/bswap.h> | |
12 | #else | |
13 | ||
936dfb80 | 14 | #ifdef CONFIG_BYTESWAP_H |
ab93bbe2 FB |
15 | #include <byteswap.h> |
16 | #else | |
17 | ||
18 | #define bswap_16(x) \ | |
19 | ({ \ | |
20 | uint16_t __x = (x); \ | |
21 | ((uint16_t)( \ | |
22 | (((uint16_t)(__x) & (uint16_t)0x00ffU) << 8) | \ | |
23 | (((uint16_t)(__x) & (uint16_t)0xff00U) >> 8) )); \ | |
24 | }) | |
25 | ||
26 | #define bswap_32(x) \ | |
27 | ({ \ | |
28 | uint32_t __x = (x); \ | |
29 | ((uint32_t)( \ | |
30 | (((uint32_t)(__x) & (uint32_t)0x000000ffUL) << 24) | \ | |
31 | (((uint32_t)(__x) & (uint32_t)0x0000ff00UL) << 8) | \ | |
32 | (((uint32_t)(__x) & (uint32_t)0x00ff0000UL) >> 8) | \ | |
33 | (((uint32_t)(__x) & (uint32_t)0xff000000UL) >> 24) )); \ | |
34 | }) | |
35 | ||
36 | #define bswap_64(x) \ | |
37 | ({ \ | |
38 | uint64_t __x = (x); \ | |
39 | ((uint64_t)( \ | |
40 | (uint64_t)(((uint64_t)(__x) & (uint64_t)0x00000000000000ffULL) << 56) | \ | |
41 | (uint64_t)(((uint64_t)(__x) & (uint64_t)0x000000000000ff00ULL) << 40) | \ | |
42 | (uint64_t)(((uint64_t)(__x) & (uint64_t)0x0000000000ff0000ULL) << 24) | \ | |
43 | (uint64_t)(((uint64_t)(__x) & (uint64_t)0x00000000ff000000ULL) << 8) | \ | |
44 | (uint64_t)(((uint64_t)(__x) & (uint64_t)0x000000ff00000000ULL) >> 8) | \ | |
45 | (uint64_t)(((uint64_t)(__x) & (uint64_t)0x0000ff0000000000ULL) >> 24) | \ | |
46 | (uint64_t)(((uint64_t)(__x) & (uint64_t)0x00ff000000000000ULL) >> 40) | \ | |
47 | (uint64_t)(((uint64_t)(__x) & (uint64_t)0xff00000000000000ULL) >> 56) )); \ | |
48 | }) | |
49 | ||
936dfb80 | 50 | #endif /* !CONFIG_BYTESWAP_H */ |
ab93bbe2 | 51 | |
ab93bbe2 FB |
52 | static inline uint16_t bswap16(uint16_t x) |
53 | { | |
54 | return bswap_16(x); | |
55 | } | |
56 | ||
5fafdf24 | 57 | static inline uint32_t bswap32(uint32_t x) |
ab93bbe2 FB |
58 | { |
59 | return bswap_32(x); | |
60 | } | |
61 | ||
5fafdf24 | 62 | static inline uint64_t bswap64(uint64_t x) |
ab93bbe2 FB |
63 | { |
64 | return bswap_64(x); | |
65 | } | |
66 | ||
5735147e | 67 | #endif /* ! CONFIG_MACHINE_BSWAP_H */ |
1360677c | 68 | |
ab93bbe2 FB |
69 | static inline void bswap16s(uint16_t *s) |
70 | { | |
71 | *s = bswap16(*s); | |
72 | } | |
73 | ||
74 | static inline void bswap32s(uint32_t *s) | |
75 | { | |
76 | *s = bswap32(*s); | |
77 | } | |
78 | ||
79 | static inline void bswap64s(uint64_t *s) | |
80 | { | |
81 | *s = bswap64(*s); | |
82 | } | |
83 | ||
e2542fe2 | 84 | #if defined(HOST_WORDS_BIGENDIAN) |
af8ffdfd FB |
85 | #define be_bswap(v, size) (v) |
86 | #define le_bswap(v, size) bswap ## size(v) | |
87 | #define be_bswaps(v, size) | |
88 | #define le_bswaps(p, size) *p = bswap ## size(*p); | |
89 | #else | |
90 | #define le_bswap(v, size) (v) | |
91 | #define be_bswap(v, size) bswap ## size(v) | |
92 | #define le_bswaps(v, size) | |
93 | #define be_bswaps(p, size) *p = bswap ## size(*p); | |
94 | #endif | |
95 | ||
96 | #define CPU_CONVERT(endian, size, type)\ | |
97 | static inline type endian ## size ## _to_cpu(type v)\ | |
98 | {\ | |
99 | return endian ## _bswap(v, size);\ | |
100 | }\ | |
101 | \ | |
102 | static inline type cpu_to_ ## endian ## size(type v)\ | |
103 | {\ | |
104 | return endian ## _bswap(v, size);\ | |
105 | }\ | |
106 | \ | |
107 | static inline void endian ## size ## _to_cpus(type *p)\ | |
108 | {\ | |
109 | endian ## _bswaps(p, size)\ | |
110 | }\ | |
111 | \ | |
112 | static inline void cpu_to_ ## endian ## size ## s(type *p)\ | |
113 | {\ | |
114 | endian ## _bswaps(p, size)\ | |
115 | }\ | |
116 | \ | |
117 | static inline type endian ## size ## _to_cpup(const type *p)\ | |
118 | {\ | |
119 | return endian ## size ## _to_cpu(*p);\ | |
120 | }\ | |
121 | \ | |
122 | static inline void cpu_to_ ## endian ## size ## w(type *p, type v)\ | |
123 | {\ | |
124 | *p = cpu_to_ ## endian ## size(v);\ | |
125 | } | |
126 | ||
127 | CPU_CONVERT(be, 16, uint16_t) | |
128 | CPU_CONVERT(be, 32, uint32_t) | |
129 | CPU_CONVERT(be, 64, uint64_t) | |
130 | ||
131 | CPU_CONVERT(le, 16, uint16_t) | |
132 | CPU_CONVERT(le, 32, uint32_t) | |
133 | CPU_CONVERT(le, 64, uint64_t) | |
134 | ||
135 | /* unaligned versions (optimized for frequent unaligned accesses)*/ | |
136 | ||
e58ffeb3 | 137 | #if defined(__i386__) || defined(_ARCH_PPC) |
af8ffdfd FB |
138 | |
139 | #define cpu_to_le16wu(p, v) cpu_to_le16w(p, v) | |
140 | #define cpu_to_le32wu(p, v) cpu_to_le32w(p, v) | |
141 | #define le16_to_cpupu(p) le16_to_cpup(p) | |
142 | #define le32_to_cpupu(p) le32_to_cpup(p) | |
88738c09 | 143 | #define be32_to_cpupu(p) be32_to_cpup(p) |
af8ffdfd | 144 | |
188d8579 FB |
145 | #define cpu_to_be16wu(p, v) cpu_to_be16w(p, v) |
146 | #define cpu_to_be32wu(p, v) cpu_to_be32w(p, v) | |
102c2976 | 147 | #define cpu_to_be64wu(p, v) cpu_to_be64w(p, v) |
188d8579 | 148 | |
af8ffdfd FB |
149 | #else |
150 | ||
151 | static inline void cpu_to_le16wu(uint16_t *p, uint16_t v) | |
152 | { | |
153 | uint8_t *p1 = (uint8_t *)p; | |
154 | ||
9e622b15 | 155 | p1[0] = v & 0xff; |
af8ffdfd FB |
156 | p1[1] = v >> 8; |
157 | } | |
158 | ||
159 | static inline void cpu_to_le32wu(uint32_t *p, uint32_t v) | |
160 | { | |
161 | uint8_t *p1 = (uint8_t *)p; | |
162 | ||
9e622b15 | 163 | p1[0] = v & 0xff; |
af8ffdfd FB |
164 | p1[1] = v >> 8; |
165 | p1[2] = v >> 16; | |
166 | p1[3] = v >> 24; | |
167 | } | |
168 | ||
169 | static inline uint16_t le16_to_cpupu(const uint16_t *p) | |
170 | { | |
171 | const uint8_t *p1 = (const uint8_t *)p; | |
172 | return p1[0] | (p1[1] << 8); | |
173 | } | |
174 | ||
175 | static inline uint32_t le32_to_cpupu(const uint32_t *p) | |
176 | { | |
177 | const uint8_t *p1 = (const uint8_t *)p; | |
178 | return p1[0] | (p1[1] << 8) | (p1[2] << 16) | (p1[3] << 24); | |
179 | } | |
180 | ||
88738c09 AJ |
181 | static inline uint32_t be32_to_cpupu(const uint32_t *p) |
182 | { | |
183 | const uint8_t *p1 = (const uint8_t *)p; | |
184 | return p1[3] | (p1[2] << 8) | (p1[1] << 16) | (p1[0] << 24); | |
185 | } | |
186 | ||
188d8579 FB |
187 | static inline void cpu_to_be16wu(uint16_t *p, uint16_t v) |
188 | { | |
189 | uint8_t *p1 = (uint8_t *)p; | |
190 | ||
191 | p1[0] = v >> 8; | |
9e622b15 | 192 | p1[1] = v & 0xff; |
188d8579 FB |
193 | } |
194 | ||
195 | static inline void cpu_to_be32wu(uint32_t *p, uint32_t v) | |
196 | { | |
197 | uint8_t *p1 = (uint8_t *)p; | |
198 | ||
199 | p1[0] = v >> 24; | |
200 | p1[1] = v >> 16; | |
201 | p1[2] = v >> 8; | |
9e622b15 | 202 | p1[3] = v & 0xff; |
188d8579 FB |
203 | } |
204 | ||
102c2976 AJ |
205 | static inline void cpu_to_be64wu(uint64_t *p, uint64_t v) |
206 | { | |
207 | uint8_t *p1 = (uint8_t *)p; | |
208 | ||
209 | p1[0] = v >> 56; | |
210 | p1[1] = v >> 48; | |
211 | p1[2] = v >> 40; | |
212 | p1[3] = v >> 32; | |
213 | p1[4] = v >> 24; | |
214 | p1[5] = v >> 16; | |
215 | p1[6] = v >> 8; | |
216 | p1[7] = v & 0xff; | |
217 | } | |
218 | ||
188d8579 FB |
219 | #endif |
220 | ||
e2542fe2 | 221 | #ifdef HOST_WORDS_BIGENDIAN |
188d8579 | 222 | #define cpu_to_32wu cpu_to_be32wu |
17e6a53f | 223 | #define leul_to_cpu(v) glue(glue(le,HOST_LONG_BITS),_to_cpu)(v) |
188d8579 FB |
224 | #else |
225 | #define cpu_to_32wu cpu_to_le32wu | |
213acd2e | 226 | #define leul_to_cpu(v) (v) |
af8ffdfd FB |
227 | #endif |
228 | ||
229 | #undef le_bswap | |
230 | #undef be_bswap | |
231 | #undef le_bswaps | |
232 | #undef be_bswaps | |
233 | ||
e73d6e3a MT |
234 | /* len must be one of 1, 2, 4 */ |
235 | static inline uint32_t qemu_bswap_len(uint32_t value, int len) | |
236 | { | |
237 | return bswap32(value) >> (32 - 8 * len); | |
238 | } | |
239 | ||
ab93bbe2 | 240 | #endif /* BSWAP_H */ |