xref: /illumos-kvm-cmd/bswap.h (revision 68396ea9)
1 #ifndef BSWAP_H
2 #define BSWAP_H
3 
4 #include "config-host.h"
5 
6 #include <inttypes.h>
7 
8 #ifdef CONFIG_MACHINE_BSWAP_H
9 #include <sys/endian.h>
10 #include <sys/types.h>
11 #include <machine/bswap.h>
12 #else
13 
14 #ifdef CONFIG_BYTESWAP_H
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 
50 #endif /* !CONFIG_BYTESWAP_H */
51 
bswap16(uint16_t x)52 static inline uint16_t bswap16(uint16_t x)
53 {
54     return bswap_16(x);
55 }
56 
bswap32(uint32_t x)57 static inline uint32_t bswap32(uint32_t x)
58 {
59     return bswap_32(x);
60 }
61 
bswap64(uint64_t x)62 static inline uint64_t bswap64(uint64_t x)
63 {
64     return bswap_64(x);
65 }
66 
67 #endif /* ! CONFIG_MACHINE_BSWAP_H */
68 
bswap16s(uint16_t * s)69 static inline void bswap16s(uint16_t *s)
70 {
71     *s = bswap16(*s);
72 }
73 
bswap32s(uint32_t * s)74 static inline void bswap32s(uint32_t *s)
75 {
76     *s = bswap32(*s);
77 }
78 
bswap64s(uint64_t * s)79 static inline void bswap64s(uint64_t *s)
80 {
81     *s = bswap64(*s);
82 }
83 
84 #if defined(HOST_WORDS_BIGENDIAN)
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 
137 #if defined(__i386__) || defined(_ARCH_PPC)
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)
143 #define be32_to_cpupu(p) be32_to_cpup(p)
144 
145 #define cpu_to_be16wu(p, v) cpu_to_be16w(p, v)
146 #define cpu_to_be32wu(p, v) cpu_to_be32w(p, v)
147 #define cpu_to_be64wu(p, v) cpu_to_be64w(p, v)
148 
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 
155     p1[0] = v & 0xff;
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 
163     p1[0] = v & 0xff;
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 
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 
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;
192     p1[1] = v & 0xff;
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;
202     p1[3] = v & 0xff;
203 }
204 
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 
219 #endif
220 
221 #ifdef HOST_WORDS_BIGENDIAN
222 #define cpu_to_32wu cpu_to_be32wu
223 #define leul_to_cpu(v) glue(glue(le,HOST_LONG_BITS),_to_cpu)(v)
224 #else
225 #define cpu_to_32wu cpu_to_le32wu
226 #define leul_to_cpu(v) (v)
227 #endif
228 
229 #undef le_bswap
230 #undef be_bswap
231 #undef le_bswaps
232 #undef be_bswaps
233 
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 
240 #endif /* BSWAP_H */
241