1 #ifndef BSWAP_H
2 #define BSWAP_H
3
4 #include "config-host.h"
5 #include "unicorn/platform.h"
6 #include <limits.h>
7 #include <string.h>
8 #include "fpu/softfloat.h"
9
10 #ifdef CONFIG_MACHINE_BSWAP_H
11 # include <sys/endian.h>
12 # include <sys/types.h>
13 # include <machine/bswap.h>
14 #elif defined(__FreeBSD__) || defined(__DragonFly__)
15 # include <sys/endian.h>
16 #elif defined(CONFIG_BYTESWAP_H)
17 # include <byteswap.h>
18
bswap16(uint16_t x)19 static inline uint16_t bswap16(uint16_t x)
20 {
21 return bswap_16(x);
22 }
23
bswap32(uint32_t x)24 static inline uint32_t bswap32(uint32_t x)
25 {
26 return bswap_32(x);
27 }
28
bswap64(uint64_t x)29 static inline uint64_t bswap64(uint64_t x)
30 {
31 return bswap_64(x);
32 }
33 # else
bswap16(uint16_t x)34 static inline uint16_t bswap16(uint16_t x)
35 {
36 return (((x & 0x00ff) << 8) |
37 ((x & 0xff00) >> 8));
38 }
39
bswap32(uint32_t x)40 static inline uint32_t bswap32(uint32_t x)
41 {
42 return (((x & 0x000000ffU) << 24) |
43 ((x & 0x0000ff00U) << 8) |
44 ((x & 0x00ff0000U) >> 8) |
45 ((x & 0xff000000U) >> 24));
46 }
47
bswap64(uint64_t x)48 static inline uint64_t bswap64(uint64_t x)
49 {
50 return (((x & 0x00000000000000ffULL) << 56) |
51 ((x & 0x000000000000ff00ULL) << 40) |
52 ((x & 0x0000000000ff0000ULL) << 24) |
53 ((x & 0x00000000ff000000ULL) << 8) |
54 ((x & 0x000000ff00000000ULL) >> 8) |
55 ((x & 0x0000ff0000000000ULL) >> 24) |
56 ((x & 0x00ff000000000000ULL) >> 40) |
57 ((x & 0xff00000000000000ULL) >> 56));
58 }
59 #endif /* ! CONFIG_MACHINE_BSWAP_H */
60
bswap16s(uint16_t * s)61 static inline void bswap16s(uint16_t *s)
62 {
63 *s = bswap16(*s);
64 }
65
bswap32s(uint32_t * s)66 static inline void bswap32s(uint32_t *s)
67 {
68 *s = bswap32(*s);
69 }
70
bswap64s(uint64_t * s)71 static inline void bswap64s(uint64_t *s)
72 {
73 *s = bswap64(*s);
74 }
75
76 #if defined(HOST_WORDS_BIGENDIAN)
77 #define be_bswap(v, size) (v)
78 #define le_bswap(v, size) glue(bswap, size)(v)
79 #define be_bswaps(v, size)
80 #define le_bswaps(p, size) do { *p = glue(bswap, size)(*p); } while(0)
81 #else
82 #define le_bswap(v, size) (v)
83 #define be_bswap(v, size) glue(bswap, size)(v)
84 #define le_bswaps(v, size)
85 #define be_bswaps(p, size) do { *p = glue(bswap, size)(*p); } while(0)
86 #endif
87
88 #define CPU_CONVERT(endian, size, type)\
89 static inline type endian ## size ## _to_cpu(type v)\
90 {\
91 return glue(endian, _bswap)(v, size);\
92 }\
93 \
94 static inline type cpu_to_ ## endian ## size(type v)\
95 {\
96 return glue(endian, _bswap)(v, size);\
97 }\
98 \
99 static inline void endian ## size ## _to_cpus(type *p)\
100 {\
101 glue(endian, _bswaps)(p, size);\
102 }\
103 \
104 static inline void cpu_to_ ## endian ## size ## s(type *p)\
105 {\
106 glue(endian, _bswaps)(p, size);\
107 }\
108 \
109 static inline type endian ## size ## _to_cpup(const type *p)\
110 {\
111 return glue(glue(endian, size), _to_cpu)(*p);\
112 }\
113 \
114 static inline void cpu_to_ ## endian ## size ## w(type *p, type v)\
115 {\
116 *p = glue(glue(cpu_to_, endian), size)(v);\
117 }
118
119 CPU_CONVERT(be, 16, uint16_t)
120 CPU_CONVERT(be, 32, uint32_t)
121 CPU_CONVERT(be, 64, uint64_t)
122
123 CPU_CONVERT(le, 16, uint16_t)
124 CPU_CONVERT(le, 32, uint32_t)
125 CPU_CONVERT(le, 64, uint64_t)
126
127 /* len must be one of 1, 2, 4 */
qemu_bswap_len(uint32_t value,int len)128 static inline uint32_t qemu_bswap_len(uint32_t value, int len)
129 {
130 return bswap32(value) >> (32 - 8 * len);
131 }
132
133 /* Unions for reinterpreting between floats and integers. */
134
135 typedef union {
136 float32 f;
137 uint32_t l;
138 } CPU_FloatU;
139
140 typedef union {
141 float64 d;
142 #if defined(HOST_WORDS_BIGENDIAN)
143 struct {
144 uint32_t upper;
145 uint32_t lower;
146 } l;
147 #else
148 struct {
149 uint32_t lower;
150 uint32_t upper;
151 } l;
152 #endif
153 uint64_t ll;
154 } CPU_DoubleU;
155
156 typedef union {
157 floatx80 d;
158 struct {
159 uint64_t lower;
160 uint16_t upper;
161 } l;
162 } CPU_LDoubleU;
163
164 typedef union {
165 float128 q;
166 #if defined(HOST_WORDS_BIGENDIAN)
167 struct {
168 uint32_t upmost;
169 uint32_t upper;
170 uint32_t lower;
171 uint32_t lowest;
172 } l;
173 struct {
174 uint64_t upper;
175 uint64_t lower;
176 } ll;
177 #else
178 struct {
179 uint32_t lowest;
180 uint32_t lower;
181 uint32_t upper;
182 uint32_t upmost;
183 } l;
184 struct {
185 uint64_t lower;
186 uint64_t upper;
187 } ll;
188 #endif
189 } CPU_QuadU;
190
191 /* unaligned/endian-independent pointer access */
192
193 /*
194 * the generic syntax is:
195 *
196 * load: ld{type}{sign}{size}{endian}_p(ptr)
197 *
198 * store: st{type}{size}{endian}_p(ptr, val)
199 *
200 * Note there are small differences with the softmmu access API!
201 *
202 * type is:
203 * (empty): integer access
204 * f : float access
205 *
206 * sign is:
207 * (empty): for floats or 32 bit size
208 * u : unsigned
209 * s : signed
210 *
211 * size is:
212 * b: 8 bits
213 * w: 16 bits
214 * l: 32 bits
215 * q: 64 bits
216 *
217 * endian is:
218 * he : host endian
219 * be : big endian
220 * le : little endian
221 * (except for byte accesses, which have no endian infix).
222 */
223
ldub_p(const void * ptr)224 static inline int ldub_p(const void *ptr)
225 {
226 return *(uint8_t *)ptr;
227 }
228
ldsb_p(const void * ptr)229 static inline int ldsb_p(const void *ptr)
230 {
231 return *(int8_t *)ptr;
232 }
233
stb_p(void * ptr,uint8_t v)234 static inline void stb_p(void *ptr, uint8_t v)
235 {
236 *(uint8_t *)ptr = v;
237 }
238
239 /* Any compiler worth its salt will turn these memcpy into native unaligned
240 operations. Thus we don't need to play games with packed attributes, or
241 inline byte-by-byte stores. */
242
lduw_he_p(const void * ptr)243 static inline int lduw_he_p(const void *ptr)
244 {
245 uint16_t r;
246 memcpy(&r, ptr, sizeof(r));
247 return r;
248 }
249
ldsw_he_p(const void * ptr)250 static inline int ldsw_he_p(const void *ptr)
251 {
252 int16_t r;
253 memcpy(&r, ptr, sizeof(r));
254 return r;
255 }
256
stw_he_p(void * ptr,uint16_t v)257 static inline void stw_he_p(void *ptr, uint16_t v)
258 {
259 memcpy(ptr, &v, sizeof(v));
260 }
261
ldl_he_p(const void * ptr)262 static inline int ldl_he_p(const void *ptr)
263 {
264 int32_t r;
265 memcpy(&r, ptr, sizeof(r));
266 return r;
267 }
268
stl_he_p(void * ptr,uint32_t v)269 static inline void stl_he_p(void *ptr, uint32_t v)
270 {
271 memcpy(ptr, &v, sizeof(v));
272 }
273
ldq_he_p(const void * ptr)274 static inline uint64_t ldq_he_p(const void *ptr)
275 {
276 uint64_t r;
277 memcpy(&r, ptr, sizeof(r));
278 return r;
279 }
280
stq_he_p(void * ptr,uint64_t v)281 static inline void stq_he_p(void *ptr, uint64_t v)
282 {
283 memcpy(ptr, &v, sizeof(v));
284 }
285
lduw_le_p(const void * ptr)286 static inline int lduw_le_p(const void *ptr)
287 {
288 return (uint16_t)le_bswap(lduw_he_p(ptr), 16);
289 }
290
ldsw_le_p(const void * ptr)291 static inline int ldsw_le_p(const void *ptr)
292 {
293 return (int16_t)le_bswap(lduw_he_p(ptr), 16);
294 }
295
ldl_le_p(const void * ptr)296 static inline int ldl_le_p(const void *ptr)
297 {
298 return le_bswap(ldl_he_p(ptr), 32);
299 }
300
ldq_le_p(const void * ptr)301 static inline uint64_t ldq_le_p(const void *ptr)
302 {
303 return le_bswap(ldq_he_p(ptr), 64);
304 }
305
stw_le_p(void * ptr,uint16_t v)306 static inline void stw_le_p(void *ptr, uint16_t v)
307 {
308 stw_he_p(ptr, le_bswap(v, 16));
309 }
310
stl_le_p(void * ptr,uint32_t v)311 static inline void stl_le_p(void *ptr, uint32_t v)
312 {
313 stl_he_p(ptr, le_bswap(v, 32));
314 }
315
stq_le_p(void * ptr,uint64_t v)316 static inline void stq_le_p(void *ptr, uint64_t v)
317 {
318 stq_he_p(ptr, le_bswap(v, 64));
319 }
320
321 /* float access */
322
ldfl_le_p(const void * ptr)323 static inline float32 ldfl_le_p(const void *ptr)
324 {
325 CPU_FloatU u;
326 u.l = ldl_le_p(ptr);
327 return u.f;
328 }
329
stfl_le_p(void * ptr,float32 v)330 static inline void stfl_le_p(void *ptr, float32 v)
331 {
332 CPU_FloatU u;
333 u.f = v;
334 stl_le_p(ptr, u.l);
335 }
336
ldfq_le_p(const void * ptr)337 static inline float64 ldfq_le_p(const void *ptr)
338 {
339 CPU_DoubleU u;
340 u.ll = ldq_le_p(ptr);
341 return u.d;
342 }
343
stfq_le_p(void * ptr,float64 v)344 static inline void stfq_le_p(void *ptr, float64 v)
345 {
346 CPU_DoubleU u;
347 u.d = v;
348 stq_le_p(ptr, u.ll);
349 }
350
lduw_be_p(const void * ptr)351 static inline int lduw_be_p(const void *ptr)
352 {
353 return (uint16_t)be_bswap(lduw_he_p(ptr), 16);
354 }
355
ldsw_be_p(const void * ptr)356 static inline int ldsw_be_p(const void *ptr)
357 {
358 return (int16_t)be_bswap(lduw_he_p(ptr), 16);
359 }
360
ldl_be_p(const void * ptr)361 static inline int ldl_be_p(const void *ptr)
362 {
363 return be_bswap(ldl_he_p(ptr), 32);
364 }
365
ldq_be_p(const void * ptr)366 static inline uint64_t ldq_be_p(const void *ptr)
367 {
368 return be_bswap(ldq_he_p(ptr), 64);
369 }
370
stw_be_p(void * ptr,uint16_t v)371 static inline void stw_be_p(void *ptr, uint16_t v)
372 {
373 stw_he_p(ptr, be_bswap(v, 16));
374 }
375
stl_be_p(void * ptr,uint32_t v)376 static inline void stl_be_p(void *ptr, uint32_t v)
377 {
378 stl_he_p(ptr, be_bswap(v, 32));
379 }
380
stq_be_p(void * ptr,uint64_t v)381 static inline void stq_be_p(void *ptr, uint64_t v)
382 {
383 stq_he_p(ptr, be_bswap(v, 64));
384 }
385
386 /* float access */
387
ldfl_be_p(const void * ptr)388 static inline float32 ldfl_be_p(const void *ptr)
389 {
390 CPU_FloatU u;
391 u.l = ldl_be_p(ptr);
392 return u.f;
393 }
394
stfl_be_p(void * ptr,float32 v)395 static inline void stfl_be_p(void *ptr, float32 v)
396 {
397 CPU_FloatU u;
398 u.f = v;
399 stl_be_p(ptr, u.l);
400 }
401
ldfq_be_p(const void * ptr)402 static inline float64 ldfq_be_p(const void *ptr)
403 {
404 CPU_DoubleU u;
405 u.ll = ldq_be_p(ptr);
406 return u.d;
407 }
408
stfq_be_p(void * ptr,float64 v)409 static inline void stfq_be_p(void *ptr, float64 v)
410 {
411 CPU_DoubleU u;
412 u.d = v;
413 stq_be_p(ptr, u.ll);
414 }
415
leul_to_cpu(unsigned long v)416 static inline unsigned long leul_to_cpu(unsigned long v)
417 {
418 /* In order to break an include loop between here and
419 qemu-common.h, don't rely on HOST_LONG_BITS. */
420 #if ULONG_MAX == UINT32_MAX
421 return le_bswap(v, 32);
422 #elif ULONG_MAX == UINT64_MAX
423 return le_bswap(v, 64);
424 #else
425 # error Unknown sizeof long
426 #endif
427 }
428
429 #undef le_bswap
430 #undef be_bswap
431 #undef le_bswaps
432 #undef be_bswaps
433
434 #endif /* BSWAP_H */
435