一、算法原理
布料模拟滤波处理流程：
1）利用点云滤波算法或者点云处理软件滤除异常点；
2）将激光雷达点云倒置；
3）设置模拟布料，设置布料网格分辨率 g r gr gr，确定模拟粒子数。布料的位置设置在点云最高点以上；
4）将布料模拟点和雷达点投影到水平面，为每个布料模拟点找到最相邻的激光点的高度值，将高度值设置为 i h v ihv ihv；
5）布料例子设置为可移动，布料粒子首先受到重力作用，当粒子高度 c h v chv chv小于 i h v ihv ihv时，将粒子高度设置为 i h v ihv ihv；粒子设置为不可移动；
6）计算布料粒子之间的内力作用，根据设置的布料刚性参数，调整布料粒子之间的相对位置；
7）重复进行5）和6）计算，迭代次数达到设置的最大迭代次数；
8）计算激光雷达点与对应布料模拟点的距离，距离小于阈值标记为地面点，距离大于阈值标记为非地面点。
二、读取las点云
参考链接：http://www.zzvips.com/article/98406.html
1、GitHub: laspy
2、基础教程：Laspy: Documentation
3、安装：pip install laspy
4、使用example:
|
1
2
3
4
5
6
7
8
9
10
11
|
import laspy#============读取las格式的点云===========infile = laspy.file.file(r"40m1.las", mode='r') # 读取点云print('x,y,z',infile.x,infile.y,infile.z) # 输出点云坐标print('点云个数:',len(infile)) #读取点云个数#============保存点云为las文件===========h = infile.headeroutfile = laspy.file.file('666.las', mode = "w", header=h)points = infile #对点云进行的相关操作outfile.points = pointsoutfile.close() #关闭文件完成保存 |
三、算法源码
1、算法细节：csf
2、源码获取：https://github.com/jianboqi/csf
3、源码编译：下载源代码。在python文件夹下：
python setup.py build
python setup.py install
4、读取las并可视化算法结果
|
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
|
import laspyimport csfimport numpy as npimport open3d as o3d#============读取las文件=============infile = laspy.file.file(r"40m1.las", mode='r') # read a las filepoints = infile.pointsxyz = np.vstack((infile.x, infile.y, infile.z)).transpose() # extract x, y, z and put into a list#============布料模拟滤波============csf = csf.csf()# 参数设置csf.params.bsloopsmooth = false #粒子设置为不可移动csf.params.cloth_resolution = 0.1 #布料网格分辨率csf.params.rigidness = 3 #布料刚性参数csf.params.time_step = 0.65csf.params.class_threshold = 0.03 #点云与布料模拟点的距离阈值csf.params.interations = 500 #最大迭代次数# more details about parameter: http://ramm.bnu.edu.cn/projects/csf/download/csf.setpointcloud(xyz)ground = csf.vecint() # 地面点索引列表non_ground = csf.vecint() # 非地面点索引列表csf.do_filtering(ground, non_ground) # 执行滤波#============保存为las文件==========outfile = laspy.file.file(r"non_ground.las", mode='w', header=infile.header)outfile.points = points[non_ground] # 提取非地面点保存到lasoutfile.close() # 关闭文件夹a=xyz[ground]b=xyz[non_ground]#=============可视化===============def view_cloud(a, b): pcd = o3d.geometry.pointcloud() # =====numpy转point======= pcd.points = o3d.utility.vector3dvector(a) pcd1 = o3d.geometry.pointcloud() pcd1.points = o3d.utility.vector3dvector(b) #=======自定义颜色======== pcd.paint_uniform_color([0, 1, 0]) pcd1.paint_uniform_color([1, 0, 0]) o3d.visualization.draw_geometries([pcd, pcd1],window_name='提取结果') o3d.visualization.draw_geometries([pcd1],window_name='非地面点') o3d.visualization.draw_geometries([pcd],window_name='地面点')view_cloud(a,b) |
5、读取pcd文件并可视化结果
|
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
|
import open3d as o3dimport csfimport numpy as nppc = o3d.io.read_point_cloud("数据//100m1.pcd")xyz = np.asarray(pc.points)csf = csf.csf()# prameter settingscsf.params.bsloopsmooth = falsecsf.params.cloth_resolution = 0.1csf.params.rigidness = 3csf.params.time_step = 0.65csf.params.class_threshold = 0.03csf.params.interations = 500# more details about parameter: http://ramm.bnu.edu.cn/projects/csf/download/csf.setpointcloud(xyz)ground = csf.vecint() # a list to indicate the index of ground points after calculationnon_ground = csf.vecint() # a list to indicate the index of non-ground points after calculationcsf.do_filtering(ground, non_ground) # do actual filtering.# o3d.io.write_point_cloud("trans_of_source.pcd", non_ground)#保存点云a=xyz[ground]b=xyz[non_ground]def view_cloud(a, b): pcd = o3d.geometry.pointcloud() # from numpy to open3d pcd.points = o3d.utility.vector3dvector(a) pcd1 = o3d.geometry.pointcloud() # from numpy to open3d pcd1.points = o3d.utility.vector3dvector(b) pcd.paint_uniform_color([0, 1, 0]) pcd1.paint_uniform_color([1, 0, 0]) o3d.visualization.draw_geometries([pcd, pcd1],window_name='提取结果') o3d.visualization.draw_geometries([pcd1],window_name='非地面点') o3d.visualization.draw_geometries([pcd],window_name='地面点')view_cloud(a,b) |
四、结果展示
五、cloudcompare实现
1、加载点云数据，点击plugins中的csf filter功能
2、弹出如下窗口：
图中：cloth resolution：是指用于覆盖地形的布的网格大小(单位与点云的单位相同)。你设置的布分辨率越大，你得到的dtm就越粗糙；max iterations：是指地形仿真的最大迭代次数。500对大多数场景来说都足够了。classification threshold：是指根据点与模拟地形之间的距离，将点云划分为地面和非地面部分的阈值。0.5适用于大多数场景
这里的网格分辨率和距离阈值最小只能设置为10cm,地面10cm的范围默认是地面点，精确度不如自己代码实现中的高。
3、最后得到的结果：
可以看出，非地面点中不能提取到路缘石。
到此这篇关于python实现csf地面点滤波的文章就介绍到这了,更多相关python地面点滤波内容请搜索服务器之家以前的文章或继续浏览下面的相关文章希望大家以后多多支持服务器之家！
原文链接：https://blog.csdn.net/qq_36686437/article/details/108431894
