基于SLAM技术的煤矿综采面巡视无人车以及自主巡视的方法技术

本发明专利技术公开了一种基于SLAM技术的煤矿综采面巡视无人车以及自主巡视的方法，首先对综采面SLAM模块进行初始化，并且获得煤矿初始环境地图；将在当前位置采集到的煤矿环境图像信息与初始环境地图进行特征点匹配，如果匹配成功，无人车在巡视过程中不断添加新位置的环境地图点，构成当前煤矿环境地图，同时对当前煤矿环境地图不停地进行更新；当综采面巡视无人车对当前矿井位置对应的巡视任务完成后，综采面巡视无人车将以最优路径到达下一目标点进行巡视。本发明专利技术可以使工作人员很便捷的掌握综采工作面的实际变化情况以及整个矿井下面的地理位置与环境变化，又能对灾情做提前预警等工作，很大程度上节省了人力和财力。

Method of inspecting unmanned vehicle and self-inspection in fully mechanized coal mining face based on SLAM Technology

【技术实现步骤摘要】
基于SLAM技术的煤矿综采面巡视无人车以及自主巡视的方法
本专利技术涉无人车定位领域，具体涉及无人车在煤矿综采面的定位以及环境地图构建。
技术介绍
随着无人驾驶技术以及SLAM技术的进步，无人车的应用越来越广泛，但无人车在矿井中对煤矿综采面的实地状况检测以及对整个矿井环境构建的应用少之又少。矿用综采面巡视无人车在矿井下面工作时的实地定位以及对矿井下面特征位置的定位是非常重要的，然而传统的定位方法是GPS定位、AGPS定位、站定位和WIFI定位等定位方式，这些定位方法对信号要求较高，容易被干扰，并且定位精度较低误差大。
技术实现思路
本专利技术的目的是提出了一种基于SLAM技术的煤矿综采面巡视无人车以及自主巡视的方法，定位精度高误差小。本专利技术的技术方案是，一种基于SLAM技术的煤矿综采面巡视无人车，所述综采面巡视无人车包括双目摄像头、防护架、底盘、防爆箱，其特征在于：所述无人车上还搭载有智能模块和传感器模块；所述智能模块包括煤矿环境图像处理模块、双目摄像头标定模块、综采面SLAM模块、煤矿地图维护与无人车路径规划模块；所述防爆箱焊接在无人车底盘上，所述双目摄像头安装在车顶上，双目摄像头顶端安装防护架；所述传感器模块包括惯性传感器；所述惯性传感器采集无人车的运动信息；所述双目摄像头获取无人车的图像信息；所述煤矿环境图像处理模块将双目摄像头采集到的图像信息与矿井中的实际标定环境建立映射关系；所述综采面SLAM模块根据双目摄像头捕获的图像信息以及惯性传感器采集到的运动信息对无人车在矿井中的位置进行定位，创建初始煤矿环境地图；所述矿井地图维护与无人车路径规划模块对综采面SLAM模块获得的无人车在矿井中的位置定位信息以及初始煤矿环境地图信息不停地进行更新之后，通过无人车控制系统以及采用滚动窗口的路径规划算法确定无人车到达矿井中其它位置的最优路径。本专利技术基于SLAM技术的煤矿综采面巡视无人车实现自主巡视的方法包括以下步骤：第一步：标定双目摄像头的内参数，对综采面SLAM模块进行初始化，并且获得初始煤矿环境地图；第二步：无人车在矿井巡视时，双目摄像头将在当前位置采集到的图像信息与初始煤矿环境地图进行特征点匹配，如果匹配成功，则进行第三步；如果匹配不成功，无人车的控制系统就会认为当前综采面巡视无人车的位置定位质量差，则会触发综采面巡视无人车的局部重定位工作，即将双目摄像头获取的图像信息添加到第一步的初始煤矿环境地图中，再重新进行特征点匹配，直到匹配成功；第三步：若局部地图特征点匹配成功，无人车采用基于最小二乘法的ICP算法建立综采面巡视无人车运动模型，使用SVD分解法求解运动模型，结合非线性优化的方式求解综采面无人车的位姿；同时无人车在巡视过程中不断添加新位置的环境地图点，构成当前煤矿环境地图，同时对当前煤矿环境地图进不停地行更新；第四步：当无人车对当前矿井位置对应的巡视任务完成后，通过无人车控制系统以及采用滚动窗口的路径规划算法确定无人车到达矿井中下一目标位置的最优路径，无人车将以最优路径到达下一目标位置进行继续巡视工作。本专利技术基于视觉SLAM技术对无人车在煤矿综采面、煤矿液压支架、巷道等多个的位置进行自主定位和环境构建，同时无人车可以对整个矿井进行巡逻监控、灾情预警，可以使工作人员很便捷的掌握综采工作面的实际变化情况以及整个矿井下面的地理位置与环境变化，又能对灾情做提前预警等工作，很大程度上节省了人力和财力。附图说明通过结合附图对本申请进行更详细的描述，本申请的目的、特征和优势将变得更加明显。附图用来对本申请实施进一步理解。图1是综采面巡视的外形结构示意图。图2是综采面巡视无人车智能模块构成图。图3是综采面巡视无人车基于SLAM的定位方法的步骤流程示意图。具体实施方式下面，将参考附图对本申请综采面巡视无人车做具体说明，具体包括如下描述：综采面巡视无人车具体外形模型示意图如图1所示。包括双目摄像头2、防护架1、底盘4、防爆箱3，所述防爆箱3焊接在综采面巡视无人车底盘4上，所述双目摄像头2安装在车顶上，双目摄像头2顶端安装防护架1，防止煤块或其它物体滚落砸坏双目摄像头。所述无人车定制防爆箱3采用铝合金外壳压铸成型，表面高压静电喷塑。如图2所示，所述综采面巡视无人车上还搭载有智能模块和惯性传感器；所述智能模块包括煤矿环境图像处理模块、双目摄像头标定模块、综采面SLAM模块、矿井地图维护与无人车路径规划模块。所述无人车控制系统由英伟达TX2开发版以及ROS操作系统组成。小车采用ROS操作系统来实现不同硬件之间的通信。ROS系统使用官方提供的开发套件在英伟达TX2开发版上创建ROS话题，将综采面巡视无人车的控制算法、综采面SLAM算法、滚动窗口的路径规划算法等提前写入到开发板中。如图3所示，本专利技术基于SLAM技术的综采面巡视无人车实现自主定位、导航、矿井综采面巡视等技术问题是通过以下步骤完成。第一步、由于综采面巡视无人车工作环境的特殊性，要先对无人车搭载的双目摄像头做内参数标定，对综采面SLAM模块进行初始化，并且获得初始煤矿环境地图。内参数标定的具体步骤如下：步骤1)将双目摄像头对准所要标定的综采面环境模板；步骤2)启动双目摄像头标定模块，在保证无人车要标定的煤矿综采面环境模板全部位于无人车搭载的双目摄像头图像视野中的前提下，从至少两个方向对要标定的综采面环境模板进行拍照，采集标定模板图像；步骤3)将采集到的标定模块图像中的特征点与实际标定环境的特征点建立对应关系，采用张正友的平面标定算法自动计算出综采面巡视无人车的摄像头优化的内参数矩阵，并保存到双目摄像头标定模块。第二步、无人车在矿井巡视时，将在当前位置采集到的煤矿环境图像信息与初始煤矿环境地图进行特征点匹配，如果匹配成功，则进行第三步；如果匹配不成功，无人车的控制系统就会认为当前综采面巡视无人车的位置定位质量差，则会触发综采面巡视无人车的局部重定位工作。局部重定位工作具体包括以下步骤：步骤1)：将双目摄像头采集到的局部图像信息加入SLAM模块建立的初始煤矿环境地图中；步骤2)：利用双目摄像头将采集到的图像信息与无人车当前工作位置对应的新的环境地图进行特征点匹配。第三步：若特征点匹配成功，无人车采用基于最小二乘法的ICP算法建立综采面巡视无人车运动模型，使用SVD分解法求解运动模型，结合非线性优化的方式求解综采面无人车当前位姿；同时根据匹配结果自动更新综采面SLAM模块；更新综采面巡视无人车在当前工作位置的地图特征点，并把该更新后的地图特征点添加到初始煤矿环境地图中，更新当前无人车在煤矿所在位置对应的地图。本专利技术采用基于煤矿环境主方向的灰度直方图最小均方误差(MinimumMeanSquaredError，缩略词为MMSE)算法进行特征点匹配。第四步，当无人车对当前矿井位置对应的巡视任务完成后，通过无人车控制系统以及采用滚动窗口的路径规划算法确定无人车到达矿井中下一目标位置的最优路径，无人车将以最优路径到达下一目标位置进行继续巡视工作。滚动窗口的路径规划算法具体步骤如下：步骤1)初始化无人车所有参数，如起始点、目标点、工作环境，并设置滚动窗口的大小，综采面巡视无人车每次移动的步长；步骤2)对当前滚动窗口的环境信息不断地更新，若窗口内存在动态障碍物，则根据其线性预测模型本文档来自技高网...

