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

Explicitly use parent frame id for tags

Browse Source
This commit is contained in:
matlabbe
2018-12-10 20:22:02 -05:00
parent 98c3ed985e
commit e0c58ebe35
1 changed files with 3 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/CoreWrapper.cpp
+3 -1
View File
@@ -2177,7 +2177,9 @@ void CoreWrapper::tagDetectionsAsyncCallback(const apriltags2_ros::AprilTagDetec
{
if(tagDetections.detections[i].id.size() >= 1)
{
uInsert(tags_, std::make_pair(tagDetections.detections[i].id[0], tagDetections.detections[i].pose));
geometry_msgs::PoseWithCovarianceStamped p = tagDetections.detections[i].pose;
p.header.frame_id = tagDetections.header.frame_id; // make sure we pass frame_id of parent
uInsert(tags_, std::make_pair(tagDetections.detections[i].id[0], p));
}
}
}