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

createTextureCameras: using CameraModel's localTransform instead of hard coded optical rotation

Browse Source
This commit is contained in:
matlabbe
2017-01-17 12:44:30 -05:00
parent a011a6af64
commit 4c7d46c8a0
1 changed files with 3 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

9
corelib/src/util3d_surface.cpp
View File

@@ -581,12 +581,9 @@ pcl::texture_mapping::CameraVector createTextureCameras(
UASSERT(poseIter->first == modelIter->first);
pcl::TextureMapping<pcl::PointXYZ>::Camera cam;
// transform into optical referential
Transform rotation(0,-1,0,0,
0,0,-1,0,
1,0,0,0);
Transform t = poseIter->second*rotation.inverse();
// should be in camera frame
UASSERT(!modelIter->second.localTransform().isNull() && !poseIter->second.isNull());
Transform t = poseIter->second*modelIter->second.localTransform();
cam.pose = t.toEigen3f();