Research on deviation correction control of coal mine roadheader based on digital twin
-
摘要: 针对复杂巷道环境下掘进机器人自主纠偏控制难题,通过分析掘进机器人偏移原因,明确了掘进机器人纠偏控制功能需求,提出了一种基于数字孪生的煤矿掘进机器人纠偏控制系统,介绍了系统组成;以掘进机器人对中纠偏为例,分析了系统纠偏控制机理,提出了基于双目视觉图像信息的掘进机器人纠偏控制方法,以双目视觉检测的巷道图像为基础数据,通过提取巷道图像特征及分析巷道坐标系与掘进机器人坐标系关系,解算出掘进机器人相对于巷道空间的位姿参数,根据解算结果对掘进机器人进行纠偏控制;构建了掘进机器人和巷道数字模型及定位定向参数数据库,通过虚实映射关系,实现了掘进机器人虚拟远程纠偏控制。实验结果表明,基于数字孪生的煤矿掘进机器人纠偏控制系统在不同工况下均可有效补偿掘进机器人偏航角和偏移距离,纠偏过程可实时显示在监测监控界面,且纠偏路径规划仿真结果与实际工况一致。Abstract: In order to solve the problem of autonomous deviation control of roadheader in complex roadway environment, the paper analyzes the deviation reasons of roadheader, defines the functional requirements of deviation correction control of roadheader, proposes a deviation correction control system of coal mine roadheader based on digital twin, and introduces the system composition. Taking the roadheader central position control as an example, the system deviation correction control mechanism is analyzed, and a deviation correction control method of the roadheader based on binocular vision image information is proposed. Taking the roadway image detected by binocular vision as the basic data, by extracting the characteristics of the roadway image and analyzing the relationship between the roadway coordinate system and the roadheader coordinate system, the position and attitude parameters of the roadheader relative to the roadway space are calculated, and the deviation correction control of the roadheader is carried out according to the solution results. The digital model and the positioning and orientation parameter database of the roadheader and the roadway are constructed, and the virtual remote deviation correction control of the roadheader is realized through the virtual-real mapping relationship. The experimental results show that the deviation correction control system based on digital twin can compensate the yaw angle and offset distance of the roadheader under different working conditions effectively. The deviation correction process can be displayed on the monitoring interface in real time, and the simulation results of deviation correction path planning are consistent with the actual working conditions.
-
表 1 掘进机器人位姿参数
Table 1. Position and attitude parameters of roadheader
序号 偏移距离/cm 偏航角/(°) 预期工况 1 5 6 右侧偏移 2 −2 −3 左侧偏移 3 4 −5 左侧偏移 4 −6 7 右侧偏移 -
[1] 马宏伟, 王鹏, 张旭辉, 等. 煤矿巷道智能掘进机器人系统关键技术研究[J]. 西安科技大学学报,2020,40(5):751-759.MA Hongwei, WANG Peng, ZHANG Xuhui, et al. Research on key technology of intelligent tunneling robotic system in coal mine[J]. Journal of Xi'an University of Science and Technology,2020,40(5):751-759. [2] 刘峰. 对煤矿智能化发展的认识和思考[J]. 中国煤炭工业,2020(8):5-9. doi: 10.3969/j.issn.1673-9612.2020.08.002LIU Feng. Understanding and thinking on intelligent development of coal mine[J]. China Coal Industry,2020(8):5-9. doi: 10.3969/j.issn.1673-9612.2020.08.002 [3] 葛世荣. 煤矿机器人现状及发展方向[J]. 中国煤炭,2019,45(7):18-27. doi: 10.3969/j.issn.1006-530X.2019.07.004GE Shirong. Present situation and development direction of coal mine robots[J]. China Coal,2019,45(7):18-27. doi: 10.3969/j.issn.1006-530X.2019.07.004 [4] 王苏彧, 杜毅博, 薛光辉, 等. 掘进机远程控制技术及监测系统研究与应用[J]. 中国煤炭,2013,39(4):63-67. doi: 10.3969/j.issn.1006-530X.2013.04.016WANG Suyu, DU Yibo, XUE Guanghui, et al. Research and application of remote control techniques and monitoring system for roadheader[J]. China Coal,2013,39(4):63-67. doi: 10.3969/j.issn.1006-530X.2013.04.016 [5] 张敏骏, 蔡岫航, 吕馥言, 等. 受限巷道空间区域栅格化掘进机自主纠偏研究[J]. 仪器仪表学报,2018,39(3):62-70.ZHANG Minjun, CAI Xiuhang, LYU Fuyan, et al. Research on roadheader auto rectification in limited roadway space based on regional grid[J]. Chinese Journal of Scientific Instrument,2018,39(3):62-70. [6] 吴淼, 沈阳, 吉晓冬, 等. 悬臂式掘进机行走轨迹及偏差感知方法[J]. 煤炭学报,2021,46(7):2046-2056.WU Miao, SHEN Yang, JI Xiaodong, et al. Trajectory and deviation perception method of boom-type roadheader[J]. Journal of China Coal Society,2021,46(7):2046-2056. [7] 宗凯, 符世琛. 大倾角巷道掘进机截割过程整机滑移的力学模型[J]. 黑龙江科技大学学报,2020,30(4):404-410. doi: 10.3969/j.issn.2095-7262.2020.04.010ZONG Kai, FU Shichen. Mechanical model for slippage of roadheader during cutting process in large dip roadway[J]. Journal of Heilongjiang University of Science and Technology,2020,30(4):404-410. doi: 10.3969/j.issn.2095-7262.2020.04.010 [8] 杨健健, 张强, 吴淼, 等. 巷道智能化掘进的自主感知及调控技术研究进展[J]. 煤炭学报,2020,45(6):2045-2055.YANG Jianjian, ZHANG Qiang, WU Miao, et al. Research progress of autonomous perception and control technology for intelligent heading[J]. Journal of China Coal Society,2020,45(6):2045-2055. [9] 张旭辉, 张超, 王妙云, 等. 数字孪生驱动的悬臂式掘进机虚拟操控技术[J]. 计算机集成制造系统,2021,27(6):1617-1628.ZHANG Xuhui, ZHANG Chao, WANG Miaoyun, et al. Digital twin-driven virtual control technology of cantilever roadheader[J]. Computer Integrated Manufacturing Systems,2021,27(6):1617-1628. [10] 张旭辉, 刘博兴, 张超, 等. 基于模糊PID的智能掘进机器人系统轨迹纠偏[J]. 煤矿机械,2021,42(5):194-197.ZHANG Xuhui, LIU Boxing, ZHANG Chao, et al. Trajectory correction of intelligent tunneling robot based on fuzzy PID[J]. Coal Mine Machinery,2021,42(5):194-197. [11] 张旭辉, 赵建勋, 杨文娟, 等. 悬臂式掘进机视觉导航与定向掘进控制技术[J]. 煤炭学报,2021,46(7):2186-2196.ZHANG Xuhui, ZHAO Jianxun, YANG Wenjuan, et al. Vision-based navigation and directional heading control technologies of boom-type roadheader[J]. Journal of China Coal Society,2021,46(7):2186-2196. [12] 张旭辉, 周创, 张超, 等. 基于视觉测量的快速掘进机器人纠偏控制研究[J]. 工矿自动化,2020,46(9):21-26.ZHANG Xuhui, ZHOU Chuang, ZHANG Chao, et al. Research on deviation correction control of rapid tunneling robot based on vision measurement[J]. Industry and Mine Automation,2020,46(9):21-26. [13] 张超, 张旭辉, 毛清华, 等. 煤矿智能掘进机器人数字孪生系统研究及应用[J]. 西安科技大学学报,2020,40(5):813-822.ZHANG Chao, ZHANG Xuhui, MAO Qinghua, et al. Research and application of digital twin system for intelligent tunneling equipment in coal mine[J]. Journal of Xi'an University of Science and Technology,2020,40(5):813-822. [14] 张敏骏, 成荣, 朱煜, 等. 倾斜巷道掘进机纠偏运动分析与控制研究[J/OL]. 煤炭学报: 1-9[2021-09-08].DOI: 10.13225/j.cnki.jccs.2020.0855.ZHANG Minjun, CHENG Rong, ZHU Yu, et al. Study on roadheader rectification running performance and control in the incline coalmine roadway[J/OL]. Journal of China Coal Society:1-9[2021-09-08]. DOI: 10.13225/j.cnki.jccs.2020.0855. [15] 薛旭升, 张旭辉, 毛清华, 等. 基于双目视觉的掘进机器人定位定向方法研究[J]. 西安科技大学学报,2020,40(5):781-789.XUE Xusheng, ZHANG Xuhui, MAO Qinghua, et al. Localization and orientation method of roadheader robot based on binocular vision[J]. Journal of Xi'an University of Science and Technology,2020,40(5):781-789. -