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

DbPlayer: fixed tf delay when rate=-1

Browse Source
This commit is contained in:
matlabbe
2015-09-04 16:43:18 -04:00
parent 2abf28d424
commit 8506ba9ca8
1 changed files with 4 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/DbPlayerNode.cpp
+4 -1
View File
@@ -136,7 +136,9 @@ int main(int argc, char** argv)
ros::Publisher scanPub;
tf2_ros::TransformBroadcaster tfBroadcaster;
UTimer timer;
rtabmap::OdometryEvent odom = reader.getNextData();
double acquisitionTime = timer.ticks();
while(ros::ok() && odom.data().id())
{
ROS_INFO("Reading sensor data %d...", odom.data().id());
@@ -238,7 +240,7 @@ int main(int argc, char** argv)
// publish transforms first
if(publishTf)
{
ros::Time tfExpiration = time + ros::Duration(1.0/rate);
ros::Time tfExpiration = time + ros::Duration(rate>0?1.0/rate:acquisitionTime);
rtabmap::Transform localTransform;
if(odom.data().cameraModels().size() == 1)
@@ -391,6 +393,7 @@ int main(int argc, char** argv)
}
odom = reader.getNextData();
acquisitionTime = timer.ticks();
}