【技术保护点】
1.一种基于SLAM技术的煤矿综采面巡视无人车，所述综采面巡视无人车包括双目摄像头(2)、防护架(1)、底盘(4)、防爆箱(3)，其特征在于：所述无人车上还搭载有智能模块和传感器模块；所述智能模块包括煤矿环境图像处理模块、双目摄像头标定模块、综采面SLAM模块、煤矿地图维护与无人车路径规划模块；所述防爆箱(3)焊接在无人车底盘(4)上，所述双目摄像头(2)安装在车顶上，双目摄像头(2)顶端安装防护架(1)；所述传感器模块包括惯性传感器；所述惯性传感器采集无人车在矿井中的运动信息；所述双目摄像头获取无人车在矿井中的图像信息；所述煤矿环境图像处理模块将双目摄像头采集到的图像信息与矿井中的实际标定环境建立映射关系；所述综采面SLAM模块根据双目摄像头捕获的图像信息以及惯性传感器采集到的运动信息对无人车在矿井中的位置进行定位，创建初始煤矿环境地图；所述矿井地图维护与无人车路径规划模块对综采面SLAM模块获得的无人车在矿井中的位置定位信息以及初始煤矿环境地图信息不停地进行更新之后，通过无人车控制系统以及采用滚动窗口的路径规划算法确定无人车到达矿井中其它位置的最优路径。

