mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-03 01:50:24 +08:00
DbViewer: don't modify ground truth values (previously they were aligned with root)
This commit is contained in:
@@ -5215,20 +5215,6 @@ void DatabaseViewer::updateGraphView()
|
||||
}
|
||||
}
|
||||
delete optimizer;
|
||||
|
||||
if(uContains(groundTruthPoses_, fromId) && uContains(posesOut, fromId))
|
||||
{
|
||||
// adjust the ground truth to fit the root
|
||||
Transform t = posesOut.at(fromId) * groundTruthPoses_.at(fromId).inverse();
|
||||
for(std::map<int, Transform>::iterator iter=groundTruthPoses_.begin(); iter!=groundTruthPoses_.end(); ++iter)
|
||||
{
|
||||
iter->second = t * iter->second;
|
||||
}
|
||||
}
|
||||
else if(groundTruthPoses_.size())
|
||||
{
|
||||
UWARN("Could not find ground truth for root node %d", fromId);
|
||||
}
|
||||
}
|
||||
if(graphes_.size())
|
||||
{
|
||||
|
||||
Reference in New Issue
Block a user