open3d 点云直通滤波

最新推荐文章于 2024-09-05 00:00:00 发布

点云-激光雷达-Slam-三维牙齿

最新推荐文章于 2024-09-05 00:00:00 发布

阅读量1.5k

点赞数 2

分类专栏：点云-激光雷达处理代码合集 python为主文章标签： python 开发语言 c++

本文链接：https://blog.csdn.net/a394467238/article/details/124942468

版权

点云-激光雷达处理代码合集 python为主专栏收录该内容

116 篇文章 371 订阅 ¥29.90 ¥99.00

订阅专栏

本文介绍了如何使用open3d库在Python和C++中实现点云的直通滤波操作，包括对X、Y、Z三个坐标轴的滤波，并提供了根据偏航角范围进行滤波的方法。

摘要由CSDN通过智能技术生成

这个真的太简单了，我就直接上代码了，包括了X，Y，Z 三个方向的直通滤波，以及可以根据偏航角范围来滤波；

def filter(point_stack):
    y = point_stack[:, 1]
    x = point_stack[:, 0]
    # z = point_stack[:, 2]
    # yaw = np.arctan2(y, x)
    # print(yaw.max, yaw.min)
    # print(x.max(), x.min())
    # print(y.max(), y.min())

    # print(z.max(), z.min())

    # field1 = yaw < 0.8
    # field2 = yaw > 0.3
    # field = np.logical_and(field1, field2)
    field1 = x < 20
    field2 = x > 1.5   # 滤波的时候根据自己的需求改这里的数值即可
    field = np.logical_and(field1, field2)
    field3 = np.abs(y) > 5
    field = np.logical_and(field, field3)
    point_stack = point_stack[field, :]
    return point_stack



filename_pic = r"2.pcd"
pcd_source = o3d.io.read_point_cloud(filename_pic)

target_np = np.asarray(pcd_source.points)
source = filter(target_np)