i/rtabmap
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap.git synced 2026-09-03 01:50:24 +08:00
Code Issues Packages Projects Releases Wiki Activity

DbViewer: fixed features not added in right image when adding loop closure

Browse Source
This commit is contained in:
matlabbe
2017-01-28 15:49:29 -05:00
parent e3d9ad005e
commit e3b3a08f5f
1 changed files with 12 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

14
guilib/src/DatabaseViewer.cpp
View File

@@ -4250,6 +4250,7 @@ void DatabaseViewer::addConstraint()
bool DatabaseViewer::addConstraint(int from, int to, bool silent, bool updateGraph)
{
bool switchedIds = false;
if(from == to)
{
UWARN("Cannot add link to same node");
@@ -4257,6 +4258,7 @@ bool DatabaseViewer::addConstraint(int from, int to, bool silent, bool updateGra
}
else if(from < to)
{
switchedIds = true;
int tmp = from;
from = to;
to = tmp;
@@ -4293,8 +4295,16 @@ bool DatabaseViewer::addConstraint(int from, int to, bool silent, bool updateGra
if(!silent)
{
ui_->graphicsView_A->setFeatures(fromS.getWords(), dataFrom.depthRaw());
ui_->graphicsView_B->setFeatures(toS.getWords(), dataTo.depthRaw());
if(switchedIds)
{
ui_->graphicsView_A->setFeatures(toS.getWords(), dataTo.depthRaw());
ui_->graphicsView_B->setFeatures(fromS.getWords(), dataFrom.depthRaw());
}
else
{
ui_->graphicsView_A->setFeatures(fromS.getWords(), dataFrom.depthRaw());
ui_->graphicsView_B->setFeatures(toS.getWords(), dataTo.depthRaw());
}
updateWordsMatching();
}