aboutsummaryrefslogtreecommitdiffstats
path: root/os/various/bswap.h
diff options
context:
space:
mode:
authorStephane D'Alu <sdalu@sdalu.com>2016-02-07 16:48:22 +0100
committerStephane D'Alu <sdalu@sdalu.com>2016-02-07 16:48:22 +0100
commitee5bea89c258d29dd628e366940569dd9795b1a9 (patch)
tree3f92899ee45f73fddf472458c72b560e5ffc7ca3 /os/various/bswap.h
parent5af8452153646009731c11dd92a8634695b60d55 (diff)
downloadChibiOS-Contrib-ee5bea89c258d29dd628e366940569dd9795b1a9.tar.gz
ChibiOS-Contrib-ee5bea89c258d29dd628e366940569dd9795b1a9.tar.bz2
ChibiOS-Contrib-ee5bea89c258d29dd628e366940569dd9795b1a9.zip
hdc1008 sensor
Diffstat (limited to 'os/various/bswap.h')
-rw-r--r--os/various/bswap.h138
1 files changed, 138 insertions, 0 deletions
diff --git a/os/various/bswap.h b/os/various/bswap.h
new file mode 100644
index 0000000..624e4ba
--- /dev/null
+++ b/os/various/bswap.h
@@ -0,0 +1,138 @@
+#ifndef BSWAP_H
+#define BSWAP_H
+
+#if defined(__cplusplus)
+extern "C" {
+#endif
+
+#if !(defined(ARCH_BIG_ENDIAN) || defined(ARCH_LITTLE_ENDIAN))
+#if YOTTA_CFG_CONFIG_ARCH_LITTLE_ENDIAN
+#define ARCH_LITTLE_ENDIAN
+#endif
+#if YOTTA_CFG_CONFIG_ARCH_BIG_ENDIAN
+#define ARCH_BIG_ENDIAN
+#endif
+#endif
+
+#if !(defined(ARCH_BIG_ENDIAN) || defined(ARCH_LITTLE_ENDIAN))
+#error "ARCH_BIG_ENDIAN or ARCH_LITTLE_ENDIAN not set."
+#endif
+
+#if defined(ARCH_BIG_ENDIAN) && defined(ARCH_LITTLE_ENDIAN)
+#error "ARCH_BIG_ENDIAN and ARCH_LITTLE_ENDIAN are both set."
+#endif
+
+
+#define BSWAP_16(x) \
+ (uint16_t)((((x) & 0xFF00) >> 8) | (((x) & 0x00FF) << 8))
+#define BSWAP_32(x) \
+ (uint32_t)((((x) & 0xFF000000UL) >> 24UL) | \
+ (((x) & 0x00FF0000UL) >> 8UL) | \
+ (((x) & 0x0000FF00UL) << 8UL) | \
+ (((x) & 0x000000FFUL) << 24UL))
+
+
+#if defined(ARCH_BIG_ENDIAN)
+#define le16_to_cpu(x) bswap_16(x)
+#define le32_to_cpu(x) bswap_32(x)
+#define be16_to_cpu(x) (x)
+#define be32_to_cpu(x) (x)
+#define cpu_to_le16(x) bswap_16(x)
+#define cpu_to_le32(x) bswap_32(x)
+#define cpu_to_be16(x) (x)
+#define cpu_to_be32(x) (x)
+#define LE16_TO_CPU(x) BSWAP_16(x)
+#define LE32_TO_CPU(x) BSWAP_32(x)
+#define BE16_TO_CPU(x) (x)
+#define BE32_TO_CPU(x) (x)
+#define CPU_TO_LE16(x) BSWAP_16(x)
+#define CPU_TO_LE32(x) BSWAP_32(x)
+#define CPU_TO_BE16(x) (x)
+#define CPU_TO_BE32(x) (x)
+#endif
+
+
+#if defined(ARCH_LITTLE_ENDIAN)
+#define le16_to_cpu(x) (x)
+#define le32_to_cpu(x) (x)
+#define be16_to_cpu(x) bswap_16(x)
+#define be32_to_cpu(x) bswap_32(x)
+#define cpu_to_le16(x) (x)
+#define cpu_to_le32(x) (x)
+#define cpu_to_be16(x) bswap_16(x)
+#define cpu_to_be32(x) bswap_32(x)
+#define LE16_TO_CPU(x) (x)
+#define LE32_TO_CPU(x) (x)
+#define BE16_TO_CPU(x) BSWAP_16(x)
+#define BE32_TO_CPU(x) BSWAP_32(x)
+#define CPU_TO_LE16(x) (x)
+#define CPU_TO_LE32(x) (x)
+#define CPU_TO_BE16(x) BSWAP_16(x)
+#define CPU_TO_BE32(x) BSWAP_32(x)
+#endif
+
+
+static inline uint16_t bswap_16(const uint16_t x)
+ __attribute__ ((warn_unused_result))
+ __attribute__ ((const))
+ __attribute__ ((always_inline));
+
+static inline uint16_t bswap_16(const uint16_t x) {
+ if (__builtin_constant_p(x))
+ return BSWAP_16(x);
+
+ uint8_t tmp;
+ union { uint16_t x; uint8_t b[2]; } data;
+
+ data.x = x;
+ tmp = data.b[0];
+ data.b[0] = data.b[1];
+ data.b[1] = tmp;
+
+ return data.x;
+}
+
+static inline uint32_t bswap_32(const uint32_t x)
+ __attribute__ ((warn_unused_result))
+ __attribute__ ((const))
+ __attribute__ ((always_inline));
+
+
+static inline uint32_t bswap_32(const uint32_t x) {
+ if (__builtin_constant_p(x))
+ return BSWAP_32(x);
+
+ uint8_t tmp;
+ union { uint32_t x; uint8_t b[4]; } data;
+
+ data.x = x;
+ tmp = data.b[0];
+ data.b[0] = data.b[3];
+ data.b[3] = tmp;
+ tmp = data.b[1];
+ data.b[1] = data.b[2];
+ data.b[2] = tmp;
+
+ return data.x;
+}
+
+static inline void bswap_n(void* const data, uint8_t len)
+ __attribute__ ((nonnull (1)));
+
+static inline void bswap_n(void* const data, uint8_t len) {
+ uint8_t* ptr = (uint8_t*)data;
+
+ for ( ; len > 1 ; ptr++, len -= 2 ) {
+ uint8_t tmp = *ptr;
+ *ptr = *(ptr + len - 1);
+ *(ptr + len - 1) = tmp;
+ }
+}
+
+#if defined(__cplusplus)
+}
+#endif
+
+#endif
+
+