contrib/openbsm/compat/endian.h

   1 /*-
   2  * Copyright (c) 2002 Thomas Moestl <tmm@FreeBSD.org>
   3  * Copyright (c) 2005 Robert N. M. Watson
   4  * All rights reserved.
   5  *
   6  * Redistribution and use in source and binary forms, with or without
   7  * modification, are permitted provided that the following conditions
   8  * are met:
   9  * 1. Redistributions of source code must retain the above copyright
  10  *    notice, this list of conditions and the following disclaimer.
  11  * 2. Redistributions in binary form must reproduce the above copyright
  12  *    notice, this list of conditions and the following disclaimer in the
  13  *    documentation and/or other materials provided with the distribution.
  14  *
  15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  16  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  17  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  18  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  19  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  20  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  21  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  22  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  23  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  24  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  25  * SUCH DAMAGE.
  26  *
  27  * Derived from FreeBSD src/sys/sys/endian.h:1.6.
  28  * $P4: //depot/projects/trustedbsd/openbsm/compat/endian.h#7 $
  29  */
  30
  31 #ifndef _COMPAT_ENDIAN_H_
  32 #define _COMPAT_ENDIAN_H_
  33
  34 /*
  35  * Some systems will have the uint/int types defined here already, others
  36  * will need stdint.h.
  37  */
  38 #include <stdint.h>
  39
  40 /*
  41  * Some operating systems do not yet have the more recent endian APIs that
  42  * permit encoding to and decoding from byte streams.  For those systems, we
  43  * implement local non-optimized versions.
  44  */
  45
  46 static __inline uint16_t
  47 bswap16(uint16_t int16)
  48 {
  49         const unsigned char *from;
  50         unsigned char *to;
  51         uint16_t t;
  52
  53         from = (const unsigned char *) &int16;
  54         to = (unsigned char *) &t;
  55
  56         to[0] = from[1];
  57         to[1] = from[0];
  58
  59         return (t);
  60 }
  61
  62 static __inline uint32_t
  63 bswap32(uint32_t int32)
  64 {
  65         const unsigned char *from;
  66         unsigned char *to;
  67         uint32_t t;
  68
  69         from = (const unsigned char *) &int32;
  70         to = (unsigned char *) &t;
  71
  72         to[0] = from[3];
  73         to[1] = from[2];
  74         to[2] = from[1];
  75         to[3] = from[0];
  76
  77         return (t);
  78 }
  79
  80 static __inline uint64_t
  81 bswap64(uint64_t int64)
  82 {
  83         const unsigned char *from;
  84         unsigned char *to;
  85         uint64_t t;
  86
  87         from = (const unsigned char *) &int64;
  88         to = (unsigned char *) &t;
  89
  90         to[0] = from[7];
  91         to[1] = from[6];
  92         to[2] = from[5];
  93         to[3] = from[4];
  94         to[4] = from[3];
  95         to[5] = from[2];
  96         to[6] = from[1];
  97         to[7] = from[0];
  98
  99         return (t);
 100 }
 101
 102 #if defined(BYTE_ORDER) && !defined(_BYTE_ORDER)
 103 #define _BYTE_ORDER     BYTE_ORDER
 104 #endif
 105 #if !defined(_BYTE_ORDER)
 106 #error "Neither BYTE_ORDER nor _BYTE_ORDER defined"
 107 #endif
 108
 109 #if defined(BIG_ENDIAN) && !defined(_BIG_ENDIAN)
 110 #define _BIG_ENDIAN     BIG_ENDIAN
 111 #endif
 112
 113 #if defined(LITTLE_ENDIAN) && !defined(_LITTLE_ENDIAN)
 114 #define _LITTLE_ENDIAN  LITTLE_ENDIAN
 115 #endif
 116
 117 /*
 118  * Host to big endian, host to little endian, big endian to host, and little
 119  * endian to host byte order functions as detailed in byteorder(9).
 120  */
 121 #if _BYTE_ORDER == _LITTLE_ENDIAN
 122 #define htobe16(x)      bswap16((x))
 123 #define htobe32(x)      bswap32((x))
 124 #define htobe64(x)      bswap64((x))
 125 #define htole16(x)      ((uint16_t)(x))
 126 #define htole32(x)      ((uint32_t)(x))
 127 #define htole64(x)      ((uint64_t)(x))
 128
 129 #define be16toh(x)      bswap16((x))
 130 #define be32toh(x)      bswap32((x))
 131 #define be64toh(x)      bswap64((x))
 132 #define le16toh(x)      ((uint16_t)(x))
 133 #define le32toh(x)      ((uint32_t)(x))
 134 #define le64toh(x)      ((uint64_t)(x))
 135 #else /* _BYTE_ORDER != _LITTLE_ENDIAN */
 136 #define htobe16(x)      ((uint16_t)(x))
 137 #define htobe32(x)      ((uint32_t)(x))
 138 #define htobe64(x)      ((uint64_t)(x))
 139 #define htole16(x)      bswap16((x))
 140 #define htole32(x)      bswap32((x))
 141 #define htole64(x)      bswap64((x))
 142
 143 #define be16toh(x)      ((uint16_t)(x))
 144 #define be32toh(x)      ((uint32_t)(x))
 145 #define be64toh(x)      ((uint64_t)(x))
 146 #define le16toh(x)      bswap16((x))
 147 #define le32toh(x)      bswap32((x))
 148 #define le64toh(x)      bswap64((x))
 149 #endif /* _BYTE_ORDER == _LITTLE_ENDIAN */
 150
 151 /* Alignment-agnostic encode/decode bytestream to/from little/big endian. */
 152
 153 static __inline uint16_t
 154 be16dec(const void *pp)
 155 {
 156         unsigned char const *p = (unsigned char const *)pp;
 157
 158         return ((p[0] << 8) | p[1]);
 159 }
 160
 161 static __inline uint32_t
 162 be32dec(const void *pp)
 163 {
 164         unsigned char const *p = (unsigned char const *)pp;
 165
 166         return ((p[0] << 24) | (p[1] << 16) | (p[2] << 8) | p[3]);
 167 }
 168
 169 static __inline uint64_t
 170 be64dec(const void *pp)
 171 {
 172         unsigned char const *p = (unsigned char const *)pp;
 173
 174         return (((uint64_t)be32dec(p) << 32) | be32dec(p + 4));
 175 }
 176
 177 static __inline uint16_t
 178 le16dec(const void *pp)
 179 {
 180         unsigned char const *p = (unsigned char const *)pp;
 181
 182         return ((p[1] << 8) | p[0]);
 183 }
 184
 185 static __inline uint32_t
 186 le32dec(const void *pp)
 187 {
 188         unsigned char const *p = (unsigned char const *)pp;
 189
 190         return ((p[3] << 24) | (p[2] << 16) | (p[1] << 8) | p[0]);
 191 }
 192
 193 static __inline uint64_t
 194 le64dec(const void *pp)
 195 {
 196         unsigned char const *p = (unsigned char const *)pp;
 197
 198         return (((uint64_t)le32dec(p + 4) << 32) | le32dec(p));
 199 }
 200
 201 static __inline void
 202 be16enc(void *pp, uint16_t u)
 203 {
 204         unsigned char *p = (unsigned char *)pp;
 205
 206         p[0] = (u >> 8) & 0xff;
 207         p[1] = u & 0xff;
 208 }
 209
 210 static __inline void
 211 be32enc(void *pp, uint32_t u)
 212 {
 213         unsigned char *p = (unsigned char *)pp;
 214
 215         p[0] = (u >> 24) & 0xff;
 216         p[1] = (u >> 16) & 0xff;
 217         p[2] = (u >> 8) & 0xff;
 218         p[3] = u & 0xff;
 219 }
 220
 221 static __inline void
 222 be64enc(void *pp, uint64_t u)
 223 {
 224         unsigned char *p = (unsigned char *)pp;
 225
 226         be32enc(p, u >> 32);
 227         be32enc(p + 4, u & 0xffffffff);
 228 }
 229
 230 static __inline void
 231 le16enc(void *pp, uint16_t u)
 232 {
 233         unsigned char *p = (unsigned char *)pp;
 234
 235         p[0] = u & 0xff;
 236         p[1] = (u >> 8) & 0xff;
 237 }
 238
 239 static __inline void
 240 le32enc(void *pp, uint32_t u)
 241 {
 242         unsigned char *p = (unsigned char *)pp;
 243
 244         p[0] = u & 0xff;
 245         p[1] = (u >> 8) & 0xff;
 246         p[2] = (u >> 16) & 0xff;
 247         p[3] = (u >> 24) & 0xff;
 248 }
 249
 250 static __inline void
 251 le64enc(void *pp, uint64_t u)
 252 {
 253         unsigned char *p = (unsigned char *)pp;
 254
 255         le32enc(p, u & 0xffffffff);
 256         le32enc(p + 4, u >> 32);
 257 }
 258
 259 #endif  /* _COMPAT_ENDIAN_H_ */