技术特征：
1.一种应用于矿山非结构化道路场景下的边界线滤波方法，其特征在于，在矿用卡车上装配感知系统，所述感知硬件系统包括固态激光雷达和计算机，所述计算机包括pcl点云库屏幕选点工具、时间戳同步模块、边界线点云预处理模块、滤波处理模块和显示器，固态激光雷达用于将感知到的三维点云数据传递给计算机；pcl点云库屏幕选点工具用于从三维点云数据中选取道路边界点云获得边界线数据；之后计算机将获取到的边界线数据通过边界线点云预处理模块进行三次样条插值预处理，使得预处理后两条边界线点云密度大致相同；所述时间戳同步模块用于将固态激光雷达的点云与预处理后的边界线进行时间戳同步接收；所述滤波处理模块用于利用边界线信息对当前帧的激光雷达点云进行滤波，得到两条边界线之间的道路点云信息；最后将获取到的两条边界线之间的道路点云信息传递给显示器进行显示，具体滤波步骤为：a、对固态激光雷达传输数据与pcl点云库屏幕选点工具选取道路边界点云进行软同步，确保两者是同一个时间分别发布的激光雷达点云数据信息和边界线数据信息；b、对步骤a获得的边界线数据信息进行三次样条插值预处理，使得道路两条边界线的点云密度大致相同；c、计算机对步骤a获取的激光雷达点云数据信息与步骤b预处理之后的边界线数据信息进行时间戳同步接收；d、将接收到的边界线数据信息与当前帧的激光雷达点云信息进行滤波处理，滤波处理过程依次为：求取包围盒、点云平移、栅格投影、光线投射、栅格内点云信息叠加，完成滤波处理后从而获得两条边界线之间的道路点云信息。2.根据权利要求1所述应用于矿山非结构化道路场景下的边界线滤波方法，其特征在于，所述步骤a中软同步方式为：在ros系统中，固态激光雷达和pcl点云库屏幕选点工具分别进行数据发布之前先在时间戳上打上统一的格林尼治时间。3.根据权利要求1所述应用于矿山非结构化道路场景下的边界线滤波方法，其特征在于，所述步骤b中对边界线数据信息进行三次样条插值预处理的具体过程为：首先将边界线数据信息[a,b]分成n个区间，分别为[(x
0,
x1),(x
1,
x2),(x
2,
x3),
…
,(x
n-1
,x
n
)]，共有n+1个点，其中两个端点分别为x0＝a,x
n
＝b；三次样条即每个区间的曲线是一个三次方程，三次样条方程满足以下条件：(1)在每一个区间(x
i,
x
i+1
)上s(x)＝s
i
(x)都是一个三次方程；(2)满足插值条件，即s(x
i
)＝y
i
，i＝0,1,2,3,
…
,n；(3)曲线光滑，即s(x),s
′
(x),s
″
(x)是连续的；通过上述条件，各个区间的三次方程能构造成如下形式y＝a
i
+b
i
x+c
i
x2+d
i
x3，这种形式即为三次样条函数s
i
(x)；对每个区间的未知系数(a
i
,b
i
,c
i
,d
i
)进行求解，则n个区间共有4n个未知数，则需要4n个方程来进行求解，通过获取4n个方程，从而求得每一区间的四个未知系数，进而得出每个区间的三次样条函数s
i
(x)，最后每个区间的三次样条函数s
i
(x)按照设定的步长，对每一区间进行插值。4.根据权利要求3所述应用于矿山非结构化道路场景下的边界线滤波方法，其特征在于，所述4n个方程的具体获取过程为：通过上述(2)中的插值条件得出，除了两个端点，所有内部的n-1个内部点均满足s
i
(x
i+1
)＝y
i+1
,s
i+1
(x
i+1
)＝y
i+1
，即每个内部点相邻两个区间内的三次方程，则有2(n-1)个方
程，再加上两个端点分别满足第一个区间和最后一个区间的三次方程，则总共有2n个方程；其次，根据(3)中曲线光滑的条件，则n-1个内部点的一阶导数是连续的，即在第i区间的末点和第i+1区间的起点是同一个点，因此同一点的一阶导数相等，即s
i
′
(x
i+1
)＝s
i+1
′
(x
i+1
)，则有n-1个方程；另外，内部点的二阶导数也是连续的，即s
i
″
(x
i+1
)＝s
i+1
″
(x
i+1
)，也有n-1个方程，此时总共有4n-2个方程，剩余两个方程通过边界条件得到：自然边界：指定端点二阶导数为0，即s
″
(x0)＝0＝s
″
(x
n
)；固定边界：指定端点一阶导数，这里分别定为a和b，即s0′
(x0)＝a,s
n-1
′
(x
n
)＝b；非扭结边界(not-a-knot spline):强制第一个插值点的三阶导数值等于第二个点的三阶导数值，最后一个点的三阶导数值等于倒数第二个点的三阶导数值，即s0″′
(x0)＝s1″′
(x1)，s
n-2
″′
(x
n-1
)＝s
n-1
″′
(x
n
)；从而获得4n个方程。5.根据权利要求1所述应用于矿山非结构化道路场景下的边界线滤波方法，其特征在于，所述步骤d中滤波处理的具体过程为：
①
求包围盒：将当前帧激光雷达点云中的点按照x,y,z的顺序进行排序，求出x方向上的最大值与最小值；y方向的最大值与最小值；z方向上的最大值与最小值，求出包围盒的尺寸如下：上式中max
x
表示的是x方向的最大值，min
x
表示的是x方向的最小值；；max
y
表示的是y方向的最大值，min
y
表示的是y方向的最小值；max
z
表示的是z方向的最大值，min
z
表示的是z方向的最小值；abs表示取绝对值；
②
点云平移：为了确保点云投射到栅格上后，点云索引为正，需要根据x，y的最小值，对点云进行平移，使得点云中点的坐标不存在负值，具体公式如下：
③
栅格投影：利用步骤
①
求出来包围盒尺寸以及设置的分辨率参数resolution，求点云中每个点对应的栅格索引以及序号，求栅格索引的公式如下：其中的cell
x
与cell
y
表示的x，y对应的栅格索引，ceil表示的是向上取整函数；利用如上函数求得每个三维点对应的栅格索引；计算出栅格索引之后，为了确保栅格索引在投射的范围之内，对超出范围的栅格进行删除，首先依据计算出的size
x
，size
y
结合分辨率计算出栅格的地图大小：筛选的准则如下：
按照以上的方式对栅格进行筛选，将符合条件的栅格保留，之后依据计算出来的栅格索引计算栅格序号：cell
num
＝cell
x
*len
y
+cell
y
按照以上进行栅格投影，即将三维点云投射到二维栅格上，并获得每个三维点对应的栅格索引以及栅格序号；
④
光线投射：将两条边界线投影到二维栅格地图上之后，获取左右边界线之间的栅格，此时对左右边界线投射上去的栅格一一进行光线投射，完成后获得左右边界线之间的栅格索引；
⑤
栅格内点云信息叠加：利用步骤
④
获取的两条边界线之间的栅格索引，将对应栅格内在步骤
③
获得的投影点进行叠加，从而获取叠加点云，由于在步骤
②
进行了坐标平移，为了维持原始的坐标不变，将坐标通过如下公式变换回去：坐标变换之后，保存点云结果，即得到滤波之后的道路点云数据。6.根据权利要求5所述的用于突出煤层瓦斯抽采钻孔的防喷孔装置，其特征在于，所述步骤
④
中光线投射具体步骤为：(1)给出左右边界线的两个栅格索引(left
x
,left
y
),(right
x
,right
y
)，将左边的点放入点(x0，y0)中；(2)将(x0，y0)装入缓存容器中，得到第一个点；(3)计算常量δx，δy，2δy，2δy-2δx，其中δx，δy分别为首尾两个点的横纵坐标差的绝对值，并计算决策参数的第一个值，决策参数的公式如下：p0＝2δy-δx(4)从k＝0开始，在沿着路径的每个x
k
处进行如下的检测：如果p
k
<0，则下一个需要绘制的点是(x
k
+1,y
k
),并且p
k+1
＝p
k
+2δy否则，下一个需要绘制的点是(x
k
+1,y
k
+1)，并且p
k+1
＝p
k
+2δy-2δx(5)重复步骤(4)共δx-1次，从而获得左右边界线之间的栅格索引。
技术总结
本发明公开了一种应用于矿山非结构化道路场景下的边界线滤波方法，先对固态激光雷达传输数据与PCL点云库屏幕选点工具选取道路边界点云进行软同步；然后对获取的边界线数据信息进行三次样条插值预处理，使得道路两条边界线的点云密度大致相同；获取的激光雷达点云数据信息与上述预处理之后的边界线数据信息进行时间戳同步接收；最后将接收到的边界线数据信息与当前帧的激光雷达点云信息进行滤波处理，完成滤波处理后从而获得两条边界线之间的道路点云信息；在非结构化道路场景下，能有效对弯道路面所需的三维点云进行提取，且具有较高的提取效率，并且能将无用的点云数据及冗余数据剔除，从而有效的减轻后续对点云数据进行传输时的带宽压力。传输时的带宽压力。传输时的带宽压力。
技术研发人员：李会军 周士伟 叶宾
受保护的技术使用者：中国矿业大学
技术研发日：2022.11.24
技术公布日：2023/3/14