Positioning error compensation of drilling robot arm for coal mine

Authors

LIANG Chunmiao, CCTEG Xi’an Research Institute (Group) Co., Ltd., Xi’an 710077, ChinaFollow
YAO Ningping, CCTEG Xi’an Research Institute (Group) Co., Ltd., Xi’an 710077, China; China Coal Research Institute, Beijing 100013, ChinaFollow
YAO Yafeng, CCTEG Xi’an Research Institute (Group) Co., Ltd., Xi’an 710077, China; China Coal Research Institute, Beijing 100013, China
PENG Tao, CCTEG Xi’an Research Institute (Group) Co., Ltd., Xi’an 710077, China

Abstract

At present, the pose of drilling robots is mostly adjusted by manual remote control and manual retest in combination. Full automatic adjustment has not been achieved. Besides, due to the low precision of open-loop control and inadequate automation capability, the accurate hole positioning and automatic construction of hole groups cannot be realized by drilling robots with water exploration and discharge, outburst prevention and punching prevention in coal mines. Herein, the kinematic model of drilling arm was established by analyzing the structure and action of the drilling robot’s drilling arm. Meanwhile, the dip angle factors such as machining error, body deformation and assembly clearance were analyzed. It is found that the dip angle and azimuth error will be enlarged because of the structure clearance of worm gear of the rotary reducer, which may be up to 0.85° in the body. Firstly, in order to eliminate the errors, the static and dynamic error compensation model of the drilling arm was established using the traditional kinematics error compensation method of the drilling arm. Besides, the joint clearance and deformation were measured by a total station. Then, the error compensation was obtained by inverse solution based on the compensation model and RBF neural network method. The average error between the expected and the actual pose of drilling arm is 9.6 mm in x direction, 18.2 mm in y direction, and 16 mm in z direction, which meets the requirements of engineering application. Secondly, in order to solve the complexity and non-real-time problems of the traditional test measurement method by a total station, a method to detect the pose error with the laser rangefinder and the high-precision open-hole orienteer in combination was proposed. Thereby, the difference between the actual and theoretical dip angle and azimuth were calculated in real time through ranging, which was used as the control input of the new dip angle and azimuth after error compensation for the real-time error detection and compensation of drilling arm. Finally, the pose error compensation model of laser ranging combination was verified using the traditional total station accuracy detection method. The test shows that: The maximum error difference and the maximum azimuth error obtained by the positioning error detection method of laser ranging combination are within ±0.5° and within ±0.5°, respectively, which are 41.1% and 37.5% higher than that before error compensation, meeting the requirements of drilling robot opening hole positioning error. In this paper, research was firstly carried out on the online accurate positioning and error compensation of the drilling robot’s drilling arm in coal industry, which has important reference and guiding significance for the accurate automatic hole positioning of drilling robots and the automatic construction of hole group.

Keywords

drilling robot, drilling arm positioning, kinematic model, pose error detection, error compensation model, coal mine

DOI

10.12363/issn.1001-1986.23.06.0334

Recommended Citation

LIANG Chunmiao, YAO Ningping, YAO Yafeng, et al. (2024) "Positioning error compensation of drilling robot arm for coal mine," Coal Geology & Exploration: Vol. 52: Iss. 3, Article 16.
DOI: 10.12363/issn.1001-1986.23.06.0334
Available at: https://cge.researchcommons.org/journal/vol52/iss3/16

Reference

[1] 黄开启，苏建华，张宇仁. 井下凿岩机器人自主操作方法研究进展[J]. 矿山机械，2013，41(2)：4−8.

HUANG Kaiqi，SU Jianhua，ZHANG Yuren. Research progress on autogenous operation method of underground rock–drilling robots[J]. Mining & Processing Equipment，2013，41(2)：4−8.

[2] 何清华，周宏兵，吴凡. 凿岩机器人钻臂的运动学研究[J]. 中南工业大学学报，1998，29(5)：483−486.

HE Qinghua，ZHOU Hongbing，WU Fan. The kinematics equations of the boom of rock–drilling robot[J]. Journal of Central South University of Technology，1998，29(5)：483−486.

[3] 谢习华. 隧道凿岩机器人控制系统及定位误差分析与补偿研究[D]. 长沙：中南大学，2009.

XIE Xihua. Research on control system of tunnel rock–drilling robot and analyzing & compensating of its positioning error[D]. Changsha：Central South University，2009.

[4] 夏毅敏，李正光，罗建利，等. 三臂凿岩台车钎杆的绝对定位误差补偿研究[J]. 机械传动，2018，42(10)：1−5.

XIA Yimin，LI Zhengguang，LUO Jianli，et al. Study on absolute positioning error compensation for the drill rod of the three–arm rock–drilling jumbo[J]. Journal of Mechanical Transmission，2018，42(10)：1−5.

[5] 夏毅敏，李正光，罗建利，等. 基于位姿误差补偿的全电脑凿岩台车钎杆定位算法[J]. 中南大学学报(自然科学版)，2019，50(1)：44−51.

XIA Yimin，LI Zhengguang，LUO Jianli，et al. Positioning algorithm of drill rod for full computer–controlled rock–drilling jumbo based on pose error compensation[J]. Journal of Central South University (Science and Technology)，2019，50(1)：44−51.

[6] 夏毅敏，马劼嵩，张亚洲，等. 基于柔度误差检测的锚杆台车机械臂定位[J]. 华南理工大学学报(自然科学版)，2020，48(3)：83−90.

XIA Yimin，MA Jiesong，ZHANG Yazhou，et al. Bolting jumbo boom positioning based on compliance error detection[J]. Journal of South China University of Technology (Natural Science Edition)，2020，48(3)：83−90.

