Send type with xbee message.

1 files changed, 8 insertions, 14 deletions

diff --git a/main.cpp b/main.cpp
index 199ffcd..1993489 100644
--- a/main.cpp
+++ b/main.cpp
@@ -66,22 +66,16 @@ void threadmain() {
 	while(1) {
 		GPIOB.ODR ^= 1 << 1;
 		
-		uint8_t buf[] = {
-			gyro.x & 0xff,
-			gyro.x >> 8,
-			gyro.y & 0xff,
-			gyro.y >> 8,
-			gyro.z & 0xff,
-			gyro.z >> 8,
-			accel.x & 0xff,
-			accel.x >> 8,
-			accel.y & 0xff,
-			accel.y >> 8,
-			accel.z & 0xff,
-			accel.z >> 8,
+		uint16_t buf[] = {
+			gyro.x,
+			gyro.y,
+			gyro.z,
+			accel.x,
+			accel.y,
+			accel.z,
 		};
 		
-		xbee_send(sizeof(buf), buf);
+		xbee_send(1, sizeof(buf), (uint8_t*)buf);
 		Time::sleep(100);
 	}
 }