bswap.h

   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
  52 static inline uint16_t bswap16(uint16_t x)
  53 {
  54     return bswap_16(x);
  55 }
  56
  57 static inline uint32_t bswap32(uint32_t x)
  58 {
  59     return bswap_32(x);
  60 }
  61
  62 static inline uint64_t bswap64(uint64_t x)
  63 {
  64     return bswap_64(x);
  65 }
  66
  67 #endif /* ! CONFIG_MACHINE_BSWAP_H */
  68
  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
  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 */