考虑关节非线性的串联双连杆机械臂工业机器人运动控制

简介

当前,导致多轴工业机器人轨迹跟踪误差的主要非线性因素是各轴上的关节非线性和不同轴间的动力学耦合效应。对此,提出了一种考虑关节非线性的串联双连杆机械臂模型的工业机器人运动控制方法。构造了机械臂运动学和动力学模型,提出了一种参数化建模方法,将连杆的非线性刚度和摩擦力直接辨识为关节非线性,并将该方法应用于具有低频振动特性、对轨迹性能具有重要影响的典型多轴工业机器人的串联双连杆臂,再现串联双连杆机械臂的运动状态,通过数值模拟和实验对比,验证了该方法的有效性。采用含可变陷波滤波器的反馈闭环控制和动态前馈补偿2自由度控制两种控制方案,提高机械臂轨迹跟踪和残余振动抑制的性能。结合4种不同运动形式,开展实验研究,与常规PI轨迹跟踪控制方法进行对比分析。结果表明,采用具有可辨识双连杆动力学模型和带可变陷波滤波器反馈闭环回路的2自由度控制方案能够提高轨迹追踪和残余振动抑制性能。