论文部分内容阅读
煤炭作为我国重要传统能源行业,智能化发展是煤炭行业转型高质量发展的必由之路。为解决采掘失衡难题,掘进装备智能化水平亟待提升。虽然煤矿装备自动化、信息化取得很大进展,但传统井下设备位姿及巷道测量方法存在稳定性不足、全局定位困难等问题。论文提出一种单目视觉与激光雷达融合的巷道三维重建与装备定位总体方案,结合多传感器融合方法实现掘进装备位姿测量,构建二维栅格与三维点云一致的巷道地图,为掘进装备在煤矿复杂环境下的定位、定向提供丰富地图信息,完成巷道环境及装备位姿的可视化呈现,对实现井下少人甚至无人化智能高效生产具有重要意义和应用价值。针对煤矿井下地图构建过程可能出现的点云运动畸变、计算实时性问题,建立基于激光雷达的巷道地图观测模型。采集激光雷达扫描数据并进行点云数据预处理,研究点云双边滤波算法和特征提取算法;通过PLICP点云匹配算法,建立最小化误差函数完成帧间位姿估计,获得机器人运动过程中不同视角下的多组统一点云,构建出坐标系一致的巷道二维栅格地图,保证激光雷达建图精度及效率,为联合地图构建奠定基础。针对单目视觉测量过程遇到的特征不足、深度获取困难问题,提出基于单目视觉的掘进装备位姿测量方案。建立相机内参标定模型,求解相机内参数;借助ORB特征检测方法提取环境特征并进行特征点匹配,采用RANSAC算法完成误匹配点对的剔除。建立对极几何算法模型,求解优化之后的匹配点对,实现对相机帧间位姿估计。提出基于三角化深度计算方法的位姿解算模型,基于三维空间点坐标采用PNP解算方法实现对掘进装备位姿求解,以此提高视觉测量精度及稳定性,并为巷道三维重建奠定基础。针对煤矿复杂环境下存在的视觉特征丢失、全局定位困难问题,提出基于单目视觉与激光雷达的松耦合SLAM算法框架,融合实现掘进装备同步定位与建图。建立单目视觉与激光雷达联合标定模型,求解其位姿转换矩阵;通过传感器时间软同步方法,借助线性插值法求解视觉对应时刻位姿,完成关键帧位姿匹配,实现传感器数据层融合;构建三维点云地图离线优化模型,通过最小化重投影误差优化三维点云地图。最后根据关键帧位姿匹配三维点云与二维栅格地图,完成巷道三维重建与掘进装备位姿解算。最后,搭建实验平台,验证上述理论方法,对系统测量性能进行评价。论文分别对单目视觉和激光雷达SLAM方法的性能和组合SLAM方法的定位性能进行实验,结果显示组合的位姿解算方法可实现更好的定位精度。在楼道对整体巷道地图构建与装备定位技术进行实验,得到匹配的二维栅格地图、三维点云地图及掘进装备运动轨迹,验证巷道三维重建方法和装备定位技术的有效性。