bswap.h

   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 #define be32_to_cpupu(p) be32_to_cpup(p)
 136
 137 #define cpu_to_be16wu(p, v) cpu_to_be16w(p, v)
 138 #define cpu_to_be32wu(p, v) cpu_to_be32w(p, v)
 139
 140 #else
 141
 142 static inline void cpu_to_le16wu(uint16_t *p, uint16_t v)
 143 {
 144     uint8_t *p1 = (uint8_t *)p;
 145
 146     p1[0] = v;
 147     p1[1] = v >> 8;
 148 }
 149
 150 static inline void cpu_to_le32wu(uint32_t *p, uint32_t v)
 151 {
 152     uint8_t *p1 = (uint8_t *)p;
 153
 154     p1[0] = v;
 155     p1[1] = v >> 8;
 156     p1[2] = v >> 16;
 157     p1[3] = v >> 24;
 158 }
 159
 160 static inline uint16_t le16_to_cpupu(const uint16_t *p)
 161 {
 162     const uint8_t *p1 = (const uint8_t *)p;
 163     return p1[0] | (p1[1] << 8);
 164 }
 165
 166 static inline uint32_t le32_to_cpupu(const uint32_t *p)
 167 {
 168     const uint8_t *p1 = (const uint8_t *)p;
 169     return p1[0] | (p1[1] << 8) | (p1[2] << 16) | (p1[3] << 24);
 170 }
 171
 172 static inline uint32_t be32_to_cpupu(const uint32_t *p)
 173 {
 174     const uint8_t *p1 = (const uint8_t *)p;
 175     return p1[3] | (p1[2] << 8) | (p1[1] << 16) | (p1[0] << 24);
 176 }
 177
 178 static inline void cpu_to_be16wu(uint16_t *p, uint16_t v)
 179 {
 180     uint8_t *p1 = (uint8_t *)p;
 181
 182     p1[0] = v >> 8;
 183     p1[1] = v;
 184 }
 185
 186 static inline void cpu_to_be32wu(uint32_t *p, uint32_t v)
 187 {
 188     uint8_t *p1 = (uint8_t *)p;
 189
 190     p1[0] = v >> 24;
 191     p1[1] = v >> 16;
 192     p1[2] = v >> 8;
 193     p1[3] = v;
 194 }
 195
 196 #endif
 197
 198 #ifdef WORDS_BIGENDIAN
 199 #define cpu_to_32wu cpu_to_be32wu
 200 #else
 201 #define cpu_to_32wu cpu_to_le32wu
 202 #endif
 203
 204 #undef le_bswap
 205 #undef be_bswap
 206 #undef le_bswaps
 207 #undef be_bswaps
 208
 209 #endif /* BSWAP_H */