基于激光靶向跟踪的悬臂式掘进机位姿测量系统研究  

Research on pose measurement system of cantilever roadheader based on laser target tracking

作　　者：薛光辉[1,2] 李圆 张云飞 XUE Guanghui;LI Yuan;ZHANG Yunfei(School of Mechanical Electronic and Information Engineering,China University of Mining and Technology-Beij ing,Beijing 100083,China;Key Laboratory of Intelligent Mining and Robotics,Ministry of Emergency Management,Beijing 100083,China;Qingdao Topscomm Communication Fire Security Co.,Ltd.,Qingdao 266111,China)

机构地区：[1]中国矿业大学(北京)机电与信息工程学院,北京100083 [2]煤矿智能化与机器人创新应用应急管理部重点实验室,北京100083 [3]青岛鼎信通讯消防安全有限公司,山东青岛266111

出　　处：《工矿自动化》2022年第7期13-21,共9页Journal Of Mine Automation

基　　金：国家自然科学基金面上项目(51874308);国家重点基础研究发展计划(973计划)项目(2014CB046306)。

摘　　要：掘进机位姿准确快速测量是煤矿巷道智能掘进的前提和基础。目前悬臂式掘进机位姿测量存在非绝对位姿测量、测量精度低、布置复杂或仅能测量少数位姿参数等问题,无法满足智能掘进需要。针对上述问题,在基于激光靶向跟踪的悬臂式掘进机位姿测量方法的基础上,设计了一种基于激光靶向跟踪的悬臂式掘进机位姿测量系统。该系统由激光跟踪装置和激光标靶组成,激光跟踪装置安装在巷道后方,发射激光到安装在悬臂式掘进机机身上的激光标靶上并跟踪激光标靶移动,通过求解激光跟踪装置、激光标靶、掘进机和巷道等坐标系间的转换矩阵即可测得掘进方向位置、偏距、高度、偏向角、俯仰角和翻滚角6个绝对位姿参数,实现了悬臂式掘进机在巷道大地坐标系中绝对位姿的全参数实时测量。分析了该系统的误差影响因素,仿真得到了其误差分布规律:随着掘进距离增加,掘进机姿态测量误差在一定范围内变化,偏距和高度测量误差呈线性增加趋势;在5~80 m测量范围内,掘进机偏向角、俯仰角和翻滚角测量误差分别小于1.4,1,0.03°,掘进方向位置测量误差小于5 mm,偏距和高度测量误差均小于20 mm。利用履带式机器人底盘搭建了位姿测量实验系统,开展了其在模拟巷道中的位姿测量实验,结果表明,掘进方向位置、偏距和高度测量误差均小于5 mm,偏向角测量误差小于1°,俯仰角测量误差小于0.6°,翻滚角测量误差可忽略不计,与仿真结果一致,证明了该系统的可靠性。The accurate and rapid measurement of the roadheader pose is the premise and foundation of intelligent heading in coal mine roadway.The existing cantilever roadheader pose measurement has the problem of non-absolute pose measurement,low measurement precision,complex arrangement,or only a few pose parameters being measured.The measurement can not meet the intelligent heading requirement.In order to solve the above problems,based on the pose measurement method of the cantilever roadheader based on laser target tracking,a pose measurement system of cantilever roadheader based on laser target tracking is designed.The system consists of a laser tracking device and a laser target.The laser tracking device is arranged behind the roadway,emits laser to the laser target arranged on the cantilever roadheader fuselage,and tracks the movement of the laser target.By solving the conversion matrix between coordinate systems such as laser tracking device,laser target,roadheader and roadway,six absolute pose parameters such as heading direction position,offset,height,deviation angle,pitch angle and roll angle can be measured.The full parameter real-time measurement of absolute pose of cantilever roadheader in roadway coordinate system is realized.The error influence factors of the system are analyzed,and the error distribution law is obtained by simulation.With the increase of heading distance,the pose measurement error of roadheader changes within a certain range.The measurement errors of offset and height increase linearly.Within the measurement range of 5-80 m,the measurement errors of the deviation angle,pitch angle and roll angle of the roadheader are less than 1.4,1,0.03°respectively・The measurement error of the heading direction position is less than 5 mm,and the measurement errors of offset and height are less than 20 mm.Using the crawler robot chassis,an experimental system for pose measurement is built.The pose measurement experiment is carried out in the simulated roadway.The results show that the measurement errors

关 键 词：智能掘进 悬臂式掘进机 绝对位姿 全参数位姿测量 激光跟踪装置 激光标靶 激光靶向跟踪 

分 类 号：TD421.5[矿业工程—矿山机电]