Obbart/universal_robots_ros_driver
1
0
Fork 0
mirror of https://gitlab.com/obbart/universal_robots_ros_driver.git synced 2026-04-10 01:50:46 +02:00
Code Releases Activity

Merge pull request #26 from jettan/master

Browse Source 
Ignore malformed messages from URSim running 1.8.X.
This commit is contained in:
Thomas Timm Andersen
2015-12-02 17:43:29 +01:00
parent 952ed2146c 1064510bd1
commit 5c71c89c1d
1 changed files with 8 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

8
src/robot_state_RT.cpp
View File

@@ -327,6 +327,14 @@ void RobotStateRT::unpack(uint8_t * buf) {
val_lock_.unlock();
return;
}
if (version_ > 1.8 & version_ < 1.9 & len != 812) {
// In 1.8.14035, every 17th and 18th package is 560 and 9 bytes long/malformed.
//printf("Len: %i\n", len);
val_lock_.unlock();
return;
}
memcpy(&unpack_to, &buf[offset], sizeof(unpack_to));
time_ = RobotStateRT::ntohd(unpack_to);
offset += sizeof(double);