[7] 吴昊骏，龚敏. 基于双侧钻臂位姿协同约束的凿岩台车车体定位方法[J]. 煤炭学报，2019，44(2)：647−654.

WU Haojun，GONG Min. Carriage positioning method of drill rig based on mutual constraints of dual booms[J]. Journal of China Coal Society，2019，44(2)：647−654.

[8] 姚亚峰，姚宁平，彭涛，等. 矿用钻孔机器人加卸钻杆的避障轨迹规划研究[J]. 煤田地质与勘探，2023，51(11)：149−158.

YAO Yafeng，YAO Ningping，PENG Tao，et al. Obstacle-avoidance trajectory planning of mine drilling robot during drill pipe loading and unloading[J]. Coal Geology & Exploration，2023，51(11)：149−158.

[9] 张宪民，刘晗. 3–RRR并联机器人含间隙的运动学标定及误差补偿[J]. 华南理工大学学报(自然科学版)，2014，42(7)：97−103.

ZHANG Xianmin，LIU Han. A clearance approach of kinematic calibration and error compensation for 3–RRR parallel robot[J]. Journal of South China University of Technology (Natural Science Edition)，2014，42(7)：97−103.

[10] 史晓佳，张福民，曲兴华，等. KUKA 工业机器人位姿测量与在线误差补偿[J]. 机械工程学报，2017，53(8)：1−7.

SHI Xiaojia，ZHANG Fumin，QU Xinghua，et al. Position and attitude measurement and online errors compensation for KUKA industrial robots[J]. Journal of Mechanical Engineering，2017，53(8)：1−7.

[11] 李睿，曲兴华. 基于组合测量的机器人运动误差特性分析及定位补偿技术[J]. 机器人，2014，36(3)：279−284.

LI Rui，QU Xinghua. The error feature analysis and positioning compensation technology for robot motion based on combined measurement[J]. Robot，2014，36(3)：279−284.

[12] 杜亮，张铁，戴孝亮. 激光跟踪仪测量距离误差的机器人运动学参数补偿[J]. 红外与激光工程，2015，44(8)：2351−2357.

DU Liang，ZHANG Tie，DAI Xiaoliang. Robot kinematic parameters compensation by measuring distance error using laser tracker system[J]. Infrared and Laser Engineering，2015，44(8)：2351−2357.

[13] 谭月胜，詹登辉，张彭豪. 刚柔耦合串联机械臂末端位置误差分析与补偿[J]. 农业机械学报，2021，52(2)：416−426.

TAN Yuesheng，ZHAN Denghui，ZHANG Penghao. Analysis and compensation of end position error of rigid–flexible coupling serial manipulator[J]. Transactions of the Chinese Society of Agricultural Machinery，2021，52(2)：416−426.

[14] 李文龙，谢核，尹周平，等. 机器人加工几何误差建模研究：Ⅱ参数辨识与位姿优化[J]. 机械工程学报，2021，57(7)：169−184.

LI Wenlong，XIE He，YIN Zhouping，et al. The research of geometric error modeling of robotic machining：II parameter identification and pose optimization[J]. Journal of Mechanical Engineering，2021，57(7)：169−184.

[15] 梁春苗，姚宁平，彭光宇，等. 煤矿井下瓦斯抽采钻孔机器人钻臂运动学研究[J]. 煤矿机械，2021，42(1)：30−33.

LIANG Chunmiao，YAO Ningping，PENG Guangyu，et al. Study on kinematics of drill arm of gas drainage drilling robot in underground coal mine[J]. Coal Mine Machinery，2021，42(1)：30−33.

[16] 梁春苗. 煤矿用钻孔机器人自动加杆识别与钻臂定位误差补偿研究[D]. 北京：煤炭科学研究总院，2022.

LIANG Chunmiao. Study on recognition of automatic drill pipe–adding and positioning error compensation of drilling boom for the drilling robot in coal mine[D]. Beijing：China Coal Research Institute，2022.

[17] 郭吉昌，朱志明，王鑫，等. 全位置焊接机器人逆运动学数值求解及轨迹规划方法[J]. 清华大学学报(自然科学版)，2018，58(3)：292−297.

GUO Jichang，ZHU Zhiming，WANG Xin，et al. Numerical solution of the inverse kinematics and trajectory planning for an all–position welding robot[J]. Journal of Tsinghua University (Science and Technology)，2018，58(3)：292−297.

[18] 张翠. 基于RBF神经网络的机械臂运动控制算法及应用研究[D]. 兰州：兰州交通大学，2014.

ZHANG Cui. Research on algorithm and application of robot manipulator motion control based on RBF neural networks[D]. Lanzhou：Lanzhou Jiaotong University，2014.

[19] 吴强，邓庆文，胡泽启，等. 基于RBF神经网络与代数法的6R机器人逆运动求解[J]. 数字制造科学，2019，17(3)：201−206.

WU Qiang，DENG Qingwen，HU Zeqi，et al. Solution of inverse kinematic for 6R robot based on RBF neural network and algebraic method[J]. Digital Manufacture Science，2019，17(3)：201−206.

[20] 雷孟宇，张旭辉，杨文娟，等. 钻锚机器人钻臂轨迹规划方法研究[J]. 煤田地质与勘探，2023，51(10)：180−190.

LEI Mengyu，ZHANG Xuhui，YANG Wenjuan，et al. Manipulator trajectory planning method of anchor drilling robot[J]. Coal Geology & Exploration，2023，51(10)：180−190.

[21] WANG Wei，WANG Lei，YUN Chao. Design of a two–step calibration method of kinematic parameters for serial robots[J]. Chinese Journal of Mechanical Engineering，2017，30(2)：438−448.