【技术特征摘要】
1.一种基于SLAM技术的煤矿综采面巡视无人车，所述综采面巡视无人车包括双目摄像头(2)、防护架(1)、底盘(4)、防爆箱(3)，其特征在于：所述无人车上还搭载有智能模块和传感器模块；所述智能模块包括煤矿环境图像处理模块、双目摄像头标定模块、综采面SLAM模块、煤矿地图维护与无人车路径规划模块；所述防爆箱(3)焊接在无人车底盘(4)上，所述双目摄像头(2)安装在车顶上，双目摄像头(2)顶端安装防护架(1)；所述传感器模块包括惯性传感器；所述惯性传感器采集无人车在矿井中的运动信息；所述双目摄像头获取无人车在矿井中的图像信息；所述煤矿环境图像处理模块将双目摄像头采集到的图像信息与矿井中的实际标定环境建立映射关系；所述综采面SLAM模块根据双目摄像头捕获的图像信息以及惯性传感器采集到的运动信息对无人车在矿井中的位置进行定位，创建初始煤矿环境地图；所述矿井地图维护与无人车路径规划模块对综采面SLAM模块获得的无人车在矿井中的位置定位信息以及初始煤矿环境地图信息不停地进行更新之后，通过无人车控制系统以及采用滚动窗口的路径规划算法确定无人车到达矿井中其它位置的最优路径。2.根据权利要求1所述的一种基于SLAM技术的煤矿综采面巡视无人车，其特征在于：所述煤矿环境图像处理模块、双目摄像头标定模块、综采面SLAM模块、矿井地图维护与无人车路径规划模块分别通过各自的应用程序编程接口进行通信。3.根据权利要求1所述的一种基于SLAM技术的煤矿综采面巡视无人车，其特征在于：所述综采面巡视无人车实现矿井自主巡视的方法包括以下步骤：第一步：标定双目摄像头的内参数，对综采面SLAM模块进行初始化，并且获得...

【专利技术属性】
技术研发人员：赵栓峰，王超，贺海涛，郭卫，王渊，
申请(专利权)人：西安科技大学，
类型：发明
国别省市：陕西,61