Research on Surface Tracking Method of Industrial Robot Based on Model Predictive Control

Abstract

摘要： 工业机器人执行接触性作业任务时，通常需要稳定控制接触力，比如在磨抛过程中，不平稳的法向接触力容易影响表面质量。为解决力跟踪控制时法向控制速度易超调和不确定环境造成法向接触力不平稳的问题，提出一种基于模型预测控制的工业机器人曲面跟踪方法。首先，根据工件模型几何信息计算出末端工具的运动轨迹，再结合机器人当前位姿求解末端工具的笛卡儿速度；然后，建立末端工具与工件接触时的状态空间模型，并依据末端工具的姿态变化对法向阻尼系数进行在线调节；最后，根据实时力信号的反馈，利用模型预测控制算法对法向速度进行修正，实现曲面恒力跟踪。基于Staubli TX90工业机器人，在末端工具姿态不变和姿态改变的情况下分别进行了曲面跟踪实验，结果显示法向接触力波动范围分别为±1 N和±2 N，方差分别为0.038 1 N2和0.105 9 N2，能够达到较好的力跟踪效果。