欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2019105243924
申请人: 中国矿业大学
专利类型:发明专利
专利状态:已下证
专利领域: 计算;推算;计数
更新日期:2024-01-05
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种井下综采工作面三维场景快速构建方法,其特征在于:利用激光扫描数据、惯性测量数据、里程计数据,快速构建综采工作面三维场景,具体步骤如下:a.在刮板输送机(2)槽帮外侧的轨道支撑架上安装柔性轨道(4),然后在柔性轨道(4)顶部安装移动云台(5),并在移动云台(5)上设置激光雷达成像系(6),所述的激光雷达成像系统(6)包括激光雷达、惯性测量单元(IMU)、里程计和控制模块;

b.通过控制模块向移动云台(5)发出行走指令后,激光雷达开始快速扫描综采工作面三维场景信息,IMU实时获取移动云台(5)的三维姿态,里程计测量移动云台(5)行走距离;

c.将IMU测量数据、里程计测量数据与激光雷达实时获取的综采工作面三维场景信息进行融合,获得综采工作面激光扫描三维点云矢量数据;

d.对三维点云矢量数据进行点云去噪、点云纠正和点云分割处理;

e.分析处理综采工作面激光扫描三维点云矢量数据,并生成综采工作面三维点云矢量数据的不规则三角网,并对综采工作面不规则三角网进行样条曲线插值处理;

f.在生成的综采工作面不规则三角网中分别提取采煤机(1)、刮板输送机(2)和液压支架(3)的轮廓特征,对提取的轮廓特征进行分离,从而快速构建出综采工作面三维场景模型。

2.根据权利要求1中所述的井下综采工作面三维场景快速构建方法,其特征在于:所述步骤c中,将惯性测量单元、里程计与激光雷达实时获取的数据进行融合的方法为:首先把激光雷达、IMU和里程计获取的数据融合到移动云台(5)W坐标系下,其中激光雷达获取的数据融合到坐标系的形式如下:式中, 和 是激光雷达坐标系L的原点轴到W坐标系下的原点平移参数,是L坐标系与W坐标系之间的旋转矩阵,其中:

式中:α,β,γ是L坐标系与W坐标系三个坐标轴X,Y,Z之间的旋转角;

IMU和里程计获取的数据均采用经典的七参数布尔莎模型融合到移动云台(5)W坐标系下;

融合后的误差方程可表示为:

式中:XΩ,YΩ,ZΩ是激光雷达、IMU和里程计获取数据融合后的坐标, 是融合后的坐标平均值,δ是融合后的误差向量;

T

最后根据最小二乘原理:δ×δ=min,解算出坐标和姿态的六个误差参数Δα,Δβ,Δγ,从而获得具有准确坐标和姿态信息的综采工作面激光扫描三维点云矢量数据。

3.根据权利要求1中所述的一种井下综采工作面三维场景快速构建方法,其特征在于:所述步骤d中的点云纠正采用基于迭代最近点算法,包括如下步骤:

1)选取第一次激光雷达扫描获得的三维点云矢量数据作为参考点集中的控制点集P={p1,p2,p3,…,pn},与其对应的待纠正点集为采集点Q={q1,q2,q3,…,qn};

2)计算点集P和Q对应空间点的距离: i=1,

2,3,…,n;

3)判断是否满足 其中||pi·qi||表示两个点集中点对的欧氏距离,并剔除不满足条件的点对。

4.根据权利要求1中所述的一种井下综采工作面三维场景快速构建方法,其特征在于:所述步骤d中,点云分割处理采用表面生长分割方法,具体步骤包括:

1)求取每一个激光雷达扫描点P的法向量和残差,并把第一次激光雷达扫描获得的三维点云矢量数据确定种子点,对应的平面确定为种子平面;

2)在最新扫描激光雷达扫描的三维点云矢量数据中设置邻近点与种子点法线向量之间的角度差异阈值为θ:对于当前生长的种子点,利用向量逻辑函数树KD(K-Dimensional)求取三维点云矢量数据中的某一个邻近点作为待处理的点,分别计算种子点与待处理点的切平面法向量,通过两点法向量计算出两条法向量的角度差;如果该角度差小于阈值θ,则将此点加入到种子点队列中,并将该点作为新的种子点,继续判别其他的未处理的点,否则,跳过该点,处理其他的未处理点;

3)设置距离阈值Δd:对于待处理的种子点,通过邻近点拟合出切平面;如果待处理点到切平面的距离小于阈值Δd则将此点加入到种子队列中,并作为新的种子点,继续判别其他的未处理点,否则,跳过该点,处理其他的未处理点;

4)检查未被标号的数据点的数量:如果没有未被标号的点,结束分割;否则,对未被标号的点求拟合平面残差,将残差最小的点作为新的种子点,并将其加入到步骤3)的种子点队列中;

5)取步骤3)中种子点队列中尚未被处理过的种子点,利用向量逻辑函数树KD检索到该种子点的k个邻近点,对该种子点的每一个邻近点逐一判断;如果该点己经在步骤4)种子点的队列中,则不处理;否则按照步骤2)和步骤3)中的相似性测度进行判别;

6)检查种子点队列中是否仍然存在未处理的点;如果有,则返回到步骤4),顺序向下执行;如果没有,则分别对步骤4)中种子点队列中的点进行标号,并结束点云分割。

5.根据权利要求1中所述的一种井下综采工作面三维场景快速构建方法,其特征在于,所述步骤f中,对提取的轮廓特征进行分离的方法包括如下步骤:

1)对激光雷达扫描的综采装备垂直面数据(垂直于水平面法线向量)进行分割,将不同的综采装备立面上的点分割到相应的分割面片上;

2)对不同的分割面片点,利用特征值法拟合出该分割面片所在的平面;

3)将该分割面片上的所有点投影到拟合出的平面上;

4)根据该分割面片所在的平面法向量,计算其与水平面法线向量之间的夹角;并通过该夹角计算出旋转矩阵,将该平面上的点旋转到水平面;

5)提取综采装备点云数据的边界点;

6)将这些边界点进行连接边界点依次连接,从而得到最终综采装备的三维轮廓。