煤矿用钻孔机器人钻臂定位误差补偿研究

作     者：梁春苗 姚宁平 姚亚峰 彭涛 LIANG Chunmiao;YAO Ningping;YAO Yafeng;PENG Tao

作者机构：中煤科工西安研究院(集团)有限公司陕西西安710077 煤炭科学研究总院北京100013 

出 版 物：《煤田地质与勘探》 (Coal Geology & Exploration)

年 卷 期：2024年第52卷第3期

页      面：153-163页

核心收录：

学科分类：081901[工学-采矿工程] 0819[工学-矿业工程] 08[工学] 

基　　金：国家重点研发计划项目(2022YFB4703601) 中煤科工西安研究院(集团)有限公司顶层设计项目(2020XAYDC01-02) 

主　　题：钻孔机器人 钻臂定位 运动学模型 位姿误差检测 误差补偿模型 煤矿 

摘      要：目前钻孔机器人位姿调节多采用手动遥控调节与人工复测结合,未实现全自动调节,开环控制精度低、自动化能力低、无法实现煤矿用探放水、防突和防冲钻孔机器人精确开孔定位与孔群全自动施工。通过分析钻孔机器人钻臂结构和动作,建立了钻臂运动学模型;通过对加工误差、机身变形、装配间隙等影响因素分析,发现采用回转减速器蜗轮蜗杆结构间隙会引起倾角和方位角误差放大,并在机身平时会引起倾角和方位角误差最大达0.85°;为消除误差,首先采用传统钻臂运动学误差补偿方法建立了钻臂静、动态误差补偿模型,利用全站仪测试关节间隙和变形量,基于补偿模型和RBF神经网络法求逆解得到误差补偿量,钻臂期望位姿与实际位姿误差的x方向平均误差为9.6 mm,y方向平均误差为18.2 mm,z方向平均误差为16 mm,满足工程应用要求;其次为解决传统全站仪试验测量的方法的复杂性和非实时性问题,提出了一种通过激光测距仪和高精度开孔定向仪组合获得位姿误差检测的方法,通过测距实时计算实际和理论倾角、方位角差值,作为误差补偿后的新倾角和方位角的控制输入量,对钻臂进行实时误差检测与补偿;最后利用传统全站仪精度检测方法对激光测距组合位姿误差补偿模型进行验证。试验表明:激光测距组合定位误差检测法最大误差差值在±0.5°以内,方位角最大误差在±0.5°以内,比未采用误差补偿前分别提高了41.1%和37.5%,满足了钻孔机器人开孔定位误差要求。在煤炭行业开展了钻孔机器人钻臂在线精确定位与误差补偿研究,对钻孔机器人精确自动开孔定位及孔群全自动施工具有重要的借鉴和指导意义。