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

fixed "path.size()=0!? nearestId=1 ids=1, aborting..." warning when Rtabmap/CreateIntermediateNodes is true and proximity detection is enabled.

Browse Source
This commit is contained in:
matlabbe
2021-05-21 17:46:19 -04:00
parent f96591e030
commit ae4778b89c
1 changed files with 6 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/CoreWrapper.cpp
+6 -1
View File
@@ -1873,7 +1873,12 @@ void CoreWrapper::process(
{ {
if(iter->first.header.stamp < lastPoseStamp_) if(iter->first.header.stamp < lastPoseStamp_)
{ {
Transform interOdom = rtabmap_ros::transformFromPoseMsg(iter->first.pose.pose); Transform interOdom;
if(!rtabmap_.getLocalOptimizedPoses().empty())
{
// add intermediate poses only if the current local graph is not empty
interOdom = rtabmap_ros::transformFromPoseMsg(iter->first.pose.pose);
}
if(!interOdom.isNull()) if(!interOdom.isNull())
{ {
cv::Mat covariance; cv::Mat covariance;