1 files changed, 58 insertions, 0 deletions

diff --git a/toxcore/util.c b/toxcore/util.c
index 7a2db450..f0bb4130 100644
--- a/toxcore/util.c
+++ b/toxcore/util.c
@@ -133,3 +133,61 @@ int load_state(load_state_callback_func load_state_callback, void *outer,
 
     return length == 0 ? 0 : -1;
 };
+
+/* Converts 4 bytes to uint32_t */
+inline__ void bytes_to_U32(uint32_t *dest, const uint8_t *bytes)
+{
+    *dest =
+    #ifdef WORDS_BIGENDIAN
+    ( ( uint32_t ) *  bytes )              |
+    ( ( uint32_t ) * ( bytes + 1 ) << 8 )  |
+    ( ( uint32_t ) * ( bytes + 2 ) << 16 ) |
+    ( ( uint32_t ) * ( bytes + 3 ) << 24 ) ;
+    #else
+    ( ( uint32_t ) *  bytes        << 24 ) |
+    ( ( uint32_t ) * ( bytes + 1 ) << 16 ) |
+    ( ( uint32_t ) * ( bytes + 2 ) << 8 )  |
+    ( ( uint32_t ) * ( bytes + 3 ) ) ;
+    #endif
+}
+
+/* Converts 2 bytes to uint16_t */
+inline__ void bytes_to_U16(uint16_t *dest, const uint8_t *bytes)
+{
+    *dest =
+    #ifdef WORDS_BIGENDIAN
+    ( ( uint16_t ) *   bytes ) |
+    ( ( uint16_t ) * ( bytes + 1 ) << 8 );
+    #else
+    ( ( uint16_t ) *   bytes << 8 ) |
+    ( ( uint16_t ) * ( bytes + 1 ) );
+    #endif
+}
+
+/* Convert uint32_t to byte string of size 4 */
+inline__ void U32_to_bytes(uint8_t *dest, uint32_t value)
+{
+    #ifdef WORDS_BIGENDIAN
+    *(dest)     = ( value );
+    *(dest + 1) = ( value >> 8 );
+    *(dest + 2) = ( value >> 16 );
+    *(dest + 3) = ( value >> 24 );
+    #else
+    *(dest)     = ( value >> 24 );
+    *(dest + 1) = ( value >> 16 );
+    *(dest + 2) = ( value >> 8 );
+    *(dest + 3) = ( value );
+    #endif
+}
+
+/* Convert uint16_t to byte string of size 2 */
+inline__ void U16_to_bytes(uint8_t *dest, uint16_t value)
+{
+    #ifdef WORDS_BIGENDIAN
+    *(dest)     = ( value );
+    *(dest + 1) = ( value >> 8 );
+    #else
+    *(dest)     = ( value >> 8 );
+    *(dest + 1) = ( value );
+    #endif
+}
\ No newline at end of file