gdhcp/unaligned.h

   1 /*
   2  *
   3  *  Connection Manager
   4  *
   5  *  Copyright (C) 2012  Intel Corporation. All rights reserved.
   6  *
   7  *  This program is free software; you can redistribute it and/or modify
   8  *  it under the terms of the GNU General Public License version 2 as
   9  *  published by the Free Software Foundation.
  10  *
  11  *  This program is distributed in the hope that it will be useful,
  12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  *  GNU General Public License for more details.
  15  *
  16  *  You should have received a copy of the GNU General Public License
  17  *  along with this program; if not, write to the Free Software
  18  *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  19  *
  20  */
  21
  22 #include <endian.h>
  23 #include <byteswap.h>
  24
  25 #define get_unaligned(ptr)                      \
  26 ({                                              \
  27         struct __attribute__((packed)) {        \
  28                 typeof(*(ptr)) __v;             \
  29         } *__p = (typeof(__p)) (ptr);           \
  30         __p->__v;                               \
  31 })
  32
  33 #define put_unaligned(val, ptr)                 \
  34 do {                                            \
  35         struct __attribute__((packed)) {        \
  36                 typeof(*(ptr)) __v;             \
  37         } *__p = (typeof(__p)) (ptr);           \
  38         __p->__v = (val);                       \
  39 } while(0)
  40
  41 #if __BYTE_ORDER == __LITTLE_ENDIAN
  42 static inline uint64_t get_le64(const void *ptr)
  43 {
  44         return get_unaligned((const uint64_t *) ptr);
  45 }
  46
  47 static inline uint64_t get_be64(const void *ptr)
  48 {
  49         return bswap_64(get_unaligned((const uint64_t *) ptr));
  50 }
  51
  52 static inline uint32_t get_le32(const void *ptr)
  53 {
  54         return get_unaligned((const uint32_t *) ptr);
  55 }
  56
  57 static inline uint32_t get_be32(const void *ptr)
  58 {
  59         return bswap_32(get_unaligned((const uint32_t *) ptr));
  60 }
  61
  62 static inline uint16_t get_le16(const void *ptr)
  63 {
  64         return get_unaligned((const uint16_t *) ptr);
  65 }
  66
  67 static inline uint16_t get_be16(const void *ptr)
  68 {
  69         return bswap_16(get_unaligned((const uint16_t *) ptr));
  70 }
  71
  72 static inline void put_be16(uint16_t val, void *ptr)
  73 {
  74         put_unaligned(bswap_16(val), (uint16_t *) ptr);
  75 }
  76
  77 static inline void put_be32(uint32_t val, void *ptr)
  78 {
  79         put_unaligned(bswap_32(val), (uint32_t *) ptr);
  80 }
  81
  82 static inline void put_le16(uint16_t val, void *ptr)
  83 {
  84         put_unaligned(val, (uint16_t *) ptr);
  85 }
  86
  87 static inline void put_le32(uint32_t val, void *ptr)
  88 {
  89         put_unaligned(val, (uint32_t *) ptr);
  90 }
  91
  92 static inline void put_be64(uint64_t val, void *ptr)
  93 {
  94         put_unaligned(bswap_64(val), (uint64_t *) ptr);
  95 }
  96
  97 static inline void put_le64(uint64_t val, void *ptr)
  98 {
  99         put_unaligned(val, (uint64_t *) ptr);
 100 }
 101 #elif __BYTE_ORDER == __BIG_ENDIAN
 102 static inline uint64_t get_le64(const void *ptr)
 103 {
 104         return bswap_64(get_unaligned((const uint64_t *) ptr));
 105 }
 106
 107 static inline uint64_t get_be64(const void *ptr)
 108 {
 109         return get_unaligned((const uint64_t *) ptr);
 110 }
 111
 112 static inline uint32_t get_le32(const void *ptr)
 113 {
 114         return bswap_32(get_unaligned((const uint32_t *) ptr));
 115 }
 116
 117 static inline uint32_t get_be32(const void *ptr)
 118 {
 119         return get_unaligned((const uint32_t *) ptr);
 120 }
 121
 122 static inline uint16_t get_le16(const void *ptr)
 123 {
 124         return bswap_16(get_unaligned((const uint16_t *) ptr));
 125 }
 126
 127 static inline uint16_t get_be16(const void *ptr)
 128 {
 129         return get_unaligned((const uint16_t *) ptr);
 130 }
 131
 132 static inline void put_be16(uint16_t val, void *ptr)
 133 {
 134         put_unaligned(val, (uint16_t *) ptr);
 135 }
 136
 137 static inline void put_be32(uint32_t val, void *ptr)
 138 {
 139         put_unaligned(val, (uint32_t *) ptr);
 140 }
 141
 142 static inline void put_le16(uint16_t val, void *ptr)
 143 {
 144         put_unaligned(bswap_16(val), (uint16_t *) ptr);
 145 }
 146
 147 static inline void put_le32(uint32_t val, void *ptr)
 148 {
 149         put_unaligned(bswap_32(val), (uint32_t *) ptr);
 150 }
 151
 152 static inline void put_be64(uint64_t val, void *ptr)
 153 {
 154         put_unaligned(val, (uint64_t *) ptr);
 155 }
 156
 157 static inline void put_le64(uint64_t val, void *ptr)
 158 {
 159         put_unaligned(bswap_64(val), (uint64_t *) ptr);
 160 }
 161 #else
 162 #error "Unknown byte order"
 163 #endif