有关节约束超冗余机械臂的增益优化轨迹规划

为了实现超冗余机械臂的实时在线规划,本文提出一种基于雅克比转置矩阵的人工势场轨迹规划方法。轨迹规划不仅要满足末端跟踪精度要求,而且要满足关节速度和角度约束,关节速度主要由轨迹规划算法的增益决定,而增益的大小决定系统稳态性能的好坏,通过优化势场函数和使用加权关节速度,在避免关节限制的前提下减小关节速度范数,从而能选择更大的增益。使用蒙特卡洛法建立最大关节速度与增益的关系,从而确定增益范围。分别在点对点运动和轨迹跟踪运动中选取不同的增益证明算法的正确性和有效性,并在轨迹跟踪运动中引入速度前馈,通过李雅普诺夫稳定性定理证明算法稳定性。通过以超冗余机械臂为模型仿真验证,得出在点对点运动下末端位置偏差小于10~(-4)mm,姿态偏差小于1×10~(-5)rad;轨迹跟踪运动的位置偏差小于10~(-3)mm,姿态偏差小于1×10~(-4)rad。最后进行实验验证,虽然实验过程中轨迹偏差相比于仿真增加一个数量级,但仍符合实验任务需求。