From f68b243dfc5467a5177b276d6b9492b5b46ae531 Mon Sep 17 00:00:00 2001
From: Hauke Petersen <hauke.petersen@fu-berlin.de>
Date: Wed, 6 Jun 2018 13:18:48 +0200
Subject: [PATCH] core/byteorder: add uint16 from/to buffer funcs
---
core/include/byteorder.h | 45 ++++++++++++++++++++++++++++++++++++++++
1 file changed, 45 insertions(+)
diff --git a/core/include/byteorder.h b/core/include/byteorder.h
index fcfa1564e8..3139942a4b 100644
--- a/core/include/byteorder.h
+++ b/core/include/byteorder.h
@@ -224,6 +224,31 @@ static inline uint32_t byteorder_swapl(uint32_t v);
*/
static inline uint64_t byteorder_swapll(uint64_t v);
+/**
+ * @brief Read a little endian encoded unsigned integer from a buffer
+ * into host byte order encoded variable, 16-bit
+ *
+ * @note This function is agnostic to the alignment of the target
+ * value in the given buffer
+ *
+ * @param[in] buf position in a buffer holding the target value
+ *
+ * @return 16-bit unsigned integer in host byte order
+ */
+static inline uint16_t byteorder_lebuftohs(const uint8_t *buf);
+
+/**
+ * @brief Write a host byte order encoded unsigned integer as little
+ * endian encoded value into a buffer, 16-bit
+ *
+ * @note This function is alignment agnostic and works with any given
+ * memory location of the buffer
+ *
+ * @param[out] buf target buffer, must be able to accept 2 bytes
+ * @param[in] val value written to the buffer, in host byte order
+ */
+static inline void byteorder_htolebufs(uint8_t *buf, uint16_t val);
+
/**
* @brief Convert from host byte order to network byte order, 16 bit.
* @see byteorder_htons()
@@ -418,6 +443,26 @@ static inline uint64_t ntohll(uint64_t v)
return byteorder_ntohll(input);
}
+static inline uint16_t byteorder_lebuftohs(const uint8_t *buf)
+{
+#if __BYTE_ORDER__ == __ORDER_LITTLE_ENDIAN__
+ return (uint16_t)((buf[0] << 8) | buf[1]);
+#else
+ return (uint16_t)((buf[1] << 8) | buf[0]);
+#endif
+}
+
+static inline void byteorder_htolebufs(uint8_t *buf, uint16_t val)
+{
+#if __BYTE_ORDER__ == __ORDER_LITTLE_ENDIAN__
+ buf[0] = (uint8_t)(val >> 8);
+ buf[1] = (uint8_t)(val & 0xff);
+#else
+ buf[0] = (uint8_t)(val & 0xff);
+ buf[1] = (uint8_t)(val >> 8);
+#endif
+}
+
#ifdef __cplusplus
}
#endif
--
GitLab