煤矿四旋翼巡检机器人系统设计.pdf

doi 10. 11799/ ce202102035 收稿日期 2020-03-09 基金项目 国家自然基金项目” 煤矿井下多机械臂智能协同分拣煤矸石基础研究” E050103; 陕西省重点研发计划重点 产业创新链项目” 煤矿综采工作面智能巡检机器人研发” S2018-YF-ZDLGY-0011; 国家自然科学基金重点 项目” 数字煤矿及智能化开采基础理论研究” 51834006 作者简介 张 力1994, 男, 山东郓城人, 硕士, 研究方向 机电一体化及煤矿机器人技术, E-mail 277696059 qq. com。 引用格式 张 力, 马宏伟, 梁 艳, 等. 煤矿四旋翼巡检机器人系统设计 [J]. 煤炭工程, 2021, 532 180-185. 煤矿四旋翼巡检机器人系统设计 张 力1,2, 马宏伟1,2, 梁 艳1,2, 薛旭升1,2 1. 西安科技大学, 机械工程学院, 陕西 西安 710054; 2. 陕西省矿山机电装备智能监测重点实验室, 陕西 西安 710054 摘 要 基于煤矿环境参数、 设备状态及人员情况的巡检需求, 针对井下低照度、 巷道结构复 杂且尚无精确的四旋翼导航定位系统如北斗、 GPS 等等特点, 设计了一种煤矿四旋翼巡检机器 人。 该机器人以机载计算机为控制核心, 结合光流、 超声波等传感器构建自主飞行控制系统; 通过 MAVROS 向飞控发送控制指令及获取飞行数据; 依靠携带的温湿度传感器、 气体传感器和摄像头实 时获取井下环境信息并通过无线网络将采集到的数据和视频信息实时回传云平台。 实验结果表明, 该机器人运行稳定, 自主性能良好, 数据传输可靠。 关键词 煤矿四旋翼飞行机器人; 巷道环境检测; 信息回传; 控制系统 中图分类号 TD76 文献标识码 A 文章编号 1671-0959202102-0180-06 Design of quadrotor inspection robot system in coal mine ZHANG Li1,2, MA Hong-wei1,2, LIANG Yan1,2, XUE xu-sheng1,2 1. College of Mechanical Engineering, Xi’an University of Science and Technology, Xi’an 710054, China; 2. Shaanxi Key Laboratory of Mine Electromechanical Equipment Intelligent Monitoring, Xi’an 710054, China Abstract Based on the inspection requirements of coal mine environmental parameters, equipment status and personnel conditions, a coal mine quadrotor inspection robot was designed for the characteristics of underground operation, such as low- illuminance, complicated roadway structure and no accurate quadrotor navigation and positioning system such as Beidou, GPS, etc. . The robot uses an on-board computer as the control core and combines optical flow, ultrasonic and other sensors to build an autonomous flight control system; sends instructions to flight controllers and acquires flight data through MAVROS; and uses the temperature and humidity sensors, gas sensors, and cameras to carry the real-time environment ination. And the collected data and video ination are transmitted back to the cloud plat in real time through the wireless network. Experimental results show that the robot runs stably, has good autonomy and reliable data transmission. Keywords coal mine quadrotor flying robot; roadway environment detection; ination return; control system 我国煤炭工业长期以来都属于高危行业[1]。 煤 矿环境结构复杂, 开采条件恶劣, 日常对煤矿设备 运行状况、 环境安全参数等重要指标的巡检是不可 或缺的[2]。 传统的地面移动式或轨道式煤矿巡检机 器人主要存在以下不足 一是易受复杂地形影响, 空间运动能力受限[3]; 二是占用通道资源且成本较 高[4]。 四旋翼无人机具有结构简单、 成本低、 反应 灵活、 易控制等特点, 且能够垂直起降与定点悬 停[5-7], 借助其优势, 能够有效降低巡检成本, 提 高巡检效率, 扩大巡检范围。 地面上空作业的四旋翼机器人通常依靠精确的 导航定位系统, 如北斗或 GPS Global Positioning 081 第53卷第2期 煤 炭 工 程 COAL ENGINEERING Vol. 53, No. 2 System, 全球定位系统提供的经纬度信息以及气压 计提供的高度信息来获取地理位置[8]; 在视距开阔、 通信无阻挡的条件下, 由飞手远程操控作业; 并通 过天空端与地面端的无线收发设备进行信息回传[9]。 然而, 煤矿井下由于低照度、 空间狭窄、 视距受限、 无北斗或 GPS 信号等特点[10-12], 严重限制了四旋翼 机器人自主飞行和巡检作业能力的发挥。 同时, 井 下巷道结构复杂、 距离长、 巷道之间纵横交错[13], 无线收发设备之间的信号传输近似直线传播, 在井 下的穿透能力和绕射能力十分差; 虽然可通过增加 回传接入点的方式延长传输距离, 但需专门在井下 增设中继器[14,15], 安装成本和维护费用比较高。 因 此, 地面上空常用的四旋翼巡检机器人不适合于煤 矿井下作业。 针对以上问题, 本文设计了一种煤矿四旋翼巡 检机器人, 该机器人能够适应于煤矿井下环境飞行, 实时探测巷道中的环境参数、 设备状况和人员信息, 并通过井下无线网络将巡检信息回传至云平台, 为 地面监控中心进行预测分析、 预防预警等应用提供 了前兆信息采集的基础。 1 设计方案 图 1 井下巡检系统总体示意图 1. 1 井下巡检系统介绍 井下巡检系统总体示意如图 1 所示, 为基于煤 矿四旋翼巡检机器人的煤矿井下巡检系统总体示意 图, 由信息采集层、 信息交互层和应用管理层组成。 系统利用机器人在井下巡检作业, 实时检测巷道内 信息, 并通过井下无线网络将数据信息和视频信息 回传至云平台数据库服务器和流媒体服务器, 地面 监控中心通过访问云平台, 实现预测分析、 预防预 警等应用。 本文主要针对信息采集层, 即煤矿四旋 翼巡检机器人系统进行设计。 1. 2 机器人设计要求 针对煤矿井下环境特点和巡检需求等, 对机器 人做出以下设计要求 机身结构应尽可能紧凑, 适 宜在巷道内灵活飞行; 测控系统各仪表及电气设备 应采取适当防爆措施; 扩展硬件需体积小, 质量轻, 便于装卸; 具有飞行调控的能力, 能够在井下自主 平稳飞行; 具有运算和规划能力, 能够协调各模块 稳定运行; 能够依靠测控系统进行井下定位和障碍 物规避; 能够为系统各模块提供充足的动力和所需 的不同电压; 能够实时获取井下环境信息, 并对数 据和视频进行处理和回传, 且在低照度时也能满足 作业需求。 1. 3 机器人总体设计 综合上述设计要求, 在地面上空作业的四旋翼 机器人基础上, 扩展了相关硬件装置并对测控系统 进行了设计, 使其能够适应井下环境自主飞行, 并 具有一定避障能力。 同时, 能通过搭载的传感器和 摄像头实时检测井下巷道内信息并通过无线网络实 现信息回传, 机器人总体架构如图 2 所示。 图 2 机器人总体架构 2 机器人测控系统 2. 1 测控系统基本组成 测控系统是巡检机器人的核心, 主要由机载计 算机、 飞行控制系统、 超声传感器、 温湿度传感器 和摄像头等部件组成, 如图 3 所示。 机载计算机采 181 2021 年第 2 期 煤 炭 工 程 装备技术 用博通四核 A-72 架构 CPU, 配置双频无线模块及 视频编解码等功能, 能够自主进行航点规划和各种 处理运算, 也可通过 SSH 命令进行人工远程控制。 选取 pixhawk 开源飞控作为机器人的飞行控制系统, 内置多种位姿传感器, 可以实时调整机器人位姿; 拥有独立的故障处理器, 能够做出相应的控制保护。 此外, 光流传感器和 IMUInertial measurement unit, 惯性测量单元等部件构成机器人定位系统; 温湿度 传感器、 气体传感器、 超声传感器和摄像头构成探 测系统; 整个测控系统由 6S 锂电池供电, 通过无线 网络与外界进行信息交互。 图 3 测控系统基本组成 此外, 为防止发生井下自爆, 本设计对测控系 统的大电流电器采取浇封方式进行防爆, 分别将电 池模块、 控制模块、 传感器模块、 摄像头模块等密 封在各自防爆盒内, 并为摄像头前端专门配置透明 挡板, 再通过防爆接口和防爆电缆连接系统各部件, 保证井下作业安全。 2. 2 机器人主要模块的功能 测控系统针对机器人井下作业的动力供给、 定 位避障、 飞行控制、 环境巡检和信息回传等主要功 能需求, 采用了模块化设计, 具体如下 2. 2. 1 电源管理模块 机器人预期作业长度以 2km 为例, 为了保证数 据采集均匀稳定、 视频图像清晰可辨, 设定机器人 以 2m/ s 的速度匀速飞行, 因此每次巡检时间约在 20min 左右。 考虑到井下巡检作业复杂, 搭载传感 器等载荷较多, 以及对巡检时间的要求, 本文选取 了容量为 8000mAh 的 6S 锂电池来保障机器人系统 的动力供应。 该电池电压为 22. 2V, 可直接为电机供电, 而 机载计算机和飞控系统均需 5V 电压供电, 若另采用 其他电源供电则额外增加了设计成本和系统载荷, 因此采用 LM2596 电压调节芯片将 22. 2V 转换为 5V, 其电路转化原理如图 4 所示。 图 4 降压电路原理 2. 2. 2 自主定位模块 由于地面上常用的四旋翼巡检机器人定位手段 如北斗、 GPS 等无法应用在煤矿环境, 因此, 本 文通过融合光流传感器与惯性测量单元的数据, 确 保机器人在煤矿井下能够达到姿态稳定和精准悬停; 在此基础上, 采用基于相机标定法解算出机器人的 空间位置坐标, 实现井下自主定位, 定位原理如下 通过 PX4flow 光流传感器提取图像中的特征点 信息并增添相应的特征描述, 利用算法多次迭代筛 除误匹配点, 并融合 IMU 数据以消除光流传感器误 差, 实现机器人在井下巷道中的姿态稳定; 对 MT9V034 摄像头标定后, 拍摄机器人悬停点投影处 的地面照片, 用标定函数进行处理后, 通过相机参 数矩阵解算出机器人在巷道地面投影的像素坐标, 通过像素坐标和世界坐标的转化关系, 求得投影点 的世界坐标, 最后代入所测高度值, 便得出机器人 当前空间位置中的世界坐标。 系统运行流程如图 5 所示。 2. 2. 3 超声测距 针对四旋翼机器人空间三维运动的特点, 在其 前、 后、 左、 右、 上、 下六个方向安装 KS103 超声 传感器用于探测障碍物信息, 该传感器最大探测范 围为 1800cm, 探测频率可达 500Hz。 机器人沿预 定路径飞行的过程中, 根据探测到的障碍物距离, 做出相应操作。 当所测距离小于安全值时, 则执行 避障策略调控飞行状态, 使机器人对当前路径做出 调整以避开障碍物。 2. 2. 4 飞行控制模块 煤矿巷道错综复杂, 空间狭窄, 障碍物较多, 281 装备技术 煤 炭 工 程 2021 年第 2 期 图 5 井下定位流程 直接远程操控机器人飞行作业的难度大、 效果差。 机载计算机具有航点解算和策略规划等功能, 通过 在其上对 pixhawk 开源飞控进行高层控制应用程序 的开发, 能够减小井下飞行控制的难度, 提高机器 人飞行的自主能力。 设计思路如下 在机载计算机 上配置 ROSRobot Operating System, 机器人操作系 统环境, 利用 MAVROS 软件包开发高层控制应用 程序。 通过高层控制应用程序向 MAVROS 节点发送 setpoint_ position/ local、 / arming、 set_ mode 等 服务请求来控制机器人飞行, 并利用 MAVROS 节点 订阅 state、 local_ position 等话题来实时获取机器人 的飞行状态及位置信息反馈给机载计算机, 系统使 用 MAVLink 协议通信, 软件结构如图 6 所示。 图 6 软件结构 2. 2. 5 环境巡检模块 该机器人在沿任务路径飞行的过程中, 通过自 身搭载的传感器和摄像头实时检测井下环境参数、 设备状态和人员信息, 有效地提升了巡检作业的效 率和经济性。 该模块主要从温湿度检测、 气体浓度 检测和图像检测方面进行了设计, 机器人巡检流程 如图 7 所示, 具体内容如下 图 7 机器人巡检流程 1 温湿度检测 DHT22 数字温湿度复合传感器, 采用单线制串行接口通信, 体积小、 质量轻, 占用 载荷少。 机器人启动 DHT22 获取环境中温湿度信 息, 经处理后将数据存储并继续下一轮检测, 机载 计算机实时将检测值与设定阈值对比, 超过设定值 则启动报警。 2 气体浓度检测煤矿巷道中的甲烷等可燃气 体, 一旦浓度超过一定范围, 会对人员健康造成危 害, 同时还会引起火灾或爆炸等事故发生。 本文选 用 MQ - 5 气体传感器, 通过气敏材料二氧化锡 SnO2, 将甲烷等可燃气体的浓度变化转化为电气 特征变化, 再经过 AD 模块转换及浓度换算后得到 气体浓度值。 当环境中气体浓度超过设定阈值时, 传感器会发出报警信号。 3 图像检测由于巷道内不宜飞行过高, 为了得 到较大的采集范围, 该机器人选用了视角较宽的 G180H 广角摄像头, 且具有红外夜视功能, 当机器 人作业环境光线较暗时, 仍能通过摄像头采集煤矿 内图像信息, 并可通过程序重新设定采集方式和视 频捕获格式来提高画面质量。 图像采集如图 8 所示, 分别为光线充足和低照 度两种情况下摄像头采集到的图像, 采集画面清晰, 381 2021 年第 2 期 煤 炭 工 程 装备技术 识别度高, 均能满足井下巡检作业的需求。 图 8 图像采集 2. 2. 6 信息回传模块 在不增设回传中继器的前提下, 为了实现井下 信息的长距离可靠回传, 本文提出了利用现有井下 无线网络将巡检信息实时发送至云平台数据库和流 媒体服务器的信息回传设计方案 1 数据回传。 在机器人上创建巡检系统的本地 数据库 MySQL, 针对不同检测信息, 分别建立了 “dht22”、“MQ5”、“flight_ state” 和 “current_ position” 数据表用于存储温湿度、 气体浓度、 飞行 状态和机器人当前位置的数据, 并配置好 python 编 程接口。 在各传感器数据采集的 Python 程序中添加 “插入到数据库” 的语句, 并在云数据库 MySQL 中 创建对应的巡检系统数据库及表格, 设置好外网连 接模式, 接着在 python 程序中配置好外网连接地址。 当机器人执行数据采集程序时, 检测到的数据也同 时回传至云数据库 MySQL。 2 视频回传。 在云平台上搭建好 nginx 流媒体 服 务 器, 并 配 置 好 rtmp Real Time Messaging Protocol, 实时消息传输协议 服务。 机器人通过 ffmpeg 对摄像头采集的图像数据进行编码处理, 并 将编好的 H. 264 码流封装成 rtmp 消息包, 利用井下 无线网络将视频推送至云平台流媒体服务器, 地面 监控中心只需知道 rtmp 推流地址便可在广域网下监 看回传的视频画面。 3 机器人样机实验 3. 1 飞行实验 本文在高 3. 5m, 宽 4m 的实验室环境下, 对巡 检机 器 人 的 自 主 飞 行 性 能 进 行 了 测 试。 通 过 MAVROS 向飞控发送目标位置, 令机器人在初始航 点2m 高处从悬停状态开始飞往目标位置, 并在预定 线路中的不同位置分别设立了三处不同障碍物, 机 器人飞行航点轨迹如图 9 所示。 通过分析飞行轨迹 及其在 XY 平面和 YZ 平面的投影可知, 机器人自主 飞行性能良好, 能够按照预定路线飞往目标位置, 并能针对三处障碍物作出明显的航点和线路调整, 分别执行了向右避障、 向左避障和向上避障。 图 9 机器人路径轨迹图 3. 2 信息回传实验 本次实验在团队现有的云平台上, 分别进行了 数据和视频信息回传的实验, 初步证实了方案的可 行性, 具体如下 1 配置好测控系统, 将其接入实验室 Wi-Fi 网 络进行测试, 执行采集程序后, 在巡检系统云数据 库中查看回传的巡检数据结果。 2 在实验室 Wi-Fi 网络下进行视频推流测试, 在手机端和电脑端输入 rtmp 推流地址, 便可在广域 网下同时监看回传的视频画面。 本次实验中视频的 帧率为 25f/ s, 延迟约 2. 5s, 分辨率为 720480, 初 步证实了视频回传方案的可行性。 4 结 论 1 针对井下环境特点和煤矿巡检需求, 分析了 机器人硬件选型及测控系统设计的要求, 提出了适 用于煤矿巡检的四旋翼机器人设计方案。 通过进行 飞行实验, 结果表明, 该机器人运行稳定, 自主性 能良好, 解决了传统用于地面上空的四旋翼机器人 无法在煤矿井下作业的问题。 2 通过进行信息回传实验, 结果表明, 该机器 人能够将巡检信息实时发送至云平台的数据库和流 媒体服务器, 实现信息可靠回传, 解决了利用收发 设备在巷道内进行信息回传时, 信号易受遮挡、 距 481 装备技术 煤 炭 工 程 2021 年第 2 期 离易受限制且对硬件要求高、 花费需求大等问题。 3 由于当前硬件环境局限, 本文暂将飞行实验 与信息回传实验分别进行了测试, 并初步验证设计 方案的可行性。 但系统各模块具有较高的可移植性, 下一步可集成完整的机器人平台进行实际巡检试飞, 并通过配置 4G 或 5G 模块, 进一步提高方案可 靠性。 参考文献 [ 1 ] 孙继平, 钱晓红. 20042015 年全国煤矿事故分析 [J]. 工矿自动化, 2016, 4211 1-5. [ 2 ] 陈小静, 李智国, 张高峰, 王裕清. 矿井灾害信息探测机器 人的设计与运动学分析 [J].煤矿机械, 2015, 368 13-15. [ 3 ] 王 岩, 马宏伟, 王 星, 杨 林. 基于迭代最近点的井下 无人机实时位姿估计 [J].工矿自动化, 2019, 459 25-29. [ 4 ] 姜俊英, 周 展, 曹现刚, 等. 煤矿巷道悬线巡检机器人结 构设计及仿真 [J]. 工矿自动化, 2018, 445 76-81. [ 5 ] 苏晓光, 姜重然, 于莉莉, 等.农业四旋翼飞行器的研究 [J]. 农机化研究, 2019, 417 75-79, 84. [ 6 ] 李 瑞, 史莹晶, 李青松. 基于 VxWorks 的小型四旋翼飞行 器半实物仿真平台设计 [J]. 实验室研究与探索, 2018, 37 08 88-93. [ 7 ] 段洪伟. 新型垂直起降无人机的发展 [C] / /2014第五届 中国无人机大会论文集. 北京 航空工业出版社, 2014 7. [ 8 ] 李 栋, 林靖宇, 高鹏宇, 等. 无人机输电线路巡检中安全 距离测量方法 [J].广西大学学报自然科学版, 2016, 412 498-505. [ 9 ] Montambault S, Beaudry J, Toussaint K, et al.On the application of VTOL UAVs to the inspection of power utility assets [C] / / Applied Robotics for the Power Industry CARPI, 2010 1st International Conference on. IEEE, 2010. [10] 杨 林, 马宏伟, 王 岩, 等. 煤矿巡检机器人同步定位与 地图 构 建 方 法 研 究 [ J].工 矿 自 动 化, 2019, 45 9 18-24. [11] 齐 帅, 李宝林, 程 岩. 煤矿救援机器人研究应用现状和 需解决的问题 [J]. 矿山机械, 2012, 40 7-10. [12] Rong X, Song R, Song X, et al.Mechanism and Explosion- proof Design for a Coal Mine Detection Robot [ J].Procedia Engineering, 2011, 15 100-104. [13] 马宏伟, 马 琨, 田海波. 矿山钻孔救援探测机器人研究进 展 [J]. 工矿自动化, 2019, 452 24-29. [14] 马宏伟, 薛旭升, 尚万峰. 基于 ABAQUS 的煤矿应急无线通 信中 继 器 设 计 [ J].制 造 业 自 动 化, 2015, 37 10 150-153. [15] 王志同, 牛志刚, 郭晨星, 等. 可自动回撤煤矿探测机器人 设计 [J]. 工矿自动化, 2018, 445 6-12. 责任编辑 赵巧芝 581 2021 年第 2 期 煤 炭 工 程 装备技术