一种煤矿井下钻孔机器人钻臂定位误差检测与补偿方法
摘要:
本发明公开了一种煤矿井下钻孔机器人钻臂定位误差检测与补偿方法,该检测方法采用靶板、激光测距传感器和开孔定向仪配合进行倾角和方位角误差检测;该补偿方法的倾角误差补偿基于倾角中偏角和偏移量变化引入的虚关节建立倾角误差补偿模型,该补偿方法的方位角误差补偿基于关节转动的偏角引入虚关节建立方位角的误差补偿模型,倾角和方位角的误差补偿模型总和即为钻臂总误差补偿模型。本发明可以实时检测钻臂定位中的误差值,并实时进行钻臂定位的补偿,实现钻臂的精确控制。
0/0