简介
前两篇对点云从算法层面上进行一定程度解析,通过使用pcl回归拟合地面算法:pcl学习系列之GroundSegmentation滤波(一)线段拟合分割算法:pcl学习系列之GroundSegmentation滤波(二)但是并不是一个算法能够解决所有的点云去除地面的场景。本篇博文将从工程层面来讲述一种点云去除地面的方式,能够应用于特定的场景进行解析达到比较好的效果。我们都知道自动驾驶泊车场景固定,泊车场地内比较平缓但是泊车进出口地面坡度较大,当下存在的地面分割算法还不能够适应进出车库大坡度场景。针对在泊车场地部署的激光雷达的地面点提取,我们能够获取该场景的先验信息进行辅助地面点的提取与分割。这里的先验信息就是我们能够获取该块场地的三维地面曲面拟合信息,通过每个点云与该三维曲面拟合的距离来判断是否为地面点。其实针对车端过滤后的点云量不大情况下,也可以使用三维曲面拟合的方式来进行地面点提取。三维曲面拟合会获取更为精确的地面空间曲面信息。
流程图
上图中红色框部分为先验信息,通过已知地面点来获取三维地面曲面信息,获得三维曲面系数。三维空间根据高程来求取的二次曲面方程为: z = f ( x , y ) = a 0 + a 1 ∗ x + a 2 ∗ x 2 + a 3 ∗ x y + a 4 ∗ y + a 5 ∗ y 2 z=f(x,y)=a_0+a_1*x+a_2*x^2+a_3*xy+a_4*y+a_5*y^2 z=f(x,y)=a0+a1∗x+a2∗x2+a3∗xy+a4∗y+a5