Research on deviation correction control of rapid tunneling robot based on vision measurement
-
摘要: 针对在煤矿井下高粉尘、低照度环境中,掘进机器人定位与控制精度不高的问题,设计了一种基于视觉测量的快速掘进机器人纠偏控制系统。利用安装在快速掘进机器人上的防爆相机,对后方的激光指向仪进行图像采集,通过以太网将采集的图像信息传输给防爆计算机;利用防爆计算机对图像进行预处理,根据位姿解算模型解算出快速掘进机器人位姿;将解算出的位姿信息与巷道设计轴线信息进行比较,计算出快速掘进机器人位姿与巷道设计轴线间的位姿偏差;根据位姿偏差的类型与大小,采用不同的控制策略计算出修正后的控制量,并输出控制指令;控制指令控制电磁比例阀的阀芯移动,实现对伸缩油缸的控制,根据各区域伸缩油缸的伸缩量不同,对快速掘进机器人进行位姿调整,实现纠偏控制。实验结果表明:位姿视觉测量精度为X方向平均偏差21.334 mm,Y方向平均偏差34.154 mm,偏航角平均偏差为0.493°;纠偏控制精度在X方向小于30 mm,满足实际工况要求。Abstract: Aiming at problems of insufficient positioning and control accuracy of tunneling robot in environment with high dust and low illumination of coal mine, a deviation correction control system of rapid tunneling robot based on vision measurement is designed. The explosion-proof camera installed on rapid tunneling robot is used to collect image of laser pointing instrument at the rear, and the collected image information is transmitted to explosion-proof computer through Ethernet. The explosion-proof computer is used to preprocess the image and then the pose of the rapid tunneling robot is calculated according to pose calculation model. The calculated pose information is compared with designed roadway axis information, and the pose deviation between the pose of the rapid tunneling robot and the roadway design axis is calculated. According to type and size of the pose deviation, different control strategies are adopted to calculate corrected control quantity and control instructions are output. The control command controls spool movement of solenoid proportional valve to control telescopic oil cylinder. According to the different expansion amount of the telescopic cylinder in each area, the pose of the rapid tunneling robot is adjusted to realize deviation correction control. The experimental results show that the average deviation of vision meosurement accuracy in X direction is 21.334 mm, that in Y direction is 34.154 mm, that of yaw angle is 0.493 ° and the error of deviation correction control in X direction is less than 30 mm, which meets requirements of actual working conditions.
-
-
期刊类型引用(23)
1. 杨春平,穆小静. 基于激光测距双阈值误差补偿的机器人步进控制. 机械设计与研究. 2024(01): 73-78 . 百度学术
2. 柳兴旺. 矿山测量工作存在的问题及应对策略研究. 矿业装备. 2024(02): 143-145 . 百度学术
3. 原钢. 智能掘锚成套装备在色连二矿的实践应用. 煤矿机械. 2024(07): 153-156 . 百度学术
4. 张旭辉,李语阳,杨文娟,张超,郑西利,麻兵. 基于改进滑模控制的悬臂式掘进机轨迹跟踪技术. 工程设计学报. 2024(04): 491-501 . 百度学术
5. 宋小芹,王照良. 任务空间内钻锚机器人掘进避障距离控制. 机械设计与制造. 2024(10): 299-304 . 百度学术
6. 曹国锋. 矿用锚杆钻车自动行走及纠偏控制策略的研究. 工程机械与维修. 2024(11): 12-14 . 百度学术
7. 巩师鑫,赵国瑞,王飞. 机器视觉感知理论与技术在煤炭工业领域应用进展综述. 工矿自动化. 2023(05): 7-21 . 本站查看
8. 薛玮哲. 黄陵二号煤矿快速掘进影响因素分析及工艺优化. 陕西煤炭. 2023(04): 159-162 . 百度学术
9. 薛旭升,任众孚,毛清华,张旭辉,马宏伟,王悦. 基于数字孪生的煤矿掘进机器人纠偏控制研究. 工矿自动化. 2022(01): 26-32 . 本站查看
10. 张旭辉,杨文娟,薛旭升,张超,万继成,毛清华,雷孟宇,杜昱阳,马宏伟,赵友军,李晓鹏,胡成军,田胜利. 煤矿远程智能掘进面临的挑战与研究进展. 煤炭学报. 2022(01): 579-597 . 百度学术
11. 宋国栋. 面向掘进工作面爆破质量评价的移动测量机器人技术研究. 煤炭工程. 2022(04): 182-186 . 百度学术
12. 乔佳伟,贾运红,王强. 基于改进粒子群算法的煤矿井下相机参数优化. 煤炭技术. 2022(04): 119-122 . 百度学术
13. 李慧,刘方,张林岗,胡镕显,张建晓. 基于HMM的烟草包装机内衬纸输送位置纠偏方法. 机械与电子. 2022(06): 31-35 . 百度学术
14. 洪卫,钟家富,潘益茅,宋吉利,卫鹏. 基于信息技术的阀门智能控制系统的设计与研究. 计算机测量与控制. 2022(06): 126-131 . 百度学术
15. 申九菊. 枕式包装机纠偏控制系统设计. 包装工程. 2022(13): 231-237 . 百度学术
16. 杨春雨,张鑫. 煤矿机器人环境感知与路径规划关键技术. 煤炭学报. 2022(07): 2844-2872 . 百度学术
17. 史先影. 掘锚一体机高效掘进系统智能控制技术研究. 煤炭科学技术. 2022(S2): 265-270 . 百度学术
18. 马宏伟,王世斌,毛清华,石增武,张旭辉,杨征,曹现刚,薛旭升,夏晶,王川伟. 煤矿巷道智能掘进关键共性技术. 煤炭学报. 2021(01): 310-320 . 百度学术
19. 张旭辉,刘博兴,张超,谢楠,周创,张楷. 基于模糊PID的智能掘进机器人系统轨迹纠偏. 煤矿机械. 2021(05): 194-197 . 百度学术
20. 王清清,奚琳. 基于SSD的码垛机械臂关节速度纠偏运动规划. 计算机仿真. 2021(07): 340-344 . 百度学术
21. 罗文,杨俊彩. 神东矿区快速掘进装备与技术研究现状及展望. 工矿自动化. 2021(S2): 32-38 . 本站查看
22. 罗文,杨俊彩. 神东矿区快速掘进关键技术研究与应用. 智能矿山. 2021(02): 7-14 . 百度学术
23. 宋国栋,魏立科,马宏伟,付霁野,刘希梁. 六轴式小臂机器人运动学理论研究及其在掘锚作业中的应用. 煤炭学报. 2021(S2): 1114-1123 . 百度学术
其他类型引用(6)
计量
- 文章访问数: 84
- HTML全文浏览量: 15
- PDF下载量: 26
- 被引次数: 29