基于SLAM技术的煤矿综采面巡视无人车以及自主巡视的方法专利检索-位姿人工智能专利检索查询-专利查询网

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

阅读：491发布：2024-02-03

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

权利要求

1.一种基于SLAM技术的煤矿综采面巡视无人车，所述综采面巡视无人车包括双目摄像头(2)、防护架(1)、底盘(4)、防爆箱(3)，其特征在于：所述无人车上还搭载有智能模块和传感器模块；所述智能模块包括煤矿环境图像处理模块、双目摄像头标定模块、综采面SLAM模块、煤矿地图维护与无人车路径规划模块；所述防爆箱(3)焊接在无人车底盘(4)上，所述双目摄像头(2)安装在车顶上，双目摄像头(2)顶端安装防护架(1)；所述传感器模块包括惯性传感器；
所述惯性传感器采集无人车在矿井中的运动信息；
所述双目摄像头获取无人车在矿井中的图像信息；
所述煤矿环境图像处理模块将双目摄像头采集到的图像信息与矿井中的实际标定环境建立映射关系；
所述综采面SLAM模块根据双目摄像头捕获的图像信息以及惯性传感器采集到的运动信息对无人车在矿井中的位置进行定位，创建初始煤矿环境地图；
所述矿井地图维护与无人车路径规划模块对综采面SLAM模块获得的无人车在矿井中的位置定位信息以及初始煤矿环境地图信息不停地进行更新之后，通过无人车控制系统以及采用滚动窗口的路径规划算法确定无人车到达矿井中其它位置的最优路径。
2.根据权利要求1所述的一种基于SLAM技术的煤矿综采面巡视无人车，其特征在于：所述煤矿环境图像处理模块、双目摄像头标定模块、综采面SLAM模块、矿井地图维护与无人车路径规划模块分别通过各自的应用程序编程接口进行通信。
3.根据权利要求1所述的一种基于SLAM技术的煤矿综采面巡视无人车，其特征在于：所述综采面巡视无人车实现矿井自主巡视的方法包括以下步骤：
第一步：标定双目摄像头的内参数，对综采面SLAM模块进行初始化，并且获得初始煤矿环境地图；
第二步：无人车在矿井巡视时，双目摄像头将在当前位置采集到的图像信息与初始煤始环境地图进行特征点匹配，如果匹配成功，则进行
第三步；如果匹配不成功，则启动全局重定位算法重新进行匹配，直到匹配成功；
第三步：若特征点匹配成功，无人车采用基于最小二乘法的ICP算法建立综采面巡视无人车运动模型，使用SVD分解法求解运动模型，结合非线性优化的方式求解综采面无人车的位姿；同时无人车在巡视过程中不断添加新位置的环境地图点，构成当前煤矿环境地图，同时对当前煤矿环境地图不停地进行更新；
第四步：当无人车对当前矿井位置对应的巡视任务完成后，通过无人车控制系统以及采用滚动窗口的路径规划算法确定无人车到达矿井中下一目标位置的最优路径，无人车将以最优路径到达下一目标位置进行继续巡视工作。
4.根据权利要求3所述的一种基于SLAM技术的煤矿综采面巡视无人车，其特征在于：第一步标定双目摄像头的内参数，具体步骤如下：
步骤1)将双目摄像头对准所要标定的综采面环境模板；
步骤2)启动双目摄像头标定模块，在保证无人车要标定的煤矿综采面环境模板全部位于双目摄像头图像视野中的前提下，从至少两个方向对要标定的综采面环境模板进行拍照，采集标定模板图像；
步骤3)将采集到的标定模块图像中检测到的特征点与实际标定环境的特征点建立对应关系，采用张正友的平面标定算法自动计算出双目摄像头优化的内参数矩阵，并保存到双目摄像头标定模块中。
5.根据权利要求3所述的一种基于SLAM技术的煤矿综采面巡视无人车，其特征在于：全局重定位算法是将双目摄像头获取的图像信息添加到第一步的初始煤矿环境初始地图中，重新进行特征点匹配，直到匹配成功。

说明书全文

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

技术领域

[0001] 本发明涉无人车定位领域，具体涉及无人车在煤矿综采面的定位以及环境地图构建。

背景技术

[0002] 随着无人驾驶技术以及SLAM技术的进步，无人车的应用越来越广泛，但无人车在矿井中对煤矿综采面的实地状况检测以及对整个矿井环境构建的应用少之又少。

[0003] 矿用综采面巡视无人车在矿井下面工作时的实地定位以及对矿井下面特征位置的定位是非常重要的，然而传统的定位方法是GPS定位、AGPS定位、站定位和WIFI定位等定位方式，这些定位方法对信号要求较高，容易被干扰，并且定位精度较低误差大。

发明内容

[0004] 本发明的目的是提出了一种基于SLAM技术的煤矿综采面巡视无人车以及自主巡视的方法，定位精度高误差小。

