i/rtabmap
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap.git synced 2026-09-02 17:40:23 +08:00
Code Issues Packages Projects Releases Wiki Activity

Converted an assert to an error.

Browse Source
This commit is contained in:
matlabbe
2021-12-26 14:53:22 -05:00
parent 3071da42f3
commit a3823594a4
1 changed files with 5 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
corelib/src/Rtabmap.cpp
View File

@@ -2592,7 +2592,11 @@ bool Rtabmap::process(
cv::Mat covariance; cv::Mat covariance;
path = optimizeGraph(nearestId, uKeysSet(path), std::map<int, Transform>(), false, covariance); path = optimizeGraph(nearestId, uKeysSet(path), std::map<int, Transform>(), false, covariance);
// transform local poses in optimized graph referential // transform local poses in optimized graph referential
UASSERT(uContains(path, nearestId)); if(!uContains(path, nearestId))
{
UERROR("Proximity path not containing nearest ID ?! Skipping this path.");
continue;
}
Transform t = _optimizedPoses.at(nearestId) * path.at(nearestId).inverse(); Transform t = _optimizedPoses.at(nearestId) * path.at(nearestId).inverse();
for(std::map<int, Transform>::iterator jter=path.lower_bound(1); jter!=path.end(); ++jter) for(std::map<int, Transform>::iterator jter=path.lower_bound(1); jter!=path.end(); ++jter)