| /* |
| * |
| * 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 <endian.h> |
| #include <byteswap.h> |
| |
| #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 |