[0005] 本发明的技术方案是，一种基于SLAM技术的煤矿综采面巡视无人车，所述综采面巡视无人车包括双目摄像头、防护架、底盘、防爆箱，其特征在于：所述无人车上还搭载有智能模块和传感器模块；所述智能模块包括煤矿环境图像处理模块、双目摄像头标定模块、综采面SLAM模块、煤矿地图维护与无人车路径规划模块；所述防爆箱焊接在无人车底盘上，所述双目摄像头安装在车顶上，双目摄像头顶端安装防护架；所述传感器模块包括惯性传感器；

[0006] 所述惯性传感器采集无人车的运动信息；

[0007] 所述双目摄像头获取无人车的图像信息；

[0008] 所述煤矿环境图像处理模块将双目摄像头采集到的图像信息与矿井中的实际标定环境建立映射关系；

[0009] 所述综采面SLAM模块根据双目摄像头捕获的图像信息以及惯性传感器采集到的运动信息对无人车在矿井中的位置进行定位，创建初始煤矿环境地图；

[0010] 所述矿井地图维护与无人车路径规划模块对综采面SLAM模块获得的无人车在矿井中的位置定位信息以及初始煤矿环境地图信息不停地进行更新之后，通过无人车控制系统以及采用滚动窗口的路径规划算法确定无人车到达矿井中其它位置的最优路径。

[0011] 本发明基于SLAM技术的煤矿综采面巡视无人车实现自主巡视的方法包括以下步骤：

[0012] 第一步：标定双目摄像头的内参数，对综采面SLAM模块进行初始化，并且获得初始煤矿环境地图；

[0013] 第二步：无人车在矿井巡视时，双目摄像头将在当前位置采集到的图像信息与初始煤矿环境地图进行特征点匹配，如果匹配成功，则进行第三步；如果匹配不成功，无人车的控制系统就会认为当前综采面巡视无人车的位置定位质量差，则会触发综采面巡视无人车的局部重定位工作，即将双目摄像头获取的图像信息添加到第一步的初始煤矿环境地图中，再重新进行特征点匹配，直到匹配成功；

[0014] 第三步：若局部地图特征点匹配成功，无人车采用基于最小二乘法的ICP算法建立综采面巡视无人车运动模型，使用SVD分解法求解运动模型，结合非线性优化的方式求解综采面无人车的位姿；同时无人车在巡视过程中不断添加新位置的环境地图点，构成当前煤矿环境地图，同时对当前煤矿环境地图进不停地行更新；

[0015] 第四步：当无人车对当前矿井位置对应的巡视任务完成后，通过无人车控制系统以及采用滚动窗口的路径规划算法确定无人车到达矿井中下一目标位置的最优路径，无人车将以最优路径到达下一目标位置进行继续巡视工作。

[0016] 本发明基于视觉SLAM技术对无人车在煤矿综采面、煤矿液压支架、巷道等多个的位置进行自主定位和环境构建，同时无人车可以对整个矿井进行巡逻监控、灾情预警，可以使工作人员很便捷的掌握综采工作面的实际变化情况以及整个矿井下面的地理位置与环境变化，又能对灾情做提前预警等工作，很大程度上节省了人力和财力。附图说明

[0017] 通过结合附图对本申请进行更详细的描述，本申请的目的、特征和优势将变得更加明显。附图用来对本申请实施进一步理解。

[0018] 图1是综采面巡视的外形结构示意图。

[0019] 图2是综采面巡视无人车智能模块构成图。

[0020] 图3是综采面巡视无人车基于SLAM的定位方法的步骤流程示意图。

具体实施方式

[0021] 下面，将参考附图对本申请综采面巡视无人车做具体说明，具体包括如下描述：

[0022] 综采面巡视无人车具体外形模型示意图如图1所示。包括双目摄像头2、防护架1、底盘4、防爆箱3，所述防爆箱3焊接在综采面巡视无人车底盘4上，所述双目摄像头2安装在车顶上，双目摄像头2顶端安装防护架1，防止煤块或其它物体滚落砸坏双目摄像头。

[0023] 所述无人车定制防爆箱3采用铝合金外壳压铸成型，表面高压静电喷塑。

[0024] 如图2所示，所述综采面巡视无人车上还搭载有智能模块和惯性传感器；所述智能模块包括煤矿环境图像处理模块、双目摄像头标定模块、综采面SLAM模块、矿井地图维护与无人车路径规划模块。

[0025] 所述无人车控制系统由英伟达TX2开发版以及ROS 操作系统组成。小车采用ROS操作系统来实现不同硬件之间的通信。ROS系统使用官方提供的开发套件在英伟达TX2开发版上创建ROS话题，将综采面巡视无人车的控制算法、综采面SLAM算法、滚动窗口的路径规划算法等提前写入到开发板中。

[0026] 如图3所示，本发明基于SLAM技术的综采面巡视无人车实现自主定位、导航、矿井综采面巡视等技术问题是通过以下步骤完成。

