基于双侧钻臂位姿协同约束的凿岩台车车体定位方法

• 作者: 吴昊骏 龚敏
• 来源期刊: 煤炭学报
• 学科: 工学
• 关键词: 凿岩台车 车体定位 双钻臂 位姿矩阵
• 年，卷（期）: 2019,（2）
• 页码范围: 647-654
• 页数: 8页
• 分类号: TD421.2
• 字数: 5084字
• 语种: 中文

摘要

车体定位是凿岩台车钻孔自动控制的先决工序,原有车体定位方法仅在理想无碴工作面可行,当有堆碴车体横向倾斜情况下,推进梁可绕激光束横向旋转造成角变量无法锁定,车体位姿存在无穷解,导致定位误差很大甚至无法使用.为解决这一问题提出利用双钻臂同时参与定位的新方法,从理论上证明了双钻臂法解算车体位姿的可行性,将求车体位姿惟一解的问题转化为求解固定边长三角形顶点位置的问题;基于D-H法及坐标系平移确定了车体-激光坐标系变换关系;引入集合条件找出车体基坐标系实际原点位置,通过MATLAB编程计算车体两侧角变量值,求解车体基坐标系在工作面坐标系下的位姿矩阵,实现车体定位.现场测试结果表明:双钻臂法充分适应有渣条件堆碴高度变化,并能快速求得车体实际位姿确定值;车体竖直方向定位误差在5％以内,不采用误差补偿手段条件下钻孔定位精度在12 cm内.通过对比两种车体定位方法对钻孔定位效果的影响发现:原方法存在定位误差向非定位侧钻臂传递的现象,全站仪测量准确的情况下,非定位侧炮孔平均定位误差较定位侧高出94％.双钻臂法定位则不存在这一问题,其双侧炮孔定位精度与原方法定位侧炮孔定位精度一致,对于误差补偿较为有利.双钻臂定位法已在井下试验得到成功验证,具有普遍性,可用于同类型凿岩台车车体定位.

作者信息

序号	姓名	单位	发文数	被引次数	H指数	G指数
1	龚敏	北京科技大学土木与资源工程学院	52	643	14.0	24.0
2	吴昊骏	北京科技大学土木与资源工程学院	7	34	3.0	5.0