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

CloudViewer: fixed an iterator comparison error

Browse Source
This commit is contained in:
Mathieu Labbé
2015-10-18 18:35:28 -04:00
parent 2953217c2c
commit 38b3e6c337
1 changed files with 23 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files

33
guilib/src/CloudViewer.cpp
View File

@@ -844,7 +844,7 @@ void CloudViewer::removeText(const std::string & id)
return;
}
if(_texts.find(id) != _coordinates.end())
if(_texts.find(id) != _texts.end())
{
_visualizer->removeText3D(id);
_texts.erase(id);
@@ -959,15 +959,28 @@ void CloudViewer::getCameraPosition(
{
std::vector<pcl::visualization::Camera> cameras;
_visualizer->getCameras(cameras);
x = cameras.front().pos[0];
y = cameras.front().pos[1];
z = cameras.front().pos[2];
focalX = cameras.front().focal[0];
focalY = cameras.front().focal[1];
focalZ = cameras.front().focal[2];
upX = cameras.front().view[0];
upY = cameras.front().view[1];
upZ = cameras.front().view[2];
if(cameras.size())
{
x = cameras.begin()->pos[0];
y = cameras.begin()->pos[1];
z = cameras.begin()->pos[2];
focalX = cameras.begin()->focal[0];
focalY = cameras.begin()->focal[1];
focalZ = cameras.begin()->focal[2];
upX = cameras.begin()->view[0];
upY = cameras.begin()->view[1];
upZ = cameras.begin()->view[2];
}
else
{
_visualizer->setCameraPosition(
-1, 0, 0,
0, 0, 0,
0, 0, 1);
x=-1.0f;
y=z=focalX=focalY=focalZ=upX=upY=0;
upZ=1.0f;
}
}
void CloudViewer::setCameraPosition(