ros noetic moveit 将点云话题通过0.10.0 open3d进行三角化

可以使用以下Python代码将点云话题转换为三角化的Mesh对象：

import rospy
import open3d as o3d
import numpy as np
from sensor_msgs.msg import PointCloud2
from shape_msgs.msg import Mesh
from geometry_msgs.msg import Point

def point_cloud_to_mesh(data):
    # Convert PointCloud2 to numpy array
    pc = ros_numpy.numpify(data)
    points = np.zeros((pc.shape[0], 3))
    points[:, 0] = pc['x']
    points[:, 1] = pc['y']
    points[:, 2] = pc['z']

    # Triangulate using Open3D
    pcd = o3d.geometry.PointCloud()
    pcd.points = o3d.utility.Vector3dVector(points)
    pcd.estimate_normals(search_param=o3d.geometry.KDTreeSearchParamHybrid(radius=0.1, max_nn=30))
    pcd.orient_normals_consistent_tangent_plane(30)
    pcd = pcd.remove_non_manifold_edges()
    mesh, _ = o3d.geometry.TriangleMesh.create_from_point_cloud_poisson(pcd, depth=8)
    mesh.compute_vertex_normals()

    # Convert mesh to Mesh message
    mesh_msg = Mesh()
    mesh_msg.vertices = [Point(p[0], p[1], p[2]) for p in mesh.vertices]
    mesh_msg.triangles = [mesh.triangles[i].astype(int) for i in range(len(mesh.triangles))]
    mesh_msg.triangulation_type = Mesh.TRIANGLE_LIST
    mesh_msg.vertex_normals = [Point(n[0], n[1], n[2]) for n in mesh.vertex_normals]

    return mesh_msg

这个函数将输入的 `PointCloud2` 消息转换为 `open3d.geometry.PointCloud` 对象，并使用 Poisson 重建算法将其三角化为 `open3d.geometry.TriangleMesh`。然后，将 `TriangleMesh` 转换为 `shape_msgs/Mesh` 消息并返回。