mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-02 09:30:25 +08:00
DbViewer: added ground truth coordinate (when available) in constraints view
This commit is contained in:
@@ -3059,7 +3059,11 @@ void DatabaseViewer::updateConstraintView(
|
||||
|
||||
ui_->constraintsViewer->addOrUpdateCoordinate("from_coordinate", Transform::getIdentity(), 0.2);
|
||||
ui_->constraintsViewer->addOrUpdateCoordinate("to_coordinate", t, 0.2);
|
||||
|
||||
if(uContains(groundTruthPoses_, link.from()) && uContains(groundTruthPoses_, link.to()))
|
||||
{
|
||||
ui_->constraintsViewer->addOrUpdateCoordinate("to_coordinate_gt",
|
||||
groundTruthPoses_.at(link.from()).inverse()*groundTruthPoses_.at(link.to()), 0.1);
|
||||
}
|
||||
|
||||
ui_->constraintsViewer->clearTrajectory();
|
||||
|
||||
|
||||
Reference in New Issue
Block a user