地下无轨采矿装备智能避障技术和方法研究.pdf
2 0 2 0年第 9期/ 第 4 1卷 黄 金 G O L D 机电与自动控制 7 7 地下无轨采矿装备智能避障技术和方法研究 收稿日期 2 0 2 0- 0 8- 1 0 ;修回日期 2 0 2 0- 0 8- 2 0 基金项目 “ 十三五” 国家重点研发计划项目( 2 0 1 8 Y F C 0 6 0 4 4 0 0 ) 作者简介 战 凯( 1 9 6 2 ) , 男, 吉林长春人, 研究员, 博士, 从事金属矿山智能装备、 智能矿山研究工作; 主持的重大项目有国家 8 6 3计划“ 十一 五” “ 十二五” 主题项目“ 地下金属矿智能开采技术” 和“ 十三五” 国家重点研发计划“ 地下金属矿规模化无人采矿关键技术研发与示 范” ; 获得的重大奖项有省部级科技奖 1 0余项, 专利 2 4项等; 北京市南四环西路总部基地 1 8区 2 3号楼, 矿冶科技集团有限公司, 1 0 0 1 6 0 ; E m a i l z h a n k a i @b g r i m m . c o m 战 凯1 , 2 , 3, 余乐文1 , 2 , 3, 张 达1 , 3, 张元生1 , 3 ( 1 . 矿冶科技集团有限公司; 2 . 北京科技大学机械工程学院; 3 . 金属矿山智能开采技术北京市重点实验室) 摘要 在分析现有无轨采矿装备避障技术基础上, 开发了三维避障探测系统, 提出了一种基于 三维环境探测的地下矿山无轨采矿装备智能避障预警方法。介绍了该技术的背景, 建立巷道探测 模型, 包括横向距离和纵向距离判断方法。将该方法应用于铲运机, 证明了该方法在无人铲运机上 的有效性和广阔的应用前景。 关键词 地下开采; 智能避障; 无轨采矿装备; 三维避障探测系统; 分级预警; 雷达 中图分类号 T D 6 7 9 文章编号 1 0 0 1- 1 2 7 7 ( 2 0 2 0 ) 0 9- 0 0 7 7- 0 4 文献标志码 Ad o i 1 0 . 1 1 7 9 2 / h j 2 0 2 0 0 9 1 2 引 言 随着矿业领域向智能化、 无人化方向的发展进程 不断加快, 发展智能采矿技术与装备成为矿山行业的 必经之路。采矿装备的智能化是智能采矿的前提, “ 十二五” 期间, 由北京矿冶研究总院牵头组织实施 的国家高技术研究发展计划( 8 6 3计划) 主题项目“ 地 下金属矿智能开采技术” , 开发了智能铲运机、 智能 装药车、 智能矿用汽车、 智能凿岩台车、 智能潜孔钻机 等智能采矿装备, 攻克了采矿装备的自主定位与导 航、 路径规划与避障、 自主行驶等核心技术, 大幅推进 了国内智能采矿装备的发展[ 1 - 2 ]。 智能避障是实现无轨采矿装备无人驾驶的关键 技术, 是提升地下无轨采矿装备安全高效作业水平的 核心, 大力开发智能避障技术具有迫切需求和重要意 义。国外无轨装备避障技术研究起步较早, 山特维克 公司开发的 A u t o M i n e系统、 O p t i m i n e矿山信息化管 理系统已成为数字化开采的典范。国内起步较晚, 露 天矿山设备避障技术研究者较多。韦海良等[ 3 ]在分 析各种防碰撞技术基础上, 研制了基于 2 4 G多普勒 效应的毫米波雷达防撞系统, 阐述了相关技术原理、 系统组成与功能, 开展了不同天气、 不同道路和车辆 不同方向等条件下试验。李鑫等[ 4 ]在分析防碰撞系 统需求的基础上提出需要采集的物理量, 设计了基于 卫星定位和角运动测算的露天矿卡车防碰撞系统, 但 该系统无法判别高度信息, 容易引起相邻梯度行驶卡 车报警信号的误报, 定位精度只能到米级。史海 平[ 5 ]通过对露天矿安全生产现状分析, 设计了基于 G P S 技术的卡车防碰撞预警系统, 为卡车防碰撞提供 及时、 全方位的预警, 但 G P S系统容易受卫星状态的 影响。杨志勇[ 6 ]开展防碰撞预警技术在 G P S卡车调 度系统中的应用研究, 实现资源的整合与共享。武先 利等[ 7 ]基于双频 R F近距离自组网稳定通信、 复杂环 境视频采集显示、 G P R S数据通信等关键技术, 研制 出了高度集成的露天矿车辆防碰撞与调度系统, 实现 多位一体的车辆间防碰撞预警。卢云峰[ 8 ]研制了露 天矿卡车安防预警预控集成终端, 实现了卡车安防预 警、 人员安防预警、 毫米波雷达防碰撞自动刹车等六 合一功能, 使露天矿卡车安防预警预控管理上升到一 个新的台阶。然而地下矿山无法接收 G P S信号, 露 天矿用卡车防碰撞技术无法在地下矿山应用, 矿冶科 技集团有限公司、 北京科技大学开发了基于 U WB- L a s e r 无轨装备定位导航系统[ 9 - 1 2 ], 通过二维激光雷 达预警系统, 判断设备与巷道距离进行预警, 实现了 无轨装备避障, 但预警阈值设置过大, 行驶过程中经 常报警, 行驶效率低; 如果预警阈值设置过小, 遇到紧 急情况无法提前预警, 安全性差。因此, 本文提出一 种基于三维环境探测的地下矿山无轨采矿装备智能 避障预警方法, 提高采矿装备避障检测准确性, 大幅 降低地下无轨装备作业的事故风险。 1 三维避障探测系统 三维避障探测系统的硬件主要包括核心板、 陀螺 仪、 激光测距传感器、 电动机、 减速机构、 编码器和电 7 8 机电与自动控制 黄 金 动机控制器、 无线路由器、 电池等部分( 见图 1 ) 。 图 1 三维避障探测系统组成 通过电动机带动二维激光测距传感器旋转, 实现 巷道轮廓三维感知, C P U通过 U S B接口采集线激光 的数据, 同时控制电动机的运行; 陀螺仪获取的方位 信息与线激光采集的点数据实时匹配, 再通过以太网 接口, 由无线路由器发送给手持 P D A进行解算, 技术 框架见图 2 。 图 2 三维避障探测系统技术框架 2 智能避障技术研究 2 . 1 巷道探测模型建立 首先将巷道环境按视角划分为 6个区域( 上下 前后左右) , 每个区域拥有 9 0 的视角, 保证空间无缝 不重叠覆盖( 见图 3 ) , 在每个视角范围内统计占据概 率地图的分布。根据分布计算可朝该方向前进的权 值, 选取权值最大的方位执行前进; 当权值都小于一 定值时判定为无可移动方向, 禁止该向移动。具体权 值计算考虑如下因素 1 ) 避障指数 Z , 视角中一定范围内( 如 1 . 5m ) 有 障碍物点, 判为存在障碍物, 禁止该向移动。 2 ) 运行惯性 I , 包括由无轨装备本身动力学特征 图 3 空间方位分割 和驾驶者造成的固定距离, 也要包括由于速度不同造 成的可变距离。 3 ) 空间深度 D , 优先向空间更宽旷的方向移动。 视角内综合深度越大, 该向移动权值越大, 反之越小。 综合考虑以上 3个因素, 通过具体场景测试确定 各项因素值的权重。 2 . 2 巷道避障技术 为了实现无轨采矿装备避障, 需要在无轨装备上 安装三维避障探测系统, 利用激光雷达采集巷道的三 维信息, 从而构建地下巷道三维感知形态, 通过巷道 探测模型评估无轨装备与障碍物或巷道壁的距离, 实 现避障预警。 巷道三维检测信息是无轨装备安全行驶的重要 判断依据, 为了准确评估无轨装备安全行驶趋势, 将 巷道三维空间模型简化投影到平面上, 通过二维平面 距离开展预警评估。将激光雷达扫描得到的直线距 离转化为检测点的二维坐标信息。在平面坐标系中, 为了得到检测点的二维坐标信息, 需要将直线距离值 转换为测量点与激光雷达之间的横向距离和纵向距 离。 横纵距离模型见图 4 。已知无轨装备宽 b , 长 l , 扫描点 P与激光雷达之间的距离 s 和横向安全距离 s M, 扫描点 P与 x 轴之间夹角 α ; 扫描点 P1与激光雷 达之间的距离 s 1, 与 x 轴夹角 α1; 扫描点 P2与激光雷 达之间的距离 s 2, 与 x 轴夹角 α2; h 为有效探测距离。 1 ) 避障指数 Z评估。将激光雷达检测到的数据 信息( 障碍点信息) 转换成坐标点, 障碍点 P i的坐标 信息为( x i, yi) 。 x i= x + sic o s αi ( 1 ) y i= y + sis i nαi ( 2 ) 其中, i = 1 , 2 , , A B [] + 1 。 式中 ( x , y ) 为激光雷达固定位置的坐标信息; A为激 光雷达扫描范围的角度( ) ; B为激光雷达的角度分 辨率; s i为激光雷达检测的障碍点到无轨装备的距离 ( m ) ; α i为障碍点 Pi对应的扫描角度( ) 。 2 0 2 0年第 9期/ 第 4 1卷 机电与自动控制 7 9 图 4 横纵距离模型示意图 2 ) 运行惯性 I 评估。为了保证无轨装备在巷道 环境中运行的安全性, 运行惯性 I 要包括由无轨装备 本身动力学特征和驾驶者造成的固定距离, 也要包括 由于速度不同造成的可变距离, 计算公式为 I = s c+ sd+ v t ( 3 ) 式中 s c为刹车距离( m ) ; sd为反应距离( m ) ; v 为车 速( m/ s ) ; t 为浮动时间参数( s ) 。 I 可以根据复杂度不同的巷道环境做相应调整。 3 ) 空间深度 D评估。通过建立横向距离和纵向 距离判断模型, 识别不同的视角、 车宽等条件下综合 深度权值 D 。根据测量点与激光雷达之间的横向距 离和纵向距离信息, 建立无轨装备的横纵距离模型。 距离判断模型提供的不同的判断条件, 会直接影响无 轨装备避障系统的输出结果, 进而影响下一步行驶动 作的判断。s M为横向安全距离, 其限定无轨装备与 巷道墙壁的最小间距, 激光雷达与巷道墙壁之间的最 小安全距离为 b / 2+ s M; 通过对扫描点横向距离与最 小安全距离的比较, 并辅助纵向距离比较, 将危险状 态分为 3个等级 绿色安全等级、 黄色提醒等级和红 色警示等级。 ( 1 ) 绿色安全等级。满足式 s c o s α≥b / 2+s M, 则表示有效探测区域内所有扫描点均在无轨装备前 方的直线行驶敏感区域以外, 由此可判断在当前的巷 道环境中, 车辆可保持前车架方向不变, 快速直线行 驶。 ( 2 ) 黄色提醒等级。满足式 s c o s α <b / 2+s M, 则表示无轨装备正前方的直线行驶敏感区域内存在 扫描点, 表明巷道出现了方向改变或有障碍物存在, 这种情况是最复杂且难以判断的。为了更准确地判 断当前车辆所处的巷道环境信息, 通过上式筛选出落 在无轨装备直线行驶敏感区域内的扫描点; 如果这些 扫描点满足辅助判断条件①α 1- α2≤5 , 则判定 无轨装备前方出现的巷道出现了方向改变, 要将危险 状态等级提升至黄色提醒等级, 提醒驾驶者注意前方 巷道情况。如果不满足辅助判断条件①, 则利用辅助 判断条件② ‖s 1s i nα1 - s 2s i nα2‖≥l / 2 , 判断这些 扫描点之间的纵向距离, 如果满足辅助判断条件②, 则 说明车辆前方的巷道环境出现了曲线型方向改变或是 巷道两侧出现障碍物, 并且它们之间的纵向距离可以 允许车辆改变角度通过此处, 要将危险状态等级提升 至黄色提醒等级, 提醒驾驶者注意前方巷道情况。 ( 3 ) 红色警示等级。如果无轨装备前方的直线 行驶敏感区域内的扫描点不能通过黄色提醒等级中 的判断条件做出明确判断, 则要将危险状态等级提升 至红色警示等级。红色警示等级中的主要判断公式 和黄色提醒等级中的相同, 即 s c o s α <b / 2+s M, 目 的是筛选出落在无轨装备直线行驶敏感区域内的扫 描点, 再通过 3个辅助判断条件继续判断; 如果扫描 点满足辅助判断条件①α 1- α2 > 5 , 则表明扫描 点在无轨装备前方的直线行驶敏感区域内分布不连 续; 如果扫描点满足辅助判断条件② ‖s 1s i nα1 - s 2s i nα2‖ < l / 2和辅助判断条件③ ‖s1c o s α1 - s 2c o s α2‖ < b + 2 sM, 则表示这些扫描点之间的纵向 距离和横向距离都无法满足无轨装备安全的通过, 从 而将危险状态等级提升至红色警示等级。 3 现场工业试验 无轨装备智能避障技术方法应用于地下巷道的 智能铲运机自主行驶, 试验场地为深圳市中金岭南有 色金属股份有限公司凡口铅锌矿 - 2 4 0m中段的主 斜坡道, 试验场地见图 5 。 图 5 智能铲运机行驶试验现场 在地下巷道的自主行驶试验中, 铲运机采用三级 预警智能避障技术与方法, 最终行驶以直线加曲线为 主, 试验跟踪效果见图 6 。试验结果表明, 本文提出 的智能避障技术可为无轨装备安全行驶提供准确数 8 0 机电与自动控制 黄 金 据支撑。 图 6 基于智能避障方法的行驶跟踪曲线 4 结 语 本文提出了一种无轨采矿装备智能避障技术方 法, 通过对无轨装备进行多区段分级预警, 有效约束 装备行驶路径, 避免无轨装备在行驶过程中互相碰撞 及撞人事故, 并得到了试验验证。基于三维环境探测 的地下矿山无轨采矿装备智能避障预警方法可有效 降低无轨装备作业的事故风险, 提升无轨装备的智能 化程度, 有效降低碰撞事故发生的概率, 提升矿山安 全生产水平, 具有推广应用价值。 [ 参 考 文 献] [ 1 ] 马飞, 杨磆, 顾青, 等. 基于改进 A 算法的地下无人铲运机导 航路径规划[ J ] . 农业机械学报, 2 0 1 5 , 4 6 ( 7 ) 3 0 3- 3 0 9 . [ 2 ] 张元生, 战凯, 马朝阳, 等. 智能矿山技术架构与建设思路[ J ] . 有色金属( 矿山部分) , 2 0 2 0 , 7 2 ( 3 ) 1- 6 . [ 3 ] 韦海良, 郭安斌, 董文斌, 等. 矿用卡车毫米波雷达防碰撞系统 的研究与应用[ J ] . 煤矿安全, 2 0 1 5 , 4 6 ( 增刊 1 ) 4 3- 4 7 . [ 4 ] 李鑫, 尚涛, 周伟, 等. 基于卫星定位和角运动测算的露天矿卡 车防碰撞系统设计[ J ] . 煤矿机械, 2 0 1 5 , 3 6 ( 1 ) 1- 2 . [ 5 ] 史海平. 基于 G P S 的卡车防碰撞预警系统在露天矿的应用[ J ] . 露天采矿技术, 2 0 1 6 , 3 1 ( 7 ) 7 5- 7 8 . [ 6 ] 杨志勇. 防碰撞预警技术在 G P S卡车调度系统中的应用[ J ] . 煤炭科学技术, 2 0 1 8 , 4 6 ( 增刊 1 ) 1 6 1- 1 6 3 . [ 7 ] 武先利, 温良, 鲜希, 等. 露天矿车辆防碰撞调度系统研究[ J ] . 煤炭科学技术, 2 0 1 5 , 4 3 ( 5 ) 8 7- 9 0 , 1 1 7 . [ 8 ] 卢云峰. 露天矿卡车安防预警预控集成终端的研制[ J ] . 中国矿 业, 2 0 1 7 , 2 6 ( 增刊 1 ) 4 0 7- 4 1 0 , 4 1 4 . [ 9 ] 石峰, 顾洪枢, 战凯, 等. 地下铲运机自主行驶与避障控制方法 研究[ J ] . 有色金属( 矿山部分) , 2 0 1 5 , 6 7 ( 5 ) 6 8- 7 5 . [ 1 0 ] 李建国, 战凯, 石峰, 等. 基于最优轨迹跟踪的地下铲运机无人 驾驶技术[ J ] . 农业机械学报, 2 0 1 5 , 4 6 ( 1 2 ) 3 2 3- 3 2 8 . [ 1 1 ] 孟宇, 肖小凤, 赵坤. 基于U WB的地下定位算法和拓扑优化[ J ] . 工程科学学报, 2 0 1 8 , 4 0 ( 6 ) 7 4 3- 7 5 3 . [ 1 2 ] 陆博, 周俊武, 赵建军. 基于 U WB系统的井下车辆高精度定位 研究[ J ] . 有色金属( 矿山部分) , 2 0 1 5 , 6 7 ( 6 ) 5 7- 6 0 . R e s e a r c ho ni n t e l l i g e n t o b s t a c l ea v o i d a n c et e c h n o l o g y a n dme t h o df o ru n d e r g r o u n dt r a c k l e s s mi n i n ge q u i p me n t Z h a nK a i 1 牞 2 牞 3牞 Y uL e w e n1 牞 2 牞 3牞 Z h a n gD a1 牞 3牞 Z h a n gY u a n s h e n g1 牞 3 牗 1 . B G R I M MT e c h n o l o g yG r o u p 牷 2 . S c h o o l o f M e c h a n i c a l E n g i n e e r i n g 牞 U n i v e r s i t yo f S c i e n c e a n dT e c h n o l o g yB e i j i n g 牷 3 . B e i j i n gK e yL a b o r a t o r yo f N o n f e r r o u s I n t e l l i g e n t M i n i n gT e c h n o l o g y 牘 A b s t r a c t 牶 T h et h r e e d i m e n s i o n a l o b s t a c l ea v o i d a n c ea n dd e t e c t i o ns y s t e mi s d e v e l o p e db a s e do nt h ea n a l y s i s o f t h ee x i s t i n g o b s t a c l e a v o i d a n c e t e c h n o l o g y f o r t r a c k l e s s e q u i p m e n t . A ni n t e l l i g e n t o b s t a c l e a v o i d a n c e a n de a r l y w a r n i n g m e t h o df o r t r a c k l e s s m i n i n g e q u i p m e n t i nu n d e r g r o u n dm i n e b a s e do nt h r e e d i m e n s i o n a l e n v i r o n m e n t d e t e c t i o ni s p r o p o s e d . T h eb a c k g r o u n do f t h et e c h n o l o g yi s i n t r o d u c e da n dt h er o a d w a yd e t e c t i o nm o d e l i s e s t a b l i s h e d 牞 i n c l u d i n gt h e m e t h o d s f o r t r a n s v e r s ed i s t a n c ea n dl o n g i t u d i n a l d i s t a n c ej u d g m e n t . T h em e t h o di s a p p l i e dt oaL H Da n dt h er e s u l t s s h o wt h a t t h em e t h o dh a s e f f e c t i v e n e s s a n dw i d ea p p l i c a t i o np r o s p e c t s f o r u n m a n n e dL H D . K e y w o r d s 牶 u n d e r g r o u n dm i n i n g 牷 i n t e l l i g e n t o b s t a c l ea v o i d a n c e 牷 t r a c k l e s se q u i p m e n t 牷 t h r e e d i m e n s i o n a l o b s t a c l e a v o i d a n c ea n dd e t e c t i o ns y s t e m 牷 g r a d e de a r l yw a r n i n g 牷 r a d a r