Common read 24-bit inverse implemented

Author: Jarkko Paso

mbed-client-libservice/common_functions.h

@@ -126,6 +126,17 @@ NS_INLINE uint_fast24_t common_read_24_bit(const uint8_t data_buf[__static 3]);
  */
 NS_INLINE uint8_t *common_write_24_bit_inverse(uint_fast24_t value, uint8_t ptr[__static 3]);
 
+/*
+ * Common read 24-bit variable from 8-bit pointer.
+ *
+ * Read 24 bits in little-endian byte order.
+ *
+ * \param data_buf pointer where data to be read
+ *
+ * \return 24-bit variable
+ */
+NS_INLINE uint_fast24_t common_read_24_bit_inverse(const uint8_t data_buf[__static 3]);
+
 /*
  * Common write 16-bit variable to 8-bit pointer.
  *
@@ -440,6 +451,15 @@ COMMON_FUNCTIONS_FN uint8_t *common_write_24_bit_inverse(uint_fast24_t value, ui
     return ptr;
 }
 
+COMMON_FUNCTIONS_FN uint_fast24_t common_read_24_bit_inverse(const uint8_t data_buf[__static 3])
+{
+    uint_fast24_t temp_24;
+    temp_24 =  *data_buf++;
+    temp_24 += (uint_fast24_t)(*data_buf++) << 8;
+    temp_24 += (uint_fast24_t)(*data_buf++) << 16;
+    return temp_24;
+}
+
 COMMON_FUNCTIONS_FN uint8_t *common_write_16_bit(uint16_t value, uint8_t ptr[__static 2])
 {
     *ptr++ = value >> 8;