摘要
锚杆钻车机械臂的自动定位打孔可进一步提高巷道支护工艺的自动化作业程度。本文针对某锚杆钻车的串并联混合8自由度冗余机械臂的逆运动学问题展开研究。该机械臂有两大特点,一是串并联混合机构,臂在整体上为串联开链机构,但其大臂存在一个四边形的并联结构;二是冗余自由度,导致逆运动学存在无穷解。针对前者,为便于使用D-H法建立运动学模型,推导了并联结构的运动表达式,将其用一个等效的串联结构来替代。针对后者,详细分析了机械臂的结构与实际工况,设置了逆解的3个条件:1)为保证推进器获得最大打孔行程,设置定位油缸为最大伸长量;2)根据不同类型锚杆孔设定大臂四边形形状,可实现姿态补偿;3)优先使用中臂进行位置补偿,以尽量减少大臂的运动。在以上约束下提出基于位姿分离的逆运动学求解方案,得到的逆解结果充分利用了机械臂的设计特点,且兼顾人工操作过程的直观、方便性。为验证算法,针对一个矩形巷道断面的锚杆孔设计,通过计算机进行了逆解计算,计算精度与速度均有满意的结果;将算法部署到PLC上,在模拟巷道自动打孔试验,结果满足工程要求。
-
单位中南大学; 高性能复杂制造国家重点实验室; 机电工程学院