i/rtabmap_ros
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap_ros.git synced 2026-10-04 08:47:45 +08:00
Code Issues Packages Projects Releases Wiki Activity

Tango: Fixed scan local transform

Browse Source
This commit is contained in:
matlabbe
2017-03-08 12:55:21 -05:00
parent 719416741f
commit c12980ee91
1 changed files with 3 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
app/android/jni/CameraTango.cpp
+3 -1
View File
@@ -667,6 +667,8 @@ SensorData CameraTango::captureImage(CameraInfo * info)
//LOGD("rtabmap = %s", odom.prettyPrint().c_str()); //LOGD("rtabmap = %s", odom.prettyPrint().c_str());
//LOGD("opengl(r)= %s", (opengl_world_T_rtabmap_world * odom * rtabmap_device_T_opengl_device).prettyPrint().c_str()); //LOGD("opengl(r)= %s", (opengl_world_T_rtabmap_world * odom * rtabmap_device_T_opengl_device).prettyPrint().c_str());
Transform scanLocalTransform = model.localTransform();
// Rotate image depending on the camera orientation // Rotate image depending on the camera orientation
if(colorCameraToDisplayRotation_ == ROTATION_90) if(colorCameraToDisplayRotation_ == ROTATION_90)
{ {
@@ -722,7 +724,7 @@ SensorData CameraTango::captureImage(CameraInfo * info)
if(rawScanPublished_) if(rawScanPublished_)
{ {
data = SensorData(scan, LaserScanInfo(cloud.total()/scanDownsampling, 0, model.localTransform()), rgb, depth, model, this->getNextSeqID(), rgbStamp); data = SensorData(scan, LaserScanInfo(cloud.total()/scanDownsampling, 0, scanLocalTransform), rgb, depth, model, this->getNextSeqID(), rgbStamp);
} }
else else
{ {