1: #ifndef BSWAP_H
2: #define BSWAP_H
3:
4: #include "config-host.h"
5:
6: #include <inttypes.h>
7:
8: #ifdef HAVE_BYTESWAP_H
9: #include <byteswap.h>
10: #else
11:
12: #define bswap_16(x) \
13: ({ \
14: uint16_t __x = (x); \
15: ((uint16_t)( \
16: (((uint16_t)(__x) & (uint16_t)0x00ffU) << 8) | \
17: (((uint16_t)(__x) & (uint16_t)0xff00U) >> 8) )); \
18: })
19:
20: #define bswap_32(x) \
21: ({ \
22: uint32_t __x = (x); \
23: ((uint32_t)( \
24: (((uint32_t)(__x) & (uint32_t)0x000000ffUL) << 24) | \
25: (((uint32_t)(__x) & (uint32_t)0x0000ff00UL) << 8) | \
26: (((uint32_t)(__x) & (uint32_t)0x00ff0000UL) >> 8) | \
27: (((uint32_t)(__x) & (uint32_t)0xff000000UL) >> 24) )); \
28: })
29:
30: #define bswap_64(x) \
31: ({ \
32: uint64_t __x = (x); \
33: ((uint64_t)( \
34: (uint64_t)(((uint64_t)(__x) & (uint64_t)0x00000000000000ffULL) << 56) | \
35: (uint64_t)(((uint64_t)(__x) & (uint64_t)0x000000000000ff00ULL) << 40) | \
36: (uint64_t)(((uint64_t)(__x) & (uint64_t)0x0000000000ff0000ULL) << 24) | \
37: (uint64_t)(((uint64_t)(__x) & (uint64_t)0x00000000ff000000ULL) << 8) | \
38: (uint64_t)(((uint64_t)(__x) & (uint64_t)0x000000ff00000000ULL) >> 8) | \
39: (uint64_t)(((uint64_t)(__x) & (uint64_t)0x0000ff0000000000ULL) >> 24) | \
40: (uint64_t)(((uint64_t)(__x) & (uint64_t)0x00ff000000000000ULL) >> 40) | \
41: (uint64_t)(((uint64_t)(__x) & (uint64_t)0xff00000000000000ULL) >> 56) )); \
42: })
43:
44: #endif /* !HAVE_BYTESWAP_H */
45:
46: static inline uint16_t bswap16(uint16_t x)
47: {
48: return bswap_16(x);
49: }
50:
51: static inline uint32_t bswap32(uint32_t x)
52: {
53: return bswap_32(x);
54: }
55:
56: static inline uint64_t bswap64(uint64_t x)
57: {
58: return bswap_64(x);
59: }
60:
61: static inline void bswap16s(uint16_t *s)
62: {
63: *s = bswap16(*s);
64: }
65:
66: static inline void bswap32s(uint32_t *s)
67: {
68: *s = bswap32(*s);
69: }
70:
71: static inline void bswap64s(uint64_t *s)
72: {
73: *s = bswap64(*s);
74: }
75:
76: #if defined(WORDS_BIGENDIAN)
77: #define be_bswap(v, size) (v)
78: #define le_bswap(v, size) bswap ## size(v)
79: #define be_bswaps(v, size)
80: #define le_bswaps(p, size) *p = bswap ## size(*p);
81: #else
82: #define le_bswap(v, size) (v)
83: #define be_bswap(v, size) bswap ## size(v)
84: #define le_bswaps(v, size)
85: #define be_bswaps(p, size) *p = bswap ## size(*p);
86: #endif
87:
88: #define CPU_CONVERT(endian, size, type)\
89: static inline type endian ## size ## _to_cpu(type v)\
90: {\
91: return endian ## _bswap(v, size);\
92: }\
93: \
94: static inline type cpu_to_ ## endian ## size(type v)\
95: {\
96: return endian ## _bswap(v, size);\
97: }\
98: \
99: static inline void endian ## size ## _to_cpus(type *p)\
100: {\
101: endian ## _bswaps(p, size)\
102: }\
103: \
104: static inline void cpu_to_ ## endian ## size ## s(type *p)\
105: {\
106: endian ## _bswaps(p, size)\
107: }\
108: \
109: static inline type endian ## size ## _to_cpup(const type *p)\
110: {\
111: return endian ## size ## _to_cpu(*p);\
112: }\
113: \
114: static inline void cpu_to_ ## endian ## size ## w(type *p, type v)\
115: {\
116: *p = 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: /* unaligned versions (optimized for frequent unaligned accesses)*/
128:
129: #if defined(__i386__) || defined(__powerpc__)
130:
131: #define cpu_to_le16wu(p, v) cpu_to_le16w(p, v)
132: #define cpu_to_le32wu(p, v) cpu_to_le32w(p, v)
133: #define le16_to_cpupu(p) le16_to_cpup(p)
134: #define le32_to_cpupu(p) le32_to_cpup(p)
135:
136: #define cpu_to_be16wu(p, v) cpu_to_be16w(p, v)
137: #define cpu_to_be32wu(p, v) cpu_to_be32w(p, v)
138:
139: #else
140:
141: static inline void cpu_to_le16wu(uint16_t *p, uint16_t v)
142: {
143: uint8_t *p1 = (uint8_t *)p;
144:
145: p1[0] = v;
146: p1[1] = v >> 8;
147: }
148:
149: static inline void cpu_to_le32wu(uint32_t *p, uint32_t v)
150: {
151: uint8_t *p1 = (uint8_t *)p;
152:
153: p1[0] = v;
154: p1[1] = v >> 8;
155: p1[2] = v >> 16;
156: p1[3] = v >> 24;
157: }
158:
159: static inline uint16_t le16_to_cpupu(const uint16_t *p)
160: {
161: const uint8_t *p1 = (const uint8_t *)p;
162: return p1[0] | (p1[1] << 8);
163: }
164:
165: static inline uint32_t le32_to_cpupu(const uint32_t *p)
166: {
167: const uint8_t *p1 = (const uint8_t *)p;
168: return p1[0] | (p1[1] << 8) | (p1[2] << 16) | (p1[3] << 24);
169: }
170:
171: static inline void cpu_to_be16wu(uint16_t *p, uint16_t v)
172: {
173: uint8_t *p1 = (uint8_t *)p;
174:
175: p1[0] = v >> 8;
176: p1[1] = v;
177: }
178:
179: static inline void cpu_to_be32wu(uint32_t *p, uint32_t v)
180: {
181: uint8_t *p1 = (uint8_t *)p;
182:
183: p1[0] = v >> 24;
184: p1[1] = v >> 16;
185: p1[2] = v >> 8;
186: p1[3] = v;
187: }
188:
189: #endif
190:
191: #ifdef WORDS_BIGENDIAN
192: #define cpu_to_32wu cpu_to_be32wu
193: #else
194: #define cpu_to_32wu cpu_to_le32wu
195: #endif
196:
197: #undef le_bswap
198: #undef be_bswap
199: #undef le_bswaps
200: #undef be_bswaps
201:
202: #endif /* BSWAP_H */
unix.superglobalmegacorp.com