Fixed mapToOdom transform not set on getMap and publishMap services

This commit is contained in:
matlabbe
2015-12-17 12:13:31 -05:00
parent 97b7b0ccf4
commit 8355431160
+3 -3
View File
@@ -1678,7 +1678,7 @@ bool CoreWrapper::getMapCallback(rtabmap_ros::GetMap::Request& req, rtabmap_ros:
rtabmap_ros::mapDataToROS(poses, rtabmap_ros::mapDataToROS(poses,
constraints, constraints,
signatures, signatures,
Transform::getIdentity(), mapToOdom_,
res.data); res.data);
res.data.header.stamp = ros::Time::now(); res.data.header.stamp = ros::Time::now();
@@ -1821,7 +1821,7 @@ bool CoreWrapper::publishMapCallback(rtabmap_ros::PublishMap::Request& req, rtab
rtabmap_ros::mapDataToROS(poses, rtabmap_ros::mapDataToROS(poses,
constraints, constraints,
signatures, signatures,
Transform::getIdentity(), mapToOdom_,
*msg); *msg);
mapDataPub_.publish(msg); mapDataPub_.publish(msg);
@@ -1835,7 +1835,7 @@ bool CoreWrapper::publishMapCallback(rtabmap_ros::PublishMap::Request& req, rtab
rtabmap_ros::mapGraphToROS(poses, rtabmap_ros::mapGraphToROS(poses,
constraints, constraints,
Transform::getIdentity(), mapToOdom_,
*msg); *msg);
mapGraphPub_.publish(msg); mapGraphPub_.publish(msg);