ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange
Ask Your Question

How do I convert a mesh to a pointcloud for use with pcl ICP

asked 2012-05-12 10:06:20 -0500

brawner gravatar image

updated 2012-05-13 08:45:28 -0500

I want to find partial overlaps between meshes in the household object database and pointcloud sensor data. My method is to convert the arm_navigation_msgs::Shape to a pcl::PointCloud and then find clusters that overlap through pcl::IterativeClosestPoint. I have all pieces working, I just think my function for converting the shape meshes to pointclouds is inefficient. Is there a way to take advantage of the underlying structure to speed up the conversion?

This is my current implementation

pcl::PointCloud<pcl::PointXYZ> PCLMeshOverlap::convertMeshToPointcloud(arm_navigation_msgs::Shape mesh)
    ROS_INFO("Converting mesh to pointcloud");
    pcl::PointCloud<pcl::PointXYZ> cloud_out;
    pcl::PointXYZ point;
    for (int i = 0; i < mesh.vertices.size(); i++)
        float isNew = true;
        for (int j = 0; j < cloud_out.points.size(); j++)
            if ( == &&
           == &&
           ==   )
                isNew = false;
        if (isNew)
            point.x =;
            point.y =;
            point.z =;
    cloud_out.width = cloud_out.points.size();
    cloud_out.height = 1;
    cloud_out.is_dense = true;
    cloud_out.header.frame_id = "/base_link";
    return cloud_out;

*Edited because the original code had some typos

edit retag flag offensive close merge delete

2 Answers

Sort by ยป oldest newest most voted

answered 2013-12-18 19:01:25 -0500

isura gravatar image

updated 2014-05-29 09:55:21 -0500

You could do this in ROS Hydro PCL 1.7 if your mesh was a pcl::PolygonMesh:

#include <pcl io="" vtk_lib_io.h="">

const std::string meshFileName = "test.stl";

pcl::PolygonMesh testMesh;
pcl::io::loadPolygonFileSTL( meshFileName, testMesh );    
pcl_conversions::fromPCL(, output );
edit flag offensive delete link more


Does this conversion sample points on the surfaces or strictly converts the vertices in the STL file into points in the point cloud? If not, is there any tool out that does sample points on the surfaces?

ben gravatar image ben  ( 2014-02-03 16:09:57 -0500 )edit

@ben to my knowledge this just converts vertices in the STL file into points in the point cloud. I am not aware of a tool that resamples points. Did you find any good solution?

isura gravatar image isura  ( 2014-05-09 15:12:00 -0500 )edit

answered 2016-09-14 07:35:45 -0500

Sagexs gravatar image

have a look at it samples point on the surface

edit flag offensive delete link more

Question Tools

1 follower


Asked: 2012-05-12 10:06:20 -0500

Seen: 10,273 times

Last updated: Sep 14 '16