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

g2o: fixed vertigo index when using landmarks. graphViewer: fixed outlier wrong set to some landmark links

Browse Source
This commit is contained in:
matlabbe
2019-04-12 21:31:20 -04:00
parent 428d5be129
commit 7acaac7a6d
2 changed files with 2 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files

5
guilib/src/GraphViewer.cpp
View File

@@ -521,10 +521,7 @@ void GraphViewer::updateGraph(const std::map<int, Transform> & poses,
if(iter->second.type() != Link::kNeighbor &&
iter->second.type() != Link::kNeighborMerged)
{
float linearError = uMax3(
fabs(iter->second.transform().x() - t.x()),
fabs(iter->second.transform().y() - t.y()),
fabs(iter->second.transform().z() - t.z()));
float linearError = fabs(iter->second.transform().getNorm() - t.getNorm());
if(linearError > _loopClosureOutlierThr)
{
linkItem->setColor(_loopClosureRejectedColor);