From 51ca65aa0586f7e96dde4bbccdf0fef170d1a3e9 Mon Sep 17 00:00:00 2001 From: Jukka Rissanen Date: Thu, 11 Oct 2012 10:11:50 +0300 Subject: gdhcp: Add unalignment macros The alignment macros are copied from Bluez. --- gdhcp/unaligned.h | 163 ++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 163 insertions(+) create mode 100644 gdhcp/unaligned.h (limited to 'gdhcp') diff --git a/gdhcp/unaligned.h b/gdhcp/unaligned.h new file mode 100644 index 00000000..ffdaae27 --- /dev/null +++ b/gdhcp/unaligned.h @@ -0,0 +1,163 @@ +/* + * + * Connection Manager + * + * Copyright (C) 2012 Intel Corporation. All rights reserved. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA + * + */ + +#include +#include + +#define get_unaligned(ptr) \ +({ \ + struct __attribute__((packed)) { \ + typeof(*(ptr)) __v; \ + } *__p = (typeof(__p)) (ptr); \ + __p->__v; \ +}) + +#define put_unaligned(val, ptr) \ +do { \ + struct __attribute__((packed)) { \ + typeof(*(ptr)) __v; \ + } *__p = (typeof(__p)) (ptr); \ + __p->__v = (val); \ +} while(0) + +#if __BYTE_ORDER == __LITTLE_ENDIAN +static inline uint64_t get_le64(const void *ptr) +{ + return get_unaligned((const uint64_t *) ptr); +} + +static inline uint64_t get_be64(const void *ptr) +{ + return bswap_64(get_unaligned((const uint64_t *) ptr)); +} + +static inline uint32_t get_le32(const void *ptr) +{ + return get_unaligned((const uint32_t *) ptr); +} + +static inline uint32_t get_be32(const void *ptr) +{ + return bswap_32(get_unaligned((const uint32_t *) ptr)); +} + +static inline uint16_t get_le16(const void *ptr) +{ + return get_unaligned((const uint16_t *) ptr); +} + +static inline uint16_t get_be16(const void *ptr) +{ + return bswap_16(get_unaligned((const uint16_t *) ptr)); +} + +static inline void put_be16(uint16_t val, void *ptr) +{ + put_unaligned(bswap_16(val), (uint16_t *) ptr); +} + +static inline void put_be32(uint32_t val, void *ptr) +{ + put_unaligned(bswap_32(val), (uint32_t *) ptr); +} + +static inline void put_le16(uint16_t val, void *ptr) +{ + put_unaligned(val, (uint16_t *) ptr); +} + +static inline void put_le32(uint32_t val, void *ptr) +{ + put_unaligned(val, (uint32_t *) ptr); +} + +static inline void put_be64(uint64_t val, void *ptr) +{ + put_unaligned(bswap_64(val), (uint64_t *) ptr); +} + +static inline void put_le64(uint64_t val, void *ptr) +{ + put_unaligned(val, (uint64_t *) ptr); +} +#elif __BYTE_ORDER == __BIG_ENDIAN +static inline uint64_t get_le64(const void *ptr) +{ + return bswap_64(get_unaligned((const uint64_t *) ptr)); +} + +static inline uint64_t get_be64(const void *ptr) +{ + return get_unaligned((const uint64_t *) ptr); +} + +static inline uint32_t get_le32(const void *ptr) +{ + return bswap_32(get_unaligned((const uint32_t *) ptr)); +} + +static inline uint32_t get_be32(const void *ptr) +{ + return get_unaligned((const uint32_t *) ptr); +} + +static inline uint16_t get_le16(const void *ptr) +{ + return bswap_16(get_unaligned((const uint16_t *) ptr)); +} + +static inline uint16_t get_be16(const void *ptr) +{ + return get_unaligned((const uint16_t *) ptr); +} + +static inline void put_be16(uint16_t val, void *ptr) +{ + put_unaligned(val, (uint16_t *) ptr); +} + +static inline void put_be32(uint32_t val, void *ptr) +{ + put_unaligned(val, (uint32_t *) ptr); +} + +static inline void put_le16(uint16_t val, void *ptr) +{ + put_unaligned(bswap_16(val), (uint16_t *) ptr); +} + +static inline void put_le32(uint32_t val, void *ptr) +{ + put_unaligned(bswap_32(val), (uint32_t *) ptr); +} + +static inline void put_be64(uint64_t val, void *ptr) +{ + put_unaligned(val, (uint64_t *) ptr); +} + +static inline void put_le64(uint64_t val, void *ptr) +{ + put_unaligned(bswap_64(val), (uint64_t *) ptr); +} +#else +#error "Unknown byte order" +#endif -- cgit v1.2.3