mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-11 12:09:51 +08:00
Fixed republished data missing
This commit is contained in:
+1
-7
@@ -3956,16 +3956,10 @@ void CoreWrapper::publishStats(const ros::Time & stamp)
|
|||||||
msg->header.stamp = stamp;
|
msg->header.stamp = stamp;
|
||||||
msg->header.frame_id = mapFrameId_;
|
msg->header.frame_id = mapFrameId_;
|
||||||
|
|
||||||
std::map<int, Signature> signatures;
|
|
||||||
if(stats.getLastSignatureData().id() > 0)
|
|
||||||
{
|
|
||||||
signatures.insert(std::make_pair(stats.getLastSignatureData().id(), stats.getLastSignatureData()));
|
|
||||||
}
|
|
||||||
|
|
||||||
rtabmap_ros::mapDataToROS(
|
rtabmap_ros::mapDataToROS(
|
||||||
stats.poses(),
|
stats.poses(),
|
||||||
stats.constraints(),
|
stats.constraints(),
|
||||||
signatures,
|
stats.getSignaturesData(),
|
||||||
stats.mapCorrection(),
|
stats.mapCorrection(),
|
||||||
*msg);
|
*msg);
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user