HyunGyu Kim / Mbed 2 deprecated MTi-1_example

kjj

Dependencies:   mbed-rtos mbed Xbus

Fork of MTi-1_example by Xsens

Files at this revision

API Documentation at this revision

Revision 27:eebe5fc884e3, committed 2015-05-20

Comitter:
Alex Young
Date:
Wed May 20 16:46:14 2015 +0200
Parent:
26:665d3624f9ab
Child:
28:ae74baf7e5ab
Commit message:
Add functions for writing stdints to xbus message

Changed in this revision

xbus/xbusutility.c Show annotated file Show diff for this revision Revisions of this file
xbus/xbusutility.h Show annotated file Show diff for this revision Revisions of this file 
--- a/xbus/xbusutility.c	Wed May 20 14:49:54 2015 +0200
+++ b/xbus/xbusutility.c	Wed May 20 16:46:14 2015 +0200
@@ -32,3 +32,26 @@
 	*out = (in[0] << 24) | (in[1] << 16) | (in[2] << 8) | in[3];
 	return in + sizeof(uint32_t);
 }
+
+uint8_t* XbusUtility_writeU8(uint8_t* out, uint8_t in)
+{
+	*out++ = in;
+	return out;
+}
+
+uint8_t* XbusUtility_writeU16(uint8_t* out, uint16_t in)
+{
+	*out++ = (in >> 8) & 0xFF;
+	*out++ = in & 0xFF;
+	return out;
+}
+
+uint8_t* XbusUtility_writeU32(uint8_t* out, uint32_t in)
+{
+
+	*out++ = (in >> 24) & 0xFF;
+	*out++ = (in >> 16) & 0xFF;
+	*out++ = (in >> 8) & 0xFF;
+	*out++ = in & 0xFF;
+	return out;
+}

--- a/xbus/xbusutility.h	Wed May 20 14:49:54 2015 +0200
+++ b/xbus/xbusutility.h	Wed May 20 16:46:14 2015 +0200
@@ -22,4 +22,8 @@
 uint8_t const* XbusUtility_readU16(uint16_t* out, uint8_t const* in);
 uint8_t const* XbusUtility_readU32(uint32_t* out, uint8_t const* in);
 
+uint8_t* XbusUtility_writeU8(uint8_t* out, uint8_t in);
+uint8_t* XbusUtility_writeU16(uint8_t* out, uint16_t in);
+uint8_t* XbusUtility_writeU32(uint8_t* out, uint32_t in);
+
 #endif // __XBUSUTILITY_H