can_codec_utils.h

Go to the documentation of this file.

 
#ifndef CAN_CODEC_UTILS_H
#define CAN_CODEC_UTILS_H
 
#include <stdint.h>
#include <stdbool.h>
#include <stddef.h>
 
// This macro is defined by GCC but not clang
#ifndef __always_inline
    #define __always_inline __inline__ __attribute__((__always_inline__))
#endif
 
// NOLINTBEGIN(cppcoreguidelines-avoid-magic-numbers, readability-magic-numbers, readability-identifier-length)

static __always_inline uint8_t swap_byte_order_8(uint8_t x) {
    return x;
}

static __always_inline uint16_t swap_byte_order_16(uint16_t x) {
    return (x & 0xFF00) >> 8 | (x & 0x00FF) << 8;
}

static __always_inline uint32_t swap_byte_order_32(uint32_t x) {
    x = (x & 0xFFFF0000) >> 16 | (x & 0x0000FFFF) << 16;
    return (x & 0xFF00FF00) >> 8 | (x & 0x00FF00FF) << 8;
}

static __always_inline uint32_t swap_byte_order_ftou(float x) {
    uint32_t ret = *((uint32_t*)&x);
    ret = (ret & 0xFFFF0000) >> 16 | (ret & 0x0000FFFF) << 16;
    return (ret & 0xFF00FF00) >> 8 | (ret & 0x00FF00FF) << 8;
}

static __always_inline float swap_byte_order_utof(uint32_t x) {
    x = (x & 0xFFFF0000) >> 16 | (x & 0x0000FFFF) << 16;
    x = (x & 0xFF00FF00) >> 8 | (x & 0x00FF00FF) << 8;
    return *((float*)&x);
}

static __always_inline uint64_t swap_byte_order_64(uint64_t x) {
    x = (x & 0xFFFFFFFF00000000ULL) >> 32 | (x & 0x00000000FFFFFFFFULL) << 32;
    x = (x & 0xFFFF0000FFFF0000ULL) >> 16 | (x & 0x0000FFFF0000FFFFULL) << 16;
    return (x & 0xFF00FF00FF00FF00ULL) >> 8 | (x & 0x00FF00FF00FF00FFULL) << 8;
}

static __always_inline uint64_t swap_byte_order_dtou(double x) {
    uint64_t ret = *((uint64_t*)&x);
    ret = (ret & 0xFFFFFFFF00000000ULL) >> 32 | (ret & 0x00000000FFFFFFFFULL) << 32;
    ret = (ret & 0xFFFF0000FFFF0000ULL) >> 16 | (ret & 0x0000FFFF0000FFFFULL) << 16;
    return (ret & 0xFF00FF00FF00FF00ULL) >> 8 | (ret & 0x00FF00FF00FF00FFULL) << 8;
}

static __always_inline double swap_byte_order_utod(uint64_t x) {
    x = (x & 0xFFFFFFFF00000000ULL) >> 32 | (x & 0x00000000FFFFFFFFULL) << 32;
    x = (x & 0xFFFF0000FFFF0000ULL) >> 16 | (x & 0x0000FFFF0000FFFFULL) << 16;
    x = (x & 0xFF00FF00FF00FF00ULL) >> 8 | (x & 0x00FF00FF00FF00FFULL) << 8;
    return *((double*)&x);
}
 
 
// NOLINTEND(cppcoreguidelines-avoid-magic-numbers, readability-magic-numbers, readability-identifier-length)
 
#endif /* CAN_CODEC_UTILS_H */