基于模型预测控制的协作焊接双机械臂轨迹跟踪算法

焊接双机械臂协作焊接时，存在从动机械臂对主机械臂末端位置的轨迹跟踪的精确性问题，课题组提出了基于模型预测控制算法的主/从位置协调控制方法。根据所建立的六自由度双机械臂的运动学模型，建立末端位置与关节角度的变换关系以及机械臂的运动预测模型；通过上述模型，对主机械臂采用位置控制方法，并通过从动机械臂末端的三维激光扫描仪测距传感器所获取的主机械臂位置及方向，对从动机械臂采用基于模型预测控制算法的位置控制；根据机械臂关节角度变换旋转运算序列及末端位置的预测模型，通过动态矩阵控制算法，由当前时刻的位置状态及下一时刻位置输入状态对未来某时域内的位置输出状态进行预测，从而实现期望的位置跟踪。最后，采用仿真实验测试来验证该算法的实用有效性，结果表明：从动机械臂末端在有较小超调的情况下快速达到稳态，实现对期望轨迹的跟踪；与传统PID控制算法相比，模型预测控制算法能够更快速、更稳定地达到对期望轨迹的跟踪效果；该算法对期望轨迹的跟踪误差在有小幅波动的情况下可保持在±0.05 mm之内，在无波动的情况下可迅速趋近于零。基于该算法，从动机械臂可根据主机械臂末端动态位置信息更加有效地实现对期望轨迹的实时跟踪。