From d866036fa4aa906b1f4c99c60e85bd44faad05be Mon Sep 17 00:00:00 2001
From: Thomas Timm Andersen <thomas.timm.dk@gmail.com>
Date: Wed, 16 Sep 2015 16:24:29 +0200
Subject: [PATCH] Fixed bug for RT message garbage in 3.0

---
 src/robot_state_RT.cpp | 5 +++--
 1 file changed, 3 insertions(+), 2 deletions(-)

diff --git a/src/robot_state_RT.cpp b/src/robot_state_RT.cpp
index cc8da67..a81951c 100644
--- a/src/robot_state_RT.cpp
+++ b/src/robot_state_RT.cpp
@@ -304,8 +304,9 @@ void RobotStateRT::unpack(uint8_t * buf) {
 
 	offset += sizeof(len);
 	len = ntohl(len);
-	if (version_ < 3.1 & len > 1044) {
-		//In 3.0, every 3rd? package is malformed...?
+	if (version_ < 3.1 & len != 1044) {
+		//In 3.0, every 4th? package is malformed...?
+		//printf("Len: %i\n", len);
 		val_lock_.unlock();
 		return;
 	}