i/rtabmap_ros
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap_ros.git synced 2026-10-11 12:09:51 +08:00
Code Issues Packages Projects Releases Wiki Activity

removed camera_info stamp check for sync and throttle nodes

Browse Source
This commit is contained in:
matlabbe
2019-04-11 12:03:58 -04:00
parent 8df7157d84
commit b4334bb832
3 changed files with 9 additions and 19 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/nodelets/data_throttle.cpp
+3 -5
View File
@@ -203,16 +203,14 @@ private:
} }
if( rgbStamp != image->header.stamp.toSec() || if( rgbStamp != image->header.stamp.toSec() ||
depthStamp != imageDepth->header.stamp.toSec() || depthStamp != imageDepth->header.stamp.toSec())
infoStamp != camInfo->header.stamp.toSec())
{ {
NODELET_ERROR("Input stamps changed between the beginning and the end of the callback! Make " NODELET_ERROR("Input stamps changed between the beginning and the end of the callback! Make "
"sure the node publishing the topics doesn't override the same data after publishing them. A " "sure the node publishing the topics doesn't override the same data after publishing them. A "
"solution is to use this node within another nodelet manager. Stamps: " "solution is to use this node within another nodelet manager. Stamps: "
"rgb=%f->%f depth=%f->%f info=%f->%f", "rgb=%f->%f depth=%f->%f",
rgbStamp, image->header.stamp.toSec(), rgbStamp, image->header.stamp.toSec(),
depthStamp, imageDepth->header.stamp.toSec(), depthStamp, imageDepth->header.stamp.toSec());
infoStamp, camInfo->header.stamp.toSec());
} }
} }
src/nodelets/stereo_sync.cpp
+3 -7
View File
@@ -211,18 +211,14 @@ private:
} }
if( leftStamp != imageLeft->header.stamp.toSec() || if( leftStamp != imageLeft->header.stamp.toSec() ||
rightStamp != imageRight->header.stamp.toSec() || rightStamp != imageRight->header.stamp.toSec())
leftInfoStamp != cameraInfoLeft->header.stamp.toSec() ||
rightInfoStamp != cameraInfoRight->header.stamp.toSec())
{ {
NODELET_ERROR("Input stamps changed between the beginning and the end of the callback! Make " NODELET_ERROR("Input stamps changed between the beginning and the end of the callback! Make "
"sure the node publishing the topics doesn't override the same data after publishing them. A " "sure the node publishing the topics doesn't override the same data after publishing them. A "
"solution is to use this node within another nodelet manager. Stamps: " "solution is to use this node within another nodelet manager. Stamps: "
"left%f->%f right=%f->%f info_left=%f->%f info_right=%f->%f", "left%f->%f right=%f->%f",
leftStamp, imageLeft->header.stamp.toSec(), leftStamp, imageLeft->header.stamp.toSec(),
rightStamp, imageRight->header.stamp.toSec(), rightStamp, imageRight->header.stamp.toSec());
leftInfoStamp, cameraInfoLeft->header.stamp.toSec(),
rightInfoStamp, cameraInfoRight->header.stamp.toSec());
} }
} }
} }
src/nodelets/stereo_throttle.cpp
+3 -7
View File
@@ -229,18 +229,14 @@ private:
} }
if( leftStamp != imageLeft->header.stamp.toSec() || if( leftStamp != imageLeft->header.stamp.toSec() ||
rightStamp != imageRight->header.stamp.toSec() || rightStamp != imageRight->header.stamp.toSec())
leftInfoStamp != camInfoLeft->header.stamp.toSec() ||
rightInfoStamp != camInfoRight->header.stamp.toSec())
{ {
NODELET_ERROR("Input stamps changed between the beginning and the end of the callback! Make " NODELET_ERROR("Input stamps changed between the beginning and the end of the callback! Make "
"sure the node publishing the topics doesn't override the same data after publishing them. A " "sure the node publishing the topics doesn't override the same data after publishing them. A "
"solution is to use this node within another nodelet manager. Stamps: " "solution is to use this node within another nodelet manager. Stamps: "
"left%f->%f right=%f->%f info_left=%f->%f info_right=%f->%f", "left%f->%f right=%f->%f",
leftStamp, imageLeft->header.stamp.toSec(), leftStamp, imageLeft->header.stamp.toSec(),
rightStamp, imageRight->header.stamp.toSec(), rightStamp, imageRight->header.stamp.toSec());
leftInfoStamp, camInfoLeft->header.stamp.toSec(),
rightInfoStamp, camInfoRight->header.stamp.toSec());
} }
} }