[0027] 第一步、由于综采面巡视无人车工作环境的特殊性，要先对无人车搭载的双目摄像头做内参数标定，对综采面SLAM模块进行初始化，并且获得初始煤矿环境地图。

[0028] 内参数标定的具体步骤如下：

[0029] 步骤1)将双目摄像头对准所要标定的综采面环境模板；

[0030] 步骤2)启动双目摄像头标定模块，在保证无人车要标定的煤矿综采面环境模板全部位于无人车搭载的双目摄像头图像视野中的前提下，从至少两个方向对要标定的综采面环境模板进行拍照，采集标定模板图像；

[0031] 步骤3)将采集到的标定模块图像中的特征点与实际标定环境的特征点建立对应关系，采用张正友的平面标定算法自动计算出综采面巡视无人车的摄像头优化的内参数矩阵，并保存到双目摄像头标定模块。

[0032] 第二步、无人车在矿井巡视时，将在当前位置采集到的煤矿环境图像信息与初始煤矿环境地图进行特征点匹配，如果匹配成功，则进行第三步；如果匹配不成功，无人车的控制系统就会认为当前综采面巡视无人车的位置定位质量差，则会触发综采面巡视无人车的局部重定位工作。

[0033] 局部重定位工作具体包括以下步骤：

[0034] 步骤1)：将双目摄像头采集到的局部图像信息加入SLAM模块建立的初始煤矿环境地图中；

[0035] 步骤2)：利用双目摄像头将采集到的图像信息与无人车当前工作位置对应的新的环境地图进行特征点匹配。

[0036] 第三步：若特征点匹配成功，无人车采用基于最小二乘法的ICP算法建立综采面巡视无人车运动模型，使用SVD分解法求解运动模型，结合非线性优化的方式求解综采面无人车当前位姿；同时根据匹配结果自动更新综采面SLAM模块；更新综采面巡视无人车在当前工作位置的地图特征点，并把该更新后的地图特征点添加到初始煤矿环境地图中，更新当前无人车在煤矿所在位置对应的地图。

[0037] 本发明采用基于煤矿环境主方向的灰度直方图最小均方误差(Minimum Mean Squared Error，缩略词为MMSE)算法进行特征点匹配。

[0038] 第四步，当无人车对当前矿井位置对应的巡视任务完成后，通过无人车控制系统以及采用滚动窗口的路径规划算法确定无人车到达矿井中下一目标位置的最优路径，无人车将以最优路径到达下一目标位置进行继续巡视工作。

[0039] 滚动窗口的路径规划算法具体步骤如下：

[0040] 步骤1)初始化无人车所有参数，如起始点、目标点、工作环境，并设置滚动窗口的大小，综采面巡视无人车每次移动的步长；

[0041] 步骤2)对当前滚动窗口的环境信息不断地更新，若窗口内存在动态障碍物，则根据其线性预测模型预测障碍物的下一时刻的运动状态；若没有动态障碍物，则矿井无人车根据窗口内生成的局部最优子目标点，规划一条朝其方向移动的局部最优路径；

[0042] 步骤3)根据碰撞预测，对综采面巡视无人车做出相应的避障策略；

[0043] 步骤4)综采面巡视无人车根据相应的避障策略，停止一段时间或改变速度找出一条与障碍物无碰撞的路径；

[0044] 步骤5)按照设定的步数，向规划好的路径移动，且步长不能大于窗口半径；

[0045] 步骤6)若综采面巡视无人车到达目标位置，则算法结束，以上内容是结合具体方式对本发明做详细介绍。

[0046] 尽管已描述了本发明的优选实施例，但本领域内的技术人员一旦得知了基本创造性概念，则可对这些实施例作出另外的变更和修改。所以，所附权利要求意欲解释为包括优选实施例以及落入本发明范围的所有变更和修改。

[0047] 显然，本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样，倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内，则本发明也意图包含这些改动和变型在内。

标题	发布/更新时间	阅读量
基于分数阶幂次趋近律的终端滑模机械臂轨迹跟踪方法	2020-07-31	0
一种基于近似度加权平均插值法的机器人精度补偿方法	2021-10-04	0
激光测风雷达指向自稳定双转镜扫描系统	2021-09-16	2
穿梭车式仓储系统	2023-06-12	0
プログラム、施工ロボット、及び施工システム	2021-05-12	1
空気調和機	2022-11-11	2
耐火被覆下地、および、耐火被覆下地施工方法、並びに、耐火被覆施工方法	2020-08-06	2
車両の動力伝達装置	2020-10-15	1
均し装置及びそれを備えた計量装置	2021-06-08	1
対象者誘導装置、対象者誘導システム、対象者誘導方法及びプログラム	2021-11-26	2

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

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

技术领域

背景技术

发明内容

具体实施方式

该功能需要专业版企业版VIP权限，您可以：