基于末端姿态约束的液压凿岩机械臂运动控制研究

为了使凿岩机械臂末端能够保持期望初始姿态且平稳、准确地移动至目标位置，提出一种基于末端姿态约束的液压凿岩机械臂运动控制方法。首先，基于雅可比矩阵建立机械臂末端广义速度与关节速度关系；然后，分析驱动油缸结构并采用全微分方法建立机械臂关节速度与油缸伸缩速度的函数关系，从而基于末端姿态不变的约束，建立机械臂末端广义速度与油缸伸缩速度的对应关系；最终通过控制器给定相应电信号直接控制各油缸伸缩速度完成对姿态约束下凿岩机械臂末端广义速度的控制。使用MATLAB和V-REP(Virtual Robot Experimentation Platform)软件分别对凿岩机械臂末端速度与关节速度关系以及三角油缸和梁摆动油缸伸缩量与关节角度对应关系进行验证，确保计算过程的正确性。通过现场实验得出数据表明：在末端姿态约束下控制凿岩机械臂保持某一期望初始姿态运动不同时间到达不同位置，凿岩机械臂末端最大姿态角偏差为0.42°,末端位置相对误差不超过0.41%,凿岩机械臂运动平稳，说明该运动控制方法可以在保证平稳运行前提下实现凿岩机械臂末端定位，从而满足工程实际需求。