From f24fb637230800de47d5b978bbebca1d4338cec9 Mon Sep 17 00:00:00 2001
From: pyhs <pierreyves@humanitas.io>
Date: Tue, 11 Jul 2017 15:28:24 -0400
Subject: [PATCH] Fixed code for new buzz (especially commit
 a854c5cdc6830e4c1ec246b46886d4298ac872f1)

---
 src/buzz_utility.cpp | 2 ++
 1 file changed, 2 insertions(+)

diff --git a/src/buzz_utility.cpp b/src/buzz_utility.cpp
index 3453a65..c9d9ea6 100644
--- a/src/buzz_utility.cpp
+++ b/src/buzz_utility.cpp
@@ -182,6 +182,7 @@ namespace buzz_utility{
    			uint16_t* data= u64_cvt_u16((uint64_t)first_INmsg[0]);
 			/*Size is at first 2 bytes*/
    			uint16_t size=data[0]*sizeof(uint64_t);
+        uint16_t robot_id = data[1];
    			delete[] data;
 			/*size and robot id read*/
 	   		size_t tot = sizeof(uint32_t);
@@ -195,6 +196,7 @@ namespace buzz_utility{
 			 			/* Append message to the Buzz input message queue */
 			 			if(unMsgSize > 0 && unMsgSize <= size - tot ) {
 			    			buzzinmsg_queue_append(VM,
+                        robot_id,
 				                buzzmsg_payload_frombuffer(first_INmsg +tot, unMsgSize));
 			    			tot += unMsgSize;
 			 			}