creating 2d scan+normal type (CV_32FC5) when normals are computed

This commit is contained in:
matlabbe
2017-09-09 22:46:37 -04:00
parent 4d0423c538
commit bf17e7368f
5 changed files with 30 additions and 10 deletions
+1 -1
View File
@@ -996,7 +996,7 @@ void CoreWrapper::commonDepthCallbackImpl(
pcl::PointCloud<pcl::Normal>::Ptr normals = rtabmap::util3d::computeFastOrganizedNormals2D(scanCloud2d, scanCloudNormalK_, scanCloudNormalRadius_);
pcl::PointCloud<pcl::PointNormal>::Ptr pclScanNormal(new pcl::PointCloud<pcl::PointNormal>);
pcl::concatenateFields(*scanCloud2d, *normals, *pclScanNormal);
scan = rtabmap::util3d::laserScanFromPointCloud(*pclScanNormal);
scan = rtabmap::util3d::laserScan2dFromPointCloud(*pclScanNormal);
}
else
{