1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
|
#include <stdint.h>
// byteswappings
#define SWAP16(x) ({ uint16_t y=(x); (((y)>>8 & 0xff) | ((y)<<8 & 0xff00)); })
#define SWAP32(x) ({ uint32_t y=(x); (((y)>>24 & 0xfful) | ((y)>>8 & 0xff00ul) | ((y)<<8 & 0xff0000ul) | ((y)<<24 & 0xff000000ul)); })
#ifdef __BIG_ENDIAN__
// big endian config
#define HOST2LE32(x) SWAP32(x)
#define HOST2BE32(x) (x)
#define LE2HOST32(x) SWAP32(x)
#define BE2HOST32(x) (x)
#define HOST2LE16(x) SWAP16(x)
#define HOST2BE16(x) (x)
#define LE2HOST16(x) SWAP16(x)
#define BE2HOST16(x) (x)
#else
// little endian config
#define HOST2LE32(x) (x)
#define HOST2BE32(x) SWAP32(x)
#define LE2HOST32(x) (x)
#define BE2HOST32(x) SWAP32(x)
#define HOST2LE16(x) (x)
#define HOST2BE16(x) SWAP16(x)
#define LE2HOST16(x) (x)
#define BE2HOST16(x) SWAP16(x)
#endif
#define GETLEs16(X) ((int16_t)GETLE16((uint16_t *)X))
#define GETLEs32(X) ((int16_t)GETLE32((uint16_t *)X))
#if defined(__PPC__) && defined(__BIG_ENDIAN__)
// GCC style
static __inline__ uint16_t GETLE16(uint16_t *ptr) {
uint16_t ret; __asm__ ("lhbrx %0, 0, %1" : "=r" (ret) : "r" (ptr));
return ret;
}
static __inline__ uint32_t GETLE32(uint32_t *ptr) {
uint32_t ret;
__asm__ ("lwbrx %0, 0, %1" : "=r" (ret) : "r" (ptr));
return ret;
}
static __inline__ uint32_t GETLE16D(uint32_t *ptr) {
uint32_t ret;
__asm__ ("lwbrx %0, 0, %1\n"
"rlwinm %0, %0, 16, 0, 31" : "=r" (ret) : "r" (ptr));
return ret;
}
static __inline__ void PUTLE16(uint16_t *ptr, uint16_t val) {
__asm__ ("sthbrx %0, 0, %1" : : "r" (val), "r" (ptr) : "memory");
}
static __inline__ void PUTLE32(uint32_t *ptr, uint32_t val) {
__asm__ ("stwbrx %0, 0, %1" : : "r" (val), "r" (ptr) : "memory");
}
#else
#define GETLE16(X) LE2HOST16(*(uint16_t *)X)
#define GETLE16D(X) ({uint32_t val = GETLE32(X); (val<<16 | val >> 16);})
#define PUTLE16(X, Y) do{*((uint16_t *)X)=HOST2LE16((uint16_t)Y);}while(0)
#ifdef __arm__
#define GETLE32(X) (*(uint16_t *)X|(((uint16_t *)X)[1]<<16))
#define PUTLE32(X, Y) do{*((uint16_t *)X)=(uint32_t)Y;((uint16_t *)X)[1]=(uint32_t)(Y)>>16;}while(0)
#else
#define GETLE32(X) LE2HOST32(*(uint32_t *)X)
#define PUTLE32(X, Y) do{*((uint32_t *)X)=HOST2LE16((uint32_t)Y);}while(0)
#endif
#endif
|
