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

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